Browse Source

[bsp][bluetrum] add wdt support

greedyhao 4 years ago
parent
commit
bd07198444

+ 3 - 0
bsp/bluetrum/libraries/hal_drivers/SConscript

@@ -18,6 +18,9 @@ if GetDepend('RT_USING_SDIO'):
 
 if GetDepend('RT_USING_I2C'):
     src += ['drv_soft_i2c.c']
+
+if GetDepend('RT_USING_WDT'):
+    src += ['drv_wdt.c']
 group = DefineGroup('Drivers', src, depend = [''], CPPPATH = path)
 
 objs = [group]

+ 149 - 0
bsp/bluetrum/libraries/hal_drivers/drv_wdt.c

@@ -0,0 +1,149 @@
+/*
+ * Copyright (c) 2020-2021, Bluetrum Development Team
+ * 
+ * SPDX-License-Identifier: Apache-2.0
+ *
+ * Change Logs:
+ * Date           Author            Notes
+ * 2020-11-30     greedyhao         first version
+ */
+
+#include <board.h>
+
+#ifdef RT_USING_WDT
+
+// #define DRV_DEBUG
+#define LOG_TAG             "drv.wdt"
+#include <drv_log.h>
+
+struct ab32_wdt_obj
+{
+    rt_watchdog_t watchdog;
+};
+static struct ab32_wdt_obj ab32_wdt;
+static struct rt_watchdog_ops ops;
+
+static rt_err_t wdt_init(rt_watchdog_t *wdt)
+{
+    return RT_EOK;
+}
+
+static rt_err_t wdt_control(rt_watchdog_t *wdt, int cmd, void *arg)
+{
+    rt_uint32_t tmp = 0;
+
+    switch (cmd)
+    {
+        /* feed the watchdog */
+    case RT_DEVICE_CTRL_WDT_KEEPALIVE:
+        WDTCON = 0xa;
+        break;
+        /* set watchdog timeout */
+    case RT_DEVICE_CTRL_WDT_SET_TIMEOUT:
+        if (arg == RT_NULL) {
+            LOG_E("The watchdog timeout argument cannot be NULL!");
+            break;
+        }
+
+        tmp = WDTCON & ~(0x7 << 20);
+
+        switch (*((rt_uint32_t *)arg))
+        {
+        case 0:
+            LOG_I("The watchdog timeout is set to 1ms");
+            tmp |= (0xa << 24) | (0x00 << 20);
+            break;
+        case 1:
+            LOG_I("The watchdog timeout is set to 256ms");
+            tmp |= (0xa << 24) | (0x01 << 20);
+            break;
+        case 2:
+            LOG_I("The watchdog timeout is set to 512ms");
+            tmp |= (0xa << 24) | (0x02 << 20);
+            break;
+        case 3:
+            LOG_I("The watchdog timeout is set to 1024ms");
+            tmp |= (0xa << 24) | (0x03 << 20);
+            break;
+        case 4:
+            LOG_I("The watchdog timeout is set to 2048ms");
+            tmp |= (0xa << 24) | (0x04 << 20);
+            break;
+        case 5:
+            LOG_I("The watchdog timeout is set to 4096ms");
+            tmp |= (0xa << 24) | (0x05 << 20);
+            break;
+        case 6:
+            LOG_I("The watchdog timeout is set to 8192ms");
+            tmp |= (0xa << 24) | (0x06 << 20);
+            break;
+        case 7:
+            LOG_I("The watchdog timeout is set to 16384ms");
+            tmp |= (0xa << 24) | (0x07 << 20);
+            break;
+        default:
+            LOG_W("The watchdog timeout argument range from 0 to 7!");
+            tmp = WDTCON;
+            break;
+        }
+        WDTCON = tmp;
+        LOG_D("WDTCON=%X", WDTCON);
+        break;
+    case RT_DEVICE_CTRL_WDT_GET_TIMEOUT:
+        switch ((WDTCON >> 20) & 0x7)
+        {
+        case 0:
+            LOG_D("The watchdog timeout is set to 1ms");
+            break;
+        case 1:
+            LOG_D("The watchdog timeout is set to 256ms");
+            break;
+        case 2:
+            LOG_D("The watchdog timeout is set to 512ms");
+            break;
+        case 3:
+            LOG_D("The watchdog timeout is set to 1024ms");
+            break;
+        case 4:
+            LOG_D("The watchdog timeout is set to 2048ms");
+            break;
+        case 5:
+            LOG_D("The watchdog timeout is set to 4096ms");
+            break;
+        case 6:
+            LOG_D("The watchdog timeout is set to 8192ms");
+            break;
+        case 7:
+            LOG_D("The watchdog timeout is set to 16384ms");
+            break;
+        default:
+            break;
+        }
+        break;
+    case RT_DEVICE_CTRL_WDT_START:
+        WDTCON = 0x110;
+        break;
+    default:
+        LOG_W("This command is not supported.");
+        return -RT_ERROR;
+    }
+    return RT_EOK;
+}
+
+int rt_wdt_init(void)
+{
+    ops.init = &wdt_init;
+    ops.control = &wdt_control;
+    ab32_wdt.watchdog.ops = &ops;
+    /* register watchdog device */
+    if (rt_hw_watchdog_register(&ab32_wdt.watchdog, "wdt", RT_DEVICE_FLAG_DEACTIVATE, RT_NULL) != RT_EOK)
+    {
+        LOG_E("wdt device register failed.");
+        return -RT_ERROR;
+    }
+    LOG_D("wdt device register success.");
+    return RT_EOK;
+}
+INIT_BOARD_EXPORT(rt_wdt_init);
+
+#endif /* RT_USING_WDT */