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