[发明专利]一种基于摇杆的步进电机阶梯速度控制方法

说明书

一种基于摇杆的步进电机阶梯速度控制方法，包括以下步骤：1)规划加速度规划表和速度规划表；2)根据摇杆倾斜角度的范围，得到角度区间表和阶梯速度表；3)根据单片机得到摇杆的模拟量计算获得当前摇杆的倾斜角度，查角度区间表和阶梯速度表获取步进电机的目标速度V_p，与步进电机当前阶梯速度V_C比较，相等则保持当前运行状态，否则保持当前步进电机速度匀速运行一段时间t，确保步进电机运行在当前阶梯速度的平稳状态之后再进行下一个阶梯速度的加减速运动，过程中摇杆的按键按下则结束摇杆对步进电机的控制。本发明实现摇杆精确稳定控制步进电机，在步进电机带大负载或高速运行阶段能有效避免抖动，提高摇杆控制步进电机运动稳定性。

技术领域

本发明属于运动控制技术领域，尤其是一种基于摇杆的步进电机阶梯速度控制方法。

背景技术

一般所说的摇杆指设计为街机游戏，飞行模拟类等游戏使用的摇杆，但是由于摇杆简单易用，工业生产生活中也常常用摇杆来实现对一些设备的控制，其中摇杆对步进电机的控制就是一种比较普遍的应用，并且越来越受到人们的关注。摇杆实现对步进电机的控制主要根据摇杆输出模拟量的变化也就是摇杆的倾斜角度的变化来控制步进电机的速度。目前，摇杆对于步进电机的速度控制关系主要有两种，分别是直线关系和曲线关系，在实际使用中，由于手动误差和摇杆的机械误差，步进电机的速度会因为无法及时响应摇杆倾斜角度变化导致步进电机产生丢步现象，特别是步进电机带大负载运行或者工作在高速模式下，直线关系和曲线关系都极易引起步进电机的抖动。因此，为了提高摇杆控制步进电机带大负载和高速工作时的稳定性和控制精度，需要一种新的基于摇杆的步进电机速度控制方法。

发明内容

为了提高摇杆控制步进电机带大负载和高速工作时的稳定性和控制精度，本发明提出了一种可以实现电机带大负载或者工作在高速模式下平稳运行，有效防止抖动和丢步的基于摇杆的步进电机阶梯速度控制方法。

本发明解决其技术问题所采用的技术方案如下：

一种基于摇杆的步进电机阶梯速度控制方法，所述方法包括以下步骤：

1)根据步进电机的矩频特性，对步进电机的加速过程进行规划，从而得出加速度规划表(a₀,a₁,···,a_n-1)，下标0到n-1表示加速度的规划顺序，a表示加速度的值，根据加速度规划表得到对应的速度规划表(v₁,v₂,···,v_n),下标1到n表示速度的规划顺序，v表示速度的大小；

2)根据摇杆倾斜角度的范围，将整个范围分成m-1个角度区间，得到角度区间表([θ₁,θ₂],[θ₂,θ₃],…,[θ_m-1,θ_m])，下标1到m-1表示角度区间从小到大每个区间的边界顺序，θ表示摇杆倾斜角度的大小；根据摇杆倾斜角度区间，从小到大分配对应的目标速度，得出阶梯速度表(V₁,V₂,…,V_m-1)，其中1到m-1表示模拟量对应的速度的顺序，V表示步进电机摇杆倾斜角度对应的目标速度大小；

3)根据单片机得到摇杆的模拟量计算获得当前摇杆的倾斜角度，查角度区间表和阶梯速度表获取当前步进电机的目标阶梯速度；之后根据当前步进电机的所处的运行状态和阶梯速度，结合速度规划表对步进电机进行加减速控制。

进一步，在所述步骤1)中，加速度规划表(a₀,a₁,···,a_n-1)和速度规划表(v₁,v₂,···,v_n)满足“S”型速度规划，加减速过程更加平滑。步进电机每隔一个固定时间T进行一次加减速，其中v_n表示经过n-1次加速后，步进电机对应的速度。