LXR uboot/post/board/lwmon5/dspic.c

   1/*
   2 * (C) Copyright 2008 Dmitry Rakhchev, EmCraft Systems, rda@emcraft.com
   3 *
   4 * Developed for DENX Software Engineering GmbH
   5 *
   6 * SPDX-License-Identifier:     GPL-2.0+
   7 */
   8
   9#include <common.h>
  10
  11/* There are two tests for dsPIC currently implemented:
  12 * 1. dsPIC ready test. Done in board_early_init_f(). Only result verified here.
  13 * 2. dsPIC POST result test.  This test gets dsPIC POST codes and version.
  14 */
  15
  16#include <post.h>
  17
  18#include <i2c.h>
  19#include <asm/io.h>
  20
  21DECLARE_GLOBAL_DATA_PTR;
  22
  23#define DSPIC_POST_ERROR_REG    0x800
  24#define DSPIC_SYS_ERROR_REG     0x802
  25#define DSPIC_SYS_VERSION_REG   0x804
  26#define DSPIC_FW_VERSION_REG    0x808
  27
  28#if CONFIG_POST & CONFIG_SYS_POST_BSPEC1
  29
  30/* Verify that dsPIC ready test done early at hw init passed ok */
  31int dspic_init_post_test(int flags)
  32{
  33        if (in_be32((void *)CONFIG_SYS_DSPIC_TEST_ADDR) &
  34            CONFIG_SYS_DSPIC_TEST_MASK) {
  35                post_log("dsPIC init test failed\n");
  36                return 1;
  37        }
  38
  39        return 0;
  40}
  41
  42#endif /* CONFIG_POST & CONFIG_SYS_POST_BSPEC1 */
  43
  44#if CONFIG_POST & CONFIG_SYS_POST_BSPEC2
  45/* Read a register from the dsPIC. */
  46int dspic_read(ushort reg, ushort *data)
  47{
  48        uchar buf[sizeof(*data)];
  49        int rval;
  50
  51        if (i2c_read(CONFIG_SYS_I2C_DSPIC_IO_ADDR, reg, 2, buf, 2))
  52                return -1;
  53        rval = i2c_read(CONFIG_SYS_I2C_DSPIC_IO_ADDR, reg, sizeof(reg),
  54                        buf, sizeof(*data));
  55        *data = (buf[0] << 8) | buf[1];
  56
  57        return rval;
  58}
  59
  60/* Verify error codes regs, display version */
  61int dspic_post_test(int flags)
  62{
  63        ushort data;
  64        int ret = 0;
  65
  66        post_log("\n");
  67
  68        /* read dspic FW-Version */
  69        if (dspic_read(DSPIC_FW_VERSION_REG, &data)) {
  70                post_log("dsPIC: failed read FW-Version\n");
  71                ret = 1;
  72        } else {
  73                post_log("dsPIC FW-Version:  %u.%u\n",
  74                         (data >> 8) & 0xFF, data & 0xFF);
  75        }
  76
  77        /* read dspic SYS-Version */
  78        if (dspic_read(DSPIC_SYS_VERSION_REG, &data)) {
  79                post_log("dsPIC: failed read version\n");
  80                ret = 1;
  81        } else {
  82                post_log("dsPIC SYS-Version: %u.%u\n",
  83                         (data >> 8) & 0xFF, data & 0xFF);
  84        }
  85
  86        /* read dspic POST error code */
  87        if (dspic_read(DSPIC_POST_ERROR_REG, &data)) {
  88                post_log("dsPIC: failed read POST code\n");
  89                ret = 1;
  90        } else {
  91                post_log("dsPIC POST-ERROR   code:  0x%04X\n", data);
  92        }
  93
  94        /* read dspic SYS error code */
  95        if ((data = dspic_read(DSPIC_SYS_ERROR_REG, &data))) {
  96                post_log("dsPIC: failed read system error\n");
  97                ret = 1;
  98        } else {
  99                post_log("dsPIC SYS-ERROR    code:  0x%04X\n", data);
 100        }
 101
 102        return ret;
 103}
 104
 105#endif /* CONFIG_POST & CONFIG_SYS_POST_BSPEC2 */
 106