[PATCH v2 4/9] drivers: Add fu540 board driver

Jagan Teki
2020-05-19T19:23:35Z

Add fu540 board driver, which is used to get runtime
boot mode of fu540 boards.

Cc: Mario Six <mario.six@gdsys.cc>
Cc: Tom Rini <trini@konsulko.com>
Cc: Simon Glass <sjg@chromium.org>
Cc: Jean-Jacques Hiblot <jjhiblot@ti.com>
Signed-off-by: Jagan Teki <jagan@amarulasolutions.com>
---
Changes for v2:
- new patch

drivers/board/Kconfig | 8 ++++
drivers/board/Makefile | 1 +
drivers/board/fu540.c | 86 ++++++++++++++++++++++++++++++++++++++++++
3 files changed, 95 insertions(+)
create mode 100644 drivers/board/fu540.c

diff --git a/drivers/board/Kconfig b/drivers/board/Kconfig
index 254f657049..306ee76bbd 100644
--- a/drivers/board/Kconfig
+++ b/drivers/board/Kconfig
@@ -12,6 +12,14 @@ config SPL_BOARD
depends on SPL_DM
bool "Enable board driver support in SPL"

+config BOARD_FU540
+ bool "Enable board driver for the FU540 boards"
+ depends on RISCV
+ select SPL_BOARD
+ help
+ Support querying board information for the fu540 boards, like
+ get soc mode select, get SPL boot device and etc.
+
config BOARD_GAZERBEAM
bool "Enable board driver for the Gazerbeam board"
help
diff --git a/drivers/board/Makefile b/drivers/board/Makefile
index cc16361755..e924472779 100644
--- a/drivers/board/Makefile
+++ b/drivers/board/Makefile
@@ -3,5 +3,6 @@
# (C) Copyright 2017
# Mario Six, Guntermann & Drunck GmbH, mario.six at gdsys.cc
obj-y += board-uclass.o
+obj-$(CONFIG_BOARD_FU540) += fu540.o
obj-$(CONFIG_BOARD_GAZERBEAM) += gazerbeam.o
obj-$(CONFIG_BOARD_SANDBOX) += sandbox.o
diff --git a/drivers/board/fu540.c b/drivers/board/fu540.c
new file mode 100644
index 0000000000..68d356df6b
--- /dev/null
+++ b/drivers/board/fu540.c
@@ -0,0 +1,86 @@
+// SPDX-License-Identifier: GPL-2.0+
+/*
+ * Copyright (c) 2020 Amarula Solutions(India)
+ */
+
+#include <common.h>
+#include <dm.h>
+#include <dm/device_compat.h>
+#include <board.h>
+#include <spl.h>
+#include <asm/io.h>
+
+#define MODE_SELECT_QSPI 0x6
+#define MODE_SELECT_SD 0xb
+#define MODE_SELECT_MASK GENMASK(3, 0)
+
+struct fu540_board {
+ void __iomem *regs;
+};
+
+static int fu540_get_boot_device(struct udevice *dev)
+{
+ struct fu540_board *priv = dev_get_priv(dev);
+ u8 boot_device = BOOT_DEVICE_MMC1;
+ u32 reg;
+
+ reg = readl(priv->regs);
+ switch (reg & MODE_SELECT_MASK) {
+ case MODE_SELECT_QSPI:
+ boot_device = BOOT_DEVICE_SPI;
+ break;
+ case MODE_SELECT_SD:
+ boot_device = BOOT_DEVICE_MMC1;
+ break;
+ default:
+ dev_err(dev,
+ "Unsupported boot device 0x%x but trying MMC1\n",
+ boot_device);
+ break;
+ }
+
+ return boot_device;
+}
+
+static int fu540_board_get_int(struct udevice *dev, int id, int *val)
+{
+ switch (id) {
+ case BOARD_SPL_BOOT_DEVICE:
+ *val = fu540_get_boot_device(dev);
+ break;
+ default:
+ dev_err(dev, "%s: Integer value %d unknown\n", dev->name, id);
+ return -EINVAL;
+ }
+
+ return 0;
+}
+
+static const struct board_ops fu540_board_ops = {
+ .get_int = fu540_board_get_int,
+};
+
+static int fu540_board_probe(struct udevice *dev)
+{
+ struct fu540_board *priv = dev_get_priv(dev);
+
+ priv->regs = (void __iomem *)dev_read_addr(dev);
+ if (IS_ERR(priv->regs))
+ return PTR_ERR(priv->regs);
+
+ return 0;
+}
+
+static const struct udevice_id fu540_board_ids[] = {
+ { .compatible = "sifive,fu540-modeselect", },
+ { /* sentinel */ }
+};
+
+U_BOOT_DRIVER(fu540_board) = {
+ .id = UCLASS_BOARD,
+ .name = "fu540_board",
+ .of_match = fu540_board_ids,
+ .ops = &fu540_board_ops,
+ .priv_auto_alloc_size = sizeof(struct fu540_board),
+ .probe = fu540_board_probe,
+};
--
2.20.1