drv_pwm.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671
  1. /*
  2. * Copyright (c) 2006-2022, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2019-04-28 tyustli first version
  9. *
  10. */
  11. #include <rtthread.h>
  12. #ifdef BSP_USING_PWM
  13. #if !defined(BSP_USING_PWM1_CH0) && !defined(BSP_USING_PWM1_CH1) && !defined(BSP_USING_PWM1_CH2) && !defined(BSP_USING_PWM1_CH3) && \
  14. !defined(BSP_USING_PWM2_CH0) && !defined(BSP_USING_PWM2_CH1) && !defined(BSP_USING_PWM2_CH2) && !defined(BSP_USING_PWM2_CH3) && \
  15. !defined(BSP_USING_PWM3_CH0) && !defined(BSP_USING_PWM3_CH1) && !defined(BSP_USING_PWM3_CH2) && !defined(BSP_USING_PWM3_CH3) && \
  16. !defined(BSP_USING_PWM4_CH0) && !defined(BSP_USING_PWM4_CH1) && !defined(BSP_USING_PWM4_CH2) && !defined(BSP_USING_PWM4_CH3) && \
  17. !defined(BSP_USING_QTMR1_CH0) && !defined(BSP_USING_QTMR1_CH1) && !defined(BSP_USING_QTMR1_CH2) && !defined(BSP_USING_QTMR1_CH3) && \
  18. !defined(BSP_USING_QTMR2_CH0) && !defined(BSP_USING_QTMR2_CH1) && !defined(BSP_USING_QTMR2_CH2) && !defined(BSP_USING_QTMR2_CH3) && \
  19. !defined(BSP_USING_QTMR3_CH0) && !defined(BSP_USING_QTMR3_CH1) && !defined(BSP_USING_QTMR3_CH2) && !defined(BSP_USING_QTMR3_CH3) && \
  20. !defined(BSP_USING_QTMR4_CH0) && !defined(BSP_USING_QTMR4_CH1) && !defined(BSP_USING_QTMR4_CH2) && !defined(BSP_USING_QTMR4_CH3)
  21. #error "Please define at least one BSP_USING_PWMx_CHx or BSP_USING_QTMRx_CHx"
  22. #endif
  23. #define LOG_TAG "drv.pwm"
  24. #include <drv_log.h>
  25. #include <rtdevice.h>
  26. #include "fsl_pwm.h"
  27. #if defined(FSL_FEATURE_SOC_TMR_COUNT) && FSL_FEATURE_SOC_TMR_COUNT > 0
  28. #include "fsl_qtmr.h"
  29. #endif
  30. #include "drv_pwm.h"
  31. #define DEFAULT_PRE 5
  32. #define DEFAULT_DUTY 50
  33. #define DEFAULT_FRE 1000
  34. #ifdef SOC_MIMXRT1170_SERIES
  35. #define PWM_SRC_CLK_FREQ CLOCK_GetRootClockFreq(kCLOCK_Root_Bus)
  36. #else
  37. #define PWM_SRC_CLK_FREQ CLOCK_GetFreq(kCLOCK_IpgClk)
  38. #endif
  39. #define DEFAULT_COMPLEMENTARY_PAIR kPWM_PwmA
  40. #define DEFAULT_POLARITY kPWM_HighTrue
  41. static pwm_signal_param_t Pwm_Signal;
  42. static rt_err_t imxrt_drv_pwm_control(struct rt_device_pwm *device, int cmd, void *arg);
  43. static struct rt_pwm_ops imxrt_drv_ops =
  44. {
  45. .control = imxrt_drv_pwm_control
  46. };
  47. static rt_err_t imxrt_drv_pwm_enable(struct rt_device_pwm *device, struct rt_pwm_configuration *configuration, rt_bool_t enable)
  48. {
  49. PWM_Type *base;
  50. pwm_module_control_t pwm_module_control;
  51. base = (PWM_Type *)device->parent.user_data;
  52. pwm_module_control = (pwm_module_control_t)(1 << configuration->channel);
  53. if (!enable)
  54. {
  55. PWM_StopTimer(base, pwm_module_control);
  56. }
  57. else
  58. {
  59. PWM_StartTimer(base, pwm_module_control);
  60. }
  61. return RT_EOK;
  62. }
  63. static rt_err_t imxrt_drv_pwm_get(struct rt_device_pwm *device, struct rt_pwm_configuration *configuration)
  64. {
  65. uint8_t get_duty;
  66. uint16_t pulseCnt = 0, pwmHighPulse = 0;
  67. uint32_t get_frequence;
  68. uint32_t pwmClock;
  69. PWM_Type *base;
  70. pwm_submodule_t pwm_submodule;
  71. base = (PWM_Type *)device->parent.user_data;
  72. pwm_submodule = (pwm_submodule_t)configuration->channel;
  73. /* get frequence */
  74. get_frequence = base->SM[pwm_submodule].VAL1;
  75. pwmClock = (PWM_SRC_CLK_FREQ / (1U << ((base->SM[pwm_submodule].CTRL & PWM_CTRL_PRSC_MASK) >> PWM_CTRL_PRSC_SHIFT)));
  76. get_frequence = pwmClock / get_frequence;
  77. /* get dutycycle */
  78. pulseCnt = base->SM[pwm_submodule].VAL1;
  79. pwmHighPulse = pulseCnt - (base->SM[pwm_submodule].VAL2) * 2;
  80. get_duty = pwmHighPulse * 100 / pulseCnt;
  81. /* conversion */
  82. configuration->period = 1000000000 / get_frequence;
  83. configuration->pulse = get_duty * configuration->period / 100;
  84. return RT_EOK;
  85. }
  86. static rt_err_t imxrt_drv_pwm_set(struct rt_device_pwm *device, struct rt_pwm_configuration *configuration)
  87. {
  88. RT_ASSERT(configuration->period > 0);
  89. RT_ASSERT(configuration->pulse <= configuration->period);
  90. PWM_Type *base;
  91. pwm_submodule_t pwm_submodule;
  92. pwm_module_control_t pwm_module_control;
  93. uint32_t period = 0;
  94. uint8_t duty = 0;
  95. base = (PWM_Type *)device->parent.user_data;
  96. pwm_submodule = (pwm_submodule_t)configuration->channel;
  97. pwm_module_control = (pwm_module_control_t)(1 << configuration->channel);
  98. duty = configuration->pulse * 100 / configuration->period;
  99. Pwm_Signal.dutyCyclePercent = duty;
  100. period = (uint32_t)(1000000000 / configuration->period);
  101. PWM_SetupPwm(base, pwm_submodule, &Pwm_Signal, 1, kPWM_CenterAligned, period, PWM_SRC_CLK_FREQ);
  102. PWM_UpdatePwmDutycycle(base, pwm_submodule, DEFAULT_COMPLEMENTARY_PAIR, kPWM_CenterAligned, duty);
  103. PWM_SetPwmLdok(base, pwm_module_control, true);
  104. return RT_EOK;
  105. }
  106. static rt_err_t imxrt_drv_pwm_control(struct rt_device_pwm *device, int cmd, void *arg)
  107. {
  108. struct rt_pwm_configuration *configuration = (struct rt_pwm_configuration *)arg;
  109. switch (cmd)
  110. {
  111. case PWM_CMD_ENABLE:
  112. return imxrt_drv_pwm_enable(device, configuration, RT_TRUE);
  113. case PWM_CMD_DISABLE:
  114. return imxrt_drv_pwm_enable(device, configuration, RT_FALSE);
  115. case PWM_CMD_SET:
  116. return imxrt_drv_pwm_set(device, configuration);
  117. case PWM_CMD_GET:
  118. return imxrt_drv_pwm_get(device, configuration);
  119. default:
  120. return RT_EINVAL;
  121. }
  122. }
  123. static rt_err_t imxrt_drv_pwm_init(PWM_Type *base, pwm_submodule_t pwm_submodule, uint16_t psc, uint32_t fre, uint8_t duty)
  124. {
  125. pwm_config_t PwmConfig;
  126. uint8_t fault_input;
  127. pwm_clock_prescale_t pwm_prescale = (pwm_clock_prescale_t)psc;
  128. fault_input = (uint8_t)pwm_submodule;
  129. PWM_GetDefaultConfig(&PwmConfig);
  130. PwmConfig.prescale = pwm_prescale;
  131. PwmConfig.reloadLogic = kPWM_ReloadPwmFullCycle;
  132. PwmConfig.pairOperation = kPWM_Independent;
  133. PwmConfig.enableDebugMode = true;
  134. if (PWM_Init(base, pwm_submodule, &PwmConfig) == kStatus_Fail)
  135. {
  136. LOG_E("init pwm failed \n");
  137. return -RT_ERROR;
  138. }
  139. base->SM[fault_input].DISMAP[0] = 0x00;
  140. base->SM[fault_input].DISMAP[1] = 0x00;
  141. Pwm_Signal.pwmChannel = DEFAULT_COMPLEMENTARY_PAIR;
  142. Pwm_Signal.level = DEFAULT_POLARITY;
  143. Pwm_Signal.dutyCyclePercent = duty;
  144. PWM_SetupPwm(base, pwm_submodule, &Pwm_Signal, 1, kPWM_CenterAligned, fre, PWM_SRC_CLK_FREQ);
  145. PWM_SetPwmLdok(base, pwm_submodule, true);
  146. return RT_EOK;
  147. }
  148. #ifdef BSP_USING_PWM1
  149. static rt_err_t imxrt_pwm1_init(PWM_Type *base)
  150. {
  151. #ifdef BSP_USING_PWM1_CH0
  152. if (imxrt_drv_pwm_init(base, kPWM_Module_0, DEFAULT_PRE, DEFAULT_FRE, DEFAULT_DUTY) != RT_EOK)
  153. {
  154. return -RT_ERROR;
  155. }
  156. #endif /* BSP_USING_PWM1_CH0 */
  157. #ifdef BSP_USING_PWM1_CH1
  158. if (imxrt_drv_pwm_init(base, kPWM_Module_1, DEFAULT_PRE, DEFAULT_FRE, DEFAULT_DUTY) != RT_EOK)
  159. {
  160. return -RT_ERROR;
  161. }
  162. #endif /* BSP_USING_PWM1_CH1 */
  163. #ifdef BSP_USING_PWM1_CH2
  164. if (imxrt_drv_pwm_init(base, kPWM_Module_2, DEFAULT_PRE, DEFAULT_FRE, DEFAULT_DUTY) != RT_EOK)
  165. {
  166. return -RT_ERROR;
  167. }
  168. #endif /*BSP_USING_PWM1_CH2 */
  169. #ifdef BSP_USING_PWM1_CH3
  170. if (imxrt_drv_pwm_init(base, kPWM_Module_3, DEFAULT_PRE, DEFAULT_FRE, DEFAULT_DUTY) != RT_EOK)
  171. {
  172. return -RT_ERROR;
  173. }
  174. #endif /* BSP_USING_PWM1_CH3 */
  175. return RT_EOK;
  176. }
  177. #endif /* BSP_USING_PWM1 */
  178. #ifdef BSP_USING_PWM2
  179. static rt_err_t imxrt_pwm2_init(PWM_Type *base)
  180. {
  181. #ifdef BSP_USING_PWM2_CH0
  182. if (imxrt_drv_pwm_init(base, kPWM_Module_0, DEFAULT_PRE, DEFAULT_FRE, DEFAULT_DUTY) != RT_EOK)
  183. {
  184. return -RT_ERROR;
  185. }
  186. #endif /* BSP_USING_PWM2_CH0 */
  187. #ifdef BSP_USING_PWM2_CH1
  188. if (imxrt_drv_pwm_init(base, kPWM_Module_1, DEFAULT_PRE, DEFAULT_FRE, DEFAULT_DUTY) != RT_EOK)
  189. {
  190. return -RT_ERROR;
  191. }
  192. #endif /* BSP_USING_PWM2_CH1 */
  193. #ifdef BSP_USING_PWM2_CH2
  194. if (imxrt_drv_pwm_init(base, kPWM_Module_2, DEFAULT_PRE, DEFAULT_FRE, DEFAULT_DUTY) != RT_EOK)
  195. {
  196. return -RT_ERROR;
  197. }
  198. #endif /*BSP_USING_PWM2_CH2 */
  199. #ifdef BSP_USING_PWM2_CH3
  200. if (imxrt_drv_pwm_init(base, kPWM_Module_3, DEFAULT_PRE, DEFAULT_FRE, DEFAULT_DUTY) != RT_EOK)
  201. {
  202. return -RT_ERROR;
  203. }
  204. #endif /* BSP_USING_PWM2_CH3 */
  205. return RT_EOK;
  206. }
  207. #endif /* BSP_USING_PWM2 */
  208. #ifdef BSP_USING_PWM3
  209. static rt_err_t imxrt_pwm3_init(PWM_Type *base)
  210. {
  211. #ifdef BSP_USING_PWM3_CH0
  212. if (imxrt_drv_pwm_init(base, kPWM_Module_0, DEFAULT_PRE, DEFAULT_FRE, DEFAULT_DUTY) != RT_EOK)
  213. {
  214. return -RT_ERROR;
  215. }
  216. #endif /* BSP_USING_PWM3_CH0 */
  217. #ifdef BSP_USING_PWM3_CH1
  218. if (imxrt_drv_pwm_init(base, kPWM_Module_1, DEFAULT_PRE, DEFAULT_FRE, DEFAULT_DUTY) != RT_EOK)
  219. {
  220. return -RT_ERROR;
  221. }
  222. #endif /* BSP_USING_PWM3_CH1 */
  223. #ifdef BSP_USING_PWM3_CH2
  224. if (imxrt_drv_pwm_init(base, kPWM_Module_2, DEFAULT_PRE, DEFAULT_FRE, DEFAULT_DUTY) != RT_EOK)
  225. {
  226. return -RT_ERROR;
  227. }
  228. #endif /*BSP_USING_PWM3_CH2 */
  229. #ifdef BSP_USING_PWM3_CH3
  230. if (imxrt_drv_pwm_init(base, kPWM_Module_3, DEFAULT_PRE, DEFAULT_FRE, DEFAULT_DUTY) != RT_EOK)
  231. {
  232. return -RT_ERROR;
  233. }
  234. #endif /* BSP_USING_PWM3_CH3 */
  235. return RT_EOK;
  236. }
  237. #endif /* BSP_USING_PWM3 */
  238. #ifdef BSP_USING_PWM4
  239. static rt_err_t imxrt_pwm4_init(PWM_Type *base)
  240. {
  241. #ifdef BSP_USING_PWM4_CH0
  242. if (imxrt_drv_pwm_init(base, kPWM_Module_0, DEFAULT_PRE, DEFAULT_FRE, DEFAULT_DUTY) != RT_EOK)
  243. {
  244. return -RT_ERROR;
  245. }
  246. #endif /* BSP_USING_PWM4_CH0 */
  247. #ifdef BSP_USING_PWM4_CH1
  248. if (imxrt_drv_pwm_init(base, kPWM_Module_1, DEFAULT_PRE, DEFAULT_FRE, DEFAULT_DUTY) != RT_EOK)
  249. {
  250. return -RT_ERROR;
  251. }
  252. #endif /* BSP_USING_PWM4_CH1 */
  253. #ifdef BSP_USING_PWM4_CH2
  254. if (imxrt_drv_pwm_init(base, kPWM_Module_2, DEFAULT_PRE, DEFAULT_FRE, DEFAULT_DUTY) != RT_EOK)
  255. {
  256. return -RT_ERROR;
  257. }
  258. #endif /*BSP_USING_PWM4_CH2 */
  259. #ifdef BSP_USING_PWM4_CH3
  260. if (imxrt_drv_pwm_init(base, kPWM_Module_3, DEFAULT_PRE, DEFAULT_FRE, DEFAULT_DUTY) != RT_EOK)
  261. {
  262. return -RT_ERROR;
  263. }
  264. #endif /* BSP_USING_PWM4_CH3 */
  265. return RT_EOK;
  266. }
  267. #endif /* BSP_USING_PWM4 */
  268. static rt_err_t imxrt_drv_qtmr_control(struct rt_device_pwm *device, int cmd, void *arg);
  269. static struct rt_pwm_ops imxrt_drv_qtmr_ops =
  270. {
  271. .control = imxrt_drv_qtmr_control
  272. };
  273. static rt_err_t imxrt_drv_qtmr_enable(struct rt_device_pwm *device, struct rt_pwm_configuration *configuration, rt_bool_t enable)
  274. {
  275. TMR_Type *base;
  276. base = (TMR_Type *)device->parent.user_data;
  277. if (!enable)
  278. {
  279. QTMR_StopTimer(base, configuration->channel);
  280. base->CHANNEL[configuration->channel].SCTRL |= (TMR_SCTRL_FORCE_MASK | TMR_SCTRL_OEN_MASK);
  281. }
  282. else
  283. {
  284. QTMR_StartTimer(base, configuration->channel, kQTMR_PriSrcRiseEdge);
  285. }
  286. return RT_EOK;
  287. }
  288. static rt_err_t imxrt_drv_qtmr_get(struct rt_device_pwm *device, struct rt_pwm_configuration *configuration)
  289. {
  290. TMR_Type *base;
  291. rt_uint32_t high_count, low_count, clk_divider, clk_freq;
  292. base = (TMR_Type *)device->parent.user_data;
  293. low_count = base->CHANNEL[configuration->channel].COMP1;
  294. high_count = base->CHANNEL[configuration->channel].COMP2;
  295. clk_divider = 1 << (((base->CHANNEL[configuration->channel].CTRL & TMR_CTRL_PCS_MASK) >> TMR_CTRL_PCS_SHIFT) - 8);
  296. clk_freq = PWM_SRC_CLK_FREQ / clk_divider;
  297. configuration->period = 1000000000 / clk_freq * (high_count + low_count);
  298. configuration->pulse = 1000000000 / clk_freq * high_count;
  299. return RT_EOK;
  300. }
  301. static rt_err_t imxrt_drv_qtmr_set(struct rt_device_pwm *device, struct rt_pwm_configuration *configuration)
  302. {
  303. RT_ASSERT(configuration->period > 0);
  304. RT_ASSERT(configuration->pulse <= configuration->period);
  305. TMR_Type *base = (TMR_Type *)device->parent.user_data;
  306. rt_size_t clk_freq = PWM_SRC_CLK_FREQ / (1 << (((base->CHANNEL[configuration->channel].CTRL & TMR_CTRL_PCS_MASK) >> TMR_CTRL_PCS_SHIFT) - 8));
  307. rt_size_t current_period_count = base->CHANNEL[configuration->channel].CMPLD1 + base->CHANNEL[configuration->channel].CMPLD2;
  308. rt_size_t period_count = clk_freq / (1000000000 / configuration->period);
  309. if (current_period_count == period_count)
  310. {
  311. rt_size_t high_count = period_count * configuration->pulse / configuration->period;
  312. rt_size_t low_count = period_count - high_count;
  313. base->CHANNEL[configuration->channel].CMPLD1 = (uint16_t)low_count;
  314. base->CHANNEL[configuration->channel].CMPLD2 = (uint16_t)high_count;
  315. }
  316. else
  317. {
  318. rt_bool_t timer_is_on = base->CHANNEL[configuration->channel].CTRL & TMR_CTRL_CM_MASK;
  319. rt_uint8_t duty = configuration->pulse * 100 / configuration->period;
  320. QTMR_StopTimer(base, configuration->channel);
  321. if (kStatus_Success != QTMR_SetupPwm(base, configuration->channel, 1000000000 / configuration->period, duty, DEFAULT_POLARITY, clk_freq))
  322. {
  323. LOG_E(LOG_TAG" setup pwm failed \n");
  324. return -RT_ERROR;
  325. }
  326. if (timer_is_on)
  327. {
  328. QTMR_StartTimer(base, configuration->channel, kQTMR_PriSrcRiseEdge);
  329. }
  330. }
  331. return RT_EOK;
  332. }
  333. static rt_err_t imxrt_drv_qtmr_control(struct rt_device_pwm *device, int cmd, void *arg)
  334. {
  335. struct rt_pwm_configuration *configuration = (struct rt_pwm_configuration *)arg;
  336. switch (cmd)
  337. {
  338. case PWM_CMD_ENABLE:
  339. return imxrt_drv_qtmr_enable(device, configuration, RT_TRUE);
  340. case PWM_CMD_DISABLE:
  341. return imxrt_drv_qtmr_enable(device, configuration, RT_FALSE);
  342. case PWM_CMD_SET:
  343. return imxrt_drv_qtmr_set(device, configuration);
  344. case PWM_CMD_GET:
  345. return imxrt_drv_qtmr_get(device, configuration);
  346. default:
  347. return RT_EINVAL;
  348. }
  349. }
  350. 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)
  351. {
  352. qtmr_config_t qtmr_config;
  353. rt_uint32_t qtmr_clock_freq;
  354. QTMR_GetDefaultConfig(&qtmr_config);
  355. qtmr_config.primarySource = (qtmr_primary_count_source_t)(psc + 8);
  356. qtmr_clock_freq = PWM_SRC_CLK_FREQ / (1 << psc);
  357. QTMR_Init(base, channel, &qtmr_config);
  358. if (kStatus_Success != QTMR_SetupPwm(base, channel, fre, duty, DEFAULT_POLARITY, qtmr_clock_freq))
  359. {
  360. LOG_E(LOG_TAG" setup pwm failed \n");
  361. return -RT_ERROR;
  362. }
  363. return RT_EOK;
  364. }
  365. static rt_err_t imxrt_qtmr_init()
  366. {
  367. TMR_Type *base_list[] =
  368. {
  369. #ifdef BSP_USING_QTMR1
  370. TMR1,
  371. #endif
  372. #ifdef BSP_USING_QTMR2
  373. TMR2,
  374. #endif
  375. #ifdef BSP_USING_QTMR3
  376. TMR3,
  377. #endif
  378. #ifdef BSP_USING_QTMR4
  379. TMR4,
  380. #endif
  381. };
  382. rt_uint8_t channel_list[] =
  383. {
  384. #ifdef BSP_USING_QTMR1
  385. #ifdef BSP_USING_QTMR1_CH0
  386. 1 << 0 |
  387. #endif
  388. #ifdef BSP_USING_QTMR1_CH1
  389. 1 << 1 |
  390. #endif
  391. #ifdef BSP_USING_QTMR1_CH2
  392. 1 << 2 |
  393. #endif
  394. #ifdef BSP_USING_QTMR1_CH3
  395. 1 << 3 |
  396. #endif
  397. 0,
  398. #endif
  399. #ifdef BSP_USING_QTMR2
  400. #ifdef BSP_USING_QTMR2_CH0
  401. 1 << 0 |
  402. #endif
  403. #ifdef BSP_USING_QTMR2_CH1
  404. 1 << 1 |
  405. #endif
  406. #ifdef BSP_USING_QTMR2_CH2
  407. 1 << 2 |
  408. #endif
  409. #ifdef BSP_USING_QTMR2_CH3
  410. 1 << 3 |
  411. #endif
  412. 0,
  413. #endif
  414. #ifdef BSP_USING_QTMR3
  415. #ifdef BSP_USING_QTMR3_CH0
  416. 1 << 0 |
  417. #endif
  418. #ifdef BSP_USING_QTMR3_CH1
  419. 1 << 1 |
  420. #endif
  421. #ifdef BSP_USING_QTMR3_CH2
  422. 1 << 2 |
  423. #endif
  424. #ifdef BSP_USING_QTMR3_CH3
  425. 1 << 3 |
  426. #endif
  427. 0,
  428. #endif
  429. #ifdef BSP_USING_QTMR4
  430. #ifdef BSP_USING_QTMR4_CH0
  431. 1 << 0 |
  432. #endif
  433. #ifdef BSP_USING_QTMR4_CH1
  434. 1 << 1 |
  435. #endif
  436. #ifdef BSP_USING_QTMR4_CH2
  437. 1 << 2 |
  438. #endif
  439. #ifdef BSP_USING_QTMR4_CH3
  440. 1 << 3 |
  441. #endif
  442. 0,
  443. #endif
  444. };
  445. for (rt_uint8_t i = 0; i < sizeof(base_list)/sizeof(TMR_Type *); ++i)
  446. {
  447. for (rt_uint8_t j = 0; j < 8; ++j)
  448. {
  449. if ((channel_list[i] >> j) & 1)
  450. {
  451. if (imxrt_drv_qtmr_init(base_list[i], j, DEFAULT_PRE, DEFAULT_FRE, DEFAULT_DUTY) != RT_EOK)
  452. {
  453. return -RT_ERROR;
  454. }
  455. }
  456. }
  457. }
  458. return RT_EOK;
  459. }
  460. int rt_hw_pwm_init(void)
  461. {
  462. rt_err_t ret = RT_EOK;
  463. #ifdef BSP_USING_PWM1
  464. static struct rt_device_pwm pwm1_device;
  465. if (imxrt_pwm1_init(PWM1) != RT_EOK)
  466. {
  467. LOG_E("init pwm1 failed\n");
  468. }
  469. ret = rt_device_pwm_register(&pwm1_device, "pwm1", &imxrt_drv_ops, PWM1);
  470. if (ret != RT_EOK)
  471. {
  472. LOG_E("%s register failed", "pwm1");
  473. }
  474. #endif /* BSP_USING_PWM1 */
  475. #ifdef BSP_USING_PWM2
  476. static struct rt_device_pwm pwm2_device;
  477. if (imxrt_pwm2_init(PWM2) != RT_EOK)
  478. {
  479. LOG_E("init pwm2 failed\n");
  480. }
  481. ret = rt_device_pwm_register(&pwm2_device, "pwm2", &imxrt_drv_ops, PWM2);
  482. if (ret != RT_EOK)
  483. {
  484. LOG_E("%s register failed", "pwm2");
  485. }
  486. #endif /* BSP_USING_PWM2 */
  487. #ifdef BSP_USING_PWM3
  488. static struct rt_device_pwm pwm3_device;
  489. if (imxrt_pwm3_init(PWM3) != RT_EOK)
  490. {
  491. LOG_E("init pwm3 failed\n");
  492. }
  493. ret = rt_device_pwm_register(&pwm3_device, "pwm3", &imxrt_drv_ops, PWM3);
  494. if (ret != RT_EOK)
  495. {
  496. LOG_E("%s register failed", "pwm3");
  497. }
  498. #endif /* BSP_USING_PWM3 */
  499. #ifdef BSP_USING_PWM4
  500. static struct rt_device_pwm pwm4_device;
  501. if (imxrt_pwm4_init(PWM4) != RT_EOK)
  502. {
  503. LOG_E("init pwm4 failed\n");
  504. }
  505. ret = rt_device_pwm_register(&pwm4_device, "pwm4", &imxrt_drv_ops, PWM4);
  506. if (ret != RT_EOK)
  507. {
  508. LOG_E("%s register failed", "pwm4");
  509. }
  510. #endif /* BSP_USING_PWM4 */
  511. #if defined(BSP_USING_QTMR1) || defined(BSP_USING_QTMR2) || defined(BSP_USING_QTMR3) || defined(BSP_USING_QTMR4)
  512. if (imxrt_qtmr_init() != RT_EOK)
  513. {
  514. LOG_E(LOG_TAG" init qtmr failed");
  515. }
  516. #endif
  517. #ifdef BSP_USING_QTMR1
  518. static struct rt_device_pwm qtmr1_device;
  519. ret = rt_device_pwm_register(&qtmr1_device, "pwm5", &imxrt_drv_qtmr_ops, TMR1);
  520. if (ret != RT_EOK)
  521. {
  522. LOG_E("%s register failed", "pwm5");
  523. }
  524. #endif /* BSP_USING_QTMR1 */
  525. #ifdef BSP_USING_QTMR2
  526. static struct rt_device_pwm qtmr2_device;
  527. ret = rt_device_pwm_register(&qtmr2_device, "pwm6", &imxrt_drv_qtmr_ops, TMR2);
  528. if (ret != RT_EOK)
  529. {
  530. LOG_E("%s register failed", "pwm6");
  531. }
  532. #endif /* BSP_USING_QTMR2 */
  533. #ifdef BSP_USING_QTMR3
  534. static struct rt_device_pwm qtmr3_device;
  535. ret = rt_device_pwm_register(&qtmr3_device, "pwm7", &imxrt_drv_qtmr_ops, TMR3);
  536. if (ret != RT_EOK)
  537. {
  538. LOG_E("%s register failed", "pwm7");
  539. }
  540. #endif /* BSP_USING_QTMR3 */
  541. #ifdef BSP_USING_QTMR4
  542. static struct rt_device_pwm qtmr4_device;
  543. ret = rt_device_pwm_register(&qtmr4_device, "pwm8", &imxrt_drv_qtmr_ops, TMR4);
  544. if (ret != RT_EOK)
  545. {
  546. LOG_E("%s register failed", "pwm8");
  547. }
  548. #endif /* BSP_USING_QTMR4 */
  549. return ret;
  550. }
  551. INIT_BOARD_EXPORT(rt_hw_pwm_init);
  552. #endif /* BSP_USING_PWM */