|
|
基于STM32步进电机s型加减速控制
一个物体从起点运动到终点,要经历加速,匀速,减速的过程,把整个过程中速度随时间变化关系画出来,就是速度曲线.
S型加减速就是指速度曲线中加减速阶段的曲线呈现一个英文字母'S'型.
S型加减速相对于梯形加减速更加平稳,对电机和传动系统的冲击更小.
S型加减速的曲线并没有限定是什么曲线,所以可以是指数曲线,可以是正弦曲线.这里分析的S型加减速是基于加速度匀速变化的曲线.
S型加减速的优点就是启动和停止都很平滑,不会有很大的冲击,但缺点就是启动和停止的时间比较长.
具体的加减速的速度曲线看背景图….
右图就是S型加速曲线和对应的加速度曲线示意图
在加速过程中,前半部分由于加速度是匀速递增的,
这段曲线我们称为加加速段曲线(后面称它为IncAccel),后半部分是加速度匀速递减的,称为减加速段(DeAccel).
加加速段是加速度关于时间的斜率为正的直线,减
加速则是加速度关于时间的斜率为负的直线.
加速度从0开始变化,到了最大值开始减小,最后为0,
由于加速度的斜率是相同的,所以加加速度和减加速度
所用的时间是一样.这两段曲线是关于加速度最大值的对应的速度中心对称的.
单片机源程序如下:
- #include "Speed.h"
- //函数名称： CalculateSpeedTab
- //函数功能：计算加减速表
- //参数参数：Speed 速度结构体
- // V0; //初速度，单位：step/s
- // Vt; //末速度，单位：step/s
- // S; //路程，单位：step
- // t; //加速时间，单位：s
- // time; //加速次数 单位：次
- // *SpeedTab; //加速速度表，速度单位：step/s
- // SecSpeedPoint; //减速点 单位：step
- //返回输出：速度结构体
- static Speed_t CalculateSpeedTab(Speed_t Speed)
- {
- int i;
- double aa; //加加速
- int DeltaV; //速度变化量
- int tempVt;
- //如果速度记录表的指针为空，说明没有分配内存
- RT_ASSERT(Speed->SpeedTab != RT_NULL);
- //各参数是否超范围
- RT_ASSERT(IS_SPEED(Speed->V0, Speed->Vt));
- RT_ASSERT(IS_SPACE(Speed->S));
- RT_ASSERT(IS_ADDTIMING(Speed->t));
- RT_ASSERT(IS_ADDTIME(Speed->time));
- //根据加速法则计算末速度
- tempVt = LASTVELOCITY(Speed->S / SPEEDPRINCIPLE, Speed->V0, Speed->t);
- Speed->Vt = (tempVt > Speed->Vt) ? Speed->Vt : tempVt;
- Speed->SecSpeedPoint = ACCELERATESPACE(Speed->V0, Speed->Vt, Speed->t); //计算减速点位置，剩余路程为该值时开始减速
- aa = (double)((Speed->Vt - Speed->V0) / 2) //加速度变化拐点时的速度值 a| /|\
- * 2 //知道直角三角形面积，逆推三角型高度时将面积*2 | / | \面积为DeltaV
- / (Speed->time / 2) //除以底边 | / | \
- / (Speed->time / 2); //再除以底边，得到斜率，即加加速 |/___|___\__time
- //开始速度计算
- for(i = 0; i < ((Speed->time / 2) + 1); i++)
- {
- DeltaV = (aa * i * i) / 2; //V = V0 + a * t / 2; a = aa * t;
- *(Speed->SpeedTab + i) = Speed->V0 + DeltaV; //当前点的速度
- *(Speed->SpeedTab + Speed->time - i) = Speed->Vt - DeltaV; //对称点的速度
- }
- return Speed;
- }
- //函数名称：TestSpeed
- //函数功能：测试速度表计算函数
- //函数参数：V0 初速度，单位：转/min
- // Vt 末速度，单位：转/min
- // S 路程，单位：mm
- // time 加速次数
- //函数返回：无
- void TestSpeed(int V0, int Vt, int S, int time)
- {
- int i;
- Speed_t Speed = (Speed_t)rt_malloc(sizeof(struct SPEED));
- Speed->V0 = STEPSPEED(V0); //起速
- Speed->Vt = STEPSPEED(Vt); //末速
- Speed->S = TOTALSTEP(S); //路程
- Speed->t = 0.2; //加速时间设为0.2秒
- Speed->time = time; //加速次数
- Speed->SpeedTab = (int *)rt_malloc(sizeof(int) * (Speed->time + 1)); //根据加速次数申请表格内存，加1，以防用的时候超界
- CalculateSpeedTab(Speed); //开始计算
- for(i = 0; i < Speed->time; i++)
- {
- rt_kprintf("SpeedTab[%d] = %d, Acceleration = %d\n"
- , i
- , *(Speed->SpeedTab + i)
- , *(Speed->SpeedTab + i + 1) - *(Speed->SpeedTab + i));
- }
- rt_kprintf("SpeedTab[%d] = %d\n", i, *(Speed->SpeedTab + i));
- rt_free(Speed->SpeedTab);
- rt_free(Speed);
- }
- FINSH_FUNCTION_EXPORT(TestSpeed, Test Speed table calculate);
头文件：
- #ifndef __SPEED_H__
- #define __SPEED_H__
- #include "rtthread.h"
- #include "finsh.h"
- /* 三分之一加减速法则：
- 加速路程不超过三分之一总路程，
- 这样做的目的是给减速留有足够的时间去检测减速点，
- 进而实现平稳的将速度减到初速度，
- 如果在处理速度够快的情况下，
- 可以选择二分之一加减速
- */
- //加减速法则，2分之一法则或3分之一法则
- #define SPEEDPRINCIPLE 3
- //电机最大转速，单位转/min
- #define MOTOMAXSPEED 1500
- //电机每转对应的传动距离,单位：mm
- #define MOTOROUNDLENGTH 36
- //电机最大初速度，初速度超过该值会对电机造成伤害，单位转/min
- #define MOTOMAXSTART 200
- //驱动器细分数
- #define DRIVERSFRACTION 1
- //电机细分数
- #define MOTOFRACTION 200
- //根据初速度，末速度，以及时间，计算加速路程
- #define ACCELERATESPACE(V0,Vt,t) (((V0) + (Vt)) * (t) / 2)
- //根据加速路程，初速度，以及时间，计算末速度
- #define LASTVELOCITY(S,V0,t) (2 * (S) / (t) - (V0))
- //根据电机转速（转/min），计算电机步速度（step/s）
- #define STEPSPEED(RV) ((RV) * MOTOFRACTION * DRIVERSFRACTION / 60)
- //根据长度计算电机所需走的步数，S的单位为mm
- #define TOTALSTEP(S) S * MOTOFRACTION * DRIVERSFRACTION / MOTOROUNDLENGTH
- struct SPEED
- {
- int V0; //初速度，单位：step/s
- int Vt; //末速度，单位：step/s
- long long S; //路程，单位：step
- double t; //加速时间，单位：s
- int time; //加速次数 单位：次
- int *SpeedTab; //加速速度表，速度单位：step/s
- int SecSpeedPoint; //减速点 单位：step(在电机运动过程中，如果剩余路程小于等于该值，那么电机开始减速)
- };
- typedef struct SPEED * Speed_t;
- //各参数范围值，可以在此设置参数范围
- //初速度大于0小于电机最高起速，末速度大于初速度，小于电机最高转速
- #define IS_SPEED(V0,Vt) (((V0) >= 0) && ((V0) <= STEPSPEED(MOTOMAXSTART)) \
- && ((Vt) >= (V0)) && ((Vt) <= STEPSPEED(MOTOMAXSPEED)))
- #define IS_SPACE(S) ((S) > 0)
- #define IS_ADDTIMING(t) ((t) > 0)
- #define IS_ADDTIME(time) ((time) >= 32) //让加速次数必须大于等于32，否则计算表格就没什么意义
- #endif
所有资料51hei提供下载:
S型加减速分析.rar
(2.64 MB, 下载次数: 1151)
|
评分
-
查看全部评分
|
[复制链接]
QQ好友和群
QQ空间
腾讯微博
腾讯朋友
收藏
淘帖
顶
踩
