LXR uboot/board/mscc/serval/serval.c

   1// SPDX-License-Identifier: (GPL-2.0+ OR MIT)
   2/*
   3 * Copyright (c) 2018 Microsemi Corporation
   4 */
   5
   6#include <common.h>
   7#include <image.h>
   8#include <init.h>
   9#include <asm/global_data.h>
  10#include <asm/io.h>
  11#include <led.h>
  12#include <miiphy.h>
  13
  14enum {
  15        BOARD_TYPE_PCB106 = 0xAABBCD00,
  16        BOARD_TYPE_PCB105,
  17};
  18
  19int board_early_init_r(void)
  20{
  21        /* Prepare SPI controller to be used in master mode */
  22        writel(0, BASE_CFG + ICPU_SW_MODE);
  23
  24        /* Address of boot parameters */
  25        gd->bd->bi_boot_params = CFG_SYS_SDRAM_BASE;
  26
  27        return 0;
  28}
  29
  30int board_phy_config(struct phy_device *phydev)
  31{
  32        phy_write(phydev, 0, 31, 0x10);
  33        phy_write(phydev, 0, 18, 0x80F0);
  34        while (phy_read(phydev, 0, 18) & 0x8000)
  35                ;
  36        phy_write(phydev, 0, 14, 0x800);
  37        phy_write(phydev, 0, 31, 0);
  38        return 0;
  39}
  40
  41static void do_board_detect(void)
  42{
  43        u16 gpio_in_reg;
  44
  45        /* Set MDIO and MDC */
  46        mscc_gpio_set_alternate(9, 2);
  47        mscc_gpio_set_alternate(10, 2);
  48
  49        /* Set GPIO page */
  50        mscc_phy_wr(1, 16, 31, 0x10);
  51        if (!mscc_phy_rd(1, 16, 15, &gpio_in_reg)) {
  52                if (gpio_in_reg & 0x200)
  53                        gd->board_type = BOARD_TYPE_PCB106;
  54                else
  55                        gd->board_type = BOARD_TYPE_PCB105;
  56        } else {
  57                gd->board_type = BOARD_TYPE_PCB105;
  58        }
  59        mscc_phy_wr(1, 16, 31, 0x0);
  60}
  61
  62#if defined(CONFIG_MULTI_DTB_FIT)
  63int board_fit_config_name_match(const char *name)
  64{
  65        if (gd->board_type == BOARD_TYPE_PCB106 &&
  66            strcmp(name, "serval_pcb106") == 0)
  67                return 0;
  68
  69        if (gd->board_type == BOARD_TYPE_PCB105 &&
  70            strcmp(name, "serval_pcb105") == 0)
  71                return 0;
  72
  73        return -1;
  74}
  75#endif
  76
  77#if defined(CONFIG_DTB_RESELECT)
  78int embedded_dtb_select(void)
  79{
  80        do_board_detect();
  81        fdtdec_setup();
  82
  83        return 0;
  84}
  85#endif
  86