Skip to content
体验新版
项目
组织
正在加载...
登录
切换导航
打开侧边栏
lfmiao0
rt-thread
提交
6d3847b6
R
rt-thread
项目概览
lfmiao0
/
rt-thread
与 Fork 源项目一致
Fork自
RT-Thread / rt-thread
通知
1
Star
0
Fork
0
代码
文件
提交
分支
Tags
贡献者
分支图
Diff
Issue
0
列表
看板
标记
里程碑
合并请求
0
DevOps
流水线
流水线任务
计划
Wiki
0
Wiki
分析
仓库
DevOps
项目成员
Pages
R
rt-thread
项目概览
项目概览
详情
发布
仓库
仓库
文件
提交
分支
标签
贡献者
分支图
比较
Issue
0
Issue
0
列表
看板
标记
里程碑
合并请求
0
合并请求
0
Pages
DevOps
DevOps
流水线
流水线任务
计划
分析
分析
仓库分析
DevOps
Wiki
0
Wiki
成员
成员
收起侧边栏
关闭侧边栏
动态
分支图
创建新Issue
流水线任务
提交
Issue看板
体验新版 GitCode,发现更多精彩内容 >>
未验证
提交
6d3847b6
编写于
2月 23, 2021
作者:
B
Bernard Xiong
提交者:
GitHub
2月 23, 2021
浏览文件
操作
浏览文件
下载
差异文件
Merge pull request #4335 from LeeChunHei/qtimer_port
爲RT1052移植QTMR的PWM
上级
5a53b08f
4c32843d
变更
2
隐藏空白更改
内联
并排
Showing
2 changed file
with
289 addition
and
20 deletion
+289
-20
bsp/imxrt/libraries/MIMXRT1050/SConscript
bsp/imxrt/libraries/MIMXRT1050/SConscript
+1
-0
bsp/imxrt/libraries/drivers/drv_pwm.c
bsp/imxrt/libraries/drivers/drv_pwm.c
+288
-20
未找到文件。
bsp/imxrt/libraries/MIMXRT1050/SConscript
浏览文件 @
6d3847b6
...
...
@@ -34,6 +34,7 @@ if GetDepend(['BSP_USING_HWTIMER']) or GetDepend(['BSP_USING_PWM']):
if
GetDepend
([
'BSP_USING_PWM'
]):
src
+=
[
'MIMXRT1052/drivers/fsl_pwm.c'
]
src
+=
[
'MIMXRT1052/drivers/fsl_qtmr.c'
]
if
GetDepend
([
'BSP_USING_RTC'
]):
src
+=
[
'MIMXRT1052/drivers/fsl_snvs_hp.c'
]
...
...
bsp/imxrt/libraries/drivers/drv_pwm.c
浏览文件 @
6d3847b6
...
...
@@ -16,8 +16,12 @@
#if !defined(BSP_USING_PWM1_CH0) && !defined(BSP_USING_PWM1_CH1) && !defined(BSP_USING_PWM1_CH2) && !defined(BSP_USING_PWM1_CH3) && \
!defined(BSP_USING_PWM2_CH0) && !defined(BSP_USING_PWM2_CH1) && !defined(BSP_USING_PWM2_CH2) && !defined(BSP_USING_PWM2_CH3) && \
!defined(BSP_USING_PWM3_CH0) && !defined(BSP_USING_PWM3_CH1) && !defined(BSP_USING_PWM3_CH2) && !defined(BSP_USING_PWM3_CH3) && \
!defined(BSP_USING_PWM4_CH0) && !defined(BSP_USING_PWM4_CH1) && !defined(BSP_USING_PWM4_CH2) && !defined(BSP_USING_PWM4_CH3)
#error "Please define at least one BSP_USING_PWMx_CHx"
!defined(BSP_USING_PWM4_CH0) && !defined(BSP_USING_PWM4_CH1) && !defined(BSP_USING_PWM4_CH2) && !defined(BSP_USING_PWM4_CH3) && \
!defined(BSP_USING_QTMR1_CH0) && !defined(BSP_USING_QTMR1_CH1) && !defined(BSP_USING_QTMR1_CH2) && !defined(BSP_USING_QTMR1_CH3) && \
!defined(BSP_USING_QTMR2_CH0) && !defined(BSP_USING_QTMR2_CH1) && !defined(BSP_USING_QTMR2_CH2) && !defined(BSP_USING_QTMR2_CH3) && \
!defined(BSP_USING_QTMR3_CH0) && !defined(BSP_USING_QTMR3_CH1) && !defined(BSP_USING_QTMR3_CH2) && !defined(BSP_USING_QTMR3_CH3) && \
!defined(BSP_USING_QTMR4_CH0) && !defined(BSP_USING_QTMR4_CH1) && !defined(BSP_USING_QTMR4_CH2) && !defined(BSP_USING_QTMR4_CH3)
#error "Please define at least one BSP_USING_PWMx_CHx or BSP_USING_QTMRx_CHx"
#endif
#define LOG_TAG "drv.pwm"
...
...
@@ -25,6 +29,9 @@
#include <rtdevice.h>
#include "fsl_pwm.h"
#if defined(FSL_FEATURE_SOC_TMR_COUNT) && FSL_FEATURE_SOC_TMR_COUNT > 0
#include "fsl_qtmr.h"
#endif
#include "drv_pwm.h"
#define DEFAULT_PRE 5
...
...
@@ -153,7 +160,7 @@ static rt_err_t imxrt_drv_pwm_init(PWM_Type *base, pwm_submodule_t pwm_submodule
if
(
PWM_Init
(
base
,
pwm_submodule
,
&
PwmConfig
)
==
kStatus_Fail
)
{
LOG_E
(
"init pwm failed
\n
"
);
return
RT_ERROR
;
return
-
RT_ERROR
;
}
base
->
SM
[
fault_input
].
DISMAP
[
0
]
=
0x00
;
...
...
@@ -176,28 +183,28 @@ static rt_err_t imxrt_pwm1_init(PWM_Type *base)
#ifdef BSP_USING_PWM1_CH0
if
(
imxrt_drv_pwm_init
(
base
,
kPWM_Module_0
,
DEFAULT_PRE
,
DEFAULT_FRE
,
DEFAULT_DUTY
)
!=
RT_EOK
)
{
return
RT_ERROR
;
return
-
RT_ERROR
;
}
#endif
/* BSP_USING_PWM1_CH0 */
#ifdef BSP_USING_PWM1_CH1
if
(
imxrt_drv_pwm_init
(
base
,
kPWM_Module_1
,
DEFAULT_PRE
,
DEFAULT_FRE
,
DEFAULT_DUTY
)
!=
RT_EOK
)
{
return
RT_ERROR
;
return
-
RT_ERROR
;
}
#endif
/* BSP_USING_PWM1_CH1 */
#ifdef BSP_USING_PWM1_CH2
if
(
imxrt_drv_pwm_init
(
base
,
kPWM_Module_2
,
DEFAULT_PRE
,
DEFAULT_FRE
,
DEFAULT_DUTY
)
!=
RT_EOK
)
{
return
RT_ERROR
;
return
-
RT_ERROR
;
}
#endif
/*BSP_USING_PWM1_CH2 */
#ifdef BSP_USING_PWM1_CH3
if
(
imxrt_drv_pwm_init
(
base
,
kPWM_Module_3
,
DEFAULT_PRE
,
DEFAULT_FRE
,
DEFAULT_DUTY
)
!=
RT_EOK
)
{
return
RT_ERROR
;
return
-
RT_ERROR
;
}
#endif
/* BSP_USING_PWM1_CH3 */
...
...
@@ -213,28 +220,28 @@ static rt_err_t imxrt_pwm2_init(PWM_Type *base)
#ifdef BSP_USING_PWM2_CH0
if
(
imxrt_drv_pwm_init
(
base
,
kPWM_Module_0
,
DEFAULT_PRE
,
DEFAULT_FRE
,
DEFAULT_DUTY
)
!=
RT_EOK
)
{
return
RT_ERROR
;
return
-
RT_ERROR
;
}
#endif
/* BSP_USING_PWM2_CH0 */
#ifdef BSP_USING_PWM2_CH1
if
(
imxrt_drv_pwm_init
(
base
,
kPWM_Module_1
,
DEFAULT_PRE
,
DEFAULT_FRE
,
DEFAULT_DUTY
)
!=
RT_EOK
)
{
return
RT_ERROR
;
return
-
RT_ERROR
;
}
#endif
/* BSP_USING_PWM2_CH1 */
#ifdef BSP_USING_PWM2_CH2
if
(
imxrt_drv_pwm_init
(
base
,
kPWM_Module_2
,
DEFAULT_PRE
,
DEFAULT_FRE
,
DEFAULT_DUTY
)
!=
RT_EOK
)
{
return
RT_ERROR
;
return
-
RT_ERROR
;
}
#endif
/*BSP_USING_PWM2_CH2 */
#ifdef BSP_USING_PWM2_CH3
if
(
imxrt_drv_pwm_init
(
base
,
kPWM_Module_3
,
DEFAULT_PRE
,
DEFAULT_FRE
,
DEFAULT_DUTY
)
!=
RT_EOK
)
{
return
RT_ERROR
;
return
-
RT_ERROR
;
}
#endif
/* BSP_USING_PWM2_CH3 */
...
...
@@ -250,28 +257,28 @@ static rt_err_t imxrt_pwm3_init(PWM_Type *base)
#ifdef BSP_USING_PWM3_CH0
if
(
imxrt_drv_pwm_init
(
base
,
kPWM_Module_0
,
DEFAULT_PRE
,
DEFAULT_FRE
,
DEFAULT_DUTY
)
!=
RT_EOK
)
{
return
RT_ERROR
;
return
-
RT_ERROR
;
}
#endif
/* BSP_USING_PWM3_CH0 */
#ifdef BSP_USING_PWM3_CH1
if
(
imxrt_drv_pwm_init
(
base
,
kPWM_Module_1
,
DEFAULT_PRE
,
DEFAULT_FRE
,
DEFAULT_DUTY
)
!=
RT_EOK
)
{
return
RT_ERROR
;
return
-
RT_ERROR
;
}
#endif
/* BSP_USING_PWM3_CH1 */
#ifdef BSP_USING_PWM3_CH2
if
(
imxrt_drv_pwm_init
(
base
,
kPWM_Module_2
,
DEFAULT_PRE
,
DEFAULT_FRE
,
DEFAULT_DUTY
)
!=
RT_EOK
)
{
return
RT_ERROR
;
return
-
RT_ERROR
;
}
#endif
/*BSP_USING_PWM3_CH2 */
#ifdef BSP_USING_PWM3_CH3
if
(
imxrt_drv_pwm_init
(
base
,
kPWM_Module_3
,
DEFAULT_PRE
,
DEFAULT_FRE
,
DEFAULT_DUTY
)
!=
RT_EOK
)
{
return
RT_ERROR
;
return
-
RT_ERROR
;
}
#endif
/* BSP_USING_PWM3_CH3 */
...
...
@@ -287,28 +294,28 @@ static rt_err_t imxrt_pwm4_init(PWM_Type *base)
#ifdef BSP_USING_PWM4_CH0
if
(
imxrt_drv_pwm_init
(
base
,
kPWM_Module_0
,
DEFAULT_PRE
,
DEFAULT_FRE
,
DEFAULT_DUTY
)
!=
RT_EOK
)
{
return
RT_ERROR
;
return
-
RT_ERROR
;
}
#endif
/* BSP_USING_PWM4_CH0 */
#ifdef BSP_USING_PWM4_CH1
if
(
imxrt_drv_pwm_init
(
base
,
kPWM_Module_1
,
DEFAULT_PRE
,
DEFAULT_FRE
,
DEFAULT_DUTY
)
!=
RT_EOK
)
{
return
RT_ERROR
;
return
-
RT_ERROR
;
}
#endif
/* BSP_USING_PWM4_CH1 */
#ifdef BSP_USING_PWM4_CH2
if
(
imxrt_drv_pwm_init
(
base
,
kPWM_Module_2
,
DEFAULT_PRE
,
DEFAULT_FRE
,
DEFAULT_DUTY
)
!=
RT_EOK
)
{
return
RT_ERROR
;
return
-
RT_ERROR
;
}
#endif
/*BSP_USING_PWM4_CH2 */
#ifdef BSP_USING_PWM4_CH3
if
(
imxrt_drv_pwm_init
(
base
,
kPWM_Module_3
,
DEFAULT_PRE
,
DEFAULT_FRE
,
DEFAULT_DUTY
)
!=
RT_EOK
)
{
return
RT_ERROR
;
return
-
RT_ERROR
;
}
#endif
/* BSP_USING_PWM4_CH3 */
...
...
@@ -317,6 +324,224 @@ static rt_err_t imxrt_pwm4_init(PWM_Type *base)
#endif
/* BSP_USING_PWM4 */
static
rt_err_t
imxrt_drv_qtmr_control
(
struct
rt_device_pwm
*
device
,
int
cmd
,
void
*
arg
);
static
struct
rt_pwm_ops
imxrt_drv_qtmr_ops
=
{
.
control
=
imxrt_drv_qtmr_control
};
static
rt_err_t
imxrt_drv_qtmr_enable
(
struct
rt_device_pwm
*
device
,
struct
rt_pwm_configuration
*
configuration
,
rt_bool_t
enable
)
{
TMR_Type
*
base
;
base
=
(
TMR_Type
*
)
device
->
parent
.
user_data
;
if
(
!
enable
)
{
QTMR_StopTimer
(
base
,
configuration
->
channel
);
base
->
CHANNEL
[
configuration
->
channel
].
SCTRL
|=
(
TMR_SCTRL_FORCE_MASK
|
TMR_SCTRL_OEN_MASK
);
}
else
{
QTMR_StartTimer
(
base
,
configuration
->
channel
,
kQTMR_PriSrcRiseEdge
);
}
return
RT_EOK
;
}
static
rt_err_t
imxrt_drv_qtmr_get
(
struct
rt_device_pwm
*
device
,
struct
rt_pwm_configuration
*
configuration
)
{
TMR_Type
*
base
;
rt_uint32_t
high_count
,
low_count
,
clk_divider
,
clk_freq
;
base
=
(
TMR_Type
*
)
device
->
parent
.
user_data
;
low_count
=
base
->
CHANNEL
[
configuration
->
channel
].
COMP1
;
high_count
=
base
->
CHANNEL
[
configuration
->
channel
].
COMP2
;
clk_divider
=
1
<<
(((
base
->
CHANNEL
[
configuration
->
channel
].
CTRL
&
TMR_CTRL_PCS_MASK
)
>>
TMR_CTRL_PCS_SHIFT
)
-
8
);
clk_freq
=
CLOCK_GetFreq
(
kCLOCK_IpgClk
)
/
clk_divider
;
configuration
->
period
=
1000000000
/
clk_freq
*
(
high_count
+
low_count
);
configuration
->
pulse
=
1000000000
/
clk_freq
*
high_count
;
return
RT_EOK
;
}
static
rt_err_t
imxrt_drv_qtmr_set
(
struct
rt_device_pwm
*
device
,
struct
rt_pwm_configuration
*
configuration
)
{
RT_ASSERT
(
configuration
->
period
>
0
);
RT_ASSERT
(
configuration
->
pulse
<=
configuration
->
period
);
TMR_Type
*
base
=
(
TMR_Type
*
)
device
->
parent
.
user_data
;
rt_size_t
clk_freq
=
CLOCK_GetFreq
(
kCLOCK_IpgClk
)
/
(
1
<<
(((
base
->
CHANNEL
[
configuration
->
channel
].
CTRL
&
TMR_CTRL_PCS_MASK
)
>>
TMR_CTRL_PCS_SHIFT
)
-
8
));
rt_size_t
current_period_count
=
base
->
CHANNEL
[
configuration
->
channel
].
CMPLD1
+
base
->
CHANNEL
[
configuration
->
channel
].
CMPLD2
;
rt_size_t
period_count
=
clk_freq
/
(
1000000000
/
configuration
->
period
);
if
(
current_period_count
==
period_count
)
{
rt_size_t
high_count
=
period_count
*
configuration
->
pulse
/
configuration
->
period
;
rt_size_t
low_count
=
period_count
-
high_count
;
base
->
CHANNEL
[
configuration
->
channel
].
CMPLD1
=
(
uint16_t
)
low_count
;
base
->
CHANNEL
[
configuration
->
channel
].
CMPLD2
=
(
uint16_t
)
high_count
;
}
else
{
rt_bool_t
timer_is_on
=
base
->
CHANNEL
[
configuration
->
channel
].
CTRL
&
TMR_CTRL_CM_MASK
;
rt_uint8_t
duty
=
configuration
->
pulse
*
100
/
configuration
->
period
;
QTMR_StopTimer
(
base
,
configuration
->
channel
);
if
(
kStatus_Success
!=
QTMR_SetupPwm
(
base
,
configuration
->
channel
,
1000000000
/
configuration
->
period
,
duty
,
DEFAULT_POLARITY
,
clk_freq
))
{
LOG_E
(
LOG_TAG
" setup pwm failed
\n
"
);
return
-
RT_ERROR
;
}
if
(
timer_is_on
)
{
QTMR_StartTimer
(
base
,
configuration
->
channel
,
kQTMR_PriSrcRiseEdge
);
}
}
return
RT_EOK
;
}
static
rt_err_t
imxrt_drv_qtmr_control
(
struct
rt_device_pwm
*
device
,
int
cmd
,
void
*
arg
)
{
struct
rt_pwm_configuration
*
configuration
=
(
struct
rt_pwm_configuration
*
)
arg
;
switch
(
cmd
)
{
case
PWM_CMD_ENABLE
:
return
imxrt_drv_qtmr_enable
(
device
,
configuration
,
RT_TRUE
);
case
PWM_CMD_DISABLE
:
return
imxrt_drv_qtmr_enable
(
device
,
configuration
,
RT_FALSE
);
case
PWM_CMD_SET
:
return
imxrt_drv_qtmr_set
(
device
,
configuration
);
case
PWM_CMD_GET
:
return
imxrt_drv_qtmr_get
(
device
,
configuration
);
default:
return
RT_EINVAL
;
}
}
static
rt_err_t
imxrt_drv_qtmr_init
(
TMR_Type
*
base
,
qtmr_channel_selection_t
channel
,
uint16_t
psc
,
uint32_t
fre
,
uint8_t
duty
)
{
qtmr_config_t
qtmr_config
;
rt_uint32_t
qtmr_clock_freq
;
QTMR_GetDefaultConfig
(
&
qtmr_config
);
qtmr_config
.
primarySource
=
(
qtmr_primary_count_source_t
)(
psc
+
8
);
qtmr_clock_freq
=
CLOCK_GetFreq
(
kCLOCK_IpgClk
)
/
(
1
<<
psc
);
QTMR_Init
(
base
,
channel
,
&
qtmr_config
);
if
(
kStatus_Success
!=
QTMR_SetupPwm
(
base
,
channel
,
fre
,
duty
,
DEFAULT_POLARITY
,
qtmr_clock_freq
))
{
LOG_E
(
LOG_TAG
" setup pwm failed
\n
"
);
return
-
RT_ERROR
;
}
return
RT_EOK
;
}
static
rt_err_t
imxrt_qtmr_init
()
{
TMR_Type
*
base_list
[]
=
{
#ifdef BSP_USING_QTMR1
TMR1
,
#endif
#ifdef BSP_USING_QTMR2
TMR2
,
#endif
#ifdef BSP_USING_QTMR3
TMR3
,
#endif
#ifdef BSP_USING_QTMR4
TMR4
,
#endif
};
rt_uint8_t
channel_list
[]
=
{
#ifdef BSP_USING_QTMR1
#ifdef BSP_USING_QTMR1_CH0
1
<<
0
|
#endif
#ifdef BSP_USING_QTMR1_CH1
1
<<
1
|
#endif
#ifdef BSP_USING_QTMR1_CH2
1
<<
2
|
#endif
#ifdef BSP_USING_QTMR1_CH3
1
<<
3
|
#endif
0
,
#endif
#ifdef BSP_USING_QTMR2
#ifdef BSP_USING_QTMR2_CH0
1
<<
0
|
#endif
#ifdef BSP_USING_QTMR2_CH1
1
<<
1
|
#endif
#ifdef BSP_USING_QTMR2_CH2
1
<<
2
|
#endif
#ifdef BSP_USING_QTMR2_CH3
1
<<
3
|
#endif
0
,
#endif
#ifdef BSP_USING_QTMR3
#ifdef BSP_USING_QTMR3_CH0
1
<<
0
|
#endif
#ifdef BSP_USING_QTMR3_CH1
1
<<
1
|
#endif
#ifdef BSP_USING_QTMR3_CH2
1
<<
2
|
#endif
#ifdef BSP_USING_QTMR3_CH3
1
<<
3
|
#endif
0
,
#endif
#ifdef BSP_USING_QTMR4
#ifdef BSP_USING_QTMR4_CH0
1
<<
0
|
#endif
#ifdef BSP_USING_QTMR4_CH1
1
<<
1
|
#endif
#ifdef BSP_USING_QTMR4_CH2
1
<<
2
|
#endif
#ifdef BSP_USING_QTMR4_CH3
1
<<
3
|
#endif
0
,
#endif
};
for
(
rt_uint8_t
i
=
0
;
i
<
sizeof
(
base_list
)
/
sizeof
(
TMR_Type
*
);
++
i
)
{
for
(
rt_uint8_t
j
=
0
;
j
<
8
;
++
j
)
{
if
((
channel_list
[
i
]
>>
j
)
&
1
)
{
if
(
imxrt_drv_qtmr_init
(
base_list
[
i
],
j
,
DEFAULT_PRE
,
DEFAULT_FRE
,
DEFAULT_DUTY
)
!=
RT_EOK
)
{
return
-
RT_ERROR
;
}
}
}
}
return
RT_EOK
;
}
int
rt_hw_pwm_init
(
void
)
{
rt_err_t
ret
=
RT_EOK
;
...
...
@@ -391,9 +616,52 @@ int rt_hw_pwm_init(void)
}
#endif
/* BSP_USING_PWM4 */
#if defined(BSP_USING_QTMR1) || defined(BSP_USING_QTMR2) || defined(BSP_USING_QTMR3) || defined(BSP_USING_QTMR4)
if
(
imxrt_qtmr_init
()
!=
RT_EOK
)
{
LOG_E
(
LOG_TAG
" init qtmr failed"
);
}
#endif
#ifdef BSP_USING_QTMR1
static
struct
rt_device_pwm
qtmr1_device
;
ret
=
rt_device_pwm_register
(
&
qtmr1_device
,
"pwm5"
,
&
imxrt_drv_qtmr_ops
,
TMR1
);
if
(
ret
!=
RT_EOK
)
{
LOG_E
(
"%s register failed"
,
"pwm5"
);
}
#endif
/* BSP_USING_QTMR1 */
#ifdef BSP_USING_QTMR2
static
struct
rt_device_pwm
qtmr2_device
;
ret
=
rt_device_pwm_register
(
&
qtmr2_device
,
"pwm6"
,
&
imxrt_drv_qtmr_ops
,
TMR2
);
if
(
ret
!=
RT_EOK
)
{
LOG_E
(
"%s register failed"
,
"pwm6"
);
}
#endif
/* BSP_USING_QTMR2 */
#ifdef BSP_USING_QTMR3
static
struct
rt_device_pwm
qtmr3_device
;
ret
=
rt_device_pwm_register
(
&
qtmr3_device
,
"pwm7"
,
&
imxrt_drv_qtmr_ops
,
TMR3
);
if
(
ret
!=
RT_EOK
)
{
LOG_E
(
"%s register failed"
,
"pwm7"
);
}
#endif
/* BSP_USING_QTMR3 */
#ifdef BSP_USING_QTMR4
static
struct
rt_device_pwm
qtmr4_device
;
ret
=
rt_device_pwm_register
(
&
qtmr4_device
,
"pwm8"
,
&
imxrt_drv_qtmr_ops
,
TMR4
);
if
(
ret
!=
RT_EOK
)
{
LOG_E
(
"%s register failed"
,
"pwm8"
);
}
#endif
/* BSP_USING_QTMR4 */
return
ret
;
}
INIT_
DEVICE
_EXPORT
(
rt_hw_pwm_init
);
INIT_
BOARD
_EXPORT
(
rt_hw_pwm_init
);
#endif
/* BSP_USING_PWM */
编辑
预览
Markdown
is supported
0%
请重试
或
添加新附件
.
添加附件
取消
You are about to add
0
people
to the discussion. Proceed with caution.
先完成此消息的编辑!
取消
想要评论请
注册
或
登录