blob: f082e4c546cc051b3105e1f3aa77791fa699e226 [file] [log] [blame]
Tom Rini83d290c2018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
Wolfgang Denkad5bb452007-03-06 18:08:43 +01002/*
3 * (C) Copyright 2002
4 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
Wolfgang Denkad5bb452007-03-06 18:08:43 +01005 */
6
7#include <common.h>
Simon Glass36bf4462019-11-14 12:57:42 -07008#include <irq_func.h>
Simon Glassf7ae49f2020-05-10 11:40:05 -06009#include <log.h>
Wolfgang Denkad5bb452007-03-06 18:08:43 +010010
11/*
12 * CPU test
13 * Load/store multiple word instructions: lmw, stmw
14 *
Wolfgang Denk7ddd4472011-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 Denkad5bb452007-03-06 18:08:43 +010018 * of the source and target buffers are then compared.
19 */
20
Wolfgang Denkad5bb452007-03-06 18:08:43 +010021#include <post.h>
22#include "cpu_asm.h"
23
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +020024#if CONFIG_POST & CONFIG_SYS_POST_CPU
Wolfgang Denkad5bb452007-03-06 18:08:43 +010025
Wolfgang Denka63aec52011-12-23 01:29:10 +000026extern void cpu_post_exec_02(ulong *code, ulong op1, ulong op2);
Wolfgang Denkad5bb452007-03-06 18:08:43 +010027
Wolfgang Denka63aec52011-12-23 01:29:10 +000028int cpu_post_test_multi(void)
Wolfgang Denkad5bb452007-03-06 18:08:43 +010029{
Wolfgang Denka63aec52011-12-23 01:29:10 +000030 int ret = 0;
31 unsigned int i;
Wolfgang Denk7ddd4472011-12-23 01:29:12 +000032 ulong src[27], dst[27];
Wolfgang Denka63aec52011-12-23 01:29:10 +000033 int flag = disable_interrupts();
Wolfgang Denkad5bb452007-03-06 18:08:43 +010034
Wolfgang Denk38081ff2011-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 Denkad5bb452007-03-06 18:08:43 +010040
Wolfgang Denk38081ff2011-12-23 01:29:11 +000041 for (i = 0; i < ARRAY_SIZE(src); ++i) {
42 src[i] = i;
43 dst[i] = 0;
Wolfgang Denkad5bb452007-03-06 18:08:43 +010044 }
45
Wolfgang Denk38081ff2011-12-23 01:29:11 +000046 cpu_post_exec_02(code, (ulong) src, (ulong) dst);
47
48 ret = memcmp(src, dst, sizeof(dst)) == 0 ? 0 : -1;
49
Wolfgang Denka63aec52011-12-23 01:29:10 +000050 if (ret != 0)
51 post_log("Error at multi test !\n");
Wolfgang Denkad5bb452007-03-06 18:08:43 +010052
Wolfgang Denka63aec52011-12-23 01:29:10 +000053 if (flag)
54 enable_interrupts();
Wolfgang Denkad5bb452007-03-06 18:08:43 +010055
Wolfgang Denka63aec52011-12-23 01:29:10 +000056 return ret;
Wolfgang Denkad5bb452007-03-06 18:08:43 +010057}
58
59#endif