LXR uboot/post/lib_powerpc/string.c

   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
  41extern void cpu_post_exec_02 (ulong *code, ulong op1, ulong op2);
  42extern void cpu_post_exec_04 (ulong *code, ulong op1, ulong op2, ulong op3,
  43    ulong op4);
  44
  45#include <bedbug/regs.h>
  46int 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