主权项 |
一种基于步进电机的运动控制器速度控制方法,其特征在于:所述方法包括以下步骤:(1)依照步进电机的矩频特性,步进电机的升降频规律应是“先快后慢”,按照此规律再结合最佳升频要求,建立速度表;根据步进电机的加减速存在惯性,每一次的频率变化都需要电机连续运行一定的步数,使得步进电机适应当前的频率,结合频率表以及步进电机的运动特性得到阶梯步长表;(2)读取n个坐标点(x<sub>1</sub>,y<sub>1</sub>),(x<sub>2</sub>,y<sub>2</sub>),...,(x<sub>n</sub>,y<sub>n</sub>),已知当前点坐标为(x<sub>0</sub>,y<sub>0</sub>),对应的两轴方向上的分速度为(v<sub>0x</sub>,v<sub>0y</sub>),当前速度方向与x轴的夹角为θ<sub>0</sub>,终点(x<sub>n</sub>,y<sub>n</sub>)速度为(v<sub>nx</sub>,v<sub>ny</sub>),通过相邻两点的坐标关系计算得到n条线段与x轴的夹角为θ<sub>1</sub>,...,θ<sub>n</sub>,根据步进电机速度的特性以及机械结构的特性确定两轴方向上的最大突变速度Δv<sub>x</sub>、Δv<sub>y</sub>;(3)在满足两轴方向上的速度变化不超过Δv<sub>x</sub>、Δv<sub>y</sub>的条件,再结合步骤(1)的速度表,当电机运动到点(x<sub>1</sub>,y<sub>1</sub>)但尚未发生速度突变时的速度为(v'<sub>0x</sub>,v'<sub>0y</sub>),突变后的速度为(v<sub>1x</sub>,v<sub>1y</sub>),以此类推,计算得到各个坐标的速度(v<sub>1x</sub>,v<sub>1y</sub>),...,(v<sub>n‑1x</sub>,v<sub>n‑1y</sub>);(4)根据步骤(1)中的阶梯步长表,采用倒推法,重新确定每一个坐标点的速度<img file="FDA0000686012890000011.GIF" wi="473" he="86" />已知终点速度(v<sub>nx</sub>,v<sub>ny</sub>),比较(v<sub>nx</sub>,v<sub>ny</sub>)与<img file="FDA0000686012890000012.GIF" wi="224" he="88" />合速度的大小关系,若前者小于后者,根据阶梯步长表进行电机的加速,得到点(x<sub>n‑1</sub>,y<sub>n‑1</sub>)的速度为<img file="FDA0000686012890000013.GIF" wi="258" he="85" />比较<img file="FDA0000686012890000014.GIF" wi="222" he="84" />与<img file="FDA0000686012890000015.GIF" wi="222" he="85" />合速度的大小关系,若前者大于后者,则将<img file="FDA0000686012890000016.GIF" wi="220" he="85" />作为点(x<sub>n‑1</sub>,y<sub>n‑1</sub>)的真实速度,否则就选择<img file="FDA0000686012890000017.GIF" wi="255" he="86" />以此类推,得到所有点的速度(V<sub>0x</sub>,V<sub>0y</sub>),...,(V<sub>nx</sub>,V<sub>ny</sub>),根据阶梯步长表实现速度控制。 |