summaryrefslogtreecommitdiff
diff options
context:
space:
mode:
Diffstat
-rw-r--r--cmd/cyclic.c5
-rw-r--r--common/board_f.c11
-rw-r--r--common/board_r.c1
-rw-r--r--common/cyclic.c50
-rw-r--r--drivers/spi/Kconfig5
-rw-r--r--drivers/spi/Makefile1
-rw-r--r--drivers/spi/npcm_pspi.c226
-rw-r--r--include/asm-generic/global_data.h8
-rw-r--r--include/cyclic.h35
-rw-r--r--include/linux/list.h53
-rw-r--r--test/test-main.c3
11 files changed, 298 insertions, 100 deletions
diff --git a/cmd/cyclic.c b/cmd/cyclic.c
index c1bc556aade..97324d82405 100644
--- a/cmd/cyclic.c
+++ b/cmd/cyclic.c
@@ -61,10 +61,11 @@ static int do_cyclic_demo(struct cmd_tbl *cmdtp, int flag, int argc,
static int do_cyclic_list(struct cmd_tbl *cmdtp, int flag, int argc,
char *const argv[])
{
- struct cyclic_info *cyclic, *tmp;
+ struct cyclic_info *cyclic;
+ struct hlist_node *tmp;
u64 cnt, freq;
- list_for_each_entry_safe(cyclic, tmp, cyclic_get_list(), list) {
+ hlist_for_each_entry_safe(cyclic, tmp, cyclic_get_list(), list) {
cnt = cyclic->run_cnt * 1000000ULL * 100ULL;
freq = lldiv(cnt, timer_get_us() - cyclic->start_time_us);
printf("function: %s, cpu-time: %lld us, frequency: %lld.%02d times/s\n",
diff --git a/common/board_f.c b/common/board_f.c
index faa096479b3..7c26e235fc0 100644
--- a/common/board_f.c
+++ b/common/board_f.c
@@ -839,7 +839,6 @@ static const init_fnc_t init_sequence_f[] = {
initf_malloc,
log_init,
initf_bootstage, /* uses its own timer, so does not need DM */
- cyclic_init,
event_init,
#ifdef CONFIG_BLOBLIST
bloblist_init,
@@ -957,6 +956,16 @@ static const init_fnc_t init_sequence_f[] = {
do_elf_reloc_fixups,
#endif
clear_bss,
+ /*
+ * Deregister all cyclic functions before relocation, so that
+ * gd->cyclic_list does not contain any references to pre-relocation
+ * devices. Drivers will register their cyclic functions anew when the
+ * devices are probed again.
+ *
+ * This should happen as late as possible so that the window where a
+ * watchdog device is not serviced is as small as possible.
+ */
+ cyclic_unregister_all,
#if !defined(CONFIG_ARM) && !defined(CONFIG_SANDBOX) && \
!CONFIG_IS_ENABLED(X86_64)
jump_to_copy,
diff --git a/common/board_r.c b/common/board_r.c
index 828ad448668..db9cfb33ad2 100644
--- a/common/board_r.c
+++ b/common/board_r.c
@@ -617,7 +617,6 @@ static init_fnc_t init_sequence_r[] = {
#endif
initr_barrier,
initr_malloc,
- cyclic_init,
log_init,
initr_bootstage, /* Needs malloc() but has its own timer */
#if defined(CONFIG_CONSOLE_RECORD)
diff --git a/common/cyclic.c b/common/cyclic.c
index 7abb82c16a9..a49bfc88f5c 100644
--- a/common/cyclic.c
+++ b/common/cyclic.c
@@ -20,9 +20,10 @@ DECLARE_GLOBAL_DATA_PTR;
void hw_watchdog_reset(void);
-struct list_head *cyclic_get_list(void)
+struct hlist_head *cyclic_get_list(void)
{
- return &gd->cyclic->cyclic_list;
+ /* Silence "discards 'volatile' qualifier" warning. */
+ return (struct hlist_head *)&gd->cyclic_list;
}
struct cyclic_info *cyclic_register(cyclic_func_t func, uint64_t delay_us,
@@ -30,11 +31,6 @@ struct cyclic_info *cyclic_register(cyclic_func_t func, uint64_t delay_us,
{
struct cyclic_info *cyclic;
- if (!gd->cyclic->cyclic_ready) {
- pr_debug("Cyclic IF not ready yet\n");
- return NULL;
- }
-
cyclic = calloc(1, sizeof(struct cyclic_info));
if (!cyclic) {
pr_debug("Memory allocation error\n");
@@ -47,14 +43,14 @@ struct cyclic_info *cyclic_register(cyclic_func_t func, uint64_t delay_us,
cyclic->name = strdup(name);
cyclic->delay_us = delay_us;
cyclic->start_time_us = timer_get_us();
- list_add_tail(&cyclic->list, &gd->cyclic->cyclic_list);
+ hlist_add_head(&cyclic->list, cyclic_get_list());
return cyclic;
}
int cyclic_unregister(struct cyclic_info *cyclic)
{
- list_del(&cyclic->list);
+ hlist_del(&cyclic->list);
free(cyclic);
return 0;
@@ -62,15 +58,16 @@ int cyclic_unregister(struct cyclic_info *cyclic)
void cyclic_run(void)
{
- struct cyclic_info *cyclic, *tmp;
+ struct cyclic_info *cyclic;
+ struct hlist_node *tmp;
uint64_t now, cpu_time;
/* Prevent recursion */
- if (gd->cyclic->cyclic_running)
+ if (gd->flags & GD_FLG_CYCLIC_RUNNING)
return;
- gd->cyclic->cyclic_running = true;
- list_for_each_entry_safe(cyclic, tmp, &gd->cyclic->cyclic_list, list) {
+ gd->flags |= GD_FLG_CYCLIC_RUNNING;
+ hlist_for_each_entry_safe(cyclic, tmp, cyclic_get_list(), list) {
/*
* Check if this cyclic function needs to get called, e.g.
* do not call the cyclic func too often
@@ -99,7 +96,7 @@ void cyclic_run(void)
}
}
}
- gd->cyclic->cyclic_running = false;
+ gd->flags &= ~GD_FLG_CYCLIC_RUNNING;
}
void schedule(void)
@@ -112,32 +109,17 @@ void schedule(void)
* schedule() might get called very early before the cyclic IF is
* ready. Make sure to only call cyclic_run() when it's initalized.
*/
- if (gd && gd->cyclic && gd->cyclic->cyclic_ready)
+ if (gd)
cyclic_run();
}
-int cyclic_uninit(void)
+int cyclic_unregister_all(void)
{
- struct cyclic_info *cyclic, *tmp;
+ struct cyclic_info *cyclic;
+ struct hlist_node *tmp;
- list_for_each_entry_safe(cyclic, tmp, &gd->cyclic->cyclic_list, list)
+ hlist_for_each_entry_safe(cyclic, tmp, cyclic_get_list(), list)
cyclic_unregister(cyclic);
- gd->cyclic->cyclic_ready = false;
-
- return 0;
-}
-
-int cyclic_init(void)
-{
- int size = sizeof(struct cyclic_drv);
-
- gd->cyclic = (struct cyclic_drv *)malloc(size);
- if (!gd->cyclic)
- return -ENOMEM;
-
- memset(gd->cyclic, '\0', size);
- INIT_LIST_HEAD(&gd->cyclic->cyclic_list);
- gd->cyclic->cyclic_ready = true;
return 0;
}
diff --git a/drivers/spi/Kconfig b/drivers/spi/Kconfig
index 19a55def051..c6900f449d5 100644
--- a/drivers/spi/Kconfig
+++ b/drivers/spi/Kconfig
@@ -326,6 +326,11 @@ config NPCM_FIU_SPI
This enables support for the Flash Interface Unit SPI controller
in master mode.
+config NPCM_PSPI
+ bool "PSPI driver for Nuvoton NPCM SoC"
+ help
+ PSPI driver for NPCM SoC
+
config NXP_FSPI
bool "NXP FlexSPI driver"
depends on SPI_MEM
diff --git a/drivers/spi/Makefile b/drivers/spi/Makefile
index 6d1154b902b..674d81caae3 100644
--- a/drivers/spi/Makefile
+++ b/drivers/spi/Makefile
@@ -53,6 +53,7 @@ obj-$(CONFIG_MVEBU_A3700_SPI) += mvebu_a3700_spi.o
obj-$(CONFIG_MXC_SPI) += mxc_spi.o
obj-$(CONFIG_MXS_SPI) += mxs_spi.o
obj-$(CONFIG_NPCM_FIU_SPI) += npcm_fiu_spi.o
+obj-$(CONFIG_NPCM_PSPI) += npcm_pspi.o
obj-$(CONFIG_NXP_FSPI) += nxp_fspi.o
obj-$(CONFIG_ATCSPI200_SPI) += atcspi200_spi.o
obj-$(CONFIG_OCTEON_SPI) += octeon_spi.o
diff --git a/drivers/spi/npcm_pspi.c b/drivers/spi/npcm_pspi.c
new file mode 100644
index 00000000000..bd9ac654113
--- /dev/null
+++ b/drivers/spi/npcm_pspi.c
@@ -0,0 +1,226 @@
+// SPDX-License-Identifier: GPL-2.0+
+/*
+ * Copyright (c) 2021 Nuvoton Technology.
+ */
+
+#include <common.h>
+#include <dm.h>
+#include <spi.h>
+#include <clk.h>
+#include <asm/gpio.h>
+#include <linux/iopoll.h>
+
+#define MAX_DIV 127
+
+/* Register offsets */
+#define PSPI_DATA 0
+#define PSPI_CTL1 2
+#define PSPI_STAT 4
+
+/* PSPI_CTL1 fields */
+#define PSPI_CTL1_SPIEN BIT(0)
+#define PSPI_CTL1_SCM BIT(7)
+#define PSPI_CTL1_SCIDL BIT(8)
+#define PSPI_CTL1_SCDV_MASK GENMASK(15, 9)
+#define PSPI_CTL1_SCDV_SHIFT 9
+
+/* PSPI_STAT fields */
+#define PSPI_STAT_BSY BIT(0)
+#define PSPI_STAT_RBF BIT(1)
+
+struct npcm_pspi_priv {
+ void __iomem *base;
+ struct clk clk;
+ struct gpio_desc cs_gpio;
+ u32 max_hz;
+};
+
+static inline void spi_cs_activate(struct udevice *dev)
+{
+ struct udevice *bus = dev->parent;
+ struct npcm_pspi_priv *priv = dev_get_priv(bus);
+
+ dm_gpio_set_value(&priv->cs_gpio, 0);
+}
+
+static inline void spi_cs_deactivate(struct udevice *dev)
+{
+ struct udevice *bus = dev->parent;
+ struct npcm_pspi_priv *priv = dev_get_priv(bus);
+
+ dm_gpio_set_value(&priv->cs_gpio, 1);
+}
+
+static inline void npcm_pspi_enable(struct npcm_pspi_priv *priv)
+{
+ u16 val;
+
+ val = readw(priv->base + PSPI_CTL1);
+ val |= PSPI_CTL1_SPIEN;
+ writew(val, priv->base + PSPI_CTL1);
+}
+
+static inline void npcm_pspi_disable(struct npcm_pspi_priv *priv)
+{
+ u16 val;
+
+ val = readw(priv->base + PSPI_CTL1);
+ val &= ~PSPI_CTL1_SPIEN;
+ writew(val, priv->base + PSPI_CTL1);
+}
+
+static int npcm_pspi_xfer(struct udevice *dev, unsigned int bitlen,
+ const void *dout, void *din, unsigned long flags)
+{
+ struct udevice *bus = dev->parent;
+ struct npcm_pspi_priv *priv = dev_get_priv(bus);
+ void __iomem *base = priv->base;
+ const u8 *tx = dout;
+ u8 *rx = din;
+ u32 bytes = bitlen / 8;
+ u8 tmp;
+ u32 val;
+ int i, ret = 0;
+
+ npcm_pspi_enable(priv);
+
+ if (flags & SPI_XFER_BEGIN)
+ spi_cs_activate(dev);
+
+ for (i = 0; i < bytes; i++) {
+ /* Making sure we can write */
+ ret = readb_poll_timeout(base + PSPI_STAT, val,
+ !(val & PSPI_STAT_BSY),
+ 1000000);
+ if (ret < 0)
+ break;
+
+ if (tx)
+ writeb(*tx++, base + PSPI_DATA);
+ else
+ writeb(0, base + PSPI_DATA);
+
+ /* Wait till write completed */
+ ret = readb_poll_timeout(base + PSPI_STAT, val,
+ !(val & PSPI_STAT_BSY),
+ 1000000);
+ if (ret < 0)
+ break;
+
+ /* Wait till read buffer full */
+ ret = readb_poll_timeout(base + PSPI_STAT, val,
+ (val & PSPI_STAT_RBF),
+ 1000000);
+ if (ret < 0)
+ break;
+
+ tmp = readb(base + PSPI_DATA);
+ if (rx)
+ *rx++ = tmp;
+ }
+
+ if (flags & SPI_XFER_END)
+ spi_cs_deactivate(dev);
+
+ npcm_pspi_disable(priv);
+
+ return ret;
+}
+
+static int npcm_pspi_set_speed(struct udevice *bus, uint speed)
+{
+ struct npcm_pspi_priv *priv = dev_get_priv(bus);
+ ulong apb_clock;
+ u32 divisor;
+ u16 val;
+
+ apb_clock = clk_get_rate(&priv->clk);
+ if (!apb_clock)
+ return -EINVAL;
+
+ if (speed > priv->max_hz)
+ speed = priv->max_hz;
+
+ divisor = DIV_ROUND_CLOSEST(apb_clock, (2 * speed) - 1);
+ if (divisor > MAX_DIV)
+ divisor = MAX_DIV;
+
+ val = readw(priv->base + PSPI_CTL1);
+ val &= ~PSPI_CTL1_SCDV_MASK;
+ val |= divisor << PSPI_CTL1_SCDV_SHIFT;
+ writew(val, priv->base + PSPI_CTL1);
+
+ debug("%s: apb_clock=%lu speed=%d divisor=%u\n",
+ __func__, apb_clock, speed, divisor);
+
+ return 0;
+}
+
+static int npcm_pspi_set_mode(struct udevice *bus, uint mode)
+{
+ struct npcm_pspi_priv *priv = dev_get_priv(bus);
+ u16 pspi_mode, val;
+
+ switch (mode & (SPI_CPOL | SPI_CPHA)) {
+ case SPI_MODE_0:
+ pspi_mode = 0;
+ break;
+ case SPI_MODE_1:
+ pspi_mode = PSPI_CTL1_SCM;
+ break;
+ case SPI_MODE_2:
+ pspi_mode = PSPI_CTL1_SCIDL;
+ break;
+ case SPI_MODE_3:
+ pspi_mode = PSPI_CTL1_SCIDL | PSPI_CTL1_SCM;
+ break;
+ default:
+ break;
+ }
+
+ val = readw(priv->base + PSPI_CTL1);
+ val &= ~(PSPI_CTL1_SCIDL | PSPI_CTL1_SCM);
+ val |= pspi_mode;
+ writew(val, priv->base + PSPI_CTL1);
+
+ return 0;
+}
+
+static int npcm_pspi_probe(struct udevice *bus)
+{
+ struct npcm_pspi_priv *priv = dev_get_priv(bus);
+ int node = dev_of_offset(bus);
+ int ret;
+
+ ret = clk_get_by_index(bus, 0, &priv->clk);
+ if (ret < 0)
+ return ret;
+
+ priv->base = dev_read_addr_ptr(bus);
+ priv->max_hz = dev_read_u32_default(bus, "spi-max-frequency", 0);
+ gpio_request_by_name_nodev(offset_to_ofnode(node), "cs-gpios", 0,
+ &priv->cs_gpio, GPIOD_IS_OUT);
+
+ return 0;
+}
+
+static const struct dm_spi_ops npcm_pspi_ops = {
+ .xfer = npcm_pspi_xfer,
+ .set_speed = npcm_pspi_set_speed,
+ .set_mode = npcm_pspi_set_mode,
+};
+
+static const struct udevice_id npcm_pspi_ids[] = {
+ { .compatible = "nuvoton,npcm845-pspi"},
+ { .compatible = "nuvoton,npcm750-pspi"},
+ { }
+};
+
+U_BOOT_DRIVER(npcm_pspi) = {
+ .name = "npcm_pspi",
+ .id = UCLASS_SPI,
+ .of_match = npcm_pspi_ids,
+ .ops = &npcm_pspi_ops,
+ .priv_auto = sizeof(struct npcm_pspi_priv),
+ .probe = npcm_pspi_probe,
+};
diff --git a/include/asm-generic/global_data.h b/include/asm-generic/global_data.h
index c4b2bb44973..02ad8ca595d 100644
--- a/include/asm-generic/global_data.h
+++ b/include/asm-generic/global_data.h
@@ -481,9 +481,9 @@ struct global_data {
#endif
#ifdef CONFIG_CYCLIC
/**
- * @cyclic: cyclic driver data
+ * @cyclic_list: list of registered cyclic functions
*/
- struct cyclic_drv *cyclic;
+ struct hlist_head cyclic_list;
#endif
/**
* @dmtag_list: List of DM tags
@@ -650,6 +650,10 @@ enum gd_flags {
* @GD_FLG_FDT_CHANGED: Device tree change has been detected by tests
*/
GD_FLG_FDT_CHANGED = 0x100000,
+ /**
+ * GD_FLG_CYCLIC_RUNNING: cyclic_run is in progress
+ */
+ GD_FLG_CYCLIC_RUNNING = 0x200000,
};
#endif /* __ASSEMBLY__ */
diff --git a/include/cyclic.h b/include/cyclic.h
index 9c5c4fcc546..44ad3cb6b80 100644
--- a/include/cyclic.h
+++ b/include/cyclic.h
@@ -15,19 +15,6 @@
#include <asm/types.h>
/**
- * struct cyclic_drv - Cyclic driver internal data
- *
- * @cyclic_list: Cylic list node
- * @cyclic_ready: Flag if cyclic infrastructure is ready
- * @cyclic_running: Flag if cyclic infrastructure is running
- */
-struct cyclic_drv {
- struct list_head cyclic_list;
- bool cyclic_ready;
- bool cyclic_running;
-};
-
-/**
* struct cyclic_info - Information about cyclic execution function
*
* @func: Function to call periodically
@@ -50,7 +37,7 @@ struct cyclic_info {
uint64_t cpu_time_us;
uint64_t run_cnt;
uint64_t next_call;
- struct list_head list;
+ struct hlist_node list;
bool already_warned;
};
@@ -79,18 +66,11 @@ struct cyclic_info *cyclic_register(cyclic_func_t func, uint64_t delay_us,
int cyclic_unregister(struct cyclic_info *cyclic);
/**
- * cyclic_init() - Set up cyclic functions
- *
- * Init a list of cyclic functions, so that these can be added as needed
- */
-int cyclic_init(void);
-
-/**
- * cyclic_uninit() - Clean up cyclic functions
+ * cyclic_unregister_all() - Clean up cyclic functions
*
* This removes all cyclic functions
*/
-int cyclic_uninit(void);
+int cyclic_unregister_all(void);
/**
* cyclic_get_list() - Get cyclic list pointer
@@ -99,7 +79,7 @@ int cyclic_uninit(void);
*
* @return: pointer to cyclic_list
*/
-struct list_head *cyclic_get_list(void);
+struct hlist_head *cyclic_get_list(void);
/**
* cyclic_run() - Interate over all registered cyclic functions
@@ -138,12 +118,7 @@ static inline void schedule(void)
{
}
-static inline int cyclic_init(void)
-{
- return 0;
-}
-
-static inline int cyclic_uninit(void)
+static inline int cyclic_unregister_all(void)
{
return 0;
}
diff --git a/include/linux/list.h b/include/linux/list.h
index 3eacf68e3a7..6910721c005 100644
--- a/include/linux/list.h
+++ b/include/linux/list.h
@@ -646,54 +646,51 @@ static inline void hlist_add_after(struct hlist_node *n,
for (pos = (head)->first; pos && ({ n = pos->next; 1; }); \
pos = n)
+#define hlist_entry_safe(ptr, type, member) \
+ ({ typeof(ptr) ____ptr = (ptr); \
+ ____ptr ? hlist_entry(____ptr, type, member) : NULL; \
+ })
+
/**
* hlist_for_each_entry - iterate over list of given type
- * @tpos: the type * to use as a loop cursor.
- * @pos: the &struct hlist_node to use as a loop cursor.
+ * @pos: the type * to use as a loop cursor.
* @head: the head for your list.
* @member: the name of the hlist_node within the struct.
*/
-#define hlist_for_each_entry(tpos, pos, head, member) \
- for (pos = (head)->first; \
- pos && ({ prefetch(pos->next); 1;}) && \
- ({ tpos = hlist_entry(pos, typeof(*tpos), member); 1;}); \
- pos = pos->next)
+#define hlist_for_each_entry(pos, head, member) \
+ for (pos = hlist_entry_safe((head)->first, typeof(*(pos)), member);\
+ pos; \
+ pos = hlist_entry_safe((pos)->member.next, typeof(*(pos)), member))
/**
* hlist_for_each_entry_continue - iterate over a hlist continuing after current point
- * @tpos: the type * to use as a loop cursor.
- * @pos: the &struct hlist_node to use as a loop cursor.
+ * @pos: the type * to use as a loop cursor.
* @member: the name of the hlist_node within the struct.
*/
-#define hlist_for_each_entry_continue(tpos, pos, member) \
- for (pos = (pos)->next; \
- pos && ({ prefetch(pos->next); 1;}) && \
- ({ tpos = hlist_entry(pos, typeof(*tpos), member); 1;}); \
- pos = pos->next)
+#define hlist_for_each_entry_continue(pos, member) \
+ for (pos = hlist_entry_safe((pos)->member.next, typeof(*(pos)), member);\
+ pos; \
+ pos = hlist_entry_safe((pos)->member.next, typeof(*(pos)), member))
/**
* hlist_for_each_entry_from - iterate over a hlist continuing from current point
- * @tpos: the type * to use as a loop cursor.
- * @pos: the &struct hlist_node to use as a loop cursor.
+ * @pos: the type * to use as a loop cursor.
* @member: the name of the hlist_node within the struct.
*/
-#define hlist_for_each_entry_from(tpos, pos, member) \
- for (; pos && ({ prefetch(pos->next); 1;}) && \
- ({ tpos = hlist_entry(pos, typeof(*tpos), member); 1;}); \
- pos = pos->next)
+#define hlist_for_each_entry_from(pos, member) \
+ for (; pos; \
+ pos = hlist_entry_safe((pos)->member.next, typeof(*(pos)), member))
/**
* hlist_for_each_entry_safe - iterate over list of given type safe against removal of list entry
- * @tpos: the type * to use as a loop cursor.
- * @pos: the &struct hlist_node to use as a loop cursor.
- * @n: another &struct hlist_node to use as temporary storage
+ * @pos: the type * to use as a loop cursor.
+ * @n: a &struct hlist_node to use as temporary storage
* @head: the head for your list.
* @member: the name of the hlist_node within the struct.
*/
-#define hlist_for_each_entry_safe(tpos, pos, n, head, member) \
- for (pos = (head)->first; \
- pos && ({ n = pos->next; 1; }) && \
- ({ tpos = hlist_entry(pos, typeof(*tpos), member); 1;}); \
- pos = n)
+#define hlist_for_each_entry_safe(pos, n, head, member) \
+ for (pos = hlist_entry_safe((head)->first, typeof(*pos), member);\
+ pos && ({ n = pos->member.next; 1; }); \
+ pos = hlist_entry_safe(n, typeof(*pos), member))
#endif
diff --git a/test/test-main.c b/test/test-main.c
index ddfd89c089a..fe3ef6daad6 100644
--- a/test/test-main.c
+++ b/test/test-main.c
@@ -287,7 +287,6 @@ static int dm_test_restore(struct device_node *of_root)
static int test_pre_run(struct unit_test_state *uts, struct unit_test *test)
{
ut_assertok(event_init());
- ut_assertok(cyclic_init());
if (test->flags & UT_TESTF_DM)
ut_assertok(dm_test_pre_run(uts));
@@ -347,7 +346,7 @@ static int test_post_run(struct unit_test_state *uts, struct unit_test *test)
ut_unsilence_console(uts);
if (test->flags & UT_TESTF_DM)
ut_assertok(dm_test_post_run(uts));
- ut_assertok(cyclic_uninit());
+ ut_assertok(cyclic_unregister_all());
ut_assertok(event_uninit());
free(uts->of_other);
generated by cgit v1.2.3 (git 2.0.4) at 2025-07-25 10:48:57 +0000