libs/rt-thread
libs
/
rt-thread
4
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity
rt-thread/bsp/phytium/libraries/drivers/drv_pwm.c

292 lines
7.9 KiB
C
Raw Blame History

/*
* Copyright (c) 2006-2023, RT-Thread Development Team
*
* SPDX-License-Identifier: Apache-2.0
*
* Email: opensource_embedded@phytium.com.cn
*
* Change Logs:
* Date Author Notes
* 2023-10-18 zhangyan first version
*
*/
#include "rtconfig.h"
#include <rtdevice.h>
#define LOG_TAG "pwm_drv"
#include "drv_log.h"
#include "drv_pwm.h"
#include "fio_mux.h"
#include "fpwm.h"
#ifdef RT_USING_SMART
#include <ioremap.h>
#endif
struct phytium_pwm
{
const char *name;
FPwmCtrl pwm_handle;
struct rt_device_pwm device; /* inherit from can device */
};
static rt_err_t drv_pwm_config(struct phytium_pwm *pwm_dev)
{
RT_ASSERT(pwm_dev);
u32 ret;
FPwmConfig config;
FPwmCtrl *pwm_handle = &pwm_dev->pwm_handle;
FIOPadSetPwmMux(pwm_handle->config.instance_id, 0);
FIOPadSetPwmMux(pwm_handle->config.instance_id, 1);
config = *FPwmLookupConfig(pwm_handle->config.instance_id);
#ifdef RT_USING_SMART
config.lsd_config_addr = (uintptr)rt_ioremap((void *)config.lsd_config_addr, 0x100);
config.pwm_base_addr = (uintptr)rt_ioremap((void *)config.pwm_base_addr, 0x1000);
config.db_base_addr = (uintptr)rt_ioremap((void *)config.db_base_addr, 0x100);
#endif
ret = FPwmCfgInitialize(pwm_handle, &config);
if (ret != FPWM_SUCCESS)
{
LOG_E("Pwm config init failed.\n");
return -RT_ERROR;
}
return RT_EOK;
}
static rt_err_t drv_pwm_enable(struct phytium_pwm *pwm_dev, struct rt_pwm_configuration *configuration, boolean enable_pwm)
{
RT_ASSERT(pwm_dev);
RT_ASSERT(configuration);
u32 channel = configuration->channel;
if (enable_pwm == RT_TRUE)
{
FPwmEnable(&pwm_dev->pwm_handle, channel);
}
else
{
FPwmDisable(&pwm_dev->pwm_handle, channel);
}
return RT_EOK;
}
static rt_err_t drv_pwm_set(struct phytium_pwm *pwm_dev, int cmd, struct rt_pwm_configuration *configuration)
{
RT_ASSERT(pwm_dev);
RT_ASSERT(configuration);
u32 ret;
FPwmVariableConfig pwm_cfg;
u32 channel = configuration->channel;
memset(&pwm_cfg, 0, sizeof(pwm_cfg));
pwm_cfg.tim_ctrl_mode = FPWM_MODULO;
pwm_cfg.tim_ctrl_div = 50 - 1;
/* Precision set to microseconds */
switch (cmd)
{
case PWM_CMD_SET:
pwm_cfg.pwm_period = configuration->period / 1000;
pwm_cfg.pwm_pulse = configuration->pulse / 1000;
break;
case PWM_CMD_SET_PERIOD:
pwm_cfg.pwm_period = configuration->period / 1000;
break;
case PWM_CMD_SET_PULSE:
pwm_cfg.pwm_pulse = configuration->pulse / 1000;
break;
}
/* Can be modified according to function */
pwm_cfg.pwm_mode = FPWM_OUTPUT_COMPARE;
pwm_cfg.pwm_polarity = FPWM_POLARITY_NORMAL;
pwm_cfg.pwm_duty_source_mode = FPWM_DUTY_CCR;
FPwmDisable(&pwm_dev->pwm_handle, channel);
ret = FPwmVariableSet(&pwm_dev->pwm_handle, channel, &pwm_cfg);
if (ret != FPWM_SUCCESS)
{
LOG_E("Pwm variable set failed.\n");
return -RT_ERROR;
}
FPwmEnable(&pwm_dev->pwm_handle, channel);
return RT_EOK;
}
static rt_err_t drv_pwm_get(struct phytium_pwm *pwm_dev, struct rt_pwm_configuration *configuration)
{
RT_ASSERT(pwm_dev);
RT_ASSERT(configuration);
u32 ret;
FPwmVariableConfig pwm_cfg;
u32 channel = configuration->channel;
memset(&pwm_cfg, 0, sizeof(pwm_cfg));
ret = FPwmVariableGet(&pwm_dev->pwm_handle, channel, &pwm_cfg);
if (ret != FPWM_SUCCESS)
{
LOG_E("Pwm variable get failed.\n");
return -RT_ERROR;
}
configuration->period = pwm_cfg.pwm_period * 1000;
configuration->pulse = pwm_cfg.pwm_pulse * 1000;
LOG_D("period = %d\n, pulse = %d\n", configuration->period, configuration->pulse);
return RT_EOK;
}
static rt_err_t drv_pwm_set_dead_time(struct phytium_pwm *pwm_dev, struct rt_pwm_configuration *configuration)
{
RT_ASSERT(pwm_dev);
RT_ASSERT(configuration);
u32 ret;
FPwmDbVariableConfig db_cfg;
u32 channel = configuration->channel;
memset(&db_cfg, 0, sizeof(db_cfg));
db_cfg.db_rise_cycle = configuration->dead_time / 1000;
db_cfg.db_fall_cycle = configuration->dead_time / 1000;
db_cfg.db_polarity_sel = FPWM_DB_AH;
db_cfg.db_in_mode = FPWM_DB_IN_MODE_PWM0;
db_cfg.db_out_mode = FPWM_DB_OUT_MODE_ENABLE_RISE_FALL;
FPwmDisable(&pwm_dev->pwm_handle, channel);
ret = FPwmDbVariableSet(&pwm_dev->pwm_handle, &db_cfg);
if (ret != FPWM_SUCCESS)
{
LOG_E("FPwmDbVariableSet failed.");
return -RT_ERROR;
}
FPwmEnable(&pwm_dev->pwm_handle, channel);
return RT_EOK;
}
static rt_err_t _pwm_control(struct rt_device_pwm *device, int cmd, void *arg)
{
struct rt_pwm_configuration *configuration = (struct rt_pwm_configuration *)arg;
struct phytium_pwm *pwm_dev;
pwm_dev = (struct phytium_pwm *)(device->parent.user_data);
switch (cmd)
{
case PWM_CMD_ENABLE:
return drv_pwm_enable(pwm_dev, configuration, RT_TRUE);
case PWM_CMD_DISABLE:
return drv_pwm_enable(pwm_dev, configuration, RT_FALSE);
case PWM_CMD_SET:
return drv_pwm_set(pwm_dev, PWM_CMD_SET, configuration);
case PWM_CMD_GET:
return drv_pwm_get(pwm_dev, configuration);
case PWM_CMD_SET_DEAD_TIME:
return drv_pwm_set_dead_time(pwm_dev, configuration);
case PWM_CMD_SET_PERIOD:
return drv_pwm_set(pwm_dev, PWM_CMD_SET_PERIOD, configuration);
case PWM_CMD_SET_PULSE:
return drv_pwm_set(pwm_dev, PWM_CMD_SET_PULSE, configuration);
default:
return -RT_EINVAL;
}
}
static const struct rt_pwm_ops _pwm_ops =
{
_pwm_control,
};
static rt_err_t pwm_controller_init(struct phytium_pwm *pwm_dev)
{
u32 ret = RT_EOK;
ret = drv_pwm_config(pwm_dev);
if (ret != FPWM_SUCCESS)
{
LOG_E("Pwm config failed.\n");
return -RT_ERROR;
}
ret = rt_device_pwm_register(&pwm_dev->device,
pwm_dev->name,
&_pwm_ops,
pwm_dev);
RT_ASSERT(ret == RT_EOK);
return ret;
}
#if defined(RT_USING_PWM0)
static struct phytium_pwm pwm0_dev;
#endif
#if defined(RT_USING_PWM1)
static struct phytium_pwm pwm1_dev;
#endif
#if defined(RT_USING_PWM2)
static struct phytium_pwm pwm2_dev;
#endif
#if defined(RT_USING_PWM3)
static struct phytium_pwm pwm3_dev;
#endif
#if defined(RT_USING_PWM4)
static struct phytium_pwm pwm4_dev;
#endif
#if defined(RT_USING_PWM5)
static struct phytium_pwm pwm5_dev;
#endif
#if defined(RT_USING_PWM6)
static struct phytium_pwm pwm6_dev;
#endif
#if defined(RT_USING_PWM7)
static struct phytium_pwm pwm7_dev;
#endif
int rt_hw_pwm_init(void)
{
#if defined(RT_USING_PWM0)
pwm0_dev.name = "PWM0";
pwm0_dev.pwm_handle.config.instance_id = FPWM0_ID;
pwm_controller_init(&pwm0_dev);
#endif
#if defined(RT_USING_PWM1)
pwm1_dev.name = "PWM1";
pwm1_dev.pwm_handle.config.instance_id = FPWM1_ID;
pwm_controller_init(&pwm1_dev);
#endif
#if defined(RT_USING_PWM2)
pwm2_dev.name = "PWM2";
pwm2_dev.pwm_handle.config.instance_id = FPWM2_ID;
pwm_controller_init(&pwm2_dev);
#endif
#if defined(RT_USING_PWM3)
pwm3_dev.name = "PWM3";
pwm3_dev.pwm_handle.config.instance_id = FPWM3_ID;
pwm_controller_init(&pwm3_dev);
#endif
#if defined(RT_USING_PWM4)
pwm4_dev.name = "PWM4";
pwm4_dev.pwm_handle.config.instance_id = FPWM4_ID;
pwm_controller_init(&pwm4_dev);
#endif
#if defined(RT_USING_PWM5)
pwm5_dev.name = "PWM5";
pwm5_dev.pwm_handle.config.instance_id = FPWM5_ID;
pwm_controller_init(&pwm5_dev);
#endif
#if defined(RT_USING_PWM6)
pwm6_dev.name = "PWM6";
pwm6_dev.pwm_handle.config.instance_id = FPWM6_ID;
pwm_controller_init(&pwm6_dev);
#endif
#if defined(RT_USING_PWM7)
pwm7_dev.name = "PWM7";
pwm7_dev.pwm_handle.config.instance_id = FPWM7_ID;
pwm_controller_init(&pwm7_dev);
#endif
return 0;
}
INIT_DEVICE_EXPORT(rt_hw_pwm_init);
View Git Blame Copy Permalink