rt-thread/bsp/bluetrum/libraries/hal_drivers/drv_wdt.c

/*
 * 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 */