新增所有文件

devices/E3106/device_init.c

@@ -0,0 +1,114 @@
+/**
+ * @file device_init.c
+ * @brief Semidrive device ealryinit.
+ *
+ * @copyright Copyright (c) 2022  Semidrive Semiconductor.
+ *            All rights reserved.
+ */
+
+#include <common.h>
+#include <sdrv_ckgen.h>
+#include <sdrv_power.h>
+#include <regs_base.h>
+#include <reg.h>
+#include <param.h>
+
+#ifndef APB_ACMP4_BASE
+/* Analog Compare (ACMP) 4 */
+#define APB_ACMP4_BASE (0xF0AC0000ul)
+#endif
+
+#ifndef APB_ACMP3_BASE
+/* Analog Compare (ACMP) 3 */
+#define APB_ACMP3_BASE (0xF0AB0000ul)
+#endif
+
+extern const sdrv_ckgen_node_t **g_ckgen_unused[];
+
+static const sdrv_ckgen_xcg_set_t g_xcg_info[] = {
+    {APB_CKGEN_SF_BASE, CKGEN_PCG_TYPE, 207},
+    {APB_CKGEN_SF_BASE, CKGEN_BCG_TYPE, 8},
+    {APB_CKGEN_SF_BASE, CKGEN_CCG_TYPE, 1},
+};
+
+static const mcu_power_e g_unused_power[] = {
+    MCU_POWER_ACMP3,
+    MCU_POWER_ACMP4,
+    MCU_POWER_END
+};
+
+static int mcu_unused_ip_cglist_mask(const sdrv_ckgen_node_t *ckgen_ip[], bool mask)
+{
+    sdrv_ckgen_node_t *node;
+    uint32_t i = 0;
+    int ret = 0;
+
+    while (ckgen_ip[i] && !ret) {
+        node = (sdrv_ckgen_node_t *)ckgen_ip[i];
+        ret = sdrv_ckgen_cg_mask(node, mask);
+        i++;
+    }
+
+    return ret;
+}
+
+static void mcu_unused_power_pre_config(const mcu_power_e *powers)
+{
+    uint32_t i = 0;
+
+    while (powers[i] != MCU_POWER_END) {
+        switch (powers[i]) {
+            case MCU_POWER_ACMP3:
+                RMWREG32(APB_ACMP3_BASE + 0xBC, 0, 1, 1);
+                RMWREG32(APB_ACMP3_BASE + 0xBC, 1, 1, 1);
+            break;
+
+            case MCU_POWER_ACMP4:
+                RMWREG32(APB_ACMP4_BASE + 0xBC, 0, 1, 1);
+                RMWREG32(APB_ACMP4_BASE + 0xBC, 1, 1, 1);
+            break;
+
+            default:
+            break;
+        }
+
+        i++;
+    }
+}
+
+static int mcu_unused_ip_config(void)
+{
+    uint32_t i = 0;
+    int ret = 0;
+
+    mcu_unused_power_pre_config(g_unused_power);
+
+    while (g_ckgen_unused[i]) {
+        ret = sdrv_ckgen_ip_clock_enable(g_ckgen_unused[i], CKGEN_HIB_MODE, false);
+        ret = sdrv_ckgen_ip_clock_enable(g_ckgen_unused[i], CKGEN_SLP_MODE, false);
+        ret = sdrv_ckgen_ip_clock_enable(g_ckgen_unused[i], CKGEN_RUN_MODE, false);
+        ret = mcu_unused_ip_cglist_mask(g_ckgen_unused[i], true);
+        i++;
+    }
+
+    return ret;
+}
+
+static void sdrv_xcg_runmode_active(const sdrv_ckgen_xcg_set_t *infos, uint32_t size)
+{
+    for (uint32_t i = 0; i < size; i++) {
+        sdrv_ckgen_xcg_type_set((sdrv_ckgen_xcg_set_t *)&infos[i], CKGEN_RUN_MODE, false);
+    }
+}
+
+/**
+ * @brief initializes the device.
+ *
+ * This function initializes the device before call main function.
+ */
+void device_init(void)
+{
+    sdrv_xcg_runmode_active(g_xcg_info, ARRAY_SIZE(g_xcg_info));
+
+    mcu_unused_ip_config();
+}