post/lib_powerpc/string.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * (C) Copyright 2002
   4  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
   5  */
   6
   7 #include <common.h>
   8 #include <irq_func.h>
   9
  10 /*
  11  * CPU test
  12  * Load/store string instructions:      lswi, stswi, lswx, stswx
  13  *
  14  * Several consecutive bytes from a source memory buffer are loaded
  15  * left to right into GPRs. After that, the bytes are stored
  16  * from the GPRs into a target memory buffer. The contents
  17  * of the source and target buffers are then compared.
  18  */
  19
  20 #include <post.h>
  21 #include "cpu_asm.h"
  22
  23 #if CONFIG_POST & CONFIG_SYS_POST_CPU
  24
  25 extern void cpu_post_exec_02 (ulong *code, ulong op1, ulong op2);
  26 extern void cpu_post_exec_04 (ulong *code, ulong op1, ulong op2, ulong op3,
  27     ulong op4);
  28
  29 int cpu_post_test_string (void)
  30 {
  31     int ret = 0;
  32     unsigned int i;
  33     int flag = disable_interrupts();
  34
  35     if (ret == 0)
  36     {
  37         char src [31], dst [31];
  38
  39         ulong code[] =
  40         {
  41             ASM_LSWI(5, 3, 31),
  42             ASM_STSWI(5, 4, 31),
  43             ASM_BLR,
  44         };
  45
  46         for (i = 0; i < sizeof(src); i ++)
  47         {
  48             src[i] = (char) i;
  49             dst[i] = 0;
  50         }
  51
  52         cpu_post_exec_02(code, (ulong)src, (ulong)dst);
  53
  54         ret = memcmp(src, dst, sizeof(dst)) == 0 ? 0 : -1;
  55     }
  56
  57     if (ret == 0)
  58     {
  59         char src [95], dst [95];
  60
  61         ulong code[] =
  62         {
  63             ASM_LSWX(8, 3, 5),
  64             ASM_STSWX(8, 4, 5),
  65             ASM_BLR,
  66         };
  67
  68         for (i = 0; i < sizeof(src); i ++)
  69         {
  70             src[i] = (char) i;
  71             dst[i] = 0;
  72         }
  73
  74         cpu_post_exec_04(code, (ulong)src, (ulong)dst, 0, sizeof(src));
  75
  76         ret = memcmp(src, dst, sizeof(dst)) == 0 ? 0 : -1;
  77     }
  78
  79     if (ret != 0)
  80     {
  81         post_log ("Error at string test !\n");
  82     }
  83
  84     if (flag)
  85         enable_interrupts();
  86
  87     return ret;
  88 }
  89
  90 #endif