rt-thread-official/bsp/allwinner/libraries/drivers/drv_pwm.c

/*
 * Copyright (c) 2006-2022, RT-Thread Development Team
 *
 * SPDX-License-Identifier: Apache-2.0
 *
 * Change Logs:
 * Date           Author           Notes
 * 2021-12-13     JasonHu          the first version
 */

#include <rtthread.h>
#include <rtdevice.h>

#include <sunxi_hal_pwm.h>

#define PWM_CHANNEL_MAX     (8) /* 0-7*/

#if defined(RT_USING_PWM) && defined(BSP_USING_PWM)

struct rt_hal_pwm
{
    struct rt_device_pwm parent;

    rt_uint32_t period[PWM_CHANNEL_MAX];
    rt_uint32_t pulse[PWM_CHANNEL_MAX];
    rt_uint32_t status;
};

static struct rt_hal_pwm _hal_pwm_device;
static struct rt_pwm_configuration configuration = {1, 100000, 100000, RT_TRUE};

static rt_err_t set(struct rt_device_pwm *device, struct rt_pwm_configuration *configuration)
{
    struct rt_hal_pwm *hal_pwm_device = (struct rt_hal_pwm *)device;

    LOG_D("drv_pwm.c set channel %d: period: %d, pulse: %d\n", configuration->channel, configuration->period, configuration->pulse);

    hal_pwm_device->period[configuration->channel] = configuration->period;
    hal_pwm_device->pulse[configuration->channel] = configuration->pulse;

    return RT_EOK;
}

static rt_err_t get(struct rt_device_pwm *device, struct rt_pwm_configuration *configuration)
{
    struct rt_hal_pwm *hal_pwm_device = (struct rt_hal_pwm *)device;

    configuration->period = hal_pwm_device->period[configuration->channel];
    configuration->pulse = hal_pwm_device->pulse[configuration->channel];
    LOG_D("drv_pwm.c get channel %d: period: %d, pulse: %d\n", configuration->channel, configuration->period, configuration->pulse);

    return RT_EOK;
}

static rt_err_t control(struct rt_device_pwm *device, int cmd, void *arg)
{
    rt_err_t result = RT_EOK;
    struct rt_pwm_configuration * configuration = (struct rt_pwm_configuration *)arg;

    struct rt_hal_pwm *hal_pwm_device = (struct rt_hal_pwm *)device;

    LOG_D("drv_pwm.c control cmd: %d. \n", cmd);

    if (configuration->channel > (PWM_CHANNEL_MAX - 1))
    {
        LOG_E("drv_pwm.c control channel: %d not support! \n", configuration->channel);
        return -RT_EIO;
    }

    LOG_D("PWM: channel:%d", configuration->channel);

    if (cmd == PWM_CMD_ENABLE)
    {
        LOG_D("PWM_CMD_ENABLE");
        struct pwm_config pwm_cfg;
        pwm_cfg.polarity = PWM_POLARITY_NORMAL;
        pwm_cfg.duty_ns =  hal_pwm_device->pulse[configuration->channel];
        pwm_cfg.period_ns = hal_pwm_device->period[configuration->channel];
        hal_pwm_device->status = 1;
        if (hal_pwm_control(configuration->channel, &pwm_cfg) != 0)
        {
            result = -RT_EIO;
        }
    }
    else if (cmd == PWM_CMD_DISABLE)
    {
        LOG_D("PWM_CMD_DISABLE");
        struct pwm_config pwm_cfg;
        pwm_cfg.polarity = PWM_POLARITY_NORMAL;
        pwm_cfg.duty_ns =  0; /* set as 0 for no duty */
        pwm_cfg.period_ns = hal_pwm_device->period[configuration->channel];
        hal_pwm_device->status = 0;
        if (hal_pwm_control(configuration->channel, &pwm_cfg) != 0)
        {
            result = -RT_EIO;
        }
        else
        {
            hal_pwm_disable_controller(configuration->channel);
        }
    }
    else if (cmd == PWM_CMD_SET)
    {
        LOG_D("PWM_CMD_SET");
        result = set(device, (struct rt_pwm_configuration *)arg);
        if(hal_pwm_device->status)
        {
            struct pwm_config pwm_cfg;
            pwm_cfg.polarity = PWM_POLARITY_NORMAL;
            pwm_cfg.duty_ns =  hal_pwm_device->pulse[configuration->channel];
            pwm_cfg.period_ns = hal_pwm_device->period[configuration->channel];
            if (hal_pwm_control(configuration->channel, &pwm_cfg) != 0)
            {
                result = -RT_EIO;
            }
        }
    }
    else if (cmd == PWM_CMD_GET)
    {
        LOG_D("PWM_CMD_GET");
        result = get(device, (struct rt_pwm_configuration *)arg);
    }

    return result;
}

static const struct rt_pwm_ops pwm_ops =
{
    control,
};

int rt_hw_pwm_init(void)
{
    /* add pwm initial. */
    if (hal_pwm_init() != 0)
    {
        LOG_E("init pwm failed!");
        return -1;
    }
    _hal_pwm_device.status = 0;
    return rt_device_pwm_register(&_hal_pwm_device.parent, "pwm", &pwm_ops, RT_NULL);
}
INIT_DEVICE_EXPORT(rt_hw_pwm_init);

#endif /* RT_USING_PWM && BSP_USING_PWM */