add isr

Author: ck-telecom

drivers/entropy/entropy_sf32lb.c

@@ -8,6 +8,8 @@
 #include <zephyr/device.h>
 #include <zephyr/drivers/clock_control/sf32lb.h>
 #include <zephyr/drivers/entropy.h>
+#include <zephyr/irq.h>
+#include <zephyr/kernel.h>
 #include <zephyr/logging/log.h>
 
 #include <register.h>
@@ -16,17 +18,31 @@ LOG_MODULE_REGISTER(entropy_sf32lb, CONFIG_ENTROPY_LOG_LEVEL);
 
 #define TRNG_CTRL offsetof(TRNG_TypeDef, CTRL)
 #define TRNG_STAT offsetof(TRNG_TypeDef, STAT)
+#define TRNG_IRQ  offsetof(TRNG_TypeDef, IRQ)
 #define TRNG_RAND offsetof(TRNG_TypeDef, RAND_NUM0)
 
 #define TRNG_RAND_NUM_MAX (8U)
 
 #define TRNG_RAND_MASK (TRNG_RAND_NUM_MAX - 1U)
 
+struct entropy_sf32lb_data {
+};
+
 struct entropy_sf32lb_config {
 	uintptr_t base;
 	struct sf32lb_clock_dt_spec clock;
+	void (*irq_config_func)(void);
 };
 
+static void entropy_sf32lb_isr(const struct device *dev)
+{
+	const struct entropy_sf32lb_config *config = dev->config;
+	struct entropy_sf32lb_data *data = dev->data;
+	uint32_t buf[TRNG_RAND_NUM_MAX];
+	uint32_t cnt;
+printk("stat:0x%x\n", sys_read32(config->base + TRNG_IRQ));
+}
+
 static int entropy_sf32lb_get_entropy(const struct device *dev, uint8_t *buffer, uint16_t length)
 {
 	const struct entropy_sf32lb_config *config = dev->config;
@@ -77,17 +93,37 @@ static int entropy_sf32lb_init(const struct device *dev)
 		return ret;
 	}
 
+	sys_set_bits(config->base + TRNG_IRQ, TRNG_IRQ_PRNG_LOCKUP_MSK |
+			       TRNG_IRQ_RAND_NUM_AVAIL_MSK |
+			       TRNG_IRQ_SEED_GEN_DONE_MSK);
+
+	config->irq_config_func();
+
+	sys_set_bit(config->base + TRNG_CTRL, TRNG_CTRL_GEN_SEED_START_Pos);
+	sys_set_bit(config->base + TRNG_CTRL, TRNG_CTRL_GEN_RAND_NUM_START_Pos);
+
 	return ret;
 }
 
 #define ENTROPY_SF32LB_DEFINE(n)                                                                   \
+	static void entropy_sf32lb_irq_config_##n(void);                                           \
+                                                                                                   \
+	static struct entropy_sf32lb_data entropy_sf32lb_data_##n;                                 \
 	static const struct entropy_sf32lb_config entropy_sf32lb_config_##n = {                    \
 		.base = DT_INST_REG_ADDR(n),                                                       \
 		.clock = SF32LB_CLOCK_DT_INST_SPEC_GET(n),                                         \
+		.irq_config_func = entropy_sf32lb_irq_config_##n,                                  \
 	};                                                                                         \
                                                                                                    \
-	DEVICE_DT_INST_DEFINE(n, entropy_sf32lb_init, NULL, NULL,                                  \
+	DEVICE_DT_INST_DEFINE(n, entropy_sf32lb_init, NULL, &entropy_sf32lb_data_##n,              \
 			      &entropy_sf32lb_config_##n, PRE_KERNEL_1,                            \
-			      CONFIG_ENTROPY_INIT_PRIORITY, &entropy_sf32lb_api);
+			      CONFIG_ENTROPY_INIT_PRIORITY, &entropy_sf32lb_api);                 \
+                                                                                                   \
+	static void entropy_sf32lb_irq_config_##n(void)                                           \
+	{                                                                                          \
+		IRQ_CONNECT(DT_INST_IRQN(n), DT_INST_IRQ(n, priority), entropy_sf32lb_isr,        \
+			    DEVICE_DT_INST_GET(n), 0);                                             \
+		irq_enable(DT_INST_IRQN(n));                                                       \
+	}
 
 DT_INST_FOREACH_STATUS_OKAY(ENTROPY_SF32LB_DEFINE)