发 帖  
原厂入驻New

[经验] 【项目分享】基于STM32的步进电机S型加减速控制算法

2019-12-16 09:41:59  1624 STM32 步进电机 电机控制 算法
分享
3
基于STM32步进电机S型加减速控制算法

STM32简介
STM32代表ARM Cortex-M内核的32位微控制器。专为要求高性能、低成本、低功耗的嵌入式应用专门设计的:
STM32系列的内核主要有:Cortex-M0、Cortex-M0+、Cortex-M3、Cortex-M4、Cortex-M7
STM32内部资源:
1.GPIO:
2.外部中断:STM32的任意一个GPIO均可设置为外部中断源
3.DMA控制器:用于在外设与存储器之间以及存储器与存储器之间提供高速数据传输。可以在无需任何 CPU 操作的情况下通过 DMA 快速移动数据。这样节省的 CPU 资源可 供其它操作使用。
4.模拟/数字转换(ADC):可配置 12 位、10 位、8 位或 6 位分辨率,它具有多达 19 个复用通道,可测量来自 16 个外部 源、两个内部源和 VBAT 通道的信号
5.数字/模拟转换(DAC):DAC 模块是 12 位电压输出数模转换器
(ADC/DAC分辨率:能够反映模拟量变化的最小单位。例:STM32 ADC的满量程为3.3V,在12位ADC转换中能识别的最小电压变化值为:3.3/2^12=3.3/4096=0.000244V)
6.定时器:高级定时器(tiM1,TIM8)、通用定时器(TIM2~5)、基本定时器(TIM6/TIM7)

图1:STM32定时器简介

内存扩展USB全速接口
bxcan控制器局域网:1986 年德国电气商博世公司开发出面向汽车的CAN 通信协议,并被广泛地应用于工业自动化、船舶、医疗设备、工业设备等方面 。
支持最大传输波特率1Mbps,当波特率设置为125kbps以下时,可靠传输距离可达1千米以上,总线上可挂载若干个can通信外设;
图2:车辆中所用到的CAN通信

串行外设接口(SPI):
I2C接口:
通用同步异步收发器(USART):
以太网(ETH):物联网

步进电机:
步进电机特点

在步进电机的控制过程中由于负载的变化和运行速度的影响常常会产生失步和过冲现象致使控制精度下降。失步和过冲现象分别出现在步进电机的启动和停止的时候。其中失步是由于同步力矩无法使转子速度跟随定子磁场的旋转速度,从而引起失步;而在控制脉冲结束时,转子在步进过程中获得过多的能量,平均速度会高于定子磁场的平均转速,使得步进电机输出转矩偏大,产生了过冲现象。
为了克服失步和过冲现象,应采用与电机控制相适应的控制算法即在启动和停止时实行加减速控制,其实质是在速度变化过程中控制发送脉冲的频率实现速度的加减速。通常加减速算法主要有梯形曲线、指数曲线和S型曲线。
(1)梯形运行曲线
对于梯形曲线来说,电机启动后做匀加速运动,达到预定速度后,电机匀速转动,然后做匀减速运动至停止。其速度和加速度曲线如图3所示。其速度的公式为:
2.png
(3)
3.png
图4-8梯形曲线速度和加速度曲线
<span]因为脉冲频率控制步进电机的转速,其初始速度V0对应步进电机的启动频率,Vm为匀速运行速度,在加速阶段t1内,经历了n1个脉冲,通过已知Vm-V0可以求出a1即加速阶段的加速度。其中加速阶段的每个脉冲周期为Tx,最小的为Tm,最大的为T0,匀加速过程中每次脉冲周期减少时间即脉冲周期变化量为 。其中转速的计算可由步距角比时间获得:
4.png
(4)
5.png
(5)
通过速度之差可得出加速阶段的] 6.png
(6)
减速阶段的计算公式与加速阶段的类似。得到 之后在脉冲循环函数中每次对定时器的ARR增加或减少相应的数值便可获得匀加速和匀减速效果。
梯形曲线其特点是算法简便,占用时少、响应快、效率高,实现方便[48]。但匀加速和匀减速阶段不符合步进电机速度变化规律,在变速和匀速转折点不能平滑过渡,这将影响电机的运行效率和使用寿命,所以这种算法主要应用在对升降速过程要求不高的场合。
(2)指数运行曲线
作为数控系统中较常见的加减速模型,指数运行曲线不同于梯形曲线在于其加速过程是按指数规律变化,加速度变化规律函数与速度变化规律函数互为反函数。运动规律如图7。
7.png
图7 指数曲线速度和加速度曲线图
其速度公式为:

8.png
(8)
式中vm为指定进给速度,t为加减速时间, 为加速度时间系数(与电机自身参数有关)。理论上加速阶段步进电机的运行频率为:

9.png
(9)
其中fm为最高脉冲频率即匀速时候的控制频率。但在实际控制中,如果直接对频率公式程序编写会造成由于参数过多计算量过大引起的CPU负荷过大,从而导致程序运行出错。所以通常情况会进行离散逼近的方式来完成曲线控制。将加速段的时间分为N段,则每次加速度改变的时间为:

10.png
(10)
可以得到每段的控制频率为:

11.png
(11)
则每段的运行步数为:

12.png
(12)
这种方法均匀的离散了加速度的变化,但在算法实现时的加速度时间分段是不均匀的,所以和设计的曲线合适有一定的出入。指数曲线克服了梯形加减速的速度不平稳问题,运动精度得到了提高,但初始加速度大,容易引起机械部件的冲击,在加减速的起点仍然存在加减速突变,限制了加速度的提高。
(3)S型曲线
S型曲线是相对较新的控制算法,常用来解决控制加速度的突变现象,由于加减速过程的速度曲线像S型得名。S型曲线并不是一种固定的算法,可分为7个阶段,加加速段、匀加速段、减加速段、匀速段、加减速段、匀减速段和减减速段,其中控制匀速阶段和匀加速阶段的有无有可分为4段型、5段型和6段型,具体如图10所示,通过调整不同阶段的参数得到不同性能的加减速特性,常见的S曲线有抛物线型和三角函数型,因此应用灵活。S型曲线的核心思想是让加速度不产生突变,其加减速平稳,柔性快速,是一种综合性能比较突出的加减速模型。因此本课题的步进电机控制采用了S型曲线控制。
13.png
图10 S型曲线速度、加速度和加加速度曲线图
其速度公式为

14.png
(13)
式(13)描述了步进电机整个的速度变化过程。虽然S曲线在加减速控制方面相较梯形和指数型有很大的提高,但是由于涉及阶段较多,实现较为复杂,因此需要对控制曲线进行一定的离散拟合优化,从而更好的实现控制要求。
基于STM32的步进电机S型加减速实现


问题:1.怎么样利用STM32输出脉冲信号?(1.定时器PWM输出;2.GPIO+高精度延时函数)
2.怎么样设置脉冲频率?(预分频系数TIMx->PSC、计数重载值TIMx-> ARR)
3.怎么样输出定量的脉冲信号?(1.定时器外部计数(高速);2.外部中断计数(低速))
步进电机闭环控制框图
15.png
步进电机通常情况是不带编码器的,哪来的信号反馈?
利用步进电机的特性(在非超载的情况下,电机的转速、停止的位置只取决于脉冲信号的频率和脉冲数,而不受负载变化的影响),采集控制器输出的脉冲作为反馈信号,进行无传感器的“伪”闭环控制,控制框图如下:


STM32实现方案1:利用STM32定时器 (高级或通用定时器)输出PWM控制步进电机,开启另一个定时器(高级或通用定时器 )为外部计数模式进行输出脉冲采集,设置以细分数为计数溢出中断,在中断里改变PWM输出定时器的输出频率。
方案2:利用STM32高级定时器输出PWM控制步进电机,同时开启定时器溢出中断,在高级定时器中的重复计数寄存器RCR(寄存器为8位寄存器,计数范围0~255),并初始化该寄存器值为细分数,在溢出中断中改变PWM输出频率,实现步进电机速度调节。提示:如不开启此寄存器,定时器每输出一个脉冲触发一次中断,而PWM输出频率通常很高,控制器将不停的开启中断/关闭中断消耗CPU。


现在回到S型控制算法:
在S型曲线加减速控制算法中,涉及到的参数有:1.最大速度;2.最大加速度;3.起跳转速;4.加加速时间(加加速脉冲数);5.匀加速时间(匀加速脉冲数),6.加速总时间(总脉冲数)等,这么多参数,怎么样确定呢?


理论计算+经验


1.最大速度:步进电机输出转矩随转速的增加呈减少趋势,计算最大负载,为保证步进电机运行时不失步,步进电机输出转矩以大于最大负载的1.5~2倍
2.最大加速度:
3.起跳转速:步进电机的参数手册里会提及
4~6 .加加速时间不应大于总加速时间的1/4;总加速时间0~1.5s
当这些参数确定好后,代入公式(1-1)便可得到步进电机运行的个阶段速度曲线,同时为了简化算法,减少MCU计算量,采用一步一插值的方法获取步进电机每一步运行的频率(采用细分控制时每一步运行在同一频率下),并将插取值换算成定时器重装载寄存器(TIMx-ARR)的值做成数组保存在MCU内存中,这样控制器只需要按顺序在数组里读取值进行定时器计数值重装载就行了。下面附上步进电机S型加减速代码:
  1. #include "spwm.h"
  2. #include "motor.h"
  3. #include "eesv3.h"
  4. #include <math.h>
  5. #include "can.h"
  6. #include "usart2.h"

  7. #IF SYSTEM_SUPPORT_OS
  8. #include "includes.h"                   //os ʹÓà    
  9. #endif

  10. uint16_t  T8_integer_num;     //ÔÈËٽ׶ÎÂö³åÊýµÄ255µÄÕûÊý±¶
  11. uint8_t   T8_remainder_num; //ÔÈËٽ׶ÎÂö³åÊýµÄ255µÄÕûÊý±¶ÓàÊý
  12. uint8_t TIM8_STATUS=0;          //TIM3¶¨Ê±Æ÷¹¤×÷״̬±êÖ¾£¨0£º¿ÕÏУ»1£ºÃ¦£©
  13. uint8_t T8Motor_Code=0;         //µç»ú´úºÅ£¬ÉèÖóÉÈ«¾Ö±äÁ¿
  14. uint8_t T8RunModel=0;           //µÚ¶þ×éµç»úÔËÐбê־λ

  15. uint16_t PREQ_TABBUR[31]={6400,6502,6810,7322,8038,8960,9424,10448,11472,12496,13520,14544,15568,16592,
  16. //  17616,18640,19664,20688,21712,22736,23760,24784,25808,26832,27856,28880,30362,31078,31590,31898,32000};

  17. /*------------------------------------------------------------------------------------
  18. * @function: static void PWM_GPIOC_Config(void)
  19. * [url=home.php?mod=space&uid=40524]@author[/url]  : Zhou Xiangping
  20. * [url=home.php?mod=space&uid=1891133]@input[/url]   : Nothing
  21. * [url=home.php?mod=space&uid=1141835]@Return[/url]  : Nothing
  22. * @date    : 19-2-2017
  23. * [url=home.php?mod=space&uid=2666770]@Brief[/url]   : ³õʼ»¯¶¨Ê±Æ÷TIM3µÄPWMÊä³öÒý½Å
  24. -------------------------------------------------------------------------------------*/
  25. static void TIM8_PWM_RCR_Config(u16 arr,u16 psc)
  26. {                           
  27.     GPIO_InitTypeDef GPIO_InitStructure;
  28.     TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;
  29.     TIM_OCInitTypeDef  TIM_OCInitStructure;
  30.     NVIC_InitTypeDef NVIC_InitStructure;

  31.     RCC_APB2PeriphclockCmd(RCC_APB2Periph_TIM8, ENABLE); //TIM8ʱÖÓʹÄÜ
  32.     RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOC , ENABLE);  //ʹÄÜGPIOCÍâÉèʱÖÓʹÄÜ                                                                        

  33.   //ÉèÖøÃÒý½ÅΪ¸´ÓÃÊä³ö¹¦ÄÜ,Êä³öTIM8 CH2µÄPWMÂö³å²¨ÐÎ
  34.     GPIO_InitStructure.GPIO_Pin = GPIO_Pin_6|GPIO_Pin_7|GPIO_Pin_8|GPIO_Pin_9; //TIM8_CH2
  35.     GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;  //¸´ÓÃÍÆÍìÊä³ö
  36.     GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  37.     GPIO_Init(GPIOC, &GPIO_InitStructure);

  38.     TIM_TimeBaseStructInit(&TIM_TimeBaseStructure);

  39.     TIM_TimeBaseStructure.TIM_Period = arr; //ÉèÖÃÔÚÏÂÒ»¸ö¸üÐÂʼþ×°Èë»î¶¯µÄ×Ô¶¯ÖØ×°ÔؼĴæÆ÷ÖÜÆÚµÄÖµ     
  40.     TIM_TimeBaseStructure.TIM_Prescaler =psc; //ÉèÖÃÓÃÀ´×÷ΪTIMxʱÖÓƵÂʳýÊýµÄÔ¤·ÖƵֵ  
  41.     TIM_TimeBaseStructure.TIM_ClockDivision = 0; //ÉèÖÃʱÖÓ·Ö¸î:TDTS = Tck_tim
  42.     TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; //TIMÏòÉϼÆÊýģʽ
  43.     TIM_TimeBaseInit(TIM8, &TIM_TimeBaseStructure); //¸ù¾ÝTIM_TimeBaseInitStructÖÐÖ¸¶¨µÄ²ÎÊý³õʼ»¯TIMxµÄʱ¼ä»ùÊýµ¥Î»
  44.     TIM_ClearITPendingBit(TIM8,TIM_IT_Update);

  45.     TIM_UpdateRequestConfig(TIM8,TIM_UpdateSource_Regular); /********* ÉèÖÃÖ»ÓмÆÊýÒç³ö×÷Ϊ¸üÐÂÖÐ¶Ï ********/
  46. //  TIM_SelectOnePulseMode(TIM8,TIM_OPMode_Single);/******* µ¥Âö³åģʽ **********/

  47.     TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM2; //Ñ¡Ôñ¶¨Ê±Æ÷ģʽ:TIMÂö³å¿í¶Èµ÷ÖÆģʽ2
  48.     TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable; //±È½ÏÊä³ö2ʹÄÜ
  49.     TIM_OCInitStructure.TIM_OutputNState = TIM_OutputNState_Disable; /****** ±È½ÏÊä³ö2NʧÄÜ *******/
  50.     TIM_OCInitStructure.TIM_Pulse = arr>>1; //ÉèÖôý×°È벶»ñ±È½Ï¼Ä´æÆ÷µÄÂö³åÖµ
  51.     TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High; //Êä³ö¼«ÐÔ:TIMÊä³ö±È½Ï¼«ÐÔ¸ß

  52.     TIM_OC1Init(TIM8, &TIM_OCInitStructure);                //¸ù¾ÝTIM_OCInitStructÖÐÖ¸¶¨µÄ²ÎÊý³õʼ»¯ÍâÉèTIMx
  53.     TIM_OC1PreloadConfig(TIM8, TIM_OCPreload_Enable); //ʹÄÜTIMxÔÚCCR1ÉϵÄԤװÔؼĴæÆ÷
  54.     TIM_OC2Init(TIM8, &TIM_OCInitStructure);
  55.     TIM_OC2PreloadConfig(TIM8, TIM_OCPreload_Enable); //ʹÄÜTIMxÔÚCCR2ÉϵÄԤװÔؼĴæÆ÷
  56.     TIM_OC3Init(TIM8, &TIM_OCInitStructure);               
  57.     TIM_OC3PreloadConfig(TIM8, TIM_OCPreload_Enable); //ʹÄÜTIMxÔÚCCR3ÉϵÄԤװÔؼĴæÆ÷
  58.     TIM_OC4Init(TIM8, &TIM_OCInitStructure);               
  59.     TIM_OC4PreloadConfig(TIM8, TIM_OCPreload_Enable); //ʹÄÜTIMxÔÚCCR4ÉϵÄԤװÔؼĴæÆ÷

  60.     TIM_ARRPreloadConfig(TIM8, ENABLE); //ʹÄÜTIMxÔÚARRÉϵÄԤװÔؼĴæÆ÷

  61.     TIM_ITConfig(TIM8, TIM_IT_Update ,ENABLE);  //TIM8   Ê¹ÄÜ»òÕßʧÄÜÖ¸¶¨µÄTIMÖжÏ

  62.     NVIC_InitStructure.NVIC_IRQChannel = TIM8_UP_IRQn;  //TIM8ÖжÏ
  63.     NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 1;  //ÏÈÕ¼ÓÅÏȼ¶1¼¶
  64.     NVIC_InitStructure.NVIC_IRQChannelSubPriority = 1;  //´ÓÓÅÏȼ¶1¼¶
  65.     NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //IRQͨµÀ±»Ê¹ÄÜ
  66.     NVIC_Init(&NVIC_InitStructure);  //¸ù¾ÝNVIC_InitStructÖÐÖ¸¶¨µÄ²ÎÊý³õʼ»¯ÍâÉèNVIC¼Ä´æÆ÷

  67.     TIM_ClearITPendingBit(TIM8, TIM_IT_Update);  //Çå³ýTIMxµÄÖжϴý´¦Àíλ:TIM ÖжÏÔ´
  68.     TIM_Cmd(TIM8, ENABLE);  //ʹÄÜTIM8                                    
  69. }
  70. /*------------------------------------------------------------------------------------
  71. * @function: PWM_OUT_Init(uint16_t arr,uint16_t psc)
  72. * @author  : Zhou Xiangping
  73. * @input   : arr£º×Ô¶¯ÖØ×°Öµ   psc£ºÊ±ÖÓÔ¤·ÖƵ
  74. * @return  : Nothing
  75. * @date    : 19-2-2017
  76. * @brief   : ³õʼ»¯TIM3¡TIM4µÄPWMÊä³ö¹¦ÄÜ
  77. -------------------------------------------------------------------------------------*/
  78. void TIM8_PWM_OUT_Init(uint16_t arr,uint16_t psc)
  79. {
  80.     TIM8_PWM_RCR_Config(arr, psc);
  81.     TIM_SetCompare1(TIM8,0); //ÉèÖÃͨµÀ1µÄÕ¼¿Õ±È50%
  82.     TIM_SetCompare2(TIM8,0); //ÉèÖÃͨµÀ2µÄÕ¼¿Õ±È50%
  83.     TIM_SetCompare3(TIM8,0); //ÉèÖÃͨµÀ3µÄÕ¼¿Õ±È50%
  84.     TIM_SetCompare4(TIM8,0); //ÉèÖÃͨµÀ4µÄÕ¼¿Õ±È50%
  85. }
  86. /*------------------------------------------------------------------------------------
  87. * @function: TIM3_Startup(uint8_t Channel,uint32_t frequency)
  88. * @author  : Zhou Xiangping
  89. * @input   : Channel£ºPWMÊä³öͨµÀ1~4£»    Frequency£ºPWMÊä³öƵÂÊ
  90. * @return  : Nothing
  91. * @date    : 19-2-2017
  92. * @brief   : ÖØÐÂ×°Ôض¨Ê±Æ÷TIM3µÄ¸÷ͨµÀPWMÊä³öƵÂʼ°Õ¼¿Õ±È
  93. -------------------------------------------------------------------------------------*/
  94. void TIM8_Startup(uint8_t Channel,uint32_t Frequency)
  95. {
  96.     u16 temp_arr=1000000/Frequency-1;
  97.     TIM_SetAutoreload(TIM8,temp_arr);//
  98.     switch(Channel)
  99.     {
  100.         case 1:
  101.                     TIM_SetCompare1(TIM8,temp_arr>>1); //ÉèÖÃͨµÀ1µÄÕ¼¿Õ±È50%
  102.             break;
  103.         case 2:
  104.                     TIM_SetCompare2(TIM8,temp_arr>>1); //ÉèÖÃͨµÀ2µÄÕ¼¿Õ±È50%
  105.             break;
  106.         case 3:
  107.                     TIM_SetCompare3(TIM8,temp_arr>>1); //ÉèÖÃͨµÀ3µÄÕ¼¿Õ±È50%      
  108.             break;
  109.         case 4:
  110.                     TIM_SetCompare4(TIM8,temp_arr>>1); //ÉèÖÃͨµÀ4µÄÕ¼¿Õ±È50%   
  111.             break;
  112.         default: break;
  113.     }   
  114.     TIM_SetCounter(TIM8,0);//
  115.     TIM_CtrlPWMOutputs(TIM8,ENABLE);    //MOE Ö÷Êä³öʹÄÜ£¨¸ß¼¶¶¨Ê±Æ÷ʱ±ØÒªµÄ»·½Ú£©
  116.     TIM_Cmd(TIM8, ENABLE); //
  117. }
  118. /*------------------------------------------------------------------------------------
  119. * @function: TIM8_UP_IRQHandler(void) //TIM8-RCRÒç³öÖжϷþÎñ³ÌÐò
  120. * @author  : Zhou Xiangping
  121. * @input   : Nothing
  122. * @return  : Nothing
  123. * @date    : 19-2-2017
  124. * @brief   : (µÚÒ»×éµç»ú¿ØÖÆË㷨ʵÏÖº¯Êý)¶¨Ê±Æ÷TIM8Òç³öÖжϣ¬´¦Àíµç»ú¿ØÖÆÐźÅSTEPµÄÂö³åÊä³öƵÂÊ
  125.                         : ¿ØÖƵç»ú0¡¢1¡¢2¡¢3Ô˶¯
  126. -------------------------------------------------------------------------------------*/
  127. void TIM8_UP_IRQHandler(void)
  128. {
  129.     static uint8_t Accel_num=0,Decel_num=STEP_NUMX;
  130.     static uint32_t totall=0;
  131.     static canbus Can1;

  132. #ifdef SYSTEM_SUPPORT_OS        
  133.     OSIntEnter();   
  134. #endif
  135.     if(TIM_GetITStatus(TIM8,TIM_FLAG_Update)!=RESET)
  136.     {
  137.         TIM_ClearITPendingBit(TIM8,TIM_FLAG_Update);
  138.         if(TIM8_STATUS==1)
  139.         {
  140.             if(Accel_num<STEP_NUMX)
  141.             {
  142.                 Accel_num++;
  143.                 totall+=SUBD_NUM;   
  144.                 switch(T8Motor_Code)
  145.                 {
  146.                     case 0: TIM8_Startup(1,PREQ_TABBUR[Accel_num]);
  147.                     break;
  148.                     case 1: TIM8_Startup(2,PREQ_TABBUR[Accel_num]);
  149.                     break;
  150.                     case 2: TIM8_Startup(3,PREQ_TABBUR[Accel_num]);
  151.                     break;
  152.                     case 3: TIM8_Startup(4,PREQ_TABBUR[Accel_num]);
  153.                     break;  
  154.                     default:break;                          
  155.                 }   
  156. //              u2_printf("\r\nT8[%d]= %d",Motor_Code,PREQ_TABBUR[Decel_num]);
  157.             }else if(T8_integer_num>0||T8_remainder_num>0)
  158.             {
  159.                 if(T8_integer_num!=0)
  160.                 {
  161.                     T8_integer_num--;
  162.                     TIM8->RCR=RCR_VAL;
  163.                     totall+=RCR_VAL;
  164.                 }else if(T8_remainder_num!=0)
  165.                 {
  166.                     totall+=T8_remainder_num;
  167.                     TIM8->RCR=T8_remainder_num;
  168.                     T8_remainder_num=0;                                 
  169.                 }
  170. //              u2_printf("\r\nT8[%d]= %d",T8Motor_Code,PREQ_TABBUR[Decel_num]);
  171.             }else if(T8RunModel >= 1)
  172.             {
  173. //               switch(Motor_Code)
  174. //                  {
  175. //                      case 0: T1RunModel=ScanSensor_EESV3(SensorNum);
  176. //                      break;
  177. //                      case 1: T1RunModel=ScanSensor_EESV3(SensorNum);
  178. //                      break;
  179. //                      case 2: T1RunModel=ScanSensor_EESV3(SensorNum);
  180. //                      break;
  181. //                      case 3: T1RunModel=ScanSensor_EESV3(SensorNum);
  182. //                      break;  
  183. //                      default:break;                                 
  184. //                  }
  185.                 u2_printf("\r\nT8RunModel= %d",T8RunModel);
  186.                 T8RunModel=ScanSensor_EESV3(1);
  187.                 u2_printf("\r\nT8RunModel= %d",T8RunModel);
  188.                 TIM8->RCR=SUBD_NUM;
  189.             }else if(Decel_num>0) //¼õËٽ׶Î
  190.                 {
  191.                     TIM8->RCR=SUBD_NUM-1;
  192.                     Decel_num--;
  193.                     totall+=SUBD_NUM;   
  194.                     switch(T8Motor_Code)
  195.                     {
  196.                         case 0: TIM8_Startup(1,PREQ_TABBUR[Decel_num]);
  197.                         break;
  198.                         case 1: TIM8_Startup(2,PREQ_TABBUR[Decel_num]);
  199.                         break;
  200.                         case 2: TIM8_Startup(3,PREQ_TABBUR[Decel_num]);
  201.                         break;
  202.                         case 3: TIM8_Startup(4,PREQ_TABBUR[Decel_num]);
  203.                         break;  
  204.                         default:break;                              
  205.                     }   
  206. //              u2_printf("\r\nT8[%d]= %d",T8Motor_Code,PREQ_TABBUR[Decel_num]);
  207.                 }else goto out;
  208.             }else
  209.             {
  210. out:
  211. //           u2_printf("\r\n totall=%d\r\n",totall);
  212.                 totall=0;
  213.                 TIM8_STATUS=0;           //±êÖ¾Ò»¸ö¹¤×÷ת̬Íê³É
  214.                 Accel_num=0;
  215.                 Decel_num=STEP_NUMX;
  216.                 TIM_CtrlPWMOutputs(TIM8,DISABLE);   //MOE Ö÷Êä³ö¹Ø±Õ
  217.                 TIM_Cmd(TIM8, DISABLE);  //¹Ø±ÕTIM8
  218.                 MOTOR_STOP0;
  219.                 TIM_SetCompare1(TIM8,0); //ÉèÖÃͨµÀ1µÄÕ¼¿Õ±È50%
  220.                 TIM_SetCompare2(TIM8,0); //ÉèÖÃͨµÀ2µÄÕ¼¿Õ±È50%
  221.                 TIM_SetCompare3(TIM8,0); //ÉèÖÃͨµÀ3µÄÕ¼¿Õ±È50%
  222.                 TIM_SetCompare4(TIM8,0); //ÉèÖÃͨµÀ4µÄÕ¼¿Õ±È50%
  223.                 switch(T8Motor_Code)
  224.                 {
  225.                     case 0:         
  226.                         Can1.CheckCode=(0xc0+T8Motor_Code+0x55+0xff+0xff+0xff+0xff)&0x00FF;
  227.                         CAN1SetData(Can1.tx_buffer,0xc0,T8Motor_Code,0x55,0xff,0xff,0xff,0xff,Can1.CheckCode);
  228.                     break;
  229.                     case 1:
  230.                         Can1.CheckCode=(0xc0+T8Motor_Code+0x55+0xff+0xff+0xff+0xff)&0x00FF;
  231.                         CAN1SetData(Can1.tx_buffer,0xc0,T8Motor_Code,0x55,0xff,0xff,0xff,0xff,Can1.CheckCode);
  232.                     break;
  233.                     case 2:
  234.                         Can1.CheckCode=(0xc0+T8Motor_Code+0x55+0xff+0xff+0xff+0xff)&0x00FF;
  235.                                     CAN1SetData(Can1.tx_buffer,0xc0,T8Motor_Code,0x55,0xff,0xff,0xff,0xff,Can1.CheckCode);
  236.                     break;
  237.                     case 3:
  238.                         Can1.CheckCode=(0xc0+T8Motor_Code+0x55+0xff+0xff+0xff+0xff)&0x00FF;
  239.                         CAN1SetData(Can1.tx_buffer,0xc0,T8Motor_Code,0x55,0xff,0xff,0xff,0xff,Can1.CheckCode);
  240.                     break;  
  241.                     default:break;                              
  242.                 }   
  243.                 CAN1_send_message(Can1.tx_buffer,8);               
  244.             }           
  245.     }
  246. #ifdef SYSTEM_SUPPORT_OS    //Èç¹ûʱÖÓ½ÚÅÄÊý¶¨ÒåÁË,˵Ã÷ҪʹÓÃucosIIÁË.
  247.     OSIntExit();                                             
  248. #endif
  249. }
  250. uint8_t Locate_Rle_FullStep2(long num,uint8_t dir,uint8_t MOTOR,uint8_t Model)
  251. {
  252.     long StepNum=0;
  253.     long T8Uniform_NUM;
  254. //  u2_printf("\r\nStepNum=%d!!\r\n",StepNum);
  255.     if(num<=0) //ÊýֵСµÈÓÚ0 ÔòÖ±½Ó·µ»Ø
  256.     {
  257.         u2_printf("\r\n The num should be greater than zero!!\r\n");
  258.         return 1;
  259.     }
  260.     /*************************************************************************/
  261.     if(TIM8_STATUS)
  262.     {
  263.         u2_printf("\r\nT8 last time pulses is not send finished!\r\n");
  264.         return 2;
  265.     }else{
  266.         T8RunModel=Model;
  267.         T8Motor_Code=MOTOR;
  268.         StepNum=num*SUBD_NUM;//ËùÐèÂö³åÊý
  269.         T8Uniform_NUM=StepNum-(STEP_NUMX*2*SUBD_NUM);      
  270.         T8_integer_num=T8Uniform_NUM/(RCR_VAL+1);
  271.         T8_remainder_num=T8Uniform_NUM%(RCR_VAL+1);
  272.         TIM8->RCR=SUBD_NUM-1;           
  273.         switch(MOTOR)
  274.         {
  275.             case 0:
  276.                     if(dir==1)
  277.                     {
  278.                         MOTOR0_DIR =1; //È·¶¨µç»úÐýת·½Ïò
  279.                     }else
  280.                     {
  281.                         MOTOR0_DIR =0;
  282.                     }
  283.                     MOTOR0_OE;
  284.                     u2_printf("MOTOR0_DIR=%d!\r\n",MOTOR0_DIR);
  285.                     TIM8_Startup(1,PREQ_TABBUR[0]); //ÉèÖÃÊä³öÆðÌøƵÂÊ
  286.                     break;
  287.             case 1:
  288.                     if(dir==1) MOTOR1_DIR =1; //È·¶¨µç»úÐýת·½Ïò
  289.                     else             MOTOR1_DIR =0;
  290.                     MOTOR1_OE;
  291.                     TIM8_Startup(2,PREQ_TABBUR[0]); //ÉèÖÃÊä³öÆðÌøƵÂÊ
  292.                     break;
  293.             case 2:
  294.                     if(dir==1) MOTOR2_DIR =1; //È·¶¨µç»úÐýת·½Ïò
  295.                     else             MOTOR2_DIR =0;
  296.                     TIM8_Startup(3,PREQ_TABBUR[0]); //ÉèÖÃÊä³öÆðÌøƵÂÊ
  297.                     break;
  298.             case 3:
  299.                     if(dir==1) MOTOR3_DIR =1; //È·¶¨µç»úÐýת·½Ïò
  300.                     else             MOTOR3_DIR =0;
  301.                     MOTOR3_OE;  
  302.                     TIM8_Startup(4,PREQ_TABBUR[0]); //ÉèÖÃÊä³öÆðÌøƵÂÊ
  303.             break;
  304.             default:
  305.                      break;            
  306.         }   
  307.         TIM8_STATUS=1;
  308.     }
  309.     return 0;
  310. }
复制代码
转自csdn
作者xping_zhou

评论

高级模式
您需要登录后才可以回帖 登录 | 注册

声明:本文内容及配图由入驻作者撰写或者入驻合作网站授权转载。文章观点仅代表作者本人,不代表电子发烧友网立场。文章及其配图仅供工程师学习之用,如有内容图片侵权或者其他问题,请联系本站作侵删。 侵权投诉
发经验
关闭

站长推荐 上一条 /7 下一条

快速回复 返回顶部 返回列表