blob: 4df45790ab65d0e95e91371ac7539aff680042b8 [file] [log] [blame]
Tom Rini10e47792018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
Wolfgang Denkb38e0df2007-03-06 18:08:43 +01002/*
3 * (C) Copyright 2002
4 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
Wolfgang Denkb38e0df2007-03-06 18:08:43 +01005 */
6
Tom Riniabb9a042024-05-18 20:20:43 -06007#include <common.h>
Simon Glass8f3f7612019-11-14 12:57:42 -07008#include <irq_func.h>
Simon Glass0f2af882020-05-10 11:40:05 -06009#include <log.h>
Wolfgang Denkb38e0df2007-03-06 18:08:43 +010010
11/*
12 * CPU test
13 * Load/store multiple word instructions: lmw, stmw
14 *
Wolfgang Denk059a2d62011-12-23 01:29:12 +000015 * 27 consecutive words are loaded from a source memory buffer
16 * into GPRs r5 through r31. After that, 27 consecutive words are stored
17 * from the GPRs r5 through r31 into a target memory buffer. The contents
Wolfgang Denkb38e0df2007-03-06 18:08:43 +010018 * of the source and target buffers are then compared.
19 */
20
Wolfgang Denkb38e0df2007-03-06 18:08:43 +010021#include <post.h>
22#include "cpu_asm.h"
23
Tom Rini3dd5d4a2022-12-04 10:14:17 -050024#if CFG_POST & CFG_SYS_POST_CPU
Wolfgang Denkb38e0df2007-03-06 18:08:43 +010025
Wolfgang Denk417c65c2011-12-23 01:29:10 +000026extern void cpu_post_exec_02(ulong *code, ulong op1, ulong op2);
Wolfgang Denkb38e0df2007-03-06 18:08:43 +010027
Wolfgang Denk417c65c2011-12-23 01:29:10 +000028int cpu_post_test_multi(void)
Wolfgang Denkb38e0df2007-03-06 18:08:43 +010029{
Wolfgang Denk417c65c2011-12-23 01:29:10 +000030 int ret = 0;
31 unsigned int i;
Wolfgang Denk059a2d62011-12-23 01:29:12 +000032 ulong src[27], dst[27];
Wolfgang Denk417c65c2011-12-23 01:29:10 +000033 int flag = disable_interrupts();
Wolfgang Denkb38e0df2007-03-06 18:08:43 +010034
Wolfgang Denkbc3e91a2011-12-23 01:29:11 +000035 ulong code[] = {
36 ASM_LMW(5, 3, 0), /* lmw r5, 0(r3) */
37 ASM_STMW(5, 4, 0), /* stmr r5, 0(r4) */
38 ASM_BLR, /* blr */
39 };
Wolfgang Denkb38e0df2007-03-06 18:08:43 +010040
Wolfgang Denkbc3e91a2011-12-23 01:29:11 +000041 for (i = 0; i < ARRAY_SIZE(src); ++i) {
42 src[i] = i;
43 dst[i] = 0;
44 }
Wolfgang Denkb38e0df2007-03-06 18:08:43 +010045
Wolfgang Denkbc3e91a2011-12-23 01:29:11 +000046 cpu_post_exec_02(code, (ulong) src, (ulong) dst);
Wolfgang Denkb38e0df2007-03-06 18:08:43 +010047
Wolfgang Denkbc3e91a2011-12-23 01:29:11 +000048 ret = memcmp(src, dst, sizeof(dst)) == 0 ? 0 : -1;
Wolfgang Denkb38e0df2007-03-06 18:08:43 +010049
Wolfgang Denk417c65c2011-12-23 01:29:10 +000050 if (ret != 0)
51 post_log("Error at multi test !\n");
Wolfgang Denkb38e0df2007-03-06 18:08:43 +010052
Wolfgang Denk417c65c2011-12-23 01:29:10 +000053 if (flag)
54 enable_interrupts();
Stefan Roese37628252008-08-06 14:05:38 +020055
Wolfgang Denk417c65c2011-12-23 01:29:10 +000056 return ret;
Wolfgang Denkb38e0df2007-03-06 18:08:43 +010057}
58
59#endif