Tom Rini | 10e4779 | 2018-05-06 17:58:06 -0400 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
Wolfgang Denk | b38e0df | 2007-03-06 18:08:43 +0100 | [diff] [blame] | 2 | /* |
| 3 | * (C) Copyright 2002 |
| 4 | * Wolfgang Denk, DENX Software Engineering, wd@denx.de. |
Wolfgang Denk | b38e0df | 2007-03-06 18:08:43 +0100 | [diff] [blame] | 5 | */ |
| 6 | |
| 7 | #include <common.h> |
Simon Glass | 8f3f761 | 2019-11-14 12:57:42 -0700 | [diff] [blame] | 8 | #include <irq_func.h> |
Simon Glass | 0f2af88 | 2020-05-10 11:40:05 -0600 | [diff] [blame] | 9 | #include <log.h> |
Wolfgang Denk | b38e0df | 2007-03-06 18:08:43 +0100 | [diff] [blame] | 10 | |
| 11 | /* |
| 12 | * CPU test |
| 13 | * Load/store multiple word instructions: lmw, stmw |
| 14 | * |
Wolfgang Denk | 059a2d6 | 2011-12-23 01:29:12 +0000 | [diff] [blame] | 15 | * 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 Denk | b38e0df | 2007-03-06 18:08:43 +0100 | [diff] [blame] | 18 | * of the source and target buffers are then compared. |
| 19 | */ |
| 20 | |
Wolfgang Denk | b38e0df | 2007-03-06 18:08:43 +0100 | [diff] [blame] | 21 | #include <post.h> |
| 22 | #include "cpu_asm.h" |
| 23 | |
Tom Rini | 8eaa3c7 | 2022-11-19 18:45:44 -0500 | [diff] [blame^] | 24 | #if CFG_POST & CONFIG_SYS_POST_CPU |
Wolfgang Denk | b38e0df | 2007-03-06 18:08:43 +0100 | [diff] [blame] | 25 | |
Wolfgang Denk | 417c65c | 2011-12-23 01:29:10 +0000 | [diff] [blame] | 26 | extern void cpu_post_exec_02(ulong *code, ulong op1, ulong op2); |
Wolfgang Denk | b38e0df | 2007-03-06 18:08:43 +0100 | [diff] [blame] | 27 | |
Wolfgang Denk | 417c65c | 2011-12-23 01:29:10 +0000 | [diff] [blame] | 28 | int cpu_post_test_multi(void) |
Wolfgang Denk | b38e0df | 2007-03-06 18:08:43 +0100 | [diff] [blame] | 29 | { |
Wolfgang Denk | 417c65c | 2011-12-23 01:29:10 +0000 | [diff] [blame] | 30 | int ret = 0; |
| 31 | unsigned int i; |
Wolfgang Denk | 059a2d6 | 2011-12-23 01:29:12 +0000 | [diff] [blame] | 32 | ulong src[27], dst[27]; |
Wolfgang Denk | 417c65c | 2011-12-23 01:29:10 +0000 | [diff] [blame] | 33 | int flag = disable_interrupts(); |
Wolfgang Denk | b38e0df | 2007-03-06 18:08:43 +0100 | [diff] [blame] | 34 | |
Wolfgang Denk | bc3e91a | 2011-12-23 01:29:11 +0000 | [diff] [blame] | 35 | 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 Denk | b38e0df | 2007-03-06 18:08:43 +0100 | [diff] [blame] | 40 | |
Wolfgang Denk | bc3e91a | 2011-12-23 01:29:11 +0000 | [diff] [blame] | 41 | for (i = 0; i < ARRAY_SIZE(src); ++i) { |
| 42 | src[i] = i; |
| 43 | dst[i] = 0; |
| 44 | } |
Wolfgang Denk | b38e0df | 2007-03-06 18:08:43 +0100 | [diff] [blame] | 45 | |
Wolfgang Denk | bc3e91a | 2011-12-23 01:29:11 +0000 | [diff] [blame] | 46 | cpu_post_exec_02(code, (ulong) src, (ulong) dst); |
Wolfgang Denk | b38e0df | 2007-03-06 18:08:43 +0100 | [diff] [blame] | 47 | |
Wolfgang Denk | bc3e91a | 2011-12-23 01:29:11 +0000 | [diff] [blame] | 48 | ret = memcmp(src, dst, sizeof(dst)) == 0 ? 0 : -1; |
Wolfgang Denk | b38e0df | 2007-03-06 18:08:43 +0100 | [diff] [blame] | 49 | |
Wolfgang Denk | 417c65c | 2011-12-23 01:29:10 +0000 | [diff] [blame] | 50 | if (ret != 0) |
| 51 | post_log("Error at multi test !\n"); |
Wolfgang Denk | b38e0df | 2007-03-06 18:08:43 +0100 | [diff] [blame] | 52 | |
Wolfgang Denk | 417c65c | 2011-12-23 01:29:10 +0000 | [diff] [blame] | 53 | if (flag) |
| 54 | enable_interrupts(); |
Stefan Roese | 3762825 | 2008-08-06 14:05:38 +0200 | [diff] [blame] | 55 | |
Wolfgang Denk | 417c65c | 2011-12-23 01:29:10 +0000 | [diff] [blame] | 56 | return ret; |
Wolfgang Denk | b38e0df | 2007-03-06 18:08:43 +0100 | [diff] [blame] | 57 | } |
| 58 | |
| 59 | #endif |