1 /* 2 * (C) Copyright 2002 3 * Wolfgang Denk, DENX Software Engineering, wd@denx.de. 4 * 5 * See file CREDITS for list of people who contributed to this 6 * project. 7 * 8 * This program is free software; you can redistribute it and/or 9 * modify it under the terms of the GNU General Public License as 10 * published by the Free Software Foundation; either version 2 of 11 * the License, or (at your option) any later version. 12 * 13 * This program is distributed in the hope that it will be useful, 14 * but WITHOUT ANY WARRANTY; without even the implied warranty of 15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 16 * GNU General Public License for more details. 17 * 18 * You should have received a copy of the GNU General Public License 19 * along with this program; if not, write to the Free Software 20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, 21 * MA 02111-1307 USA 22 */ 23 24 #include <common.h> 25 26 /* 27 * CPU test 28 * Load/store string instructions: lswi, stswi, lswx, stswx 29 * 30 * Several consecutive bytes from a source memory buffer are loaded 31 * left to right into GPRs. After that, the bytes are stored 32 * from the GPRs into a target memory buffer. The contents 33 * of the source and target buffers are then compared. 34 */ 35 36 #include <post.h> 37 #include "cpu_asm.h" 38 39 #if CONFIG_POST & CONFIG_SYS_POST_CPU 40 41 extern void cpu_post_exec_02 (ulong *code, ulong op1, ulong op2); 42 extern void cpu_post_exec_04 (ulong *code, ulong op1, ulong op2, ulong op3, 43 ulong op4); 44 45 #include <bedbug/regs.h> 46 int cpu_post_test_string (void) 47 { 48 int ret = 0; 49 unsigned int i; 50 int flag = disable_interrupts(); 51 52 if (ret == 0) 53 { 54 char src [31], dst [31]; 55 56 ulong code[] = 57 { 58 ASM_LSWI(5, 3, 31), 59 ASM_STSWI(5, 4, 31), 60 ASM_BLR, 61 }; 62 63 for (i = 0; i < sizeof(src); i ++) 64 { 65 src[i] = (char) i; 66 dst[i] = 0; 67 } 68 69 cpu_post_exec_02(code, (ulong)src, (ulong)dst); 70 71 ret = memcmp(src, dst, sizeof(dst)) == 0 ? 0 : -1; 72 } 73 74 if (ret == 0) 75 { 76 char src [95], dst [95]; 77 78 ulong code[] = 79 { 80 ASM_LSWX(8, 3, 5), 81 ASM_STSWX(8, 4, 5), 82 ASM_BLR, 83 }; 84 85 for (i = 0; i < sizeof(src); i ++) 86 { 87 src[i] = (char) i; 88 dst[i] = 0; 89 } 90 91 cpu_post_exec_04(code, (ulong)src, (ulong)dst, 0, sizeof(src)); 92 93 ret = memcmp(src, dst, sizeof(dst)) == 0 ? 0 : -1; 94 } 95 96 if (ret != 0) 97 { 98 post_log ("Error at string test !\n"); 99 } 100 101 if (flag) 102 enable_interrupts(); 103 104 return ret; 105 } 106 107 #endif 108