285 lines
10 KiB
C
285 lines
10 KiB
C
/*
|
||
* Copyright (C) 2018 Shanghai Eastsoft Microelectronics Co., Ltd.
|
||
*
|
||
* SPDX-License-Identifier: Apache-2.0
|
||
*
|
||
* Licensed under the Apache License, Version 2.0 (the License); you may
|
||
* not use this file except in compliance with the License.
|
||
* You may obtain a copy of the License at
|
||
*
|
||
* www.apache.org/licenses/LICENSE-2.0
|
||
*
|
||
* Unless required by applicable law or agreed to in writing, software
|
||
* distributed under the License is distributed on an AS IS BASIS, WITHOUT
|
||
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||
* See the License for the specific language governing permissions and
|
||
* limitations under the License.
|
||
*
|
||
* Change Logs:
|
||
* Date Author Notes
|
||
* 2019-03-11 wangyq the first version
|
||
* 2019-11-01 wangyq update libraries
|
||
* 2021-04-20 liuhy the second version
|
||
*/
|
||
|
||
#include <rthw.h>
|
||
#include <rtthread.h>
|
||
#include <rtdevice.h>
|
||
#include <board.h>
|
||
#include "es_conf_info_pwm.h"
|
||
|
||
|
||
#ifdef RT_USING_PWM
|
||
|
||
static void pwm_set_duty(timer_handle_t *timer_initstruct, timer_channel_t ch, uint32_t ns)
|
||
{
|
||
uint64_t tmp = (uint64_t)ald_cmu_get_pclk1_clock() * ns / 1000000000 /
|
||
(timer_initstruct->init.prescaler + 1);
|
||
|
||
if (ch == TIMER_CHANNEL_1)
|
||
WRITE_REG(timer_initstruct->perh->CCVAL1, (uint32_t)tmp);
|
||
else if (ch == TIMER_CHANNEL_2)
|
||
WRITE_REG(timer_initstruct->perh->CCVAL2, (uint32_t)tmp);
|
||
else if (ch == TIMER_CHANNEL_3)
|
||
WRITE_REG(timer_initstruct->perh->CCVAL3, (uint32_t)tmp);
|
||
else if (ch == TIMER_CHANNEL_4)
|
||
WRITE_REG(timer_initstruct->perh->CCVAL4, (uint32_t)tmp);
|
||
}
|
||
|
||
static rt_err_t es32f0_pwm_control(struct rt_device_pwm *device, int cmd, void *arg)
|
||
{
|
||
rt_err_t ret = RT_EOK;
|
||
uint64_t _arr,bus_speed,tmp;
|
||
uint32_t _maxcnt,_ccep_ch_en = 0U;
|
||
timer_channel_t pwm_channel;
|
||
timer_oc_init_t tim_ocinit;
|
||
timer_handle_t *timer_initstruct = (timer_handle_t *)device->parent.user_data;
|
||
struct rt_pwm_configuration *cfg = (struct rt_pwm_configuration *)arg;
|
||
|
||
RT_ASSERT(timer_initstruct != RT_NULL);
|
||
|
||
/* select pwm output channel */
|
||
if (1 == cfg->channel)
|
||
{
|
||
pwm_channel = TIMER_CHANNEL_1;
|
||
_ccep_ch_en = timer_initstruct->perh->CCEP & TIMER_CCEP_CC1EN_MSK;
|
||
}
|
||
else if (2 == cfg->channel)
|
||
{
|
||
pwm_channel = TIMER_CHANNEL_2;
|
||
_ccep_ch_en = timer_initstruct->perh->CCEP & TIMER_CCEP_CC2EN_MSK;
|
||
}
|
||
else if (3 == cfg->channel)
|
||
{
|
||
pwm_channel = TIMER_CHANNEL_3;
|
||
_ccep_ch_en = timer_initstruct->perh->CCEP & TIMER_CCEP_CC3EN_MSK;
|
||
}
|
||
else if (4 == cfg->channel)
|
||
{
|
||
pwm_channel = TIMER_CHANNEL_4;
|
||
_ccep_ch_en = timer_initstruct->perh->CCEP & TIMER_CCEP_CC4EN_MSK;
|
||
}
|
||
else
|
||
return RT_EINVAL;
|
||
|
||
switch (cmd)
|
||
{
|
||
case PWM_CMD_ENABLE:
|
||
ald_timer_pwm_start(timer_initstruct, pwm_channel);
|
||
break;
|
||
|
||
case PWM_CMD_DISABLE:
|
||
ald_timer_pwm_stop(timer_initstruct, pwm_channel);
|
||
break;
|
||
|
||
case PWM_CMD_SET:
|
||
|
||
/*当通道没开的时候：关通道，设置输出模式和极性，初始化通道*/
|
||
if(!_ccep_ch_en)
|
||
{
|
||
tim_ocinit.oc_mode = ES_PWM_OC_MODE;
|
||
tim_ocinit.oc_polarity = ES_PWM_OC_POLARITY;
|
||
tim_ocinit.oc_fast_en = DISABLE;
|
||
tim_ocinit.ocn_polarity = TIMER_OCN_POLARITY_HIGH;
|
||
tim_ocinit.ocn_idle = TIMER_OCN_IDLE_RESET;
|
||
tim_ocinit.oc_idle = TIMER_OC_IDLE_RESET;
|
||
ald_timer_oc_config_channel(timer_initstruct, &tim_ocinit, pwm_channel);
|
||
}
|
||
|
||
bus_speed = (uint64_t)ald_cmu_get_pclk1_clock();
|
||
|
||
/*外设的计数器最大值*/
|
||
_maxcnt = 0xFFFF;
|
||
|
||
/*当最大分频 <= _maxcnt时：估计大概的分频，加快速度 */
|
||
tmp = bus_speed * (cfg->period)/1000000000/_maxcnt;
|
||
timer_initstruct->init.prescaler = (tmp > 2U) ? (tmp - 2U) : 0U ; /*bus_speed < 500000000*/
|
||
|
||
/* count registers max , auto adjust prescaler */
|
||
do
|
||
{
|
||
_arr = bus_speed * (cfg->period) / 1000000000 /(++timer_initstruct->init.prescaler);
|
||
|
||
}
|
||
while (_arr > _maxcnt);
|
||
|
||
WRITE_REG(timer_initstruct->perh->AR, (uint32_t)_arr);
|
||
timer_initstruct->init.period = (uint32_t)_arr;
|
||
|
||
/* update prescaler */
|
||
WRITE_REG(timer_initstruct->perh->PRES, --timer_initstruct->init.prescaler);
|
||
|
||
pwm_set_duty(timer_initstruct, pwm_channel, cfg->pulse);
|
||
|
||
break;
|
||
|
||
case PWM_CMD_GET:
|
||
cfg->pulse = ald_timer_read_capture_value(timer_initstruct, pwm_channel) * 100 /
|
||
READ_REG(timer_initstruct->perh->AR);
|
||
break;
|
||
|
||
default:
|
||
break;
|
||
}
|
||
return ret;
|
||
}
|
||
|
||
const static struct rt_pwm_ops es32f0_pwm_ops =
|
||
{
|
||
es32f0_pwm_control
|
||
};
|
||
|
||
int rt_hw_pwm_init(void)
|
||
{
|
||
rt_err_t ret = RT_EOK;
|
||
gpio_init_t gpio_initstructure;
|
||
|
||
gpio_initstructure.mode = GPIO_MODE_OUTPUT;
|
||
gpio_initstructure.odos = GPIO_PUSH_PULL;
|
||
gpio_initstructure.pupd = GPIO_PUSH_UP;
|
||
gpio_initstructure.odrv = GPIO_OUT_DRIVE_NORMAL;
|
||
gpio_initstructure.flt = GPIO_FILTER_DISABLE;
|
||
gpio_initstructure.type = GPIO_TYPE_TTL;
|
||
|
||
#ifdef BSP_USING_AD16C4T0_PWM /* 4 channels */
|
||
static struct rt_device_pwm ad16c4t0_pwm_dev;
|
||
static timer_handle_t ad16c4t0_timer_initstruct;
|
||
|
||
ad16c4t0_timer_initstruct.perh = AD16C4T0;
|
||
ald_timer_pwm_init(&ad16c4t0_timer_initstruct);
|
||
|
||
/* gpio initialization */
|
||
|
||
#if defined(ES_AD16C4T0_CH1_GPIO_FUNC)&&defined(ES_AD16C4T0_CH1_GPIO_PORT)&&defined(ES_AD16C4T0_CH1_GPIO_PIN)
|
||
gpio_initstructure.func = ES_AD16C4T0_CH1_GPIO_FUNC;
|
||
ald_gpio_init(ES_AD16C4T0_CH1_GPIO_PORT, ES_AD16C4T0_CH1_GPIO_PIN, &gpio_initstructure);
|
||
#endif
|
||
|
||
#if defined(ES_AD16C4T0_CH2_GPIO_FUNC)&&defined(ES_AD16C4T0_CH2_GPIO_PORT)&&defined(ES_AD16C4T0_CH2_GPIO_PIN)
|
||
gpio_initstructure.func = ES_AD16C4T0_CH2_GPIO_FUNC;
|
||
ald_gpio_init(ES_AD16C4T0_CH2_GPIO_PORT, ES_AD16C4T0_CH2_GPIO_PIN, &gpio_initstructure);
|
||
#endif
|
||
|
||
#if defined(ES_AD16C4T0_CH3_GPIO_FUNC)&&defined(ES_AD16C4T0_CH3_GPIO_PORT)&&defined(ES_AD16C4T0_CH3_GPIO_FUNC)
|
||
gpio_initstructure.func = ES_AD16C4T0_CH3_GPIO_FUNC;
|
||
ald_gpio_init(ES_AD16C4T0_CH3_GPIO_PORT, ES_AD16C4T0_CH3_GPIO_PIN, &gpio_initstructure);
|
||
#endif
|
||
|
||
#if defined(ES_AD16C4T0_CH4_GPIO_FUNC)&&defined(ES_AD16C4T0_CH4_GPIO_PORT)&&defined(ES_AD16C4T0_CH4_GPIO_PIN)
|
||
gpio_initstructure.func = ES_AD16C4T0_CH4_GPIO_FUNC;
|
||
ald_gpio_init(ES_AD16C4T0_CH4_GPIO_PORT, ES_AD16C4T0_CH4_GPIO_PIN, &gpio_initstructure);
|
||
#endif
|
||
|
||
ret = rt_device_pwm_register(&ad16c4t0_pwm_dev, ES_DEVICE_NAME_AD16C4T0_PWM, &es32f0_pwm_ops,
|
||
&ad16c4t0_timer_initstruct);
|
||
#endif
|
||
|
||
#ifdef BSP_USING_GP16C4T0_PWM /* 4 channels */
|
||
static struct rt_device_pwm gp16c4t0_pwm_dev;
|
||
static timer_handle_t gp16c4t0_timer_initstruct;
|
||
|
||
gp16c4t0_timer_initstruct.perh = GP16C4T0;
|
||
ald_timer_pwm_init(&gp16c4t0_timer_initstruct);
|
||
|
||
/* gpio initialization */
|
||
|
||
#if defined(ES_GP16C4T0_CH1_GPIO_FUNC)&&defined(ES_GP16C4T0_CH1_GPIO_PORT)&&defined(ES_GP16C4T0_CH1_GPIO_PIN)
|
||
gpio_initstructure.func = ES_GP16C4T0_CH1_GPIO_FUNC;
|
||
ald_gpio_init(ES_GP16C4T0_CH1_GPIO_PORT, ES_GP16C4T0_CH1_GPIO_PIN, &gpio_initstructure);
|
||
#endif
|
||
|
||
#if defined(ES_GP16C4T0_CH2_GPIO_FUNC)&&defined(ES_GP16C4T0_CH2_GPIO_PORT)&&defined(ES_GP16C4T0_CH2_GPIO_PIN)
|
||
gpio_initstructure.func = ES_GP16C4T0_CH2_GPIO_FUNC;
|
||
ald_gpio_init(ES_GP16C4T0_CH2_GPIO_PORT, ES_GP16C4T0_CH2_GPIO_PIN, &gpio_initstructure);
|
||
#endif
|
||
|
||
#if defined(ES_GP16C4T0_CH3_GPIO_FUNC)&&defined(ES_GP16C4T0_CH3_GPIO_PORT)&&defined(ES_GP16C4T0_CH3_GPIO_PIN)
|
||
gpio_initstructure.func = ES_GP16C4T0_CH3_GPIO_FUNC;
|
||
ald_gpio_init(ES_GP16C4T0_CH3_GPIO_PORT, ES_GP16C4T0_CH3_GPIO_PIN, &gpio_initstructure);
|
||
#endif
|
||
|
||
#if defined(ES_GP16C4T0_CH4_GPIO_FUNC)&&defined(ES_GP16C4T0_CH4_GPIO_PORT)&&defined(ES_GP16C4T0_CH4_GPIO_PIN)
|
||
gpio_initstructure.func = ES_GP16C4T0_CH4_GPIO_FUNC;
|
||
ald_gpio_init(ES_GP16C4T0_CH4_GPIO_PORT, ES_GP16C4T0_CH4_GPIO_PIN, &gpio_initstructure);
|
||
#endif
|
||
|
||
ret = rt_device_pwm_register(&gp16c4t0_pwm_dev, ES_DEVICE_NAME_GP16C4T0_PWM, &es32f0_pwm_ops,
|
||
&gp16c4t0_timer_initstruct);
|
||
#endif
|
||
|
||
|
||
#ifdef BSP_USING_GP16C2T0_PWM /* 2 channels */
|
||
static struct rt_device_pwm gp16c2t0_pwm_dev;
|
||
static timer_handle_t gp16c2t0_timer_initstruct;
|
||
|
||
gp16c2t0_timer_initstruct.perh = GP16C2T0;
|
||
ald_timer_pwm_init(&gp16c2t0_timer_initstruct);
|
||
|
||
/* gpio initialization */
|
||
|
||
#if defined(ES_GP16C2T0_CH1_GPIO_FUNC)&&defined(ES_GP16C2T0_CH1_GPIO_PORT)&&defined(ES_GP16C2T0_CH1_GPIO_PIN)
|
||
gpio_initstructure.func = ES_GP16C2T0_CH1_GPIO_FUNC;
|
||
ald_gpio_init(ES_GP16C2T0_CH1_GPIO_PORT, ES_GP16C2T0_CH1_GPIO_PIN, &gpio_initstructure);
|
||
#endif
|
||
|
||
#if defined(ES_GP16C2T0_CH2_GPIO_FUNC)&&defined(ES_GP16C2T0_CH2_GPIO_PORT)&&defined(ES_GP16C2T0_CH2_GPIO_PIN)
|
||
gpio_initstructure.func = ES_GP16C2T0_CH2_GPIO_FUNC;
|
||
ald_gpio_init(ES_GP16C2T0_CH2_GPIO_PORT, ES_GP16C2T0_CH2_GPIO_PIN, &gpio_initstructure);
|
||
#endif
|
||
|
||
ret = rt_device_pwm_register(&gp16c2t0_pwm_dev, ES_DEVICE_NAME_GP16C2T0_PWM, &es32f0_pwm_ops,
|
||
&gp16c2t0_timer_initstruct);
|
||
#endif
|
||
|
||
|
||
#ifdef BSP_USING_GP16C2T1_PWM /* 2 channels */
|
||
static struct rt_device_pwm gp16c2t1_pwm_dev;
|
||
static timer_handle_t gp16c2t1_timer_initstruct;
|
||
|
||
gp16c2t1_timer_initstruct.perh = GP16C2T1;
|
||
ald_timer_pwm_init(&gp16c2t1_timer_initstruct);
|
||
|
||
/* gpio initialization */
|
||
|
||
#if defined(ES_GP16C2T1_CH1_GPIO_FUNC)&&defined(ES_GP16C2T1_CH1_GPIO_PORT)&&defined(ES_GP16C2T1_CH1_GPIO_PIN)
|
||
gpio_initstructure.func = ES_GP16C2T1_CH1_GPIO_FUNC;
|
||
ald_gpio_init(ES_GP16C2T1_CH1_GPIO_PORT, ES_GP16C2T1_CH1_GPIO_PIN, &gpio_initstructure);
|
||
#endif
|
||
|
||
#if defined(ES_GP16C2T1_CH2_GPIO_FUNC)&&defined(ES_GP16C2T1_CH2_GPIO_PORT)&&defined(ES_GP16C2T1_CH2_GPIO_PIN)
|
||
gpio_initstructure.func = ES_GP16C2T1_CH2_GPIO_FUNC;
|
||
ald_gpio_init(ES_GP16C2T1_CH2_GPIO_PORT, ES_GP16C2T1_CH2_GPIO_PIN, &gpio_initstructure);
|
||
#endif
|
||
|
||
ret = rt_device_pwm_register(&gp16c2t1_pwm_dev, ES_DEVICE_NAME_GP16C2T1_PWM, &es32f0_pwm_ops,
|
||
&gp16c2t1_timer_initstruct);
|
||
#endif
|
||
|
||
|
||
|
||
return ret;
|
||
}
|
||
INIT_DEVICE_EXPORT(rt_hw_pwm_init);
|
||
|
||
#endif
|