pwm.c 9.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257
  1. #include "bsp/bsp.h"
  2. #include "bsp/bsp_driver.h"
  3. #include "os/os_task.h"
  4. #include "libs/logger.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. static void pwm_gpio_init(gpio_type *gpiox, gpio_mode_type mode, gpio_output_type otype, gpio_pull_type pull, u32 pin) {
  23. gpio_init_type gpio_init_struct = {0};
  24. gpio_default_para_init(&gpio_init_struct);
  25. gpio_init_struct.gpio_mode = mode;
  26. gpio_init_struct.gpio_out_type = otype;
  27. gpio_init_struct.gpio_pull = pull;
  28. gpio_init_struct.gpio_drive_strength = GPIO_DRIVE_STRENGTH_STRONGER;
  29. /* High-side, Phase A,B,C Config */
  30. gpio_init_struct.gpio_pins = pin;
  31. gpio_init(gpiox, &gpio_init_struct);
  32. }
  33. void pwm_3phase_init(void){
  34. _pwm_gpio_config();
  35. _init_pwm_timer(false);
  36. }
  37. void pwm_3phase_sides(bool hon, bool lon) {
  38. if (hon && lon) {
  39. return;
  40. }
  41. tmr_reset(MOS_PWM_TIMER);
  42. crm_periph_clock_enable(PWM_CRM_CLK, TRUE);
  43. pwm_gpio_init(PWM_U_P_GROUP,GPIO_MODE_OUTPUT,GPIO_OUTPUT_PUSH_PULL,GPIO_PULL_NONE, PWM_U_P_PIN);
  44. pwm_gpio_init(PWM_V_P_GROUP,GPIO_MODE_OUTPUT,GPIO_OUTPUT_PUSH_PULL,GPIO_PULL_NONE,PWM_V_P_PIN);
  45. pwm_gpio_init(PWM_W_P_GROUP,GPIO_MODE_OUTPUT,GPIO_OUTPUT_PUSH_PULL,GPIO_PULL_NONE,PWM_W_P_PIN);
  46. pwm_gpio_init(PWM_U_N_GROUP,GPIO_MODE_OUTPUT,GPIO_OUTPUT_PUSH_PULL,GPIO_PULL_NONE,PWM_U_N_PIN);
  47. pwm_gpio_init(PWM_V_N_GROUP,GPIO_MODE_OUTPUT,GPIO_OUTPUT_PUSH_PULL,GPIO_PULL_NONE,PWM_V_N_PIN);
  48. pwm_gpio_init(PWM_W_N_GROUP,GPIO_MODE_OUTPUT,GPIO_OUTPUT_PUSH_PULL,GPIO_PULL_NONE,PWM_W_N_PIN);
  49. sys_debug("pwm_3phase_sides\n");
  50. /* 开上桥或者下桥之前先关闭下桥或者上桥 */
  51. if (hon) {
  52. _pwm_gpio_config();
  53. _init_pwm_timer(false);
  54. delay_us(10);
  55. pwm_start();
  56. pwm_update_duty(FOC_PWM_Half_Period-200, FOC_PWM_Half_Period-200, FOC_PWM_Half_Period-200);
  57. }else if (lon) {
  58. gpio_bits_write(PWM_U_P_GROUP, PWM_U_P_PIN, FALSE);
  59. gpio_bits_write(PWM_V_P_GROUP, PWM_V_P_PIN, FALSE);
  60. gpio_bits_write(PWM_W_P_GROUP, PWM_W_P_PIN, FALSE);
  61. delay_us(10);
  62. gpio_bits_write(PWM_U_N_GROUP, PWM_U_N_PIN, TRUE);
  63. gpio_bits_write(PWM_V_N_GROUP, PWM_V_N_PIN, TRUE);
  64. gpio_bits_write(PWM_W_N_GROUP, PWM_W_N_PIN, TRUE);
  65. }else {
  66. #if 0
  67. gpio_bit_write(PWM_U_P_GROUP, PWM_U_P_PIN, RESET);
  68. gpio_bit_write(PWM_V_P_GROUP, PWM_V_P_PIN, RESET);
  69. gpio_bit_write(PWM_W_P_GROUP, PWM_W_P_PIN, RESET);
  70. gpio_bit_write(PWM_U_N_GROUP, PWM_U_N_PIN, RESET);
  71. gpio_bit_write(PWM_V_N_GROUP, PWM_V_N_PIN, RESET);
  72. gpio_bit_write(PWM_W_N_GROUP, PWM_W_N_PIN, RESET);
  73. #else
  74. pwm_3phase_init();
  75. #endif
  76. }
  77. }
  78. static void _pwm_gpio_config(void)
  79. {
  80. crm_periph_clock_enable(PWM_U_P_RCU, TRUE);
  81. crm_periph_clock_enable(PWM_V_P_RCU, TRUE);
  82. crm_periph_clock_enable(PWM_W_P_RCU, TRUE);
  83. crm_periph_clock_enable(PWM_U_N_RCU, TRUE);
  84. crm_periph_clock_enable(PWM_V_N_RCU, TRUE);
  85. crm_periph_clock_enable(PWM_W_N_RCU, TRUE);
  86. /*configure PA8 PA9 PA10(TIMER0 CH0 CH1 CH2) as alternate function*/
  87. pwm_gpio_init(PWM_U_P_GROUP,PWM_U_P_MODE,GPIO_OUTPUT_PUSH_PULL,GPIO_PULL_DOWN,PWM_U_P_PIN);
  88. pwm_gpio_init(PWM_V_P_GROUP,PWM_V_P_MODE,GPIO_OUTPUT_PUSH_PULL,GPIO_PULL_DOWN,PWM_V_P_PIN);
  89. pwm_gpio_init(PWM_W_P_GROUP,PWM_W_P_MODE,GPIO_OUTPUT_PUSH_PULL,GPIO_PULL_DOWN,PWM_W_P_PIN);
  90. /*configure PB13 PB14 PB15(TIMER0 CH0N CH1N CH2N) as alternate function*/
  91. pwm_gpio_init(PWM_U_N_GROUP,PWM_U_N_MODE,GPIO_OUTPUT_PUSH_PULL,GPIO_PULL_UP,PWM_U_N_PIN);
  92. pwm_gpio_init(PWM_V_N_GROUP,PWM_V_N_MODE,GPIO_OUTPUT_PUSH_PULL,GPIO_PULL_UP,PWM_V_N_PIN);
  93. pwm_gpio_init(PWM_W_N_GROUP,PWM_W_N_MODE,GPIO_OUTPUT_PUSH_PULL,GPIO_PULL_UP,PWM_W_N_PIN);
  94. /*configure BRAKE IN*/
  95. #ifdef PWM_BRAKE_GROUP
  96. /* TIMER0 BKIN */
  97. crm_periph_clock_enable(PWM_BRAKE_RCU, TRUE);
  98. pwm_gpio_init(PWM_BRAKE_GROUP, PWM_BRAKE_MODE, GPIO_OUTPUT_PUSH_PULL,GPIO_PULL_NONE, PWM_BRAKE_PIN);
  99. #endif
  100. }
  101. static u8 _dead_time(u16 t) {
  102. if (t < 128) {
  103. return (u8 )t;
  104. }else if (t <= (64 + 63) * 2) { //11 1111
  105. return ((((u8)2<<6) + (t-64)/2));
  106. }else if (t <= (32 + 31) * 8) {
  107. return (((u8)3 << 6) + (t - 32)/8);
  108. }else {
  109. if ((t-32)/16 > 63) {
  110. return 0xFF;
  111. }
  112. return (((u8)7<<3) + (t - 32)/16);
  113. }
  114. }
  115. static void _init_pwm_timer(bool enable_brk) {
  116. tmr_output_config_type tmr_output_struct;
  117. tmr_brkdt_config_type tmr_brkdt_config_struct;
  118. tmr_reset(MOS_PWM_TIMER);
  119. crm_periph_clock_enable(PWM_CRM_CLK, TRUE);
  120. tmr_repetition_counter_set(MOS_PWM_TIMER, 1); /* the pwm cycle isr in underflow (high-side pwm on) */
  121. tmr_base_init(MOS_PWM_TIMER, FOC_PWM_Half_Period, 0);
  122. tmr_cnt_dir_set(MOS_PWM_TIMER, TMR_COUNT_TWO_WAY_1); /* output compare interrupt flags are set only count-down */
  123. /* set dead time clock */
  124. tmr_clock_source_div_set(MOS_PWM_TIMER, TMR_CLOCK_DIV1);
  125. /* channel 1,2,3,1C,2C,3C configuration in output mode */
  126. tmr_channel_value_set(MOS_PWM_TIMER, TMR_SELECT_CHANNEL_1, FOC_PWM_Half_Period/2);
  127. tmr_channel_value_set(MOS_PWM_TIMER, TMR_SELECT_CHANNEL_2, FOC_PWM_Half_Period/2);
  128. tmr_channel_value_set(MOS_PWM_TIMER, TMR_SELECT_CHANNEL_3, FOC_PWM_Half_Period/2);
  129. tmr_output_default_para_init(&tmr_output_struct);
  130. tmr_output_struct.oc_mode = TMR_OUTPUT_CONTROL_PWM_MODE_A;
  131. tmr_output_struct.oc_output_state = TRUE;
  132. tmr_output_struct.oc_polarity = TMR_OUTPUT_ACTIVE_HIGH;
  133. tmr_output_struct.oc_idle_state = FALSE;
  134. tmr_output_struct.occ_output_state = TRUE;
  135. tmr_output_struct.occ_polarity = TMR_OUTPUT_ACTIVE_HIGH;
  136. tmr_output_struct.occ_idle_state = FALSE;
  137. /* channel 1, 2, 3 */
  138. tmr_output_channel_config(MOS_PWM_TIMER, TMR_SELECT_CHANNEL_1, &tmr_output_struct);
  139. tmr_output_channel_config(MOS_PWM_TIMER, TMR_SELECT_CHANNEL_2, &tmr_output_struct);
  140. tmr_output_channel_config(MOS_PWM_TIMER, TMR_SELECT_CHANNEL_3, &tmr_output_struct);
  141. tmr_output_channel_buffer_enable(MOS_PWM_TIMER, TMR_SELECT_CHANNEL_1, TRUE);
  142. tmr_output_channel_buffer_enable(MOS_PWM_TIMER, TMR_SELECT_CHANNEL_2, TRUE);
  143. tmr_output_channel_buffer_enable(MOS_PWM_TIMER, TMR_SELECT_CHANNEL_3, TRUE);
  144. tmr_output_struct.oc_mode = TMR_OUTPUT_CONTROL_PWM_MODE_B;
  145. tmr_output_channel_config(MOS_PWM_TIMER, TMR_SELECT_CHANNEL_4, &tmr_output_struct);
  146. tmr_channel_value_set(MOS_PWM_TIMER, TMR_SELECT_CHANNEL_4, FOC_PWM_Half_Period-1);
  147. tmr_output_channel_buffer_enable(MOS_PWM_TIMER, TMR_SELECT_CHANNEL_4, TRUE);
  148. #ifdef PWM_BRAKE_GROUP
  149. /* automatic output enable, break, dead time and lock configuration */
  150. tmr_brkdt_default_para_init(&tmr_brkdt_config_struct);
  151. tmr_brkdt_config_struct.brk_enable = enable_brk?TRUE:FALSE;
  152. tmr_brkdt_config_struct.auto_output_enable = FALSE;
  153. tmr_brkdt_config_struct.deadtime = _dead_time(NS_2_TCLK(PWM_DEAD_TIME_NS));
  154. tmr_brkdt_config_struct.fcsodis_state = TRUE;
  155. tmr_brkdt_config_struct.fcsoen_state = FALSE;
  156. tmr_brkdt_config_struct.brk_polarity = TMR_BRK_INPUT_ACTIVE_LOW;
  157. tmr_brkdt_config_struct.wp_level = TMR_WP_OFF;
  158. tmr_brkdt_config(MOS_PWM_TIMER, &tmr_brkdt_config_struct);
  159. #endif
  160. tmr_primary_mode_select(MOS_PWM_TIMER, TMR_PRIMARY_SEL_OVERFLOW);
  161. tmr_flag_clear(MOS_PWM_TIMER, TMR_OVF_FLAG | TMR_BRK_FLAG | TMR_C4_INT);
  162. tmr_interrupt_enable(MOS_PWM_TIMER, TMR_OVF_INT, TRUE);
  163. tmr_interrupt_enable(MOS_PWM_TIMER, TMR_BRK_INT, TRUE);
  164. /* disable single pulse mode */
  165. tmr_one_cycle_mode_enable(MOS_PWM_TIMER, FALSE);
  166. /* pwm timer output enable */
  167. tmr_output_enable(MOS_PWM_TIMER, FALSE);
  168. nvic_irq_enable(TMR1_BRK_TMR9_IRQn, EBREAK_IRQ_PRIORITY, 0);
  169. nvic_irq_enable(TMR1_OVF_TMR10_IRQn, TIMER_UP_IRQ_PRIORITY, 0);
  170. /* enable pwm timer */
  171. tmr_counter_enable(MOS_PWM_TIMER, TRUE);
  172. }
  173. void pwm_start(void){
  174. pwm_update_duty(FOC_PWM_Half_Period/2, FOC_PWM_Half_Period/2, FOC_PWM_Half_Period/2);
  175. pwm_update_2smaples(FOC_PWM_Half_Period-1, FOC_PWM_Half_Period + 1);
  176. /* wait for a new PWM period to flush last HF task */
  177. tmr_flag_clear(MOS_PWM_TIMER, TMR_OVF_FLAG);
  178. tmr_event_sw_trigger(MOS_PWM_TIMER, TMR_OVERFLOW_SWTRIG);
  179. while ( tmr_flag_get(MOS_PWM_TIMER, TMR_OVF_FLAG) == RESET ){}
  180. /* Clear Update Flag */
  181. tmr_flag_clear(MOS_PWM_TIMER, TMR_OVF_FLAG);
  182. tmr_output_enable(MOS_PWM_TIMER, TRUE);
  183. }
  184. void pwm_stop(void){
  185. tmr_output_enable(MOS_PWM_TIMER, FALSE);
  186. tmr_interrupt_enable(MOS_PWM_TIMER, TMR_OVF_INT, FALSE);
  187. /* wait for a new PWM period to flush last HF task */
  188. tmr_flag_clear(MOS_PWM_TIMER, TMR_OVF_FLAG);
  189. while ( tmr_flag_get(MOS_PWM_TIMER, TMR_OVF_FLAG) == RESET ){}
  190. /* Clear Update Flag */
  191. tmr_flag_clear(MOS_PWM_TIMER, TMR_OVF_FLAG);
  192. }
  193. void pwm_enable_output(bool enable) {
  194. if (enable) {
  195. tmr_output_enable(MOS_PWM_TIMER,TRUE);
  196. }else {
  197. tmr_output_enable(MOS_PWM_TIMER,FALSE);
  198. }
  199. }
  200. /*open low side of the mosfet*/
  201. void pwm_turn_on_low_side(void)
  202. {
  203. pwm_update_duty(0, 0, 0);
  204. pwm_update_2smaples(FOC_PWM_Half_Period-1, FOC_PWM_Half_Period + 1);
  205. tmr_flag_clear(MOS_PWM_TIMER, TMR_OVF_FLAG);
  206. tmr_event_sw_trigger(MOS_PWM_TIMER, TMR_OVERFLOW_SWTRIG);
  207. while ( tmr_flag_get(MOS_PWM_TIMER, TMR_OVF_FLAG) == RESET ){}
  208. /* Main PWM Output Enable */
  209. tmr_output_enable(MOS_PWM_TIMER,TRUE);
  210. }
  211. void pwm_update_sample(u32 samp1, u32 samp2, u8 sector) {
  212. if (samp1 < FOC_PWM_Half_Period) {
  213. update_adc_trigger(samp1);
  214. pwm_change_t3_mode(TMR_OUTPUT_CONTROL_PWM_MODE_B);
  215. }else {
  216. update_adc_trigger(samp2);
  217. pwm_change_t3_mode(TMR_OUTPUT_CONTROL_PWM_MODE_A);
  218. }
  219. adc_current_sample_config(sector);
  220. }