mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-08-22 01:48:52 +09:00
![Marek Behún](/assets/img/avatar_default.png)
If PCIe Mox module is connected we want to have PCIe node enabled in U-Boot's device tree. Signed-off-by: Marek Behun <marek.behun@nic.cz> Signed-off-by: Stefan Roese <sr@denx.de>
210 lines
4.2 KiB
C
210 lines
4.2 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright (C) 2018 Marek Behun <marek.behun@nic.cz>
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <asm/io.h>
|
|
#include <dm.h>
|
|
#include <clk.h>
|
|
#include <spi.h>
|
|
#include <linux/string.h>
|
|
#include <linux/libfdt.h>
|
|
#include <fdt_support.h>
|
|
|
|
#ifdef CONFIG_WDT_ARMADA_37XX
|
|
#include <wdt.h>
|
|
#endif
|
|
|
|
#define MAX_MOX_MODULES 10
|
|
|
|
#define MOX_MODULE_SFP 0x1
|
|
#define MOX_MODULE_PCI 0x2
|
|
#define MOX_MODULE_TOPAZ 0x3
|
|
#define MOX_MODULE_PERIDOT 0x4
|
|
#define MOX_MODULE_USB3 0x5
|
|
#define MOX_MODULE_PASSPCI 0x6
|
|
|
|
#define ARMADA_37XX_NB_GPIO_SEL 0xd0013830
|
|
#define ARMADA_37XX_SPI_CTRL 0xd0010600
|
|
#define ARMADA_37XX_SPI_CFG 0xd0010604
|
|
#define ARMADA_37XX_SPI_DOUT 0xd0010608
|
|
#define ARMADA_37XX_SPI_DIN 0xd001060c
|
|
|
|
#define PCIE_PATH "/soc/pcie@d0070000"
|
|
|
|
DECLARE_GLOBAL_DATA_PTR;
|
|
|
|
#if defined(CONFIG_OF_BOARD_FIXUP)
|
|
int board_fix_fdt(void *blob)
|
|
{
|
|
u8 topology[MAX_MOX_MODULES];
|
|
int i, size, node;
|
|
bool enable;
|
|
|
|
/*
|
|
* SPI driver is not loaded in driver model yet, but we have to find out
|
|
* if pcie should be enabled in U-Boot's device tree. Therefore we have
|
|
* to read SPI by reading/writing SPI registers directly
|
|
*/
|
|
|
|
writel(0x563fa, ARMADA_37XX_NB_GPIO_SEL);
|
|
writel(0x10df, ARMADA_37XX_SPI_CFG);
|
|
writel(0x2005b, ARMADA_37XX_SPI_CTRL);
|
|
|
|
while (!(readl(ARMADA_37XX_SPI_CTRL) & 0x2))
|
|
udelay(1);
|
|
|
|
for (i = 0; i < MAX_MOX_MODULES; ++i) {
|
|
writel(0x0, ARMADA_37XX_SPI_DOUT);
|
|
|
|
while (!(readl(ARMADA_37XX_SPI_CTRL) & 0x2))
|
|
udelay(1);
|
|
|
|
topology[i] = readl(ARMADA_37XX_SPI_DIN) & 0xff;
|
|
if (topology[i] == 0xff)
|
|
break;
|
|
|
|
topology[i] &= 0xf;
|
|
}
|
|
|
|
size = i;
|
|
|
|
writel(0x5b, ARMADA_37XX_SPI_CTRL);
|
|
|
|
if (size > 1 && (topology[1] == MOX_MODULE_PCI ||
|
|
topology[1] == MOX_MODULE_USB3 ||
|
|
topology[1] == MOX_MODULE_PASSPCI))
|
|
enable = true;
|
|
else
|
|
enable = false;
|
|
|
|
node = fdt_path_offset(blob, PCIE_PATH);
|
|
|
|
if (node < 0) {
|
|
printf("Cannot find PCIe node in U-Boot's device tree!\n");
|
|
return 0;
|
|
}
|
|
|
|
if (fdt_setprop_string(blob, node, "status",
|
|
enable ? "okay" : "disabled") < 0) {
|
|
printf("Cannot %s PCIe in U-Boot's device tree!\n",
|
|
enable ? "enable" : "disable");
|
|
return 0;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
#endif
|
|
|
|
#ifdef CONFIG_WDT_ARMADA_37XX
|
|
static struct udevice *watchdog_dev;
|
|
|
|
void watchdog_reset(void)
|
|
{
|
|
static ulong next_reset;
|
|
ulong now;
|
|
|
|
if (!watchdog_dev)
|
|
return;
|
|
|
|
now = timer_get_us();
|
|
|
|
/* Do not reset the watchdog too often */
|
|
if (now > next_reset) {
|
|
wdt_reset(watchdog_dev);
|
|
next_reset = now + 100000;
|
|
}
|
|
}
|
|
#endif
|
|
|
|
int board_init(void)
|
|
{
|
|
/* address of boot parameters */
|
|
gd->bd->bi_boot_params = CONFIG_SYS_SDRAM_BASE + 0x100;
|
|
|
|
#ifdef CONFIG_WDT_ARMADA_37XX
|
|
if (uclass_get_device(UCLASS_WDT, 0, &watchdog_dev)) {
|
|
printf("Cannot find Armada 3720 watchdog!\n");
|
|
} else {
|
|
printf("Enabling Armada 3720 watchdog (3 minutes timeout).\n");
|
|
wdt_start(watchdog_dev, 180000, 0);
|
|
}
|
|
#endif
|
|
|
|
return 0;
|
|
}
|
|
|
|
int last_stage_init(void)
|
|
{
|
|
struct spi_slave *slave;
|
|
struct udevice *dev;
|
|
u8 din[10], dout[10];
|
|
int ret, i;
|
|
size_t len = 0;
|
|
char module_topology[128];
|
|
|
|
ret = spi_get_bus_and_cs(0, 1, 20000000, SPI_CPHA, "spi_generic_drv",
|
|
"mox-modules@1", &dev, &slave);
|
|
if (ret)
|
|
goto fail;
|
|
|
|
ret = spi_claim_bus(slave);
|
|
if (ret)
|
|
goto fail_free;
|
|
|
|
memset(din, 0, 10);
|
|
memset(dout, 0, 10);
|
|
|
|
ret = spi_xfer(slave, 80, dout, din, SPI_XFER_ONCE);
|
|
if (ret)
|
|
goto fail_release;
|
|
|
|
if (din[0] != 0x00 && din[0] != 0xff)
|
|
goto fail_release;
|
|
|
|
printf("Module Topology:\n");
|
|
for (i = 1; i < 10 && din[i] != 0xff; ++i) {
|
|
u8 mid = din[i] & 0xf;
|
|
size_t mlen;
|
|
const char *mname = "";
|
|
|
|
switch (mid) {
|
|
case 0x1:
|
|
mname = "sfp-";
|
|
printf("% 4i: SFP Module\n", i);
|
|
break;
|
|
case 0x2:
|
|
mname = "pci-";
|
|
printf("% 4i: Mini-PCIe Module\n", i);
|
|
break;
|
|
case 0x3:
|
|
mname = "topaz-";
|
|
printf("% 4i: Topaz Switch Module\n", i);
|
|
break;
|
|
default:
|
|
printf("% 4i: unknown (ID %i)\n", i, mid);
|
|
}
|
|
|
|
mlen = strlen(mname);
|
|
if (len + mlen < sizeof(module_topology)) {
|
|
strcpy(module_topology + len, mname);
|
|
len += mlen;
|
|
}
|
|
}
|
|
printf("\n");
|
|
|
|
module_topology[len > 0 ? len - 1 : 0] = '\0';
|
|
|
|
env_set("module_topology", module_topology);
|
|
|
|
fail_release:
|
|
spi_release_bus(slave);
|
|
fail_free:
|
|
spi_free_slave(slave);
|
|
fail:
|
|
if (ret)
|
|
printf("Cannot read module topology!\n");
|
|
return ret;
|
|
}
|