LXR uboot/post/lib_powerpc/multi.c

   1/*
   2 * (C) Copyright 2002
   3 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
   4 *
   5 * SPDX-License-Identifier:     GPL-2.0+
   6 */
   7
   8#include <common.h>
   9
  10/*
  11 * CPU test
  12 * Load/store multiple word instructions:       lmw, stmw
  13 *
  14 * 27 consecutive words are loaded from a source memory buffer
  15 * into GPRs r5 through r31. After that, 27 consecutive words are stored
  16 * from the GPRs r5 through r31 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
  25extern void cpu_post_exec_02(ulong *code, ulong op1, ulong op2);
  26
  27int cpu_post_test_multi(void)
  28{
  29        int ret = 0;
  30        unsigned int i;
  31        ulong src[27], dst[27];
  32        int flag = disable_interrupts();
  33
  34        ulong code[] = {
  35                ASM_LMW(5, 3, 0),       /* lmw  r5, 0(r3)       */
  36                ASM_STMW(5, 4, 0),      /* stmr r5, 0(r4)       */
  37                ASM_BLR,                /* blr                  */
  38        };
  39
  40        for (i = 0; i < ARRAY_SIZE(src); ++i) {
  41                src[i] = i;
  42                dst[i] = 0;
  43        }
  44
  45        cpu_post_exec_02(code, (ulong) src, (ulong) dst);
  46
  47        ret = memcmp(src, dst, sizeof(dst)) == 0 ? 0 : -1;
  48
  49        if (ret != 0)
  50                post_log("Error at multi test !\n");
  51
  52        if (flag)
  53                enable_interrupts();
  54
  55        return ret;
  56}
  57
  58#endif
  59