pwm.c 10 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299
  1. #include "bsp/bsp.h"
  2. #include "bsp/pwm.h"
  3. #include "bsp/adc.h"
  4. #include "os/os_task.h"
  5. /*
  6. 以下主要是在某一相电路无法采集的时候,需要对这相的pwm挖坑处理
  7. timer 分配:
  8. timer0 -> ch0-2 互补pwm
  9. ch4 event, update event 触发DMA(ch3,4)实现CCR的自更新
  10. timer1 -> 触发ADC采样,GD32不支持多channel 或方式触发输出,通过timer1的 ch0 compara 配置 TRGO触发ADC,但是需要在一个PWM周期内触发2次(单电阻)
  11. timer0 master --> timer1 slave/master 确保timer0,1同步开始,同频同相位
  12. DMA 分配:
  13. DMA0 ch4 -> timer0 update event
  14. ch3 -> timer0 chan3 CC event
  15. ch1 -> timer1 update event,需要更新CCR
  16. */
  17. static void _init_pwm_timer(bool);
  18. static void _pwm_gpio_config(void);
  19. #ifndef PWM_BRAKE_GROUP
  20. static void _gpio_brakein_irq_enable(void);
  21. #endif
  22. u16 timer_update_buffer[6] = {0};
  23. static rcu_periph_enum _rcu_clk(u32 timer) {
  24. if (timer == TIMER0) {
  25. return RCU_TIMER0;
  26. }
  27. if (timer == TIMER1) {
  28. return RCU_TIMER1;
  29. }
  30. if (timer == TIMER2) {
  31. return RCU_TIMER2;
  32. }
  33. return RCU_TIMER2;
  34. }
  35. void pwm_3phase_init(void){
  36. _pwm_gpio_config();
  37. _init_pwm_timer(true);
  38. }
  39. void pwm_3phase_sides(bool hon, bool lon) {
  40. if (hon && lon) {
  41. return;
  42. }
  43. timer_deinit(pwm_timer);
  44. rcu_periph_clock_enable(_rcu_clk(pwm_timer));
  45. gpio_init(PWM_U_P_GROUP,GPIO_MODE_OUT_PP,GPIO_OSPEED_50MHZ,PWM_U_P_PIN);
  46. gpio_init(PWM_V_P_GROUP,GPIO_MODE_OUT_PP,GPIO_OSPEED_50MHZ,PWM_V_P_PIN);
  47. gpio_init(PWM_W_P_GROUP,GPIO_MODE_OUT_PP,GPIO_OSPEED_50MHZ,PWM_W_P_PIN);
  48. gpio_init(PWM_U_N_GROUP,GPIO_MODE_OUT_PP,GPIO_OSPEED_50MHZ,PWM_U_N_PIN);
  49. gpio_init(PWM_V_N_GROUP,GPIO_MODE_OUT_PP,GPIO_OSPEED_50MHZ,PWM_V_N_PIN);
  50. gpio_init(PWM_W_N_GROUP,GPIO_MODE_OUT_PP,GPIO_OSPEED_50MHZ,PWM_W_N_PIN);
  51. /* 开上桥或者下桥之前先关闭下桥或者上桥 */
  52. if (hon) {
  53. _pwm_gpio_config();
  54. _init_pwm_timer(false);
  55. delay_us(10);
  56. pwm_start();
  57. pwm_update_duty(FOC_PWM_Half_Period-200, FOC_PWM_Half_Period-200, FOC_PWM_Half_Period-200);
  58. }else if (lon) {
  59. gpio_bit_write(PWM_U_P_GROUP, PWM_U_P_PIN, RESET);
  60. gpio_bit_write(PWM_V_P_GROUP, PWM_V_P_PIN, RESET);
  61. gpio_bit_write(PWM_W_P_GROUP, PWM_W_P_PIN, RESET);
  62. delay_us(10);
  63. gpio_bit_write(PWM_U_N_GROUP, PWM_U_N_PIN, SET);
  64. gpio_bit_write(PWM_V_N_GROUP, PWM_V_N_PIN, SET);
  65. gpio_bit_write(PWM_W_N_GROUP, PWM_W_N_PIN, SET);
  66. }else {
  67. #if 0
  68. gpio_bit_write(PWM_U_P_GROUP, PWM_U_P_PIN, RESET);
  69. gpio_bit_write(PWM_V_P_GROUP, PWM_V_P_PIN, RESET);
  70. gpio_bit_write(PWM_W_P_GROUP, PWM_W_P_PIN, RESET);
  71. gpio_bit_write(PWM_U_N_GROUP, PWM_U_N_PIN, RESET);
  72. gpio_bit_write(PWM_V_N_GROUP, PWM_V_N_PIN, RESET);
  73. gpio_bit_write(PWM_W_N_GROUP, PWM_W_N_PIN, RESET);
  74. #else
  75. pwm_3phase_init();
  76. #endif
  77. }
  78. }
  79. static void _pwm_gpio_config(void)
  80. {
  81. rcu_periph_clock_enable(PWM_U_P_RCU);
  82. rcu_periph_clock_enable(PWM_V_P_RCU);
  83. rcu_periph_clock_enable(PWM_W_P_RCU);
  84. rcu_periph_clock_enable(PWM_U_N_RCU);
  85. rcu_periph_clock_enable(PWM_V_N_RCU);
  86. rcu_periph_clock_enable(PWM_W_N_RCU);
  87. rcu_periph_clock_enable(RCU_AF);
  88. /*configure PA8 PA9 PA10(TIMER0 CH0 CH1 CH2) as alternate function*/
  89. gpio_init(PWM_U_P_GROUP,PWM_U_P_MODE,GPIO_OSPEED_50MHZ,PWM_U_P_PIN);
  90. gpio_init(PWM_V_P_GROUP,PWM_V_P_MODE,GPIO_OSPEED_50MHZ,PWM_V_P_PIN);
  91. gpio_init(PWM_W_P_GROUP,PWM_W_P_MODE,GPIO_OSPEED_50MHZ,PWM_W_P_PIN);
  92. /*configure PB13 PB14 PB15(TIMER0 CH0N CH1N CH2N) as alternate function*/
  93. gpio_init(PWM_U_N_GROUP,PWM_U_N_MODE,GPIO_OSPEED_50MHZ,PWM_U_N_PIN);
  94. gpio_init(PWM_V_N_GROUP,PWM_V_N_MODE,GPIO_OSPEED_50MHZ,PWM_V_N_PIN);
  95. gpio_init(PWM_W_N_GROUP,PWM_W_N_MODE,GPIO_OSPEED_50MHZ,PWM_W_N_PIN);
  96. /*configure BRAKE IN*/
  97. #ifdef PWM_BRAKE_GROUP
  98. /* TIMER0 BKIN */
  99. rcu_periph_clock_enable(PWM_BRAKE_RCU);
  100. gpio_init(PWM_BRAKE_GROUP, PWM_BRAKE_MODE, GPIO_OSPEED_50MHZ, PWM_BRAKE_PIN);
  101. #endif
  102. }
  103. static u8 _dead_time(u16 t) {
  104. if (t < 128) {
  105. return (u8 )t;
  106. }else if (t < (64 + 63) * 2) { //11 1111
  107. return (((u8)2<<6 + (t-64)/2));
  108. }else if (t < (32 + 31) * 8) {
  109. return ((u8)3 << 3 + (t - 32)/8);
  110. }else {
  111. if ((t-32)/16 > 63) {
  112. return 0xFF;
  113. }
  114. return ((u8)7<<3 + (t - 32)/16);
  115. }
  116. }
  117. static void _init_pwm_timer(bool enable_brk) {
  118. timer_oc_parameter_struct timer_ocintpara;
  119. timer_parameter_struct timer_initpara;
  120. u32 timer = pwm_timer;
  121. u32 half_period = FOC_PWM_Half_Period;
  122. rcu_periph_clock_enable(_rcu_clk(timer));
  123. timer_deinit(timer);
  124. /* TIMER0 configuration */
  125. memset(&timer_initpara, 0, sizeof(timer_initpara));
  126. memset(&timer_ocintpara, 0, sizeof(timer_ocintpara));
  127. timer_initpara.prescaler = 0;
  128. timer_initpara.alignedmode = TIMER_COUNTER_CENTER_UP;
  129. timer_initpara.counterdirection = TIMER_COUNTER_UP;
  130. timer_initpara.period = half_period;
  131. timer_initpara.clockdivision = TIMER_CKDIV_DIV1;
  132. timer_initpara.repetitioncounter = 1;
  133. timer_init(timer,&timer_initpara);
  134. /* auto-reload preload enable */
  135. timer_auto_reload_shadow_enable(timer);
  136. /* CH1,CH2 and CH3 configuration in PWM mode */
  137. timer_ocintpara.outputstate = TIMER_CCX_ENABLE;
  138. timer_ocintpara.outputnstate = TIMER_CCXN_ENABLE;
  139. timer_ocintpara.ocpolarity = TIMER_OC_POLARITY_HIGH;
  140. timer_ocintpara.ocnpolarity = TIMER_OCN_POLARITY_HIGH;
  141. timer_ocintpara.ocidlestate = TIMER_OC_IDLE_STATE_LOW;
  142. timer_ocintpara.ocnidlestate = TIMER_OCN_IDLE_STATE_LOW;
  143. timer_channel_output_config(timer,TIMER_CH_0,&timer_ocintpara);
  144. timer_channel_output_pulse_value_config(timer,TIMER_CH_0,half_period/2);
  145. timer_channel_output_mode_config(timer,TIMER_CH_0,PWM_MODE);
  146. timer_channel_output_shadow_config(timer,TIMER_CH_0,TIMER_OC_SHADOW_ENABLE);
  147. timer_channel_output_config(timer,TIMER_CH_1,&timer_ocintpara);
  148. timer_channel_output_pulse_value_config(timer,TIMER_CH_1,half_period/2);
  149. timer_channel_output_mode_config(timer,TIMER_CH_1,PWM_MODE);
  150. timer_channel_output_shadow_config(timer,TIMER_CH_1,TIMER_OC_SHADOW_ENABLE);
  151. timer_channel_output_config(timer,TIMER_CH_2,&timer_ocintpara);
  152. timer_channel_output_pulse_value_config(timer,TIMER_CH_2,half_period/2);
  153. timer_channel_output_mode_config(timer,TIMER_CH_2,PWM_MODE);
  154. timer_channel_output_shadow_config(timer,TIMER_CH_2,TIMER_OC_SHADOW_ENABLE);
  155. timer_ocintpara.outputstate = TIMER_CCX_ENABLE;
  156. timer_ocintpara.outputnstate = TIMER_CCXN_DISABLE;
  157. timer_ocintpara.ocpolarity = TIMER_OC_POLARITY_HIGH;
  158. timer_ocintpara.ocnpolarity = TIMER_OCN_POLARITY_HIGH;
  159. timer_ocintpara.ocidlestate = TIMER_OC_IDLE_STATE_LOW;
  160. timer_ocintpara.ocnidlestate = TIMER_OCN_IDLE_STATE_LOW;
  161. /* chan3 trigger adc O3CPRE is alwary active high, adc trigger is rising */
  162. timer_channel_output_config(timer,TIMER_CH_3,&timer_ocintpara);
  163. timer_channel_output_pulse_value_config(timer,TIMER_CH_3,half_period-5);
  164. timer_channel_output_mode_config(timer,TIMER_CH_3,TIMER_OC_MODE_PWM1);
  165. timer_channel_output_shadow_config(timer,TIMER_CH_3,TIMER_OC_SHADOW_ENABLE);
  166. #ifdef PWM_BRAKE_GROUP
  167. timer_break_parameter_struct timer_breakpara;
  168. timer_breakpara.runoffstate = TIMER_ROS_STATE_DISABLE;
  169. timer_breakpara.ideloffstate = TIMER_ROS_STATE_DISABLE;
  170. timer_breakpara.protectmode = TIMER_CCHP_PROT_OFF;
  171. timer_breakpara.deadtime = _dead_time(NS_2_TCLK(PWM_DEAD_TIME_NS));
  172. timer_breakpara.breakstate = enable_brk?TIMER_BREAK_ENABLE:TIMER_BREAK_DISABLE;
  173. timer_breakpara.breakpolarity = TIMER_BREAK_POLARITY_LOW;
  174. timer_breakpara.outputautostate = TIMER_OUTAUTO_DISABLE;
  175. timer_break_config(timer,&timer_breakpara);
  176. timer_interrupt_enable(timer, TIMER_INT_BRK);
  177. timer_interrupt_flag_clear(timer, TIMER_INT_FLAG_BRK);
  178. nvic_irq_enable(TIMER0_BRK_IRQn, EBREAK_IRQ_PRIORITY, 0);
  179. #else
  180. _gpio_brakein_irq_enable();
  181. #endif
  182. timer_master_slave_mode_config(timer,TIMER_MASTER_SLAVE_MODE_DISABLE);
  183. pwm_enable_channel();
  184. timer_interrupt_disable(timer, TIMER_INT_UP);
  185. timer_interrupt_flag_clear(timer, TIMER_INT_FLAG_UP);
  186. nvic_irq_enable(TIMER0_UP_IRQn, TIMER_UP_IRQ_PRIORITY, 0);
  187. timer_enable(timer);
  188. #ifdef GD32_FOC_DEMO
  189. /* IR2136S enable */
  190. gpio_ir2136_enable(true);
  191. #endif
  192. }
  193. #ifndef PWM_BRAKE_GROUP
  194. static void _gpio_brakein_irq_enable(void){
  195. #ifndef GD32_FOC_DEMO
  196. gpio_exti_source_select(GPIO_PORT_SOURCE_GPIOB, GPIO_PIN_SOURCE_4);
  197. exti_init(EXTI_4, EXTI_INTERRUPT, EXTI_TRIG_BOTH);
  198. nvic_irq_enable(EXTI4_IRQn, EBREAK_IRQ_PRIORITY, 0U);
  199. exti_interrupt_flag_clear(EXTI_4);
  200. exti_interrupt_enable(EXTI_4);
  201. gpio_exti_source_select(GPIO_PORT_SOURCE_GPIOB, GPIO_PIN_SOURCE_5);
  202. exti_init(EXTI_5, EXTI_INTERRUPT, EXTI_TRIG_BOTH);
  203. nvic_irq_enable(EXTI5_9_IRQn, EBREAK_IRQ_PRIORITY, 0U);
  204. exti_interrupt_flag_clear(EXTI_5);
  205. exti_interrupt_enable(EXTI_5);
  206. #endif
  207. }
  208. #endif
  209. void pwm_start(void){
  210. pwm_update_duty(FOC_PWM_Half_Period/2, FOC_PWM_Half_Period/2, FOC_PWM_Half_Period/2);
  211. pwm_update_2smaples(FOC_PWM_Half_Period-1, FOC_PWM_Half_Period + 1);
  212. /* wait for a new PWM period to flush last HF task */
  213. timer_flag_clear(pwm_timer, TIMER_FLAG_UP);
  214. timer_event_software_generate(pwm_timer, TIMER_EVENT_SRC_UPG);
  215. while ( timer_flag_get(pwm_timer, TIMER_FLAG_UP) == RESET ){}
  216. /* Clear Update Flag */
  217. timer_flag_clear(pwm_timer, TIMER_FLAG_UP);
  218. timer_primary_output_config(pwm_timer,ENABLE);
  219. }
  220. void pwm_stop(void){
  221. timer_primary_output_config(pwm_timer,DISABLE);
  222. timer_interrupt_disable(pwm_timer, TIMER_INT_UP);
  223. /* wait for a new PWM period to flush last HF task */
  224. timer_flag_clear(pwm_timer, TIMER_FLAG_UP);
  225. while ( timer_flag_get(pwm_timer, TIMER_FLAG_UP) == RESET ){}
  226. /* Clear Update Flag */
  227. timer_flag_clear(pwm_timer, TIMER_FLAG_UP);
  228. }
  229. void pwm_enable_output(bool enable) {
  230. if (enable) {
  231. timer_primary_output_config(pwm_timer,ENABLE);
  232. }else {
  233. timer_primary_output_config(pwm_timer,DISABLE);
  234. }
  235. }
  236. /*open low side of the mosfet*/
  237. void pwm_turn_on_low_side(void)
  238. {
  239. pwm_update_duty(0, 0, 0);
  240. pwm_update_2smaples(FOC_PWM_Half_Period-1, FOC_PWM_Half_Period + 1);
  241. timer_flag_clear(pwm_timer,TIMER_FLAG_UP);
  242. timer_event_software_generate(pwm_timer, TIMER_EVENT_SRC_UPG);
  243. while (timer_flag_get(pwm_timer,TIMER_FLAG_UP) == RESET );
  244. /* Main PWM Output Enable */
  245. timer_primary_output_config(pwm_timer, ENABLE);
  246. }
  247. void pwm_update_sample(u32 samp1, u32 samp2, u8 sector) {
  248. if (samp1 < FOC_PWM_Half_Period) {
  249. TIMER_CH3CV(pwm_timer) = samp1;
  250. pwm_change_t3_mode(TIMER_OC_MODE_PWM1);
  251. }else {
  252. TIMER_CH3CV(pwm_timer) = samp2;
  253. pwm_change_t3_mode(TIMER_OC_MODE_PWM0);
  254. }
  255. adc_current_sample_config(sector);
  256. }