多轴同步运动控制方法、装置及计算机可读存储介质制造方法及图纸

本发明专利技术提供了一种多轴同步运动控制方法、装置及计算机可读存储介质，其方法包括步骤：获取在当前时间片内第一丝杆的第一位移和第二丝杆的第二位移，第一丝杆和第二丝杆平行设置并用于沿同一方向共同运送物体；比较第一位移和第二位移的大小，计算第一位移和第二位移的位移差；若第一位移小于第二位移，根据位移差控制第一丝杆的第一移动速度大于第二丝杆的第二移动速度；若第二位移小于第一位移，根据位移差控制第二丝杆的第二移动速度大于第一丝杆的第一移动速度。本发明专利技术可实现减少第一丝杆和第二丝杆的位移误差，以及提高丝杆和导轨等设备的使用寿命。轨等设备的使用寿命。轨等设备的使用寿命。

【技术实现步骤摘要】
多轴同步运动控制方法、装置及计算机可读存储介质


[0001]本专利技术涉及影像测量
，尤其涉及多轴同步运动控制方法、装置及计算机可读存储介质。

技术介绍

[0002]在现代大型装备生产制造过程中，高精度、高稳定度和高速的要求，已经是设备竞争的关键因素之一。由于大型装备的重量重、体积大等特殊原因，使其利用单轴的托举系统无法完成移动需求，为了满足该类装备的移动，在机械结构上采用了主动双轴设计，利用双轴丝杆带动移动臂烟导轨移动，从而使该移动臂带动装备移动。
[0003]机械双轴的导轨及丝杆，因各种情况，在制造过程中，不可避免的会产生精度偏差，致使在伺服电机相同数量脉冲下，移动距离也不相等。轻者会使运送的物体产生位置和角度偏差，影响后续的处理；重者会造成丝杆和导轨等设备的损坏。

技术实现思路

[0004]本专利技术的目的在于提供一种多轴同步运动控制方法、装置及计算机可读存储介质，以解决上述技术问题。
[0005]为了达到上述目的，本专利技术的第一方面提供了一种多轴同步运动控制方法，所述方法包括：
[0006]获取在当前时间片内第一丝杆的第一位移和第二丝杆的第二位移，所述第一丝杆和所述第二丝杆平行设置并用于沿同一方向共同运送物体；
[0007]比较所述第一位移和所述第二位移的大小，计算所述第一位移和所述第二位移的位移差；
[0008]若所述第一位移小于所述所述第二位移，根据所述位移差控制所述第一丝杆的第一移动速度大于所述第二丝杆的第二移动速度；
[0009]若所述第二位移小于所述所述第一位移，根据所述位移差控制所述第二丝杆的所述第二移动速度大于所述第一丝杆的第一移动速度。
[0010]在一些实施例中，所述获取在当前时间片内第一丝杆的第一位移和第二丝杆的第二位移进一步包括：
[0011]获取在当前时间片内第一光栅尺检测所述第一丝杆的第一移动速度和第二光栅尺检测所述第二丝杆的第二移动速度；
[0012]根据所述第一移动速度计算所述当前时间片内的所述第一位移；
[0013]根据所述第二移动速度计算所述当前时间片内的所述第二位移。
[0014]在一些实施例中，所述方法均于同一所述当前时间片内执行。
[0015]在一些实施例中，所述当前时间片小于或等于50ms。
[0016]本专利技术的第二方面提供了一种多轴同步运动控制方法，所述方法包括：
[0017]第一光栅尺在当前时间片内检测所述第一丝杆的第一移动速度并发送所述第一
移动速度至控制模块：
[0018]第二光栅尺在当前时间片内检测所述第二丝杆的第二移动速度并发送所述第二移动速度至控制模块；
[0019]所述控制模块根据所述第一移动速度和所述第二移动速度分别计算所第一丝杆的第一位移和所述第二丝杆的第二位移；
[0020]所述控制模块比较所述第一位移和所述第二位移的大小，计算所述第一位移和所述第二位移的位移差；
[0021]若所述第一位移小于所述所述第二位移，所述控制模块根据所述位移差控制所述第一丝杆的第一移动速度大于所述第二丝杆的第二移动速度以使在下一时间片所述第一位移和所述第二位移同步；
[0022]若所述第二位移小于所述所述第一位移，所述控制模块根据所述位移差控制所述第二丝杆的所述第二移动速度大于所述第一丝杆的第一移动速度以使在下一时间片所述第一位移和所述第二位移同步。
[0023]在一些实施例中，所述控制模块包括第一DSP运算器、第二DSP运算器、差值比较器、第一速度控制模块、第二速度控制模块、第一脉冲输出模块和第二脉冲输出模块，所述第一DSP运算器与所述第一光栅尺连接，所述第二DSP运算器与所述第二光栅尺连接，所述第一DSP运算器、所述第二DSP运算器、所述第一速度控制模块和所述第二速度控制模块均与所述差值比较器连接，所述第一脉冲输出模块连接所述第一速度控制模块和所述第一丝杆，所述第二脉冲输出模块连接所述第二速度控制模块和所述第二丝杆，所述方法进一步包括：
[0024]所述第一光栅尺在所述当前时间片内检测所述第一丝杆的第一移动速度并发送所述第一移动速度至所述第一DSP运算器；
[0025]所述第二光栅尺在所述当前时间片内检测所述第二丝杆的第二移动速度并发送所述第二移动速度至所述第二DSP运算器；
[0026]所述第一DSP运算器根据所述第一移动速度计算所第一丝杆的所述第一位移；
[0027]所述第二DSP运算器根据所述第二移动速度计算所第二丝杆的所述第二位移；
[0028]所述差值比较器比较所述第一位移和所述第二位移的大小，计算所述第一位移和所述第二位移的位移差；
[0029]若所述第一位移小于所述所述第二位移，所述第一速度控制模块根据所述位移差发送第一脉冲至所述第一脉冲输出模块，所述第一脉冲输出模块控制所述第一丝杆以所述第一移动速度移动，所述第二速度控制模块根据所述位移差发送第二脉冲至所述第二脉冲输出模块，所述第二脉冲输出模块控制所述第二丝杆以所述第二移动速度移动，所述第一脉冲的发生频率大于所述第二脉冲的发生频率以使所述第一移动速度大于所述第二移动速度；
[0030]若所述第二位移小于所述所述第一位移，所述第一速度控制模块根据所述位移差发送第一脉冲至所述第一脉冲输出模块，所述第一脉冲输出模块控制所述第一丝杆以所述第一移动速度移动，所述第二速度控制模块根据所述位移差发送第二脉冲至所述第二脉冲输出模块，所述第二脉冲输出模块控制所述第二丝杆以所述第二移动速度移动，所述第二脉冲的发生频率大于所述第一脉冲的发生频率以使所述第二移动速度大于所述第一移动
速度。
[0031]本专利技术的第三方面提供了一种多轴同步运动控制装置，包括控制模块、第一丝杆、第二丝杆、第一光栅尺和第二光栅尺，所述第一丝杆、第二丝杆、第一光栅尺和第二光栅尺均与所述控制模块连接，所述第一光栅尺用于检测所述第一丝杆的第一移动速度并反馈至所述控制模块，所述第二光栅尺用于检测所述第二丝杆的第二移动速度并反馈至所述控制模块，所述控制模块执行上述的多轴同步运动控制方法。
[0032]在一些实施例中，所述控制模块包括第一DSP运算器、第二DSP运算器、差值比较器、第一速度控制模块、第二速度控制模块、第一脉冲输出模块和第二脉冲输出模块，所述第一DSP运算器与所述第一光栅尺连接，所述第二DSP运算器与所述第二光栅尺连接，所述第一DSP运算器、所述第二DSP运算器、所述第一速度控制模块和所述第二速度控制模块均与所述差值比较器连接，所述第一脉冲输出模块连接所述第一速度控制模块和所述第一丝杆，所述第二脉冲输出模块连接所述第二速度控制模块和所述第二丝杆，
[0033]所述第一光栅尺用于在所述当前时间片内检测所述第一丝杆的第一移动速度并发送所述第一移动速度至所述第一DSP运算器；
[0034]所述第二光栅尺用于在所述当前时间片内检测所述第二丝杆的第二移动速度并发送所述第二移动速度至所述第二DSP运算器；本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种多轴同步运动控制方法，其特征在于，所述方法包括：获取在当前时间片内第一丝杆的第一位移和第二丝杆的第二位移，所述第一丝杆和所述第二丝杆平行设置并用于沿同一方向共同运送物体；比较所述第一位移和所述第二位移的大小，计算所述第一位移和所述第二位移的位移差；若所述第一位移小于所述所述第二位移，根据所述位移差控制所述第一丝杆的第一移动速度大于所述第二丝杆的第二移动速度；若所述第二位移小于所述所述第一位移，根据所述位移差控制所述第二丝杆的所述第二移动速度大于所述第一丝杆的第一移动速度。2.根据权利要求1所述的多轴同步运动控制方法，其特征在于，所述获取在当前时间片内第一丝杆的第一位移和第二丝杆的第二位移进一步包括：获取在当前时间片内第一光栅尺检测所述第一丝杆的第一移动速度和第二光栅尺检测所述第二丝杆的第二移动速度；根据所述第一移动速度计算所述当前时间片内的所述第一位移；根据所述第二移动速度计算所述当前时间片内的所述第二位移。3.根据权利要求1所述的多轴同步运动控制方法，其特征在于，所述方法均于同一所述当前时间片内执行。4.根据权利要求1所述的多轴同步运动控制方法，其特征在于，所述当前时间片小于或等于50ms。5.一种多轴同步运动控制方法，其特征在于，所述方法包括：第一光栅尺在当前时间片内检测所述第一丝杆的第一移动速度并发送所述第一移动速度至控制模块：第二光栅尺在当前时间片内检测所述第二丝杆的第二移动速度并发送所述第二移动速度至控制模块；所述控制模块根据所述第一移动速度和所述第二移动速度分别计算所第一丝杆的第一位移和所述第二丝杆的第二位移；所述控制模块比较所述第一位移和所述第二位移的大小，计算所述第一位移和所述第二位移的位移差；若所述第一位移小于所述所述第二位移，所述控制模块根据所述位移差控制所述第一丝杆的第一移动速度大于所述第二丝杆的第二移动速度以使在下一时间片所述第一位移和所述第二位移同步；若所述第二位移小于所述所述第一位移，所述控制模块根据所述位移差控制所述第二丝杆的所述第二移动速度大于所述第一丝杆的第一移动速度以使在下一时间片所述第一位移和所述第二位移同步。6.根据权利要求5所述的多轴同步运动控制方法，其特征在于，所述控制模块包括第一DSP运算器、第二DSP运算器、差值比较器、第一速度控制模块、第二速度控制模块、第一脉冲输出模块和第二脉冲输出模块，所述第一DSP运算器与所述第一光栅尺连接，所述第二DSP运算器与所述第二光栅尺连接，所述第一DSP运算器、所述第二DSP运算器、所述第一速度控制模块和所述第二速度控制模块均与所述差值比较器连接，所述第一脉冲输出模块连接所
述第一速度控制模块和所述第一丝杆，所述第二脉冲输出模块连接所述第二速度控制模块和所述第二丝杆，所述方法进一步包括：所述第一光栅尺在所述当前时间片内检测所述第一丝杆的第一移动速度并发送所述第一移动速度至所述第一DSP运算器；所述第二光栅尺在所述当前时间片内检测所述第二丝杆的第二移动速度并发送所述第二移动速度至所述第二DSP运算器；所述第一DSP运算器根据所述第一移动速度计算所第一丝杆的所述第一位移；所述第二DSP运算器根据所述第二移动速度计算所第二丝杆的所述第二位移；所述差值比较器比较所述第一位移和所述第二位移的大小，计算所述第一位移和所述第二位移的位移差；若所述第一位移小于所述所述第二位移，所述第一速度控制模块根据所述位移差发送第一脉冲至所述第一脉冲输出模块，所述第一脉冲输出模块控制所述第一丝杆以所述第一移动速度移动，所述第二速度控制模块根据所述位移差发送第二脉冲至所述第二脉冲输出模块，所述第二脉冲输出模块控制所述第二丝杆以所述第二移动速度移动，所述第一脉冲的发生频率大于所述第二脉冲的发...

【专利技术属性】
技术研发人员：段存立，赵常谷，
申请(专利权)人：东莞市兆丰精密仪器有限公司，
类型：发明
国别省市：