电机驱动是很常见的应用，在很多系统中我们都会碰到需要改变电机的速度以实现相应的控制功能，这就涉及到电机速度曲线规划的问题。在这篇中我们就来简单讨论一下电机的梯形曲线规划的问题。

1、基本原理

梯形速度曲线控制算法是工业控制领域应用最为广泛的加减速控制策略之一。所谓梯形速度曲线将整个运动过程分为匀加速、匀速和匀减速三个阶段，在变速过程中加速度保持不变。

从变速过程中加速度保持不变这特点来说，其加减速过程其实是一个线性过程。我们可以采用一个线性函数来描述它。

这一线性函数，具体到我们的加减速过程中就是速度与时间的函数关系，函数结果就是我们某一时刻的速度，变量就是时间，斜率就是加速度，初始速度就是截距，具体如下：

这一函数表达的是连续的，但实际使用中我们需要离散化处理，我们必定以一定的时间间隔来处理速度的增加问题。这样实际的速度变化就不可能是连续的，而是阶梯状的，具体如下：

为了速度的变化尽量平缓，我们需要尽可能地让时间间隔小一些，这其实是我们在考虑编写程序时需要处理的一个参数。

2、设计与实现

我们已经简单描述了S型速度规划曲线的数学原理及应用表达式。接下来我们来考虑怎么实现它。

考虑到在同一个驱动器中可能因为应用场景的需要存在多条的速度规划曲线。所以我们以基于对象的思路来考虑它，这样我们在更换不同的曲线就只需要更换不同的曲线实力就可以了。所以我们先来分析一下曲线对象的属性和操作。

鉴于前面的分析，我们认为作为一个调速曲线对象至少要记录：开始调速时的初始速度、当前速度、目标速度、加速度、最大速度、最小速度、调速时间、调速时间跨度、曲线类型等，我们将这些记为对象的属性。据此我们可以定义电机速度曲线的对象类型为：

/* 定义电机速度曲线对象 */
typedef struct CurveObject {float startSpeed;    //开始调速时的初始速度float currentSpeed;   //当前速度float targetSpeed;    //目标速度float stepSpeed;     //加速度float speedMax;     //最大速度float speedMin;     //最小速度uint32_t aTimes;     //调速时间uint32_t maxTimes;    //调速跨度SpeedCurveType curveMode;  //曲线类型
}CurveObjectType;

我们已经定义了一个速度曲线对象类型，接下来我们就来分析如何实现一个T型调速曲线。我们已经描述过，速度其实就是时间的函数，根据我们前面分析的速度时间的函数表达式，我们实现如下：

void (*pCalCurve[])(CurveObjectType *curve)={CalCurveNone,CalCurveTRAP,CalCurveSPTA};/* 电机曲线加减速操作-------------------------------------------------------- */
void MotorVelocityCurve(CurveObjectType *curve)
{float temp=0;if(curve->targetSpeed>curve->speedMax){curve->targetSpeed=curve->speedMax;}if(curve->targetSpeed<curve->speedMin){curve->targetSpeed=curve->speedMin;}if((fabs(curve->currentSpeed-curve->startSpeed)<=curve->stepSpeed)&&(curve->maxTimes==0)){if(curve->startSpeed<curve->speedMin){curve->startSpeed=curve->speedMin;}temp=fabs(curve->targetSpeed-curve->startSpeed);temp=temp/curve->stepSpeed;curve->maxTimes=(uint32_t)(temp)+1;curve->aTimes=0;}if(curve->aTimes<curve->maxTimes){pCalCurve[curve->curveMode](curve);curve->aTimes++;}else{curve->currentSpeed=curve->targetSpeed;curve->maxTimes=0;curve->aTimes=0;}
}/*梯形曲线速度计算*/
static void CalCurveTRAP(CurveObjectType *trap)
{float slope=0.0;slope=(trap->targetSpeed-trap->startSpeed)/trap->maxTimes;trap->currentSpeed=trap->startSpeed+slope*trap->aTimes;if(trap->currentSpeed>trap->speedMax){trap->currentSpeed=trap->speedMax;}if(trap->currentSpeed<trap->speedMin){trap->currentSpeed=trap->speedMin;}
}

在这个实现中，我们出于更普遍的实用性考虑，将各种曲线的相同操作集成在一起，然后将它们差异的部分通过曲线类型属性以回调函数的方式集成。

3、应用与验证

我们实现了T形电机速度规划曲线的基本设计与实现。接下来，我们就是用这一调速曲线来实现一个电机调速的实例。我们定义速度规划曲线时，是及与对象的思想来实现的，所以我们先声明一条曲线对象实例。

CurveObjectType curve; //电机调速曲线

在声明了这一曲线对象后，我们需要对其初始化赋值才能正确的使用。大多数的属性直接根据应用对象的要求给予初始值就可以了。需要注意的是曲线类型这一属性，这将决定使用什么样的速度规划曲线。该属性为SpeedCurveType枚举，该枚举定义如下：

/* 定义电机速度曲线类型枚举 */
typedef enum SpeedCurve {CURVE_NONE=0,  //直启CURVE_TRAP=1,  //梯形曲线CURVE_SPTA=2   //S型曲线
}SpeedCurveType;

在这里我们需要将曲线类型初始化为T形速度规划曲线。具体操作如下：

curve.curveMode=CURVE_TRAP;

初始化完成之后就可以使用曲线对象来实现电机速度的调节了。使用也很简单，只要按一定的时间周期调用我们前面实现的MotorVelocityCurve函数就可以实现整个调速过程。具体如下：

MotorVelocityCurve(&curve);

在每次调速开始之前都需要设置取下的开始速度和目标速度，这样函数就会按照设定的起始速度和目标速度实现速度调整。

4、小结

我们实现了梯形加减速曲线，并使用其实现了具体的应用。总体来说，当我们将参数设置的合适时，所起到的效果也是非常明显的。在我们的实际使用过程中，梯形曲线对大多数的应用基本都合适。不仅是在启动和停车过程，在运行过程中如果速度设定发生改变，也会调用曲线实现加减速过程。

梯形速度曲线虽说实现简单，在一般的应用场合也能有不错的效果，但实际上还是有一定的问题。梯形速度曲线的加速度是一个常量，这就造成加速度的变化过程并不连续，在加减速阶段和匀速运动阶段的连接部分，加速度会发生突变，而这种突变可能会对控制目标产生冲击，而有些应用场合这种冲击是不允许的。

欢迎关注：

电机速度曲线规划1：梯形速度曲线设计与实现相关推荐

电机速度曲线规划2：S形速度曲线设计与实现
电机驱动是很常见的应用,在很多系统中我们都会碰到需要改变电机的速度以实现相应的控制功能,这就涉及到电机速度曲线规划的问题.在这篇中我们就来简单讨论一下电机的S型曲线规划的问题. 1.基本原理 ...
电机速度曲线规划_S曲线
导读:电机驱动是很常见的应用,在很多系统中都会碰到需要改变电机的速度以实现相应的控制功能,这就涉及到电机速度曲线规划的问题. 本文仅代表记录自己的学习理解,如有错误,欢迎指正.想要S型速度曲线规划的仿 ...
点到点轨迹规划【1】——梯形速度曲线规划
[声明]实验中用到梯形速度规划相关知识,发现关于梯形速度规划的这篇知乎文章资料很好,特此做的归纳笔记,原文中的公式稍有错误,本人已在下面博文中更正,打算整理一个经典点到点轨迹规划方法的专栏.如有侵权, ...
1学习笔记之知乎话题：多轴插补为什么普遍使用梯形速度曲线？
机械臂-轨迹规划-速度规划-学习笔记学习对象:知乎话题:多轴插补为什么普遍使用梯形速度曲线? ICRA2014 Joonyoung PPT 了解一下运动控制器从工业角度讲:算法与硬件平台的关系韩 ...
c语言如何控制上位机界面大小,电机上位机控制及界面设计参考.doc
电机上位机控制及界面设计参考 PAGE 1 电机上位机控制及界面设计吴牛俊 (自动化与电气工程学院指导教师:周克宁) 摘要:随着计算机.电子.通讯技术的飞速发展,人们对于车间现场设备的运行管理控制 ...
[论文]欠驱动水下机器人的平面轨迹规划与跟踪控制设计
[论文]欠驱动水下机器人的平面轨迹规划与跟踪控制设计摘要研究了欠驱动自主水下航行器在水平面上的轨迹规划与跟踪控制的组合问题.给定光滑的.惯性的二维参考轨迹,规划算法利用车辆动力学计算参考方向和机体 ...
天津地铁出行线路规划项目需求分析与设计思路分析
天津地铁出行线路规划项目需求分析与设计思路分析项目概要以下是天津地铁线路总图,本项目的受众可以通过本软件,获得天津市地铁出行最便捷,最快速的线路推荐. 需求分析实现一个帮助进行地铁出行路线规划的 ...
基于matlab的mk2三自由度机械臂轨迹规划及控制器仿真设计
基于matlab的mk2三自由度机械臂轨迹规划及控制器仿真设计(报告+ppt) 摘要:本文的研究对象为EEZYbotARM MK2三自由度机械臂,分析了其机械结构,建立D-H参数表,同时在MATLA ...
一文教你快速搞懂速度曲线规划之S形曲线（超详细+图文+推导+附件代码）
加入技术交流群领取资料本文介绍了运动控制终的S曲线,通过matlab和C语言实现并进行仿真:本文篇幅较长,请自备茶水: 请帮忙点个赞

电机速度曲线规划1：梯形速度曲线设计与实现