无刷直流电机不转

2019-03-23 18:32发布

站内问答 / STM32/STM8
2680 0 997
  1. /* MAIN.C file
  2. *
  3. * Copyright (c) 2002-2005 STMicroelectronics
  4. */


  7. /* MAIN.C file
  8. 摘要：
  9. 1.PD7延时反转，指示系统工作。
  10. 2.上电，按指定PWM输出换相，实现电机基本运转功能。
  11. 3.换相依据为HALl信号，采用PORTD中断功能完成.
  12. 总之，上电根据HALL状态换相，并在输出PWM信号后，电机会转动，
  13. 同时HALL信号不断改变，然后进入捕获中断，进行及时换相。
  14. 如此实现电机的运转控制。
  15. 2013.5.8
  16. */
  17. #include "stm8s.h"

  19. #define STM8_FREQ_MHZ 16
  20. #define PWM_FREQUENCY 16000

  22. static const u16 hArrPwmVal = ((u16)((STM8_FREQ_MHZ * (u32)1000000)/PWM_FREQUENCY));
  23. //PWM信号周期

  25. #define PWMOUT 20
  26. //按15%占空比输出

  28. const unsigned char PWM_EN1_TAB[6]={0x00,0x00,0x10,0x10,0x01,0x01};
  29. //六步法中，CH1CH2通道极性及使能配置
  30. const unsigned char PWM_EN2_TAB[6]={0x01,0x01,0x00,0x00,0x0,0x00};
  31. //六步法中，CH3通道极性及使能配置

  33. //上桥臂开关控制端口定义
  34. #define MCO1_PORT GPIOC
  35. #define MCO1_PIN        GPIO_PIN_1
  36. #define MCO3_PORT GPIOC
  37. #define MCO3_PIN        GPIO_PIN_2
  38. #define MCO5_PORT GPIOC
  39. #define MCO5_PIN        GPIO_PIN_3

  41. //下桥臂开关控制端口定义
  42. #define MCO0_PORT GPIOB
  43. #define MCO0_PIN        GPIO_PIN_0
  44. #define MCO2_PORT GPIOB
  45. #define MCO2_PIN        GPIO_PIN_1
  46. #define MCO4_PORT GPIOB
  47. #define MCO4_PIN        GPIO_PIN_2
  48. //下桥臂低电平开关管导通
  49. #define PWM_A_OFF MCO0_PORT->ODR |= (u8)MCO0_PIN;
  50. #define PWM_B_OFF MCO2_PORT->ODR |= (u8)MCO2_PIN;
  51. #define PWM_C_OFF MCO4_PORT->ODR |= (u8)MCO4_PIN;

  53. #define PWM_A_ON MCO0_PORT->ODR &= (u8)(~MCO0_PIN);
  54. #define PWM_B_ON MCO2_PORT->ODR &= (u8)(~MCO2_PIN);
  55. #define PWM_C_ON MCO4_PORT->ODR &= (u8)(~MCO4_PIN);

  57. //霍尔引脚定义
  58. #define H1_PORT GPIOD->IDR
  59. #define H1_PIN  BIT2

  61. #define H2_PORT GPIOD->IDR
  62. #define H2_PIN  BIT3

  64. #define H3_PORT GPIOD->IDR
  65. #define H3_PIN  BIT4

  67. unsigned char bHallSteps[2][8]={
  68. {7,5,3,4,1,0,2,7},//正转
  69. {7,2,0,1,4,3,5,7}//反转
  70. };

  72. /* Private vars and define */
  73. #define BIT0 0x01
  74. #define BIT1 0x02
  75. #define BIT2 0x04
  76. #define BIT3 0x08
  77. #define BIT4 0x10
  78. #define BIT5 0x20
  79. #define BIT6 0x40
  80. #define BIT7 0x80

  82. //换相子函数声明
  83. void Commutation(unsigned char bHallStartStep,unsigned int OutPwmValue);

  85. unsigned int outpwm=0;
  86.        

  88. //初始化按键，指示灯端口
  89. void GPIO_int(void)
  90. {
  91.          /* LEDs */
  92.         GPIO_Init(GPIOD, GPIO_PIN_7, GPIO_MODE_OUT_PP_HIGH_FAST);
  93. }

  95. //系统时钟配置：内部16M
  96. void Clock_init(void)
  97. {
  98.         /* Select fCPU = 16MHz */
  99.   CLK_SYSCLKConfig(CLK_PRESCALER_HSIDIV1);
  100. }

  102. //换相电路开关管IO初始化
  103. void PWM_IO_init(void)
  104. {       
  105.   //PB012 下桥臂0有效 ,配置为高电平
  106.         GPIO_Init(MCO0_PORT, MCO0_PIN,GPIO_MODE_OUT_PP_HIGH_FAST);
  107.         GPIO_Init(MCO2_PORT, MCO2_PIN,GPIO_MODE_OUT_PP_HIGH_FAST);
  108.         GPIO_Init(MCO4_PORT, MCO4_PIN,GPIO_MODE_OUT_PP_HIGH_FAST);
  109.        
  110.         //PC123 上桥臂1有效,配置为低电平
  111.         GPIO_Init(MCO1_PORT, MCO1_PIN,GPIO_MODE_OUT_PP_LOW_FAST);
  112.         GPIO_Init(MCO3_PORT, MCO3_PIN,GPIO_MODE_OUT_PP_LOW_FAST);
  113.         GPIO_Init(MCO5_PORT, MCO5_PIN,GPIO_MODE_OUT_PP_LOW_FAST);       
  114. }

  116. void Tim1_init(void)
  117. {
  118.          /* TIM1 Peripheral Configuration */
  119.   TIM1_DeInit();

  121.   TIM1_TimeBaseInit(0, TIM1_COUNTERMODE_UP, hArrPwmVal, 0);

  123.   TIM1_OC1Init(TIM1_OCMODE_PWM1, TIM1_OUTPUTSTATE_ENABLE, TIM1_OUTPUTNSTATE_DISABLE, hArrPwmVal*0, TIM1_OCPOLARITY_HIGH, TIM1_OCNPOLARITY_LOW, TIM1_OCIDLESTATE_RESET, TIM1_OCNIDLESTATE_SET);

  125.   TIM1_OC2Init(TIM1_OCMODE_PWM1, TIM1_OUTPUTSTATE_ENABLE, TIM1_OUTPUTNSTATE_DISABLE, hArrPwmVal*0, TIM1_OCPOLARITY_HIGH, TIM1_OCNPOLARITY_LOW, TIM1_OCIDLESTATE_RESET, TIM1_OCNIDLESTATE_SET);

  127.   TIM1_OC3Init(TIM1_OCMODE_PWM1, TIM1_OUTPUTSTATE_ENABLE, TIM1_OUTPUTNSTATE_DISABLE, hArrPwmVal*0, TIM1_OCPOLARITY_HIGH, TIM1_OCNPOLARITY_LOW, TIM1_OCIDLESTATE_RESET, TIM1_OCNIDLESTATE_SET);

  129.   TIM1_CCPreloadControl(DISABLE);
  130.         TIM1_Cmd(ENABLE);
  131. }

  133. //初始化HALL捕获输入定义器，采用PD口外部中断捕获输入
  134. void HALLEXTI_INIT(void)
  135. {
  136.         GPIO_Init(GPIOD, GPIO_PIN_2|GPIO_PIN_3|GPIO_PIN_4,GPIO_MODE_IN_PU_IT);        //HALL端口模式配置
  137. }

  139. //根据HALL状态换相，启动电机运行
  140. void HALL_START(void)
  141. {
  142.         u8 bHStatus = 0,bHallStartStep;
  143.                        
  144.                 // Read status of H1
  145.         if (H1_PORT & H1_PIN)
  146.         {
  147.                 bHStatus |= BIT2;
  148.         }
  149.        
  150.         // Read status of H2
  151.         if (H2_PORT & H2_PIN)
  152.         {
  153.                 bHStatus |= BIT1;
  154.         }
  155.                
  156.                 // Read status of H3
  157.         if (H3_PORT & H3_PIN)
  158.         {                       
  159.                         bHStatus |= BIT0;
  160.         }
  161.        
  162.         bHallStartStep = bHallSteps[1][bHStatus];//得到换相步序

  164.         if (bHallStartStep == 7)//不该出现的HALL状态
  165.         {                       
  166.                         return;
  167.         }
  168.                
  169.                
  170.                 GPIOD->CR2|=BIT3|BIT2|BIT4;
  171.                 EXTI->CR1|=BIT6|BIT7;
  172.                 Commutation(bHallStartStep,outpwm);//输出PWM信号，启动电机
  173. }

  175. @far @interrupt void EXTI_PORTD_IRQHandler(void)
  176. {
  177.         /* in order to detect unexpected events during development,
  178.            it is recommended to set a breakpoint on the following instruction
  179.         */
  180.         u8 bHStatus =0,i,bHallStartStep;
  181.                
  182.         bHStatus=(GPIO_ReadInputData(GPIOD)>>2)&0x07;
  183.         for(i=0;i<50;i++);//滤波时间
  184.         i=(GPIO_ReadInputData(GPIOD)>>2)&0x07;
  185.         if(bHStatus!=i)return;
  186.        
  187.         bHStatus=0;       
  188.                 // Read status of H1
  189.         if (H1_PORT & H1_PIN)
  190.         {
  191.                 bHStatus |= BIT2;
  192.         }
  193.        
  194.         // Read status of H2
  195.         if (H2_PORT & H2_PIN)
  196.         {
  197.                 bHStatus |= BIT1;
  198.         }
  199.                        
  200.         // Read status of H3
  201.         if (H3_PORT & H3_PIN)
  202.         {
  203.                         bHStatus |= BIT0;
  204.         }

  206.                 bHallStartStep = bHallSteps[1][bHStatus];//得到换相步序

  208.                 if (bHallStartStep == 7)
  209.                 { //故障，停止输出
  210.                         TIM1->BKR &= (uint8_t)(~TIM1_BKR_MOE);//禁止PWM输出
  211.                         PWM_A_OFF;
  212.                         PWM_B_OFF;
  213.                         PWM_C_OFF;
  214.                         return;
  215.                 }
  216.                
  217.                
  218.                 EXTI->CR1|=BIT6|BIT7;
  219.                 Commutation(bHallStartStep,outpwm);//输出PWM信号，启动电机
  220.         return;
  221. }

  223. void ChongD(void)
  224. {       
  225.   unsigned int tem_c=0;
  226.         PWM_A_ON;PWM_B_ON;PWM_C_ON;
  227.         for(tem_c=0;tem_c<50000;tem_c++);
  228.         PWM_A_OFF;PWM_B_OFF;PWM_C_OFF;
  229. }

  231. main()
  232. {
  233.   unsigned int tem_c=0;
  234.         unsigned char step=0;
  235.        
  236.         for(tem_c=0;tem_c<50000;tem_c++);//上电延时，等待系统稳定

  238.         Clock_init();//指示灯端口初始化
  239.         GPIO_int();//时钟配置
  240.        
  241.         PWM_IO_init();//开关管控制端口初始化
  242.         Tim1_init();//高级定时器配置       
  243.         HALLEXTI_INIT();//HALL端口初始化配置
  244.         ChongD();
  245.         outpwm=hArrPwmVal*PWMOUT/100;//固定占空比的PWM值
  246.         HALL_START();//根据HALL状态输出PWM状态，启动电机运行
  247.         enableInterrupts();
  248.        
  249.         while (1);
  250.         {
  251.                 for(tem_c=0;tem_c<50000;tem_c++);//延时时间
  252.                 GPIO_WriteReverse(GPIOD,GPIO_PIN_7);//PD7指示灯反转
  253.         }
  254. }

  256. //换向输出PWM值，
  257. //bHallStartStep:当前换相步序0-5，OutPwmValue 输出PWM值
  258. void Commutation(unsigned char bHallStartStep,unsigned int OutPwmValue)
  259. {       
  260.    TIM1->BKR &= (uint8_t)(~TIM1_BKR_MOE);//禁止PWM输出
  261.         if(bHallStartStep!=3&&bHallStartStep!=4)
  262.         PWM_A_OFF;
  263.         if(bHallStartStep!=0&&bHallStartStep!=5)
  264.         PWM_B_OFF;
  265.         if(bHallStartStep!=1&&bHallStartStep!=2)
  266.         PWM_C_OFF;
  267.          
  268.         //根据换相步序，打开不同的开关管，并施加正确的PWM信号
  269.         if(bHallStartStep==0)//AB
  270.         {
  271.                 TIM1->CCR3H = (uint8_t)(OutPwmValue >> 8);
  272.     TIM1->CCR3L = (uint8_t)(OutPwmValue);
  273.                 PWM_B_ON;
  274.         }
  275.   else if(bHallStartStep==1)        //AC
  276.         {
  277.                 TIM1->CCR3H = (uint8_t)(OutPwmValue >> 8);
  278.     TIM1->CCR3L = (uint8_t)(OutPwmValue);
  279.           PWM_C_ON;
  280.         }
  281.         else if(bHallStartStep==2)        //BC
  282.         {
  283.                 TIM1->CCR2H = (uint8_t)(OutPwmValue >> 8);
  284.     TIM1->CCR2L = (uint8_t)(OutPwmValue);
  285.           PWM_C_ON;
  286.         }
  287.         else if(bHallStartStep==3)        //BA
  288.         {
  289.                 TIM1->CCR2H = (uint8_t)(OutPwmValue >> 8);
  290.     TIM1->CCR2L = (uint8_t)(OutPwmValue);
  291.           PWM_A_ON;
  292.         }
  293.         else if(bHallStartStep==4)//CA
  294.         {
  295.                 TIM1->CCR1H = (uint8_t)(OutPwmValue >> 8);
  296.     TIM1->CCR1L = (uint8_t)(OutPwmValue);
  297.           PWM_A_ON;
  298.         }
  299.         else if(bHallStartStep==5)        //CB
  300.         {
  301.                 TIM1->CCR1H = (uint8_t)(OutPwmValue >> 8);
  302.     TIM1->CCR1L = (uint8_t)(OutPwmValue);
  303.           PWM_B_ON;
  304.         }
  305.        
  306.         TIM1->CCER1=PWM_EN1_TAB[bHallStartStep];
  307.         TIM1->CCER2=PWM_EN2_TAB[bHallStartStep];               
  308.         TIM1->BKR|=TIM1_BKR_MOE;//使能PWM输出
  309. }

  311. #ifdef USE_FULL_ASSERT

  313. /**
  314.   * @brief  Reports the name of the source file and the source line number
  315.   *   where the assert_param error has occurred.
  316.   * @param file: pointer to the source file name
  317.   * @param line: assert_param error line source number
  318.   * @retval : None
  319.   */
  320. void assert_failed(u8* file, u32 line)
  321. {
  322.   /* User can add his own implementation to report the file name and line number,
  323.      ex: printf("Wrong parameters value: file %s on line %d ", file, line) */

  325.   /* Infinite loop */
  326.   while (1)
  327.   {
  328.   }
  329. }
  330. #endif
复制代码


程序控制三相120°无刷直流电机，芯片为stm8s207rb其中有六状态，本应该是下面六种相序
UH WL           UH VL
WH  VL         WH UL
VH UL          VH  WL
用PD口外部中断捕获霍尔信号，却出现
UH VL WL       UH UL WL   
WH WL UL      WH WL UL
VH VL UL       VH VL WL
写的程序出现了上下桥同时导通的情况
请问各位大神，这个该怎么解决？？？？？

此帖出自小平头技术问答
发送
 看不清?
0条回答

一周热门 更多>

相关问题