申请/专利权人：浙江生波智能装备有限公司

申请日：2021-10-23

公开（公告）日：2024-03-22

公开（公告）号：CN114003000B

主分类号：G05B19/41

分类号：G05B19/41

优先权：

专利状态码：有效-授权

法律状态：2024.03.22#授权;2022.02.22#实质审查的生效;2022.02.01#公开

摘要：本发明提出一种三轴移动机构多点移动控制方法，应用于需要走直线插补三轴联动测量设备或其它需用到三轴直线插补的控制场合，其包括以下步骤：S1，获取待作业的各坐标点数据；S2，设定坐标点间的移动速度为V；S3，根据坐标点数据和移动速度V来计算由当前坐标点E1移至下一从标点E2过程中各轴伺服电机的转速，并控制各轴伺服电机按对应转速执行；S4，重复上述步骤S3依序遍历各坐标点。本发明性能稳定、处理效率高、精确度高等，与传统数控或者具备插补功能的PLC相比，大大降低设备成本，且无需编写G代码实现插补控制，降低对操作人员的要求，且提高测量效率，并且不会产生人为误差，对测量产品的大小没有限制。

主权项：1.一种三轴移动机构多点移动控制方法，其特征在于，包括以下步骤：S1，获取待作业的各坐标点数据；S2，设定坐标点间的移动速度为V；S3，根据坐标点数据和移动速度V来计算由当前坐标点E1X1,Y1,Z1移至下一坐标点E2X2,Y2,Z2过程中各轴伺服电机的转速，并控制各轴伺服电机按对应转速执行；该转速的计算包含以下步骤：S31，根据空间直角坐标系的两点距离公式计算当前坐标点E1至下一坐标点E2的距离D，S32，计算当前坐标点E1运动至下一坐标点E2的时间t，t＝DV；S34，计算各轴伺服电机的运行速度Vx、Vy和Vz；Vx＝|X2-X1|t，Vy＝|Y2-Y1|t，Vz＝|Z2-Z1|t；S35，计算各轴伺服电机的运行方向；当X2-X10时，X轴伺服电机正向运行；当X2-X10时，X轴伺服电机反向运行；X2-X1＝0时，X轴伺服电机待机；当Y2-Y10时，Y轴伺服电机正向运行；当Y2-Y10时，Y轴伺服电机反向运行；Y2-Y1＝0时，Y轴伺服电机待机；当Z2-Z10时，Z轴伺服电机正向运行；当Z2-Z10时，Z轴伺服电机反向运行；Z2-Z1＝0时，Z轴伺服电机待机；S36，由上述计算所得的运行速度和运行方向控制各轴伺服电机，实现由当前坐标点E1运动向下一坐标点E2的位移；S4，重复上述步骤S3依序遍历各坐标点；在当前坐标点上的操作完毕后先进行Z轴向的复位，X轴和Y轴向坐标不变，即由当前坐标点E1X1,Y1,Z1复位至坐标点E10X1,Y1,Z0，Z0设定为小于任意坐标点的Z轴坐标值；再由坐标点E10X1,Y1,Z0计算至下一从标点E2X2,Y2,Z2过程中各轴伺服电机的转速；其中包含以下步骤：S311，根据空间直角坐标系的两点距离公式计算当前坐标点E10至下一坐标点E2的距离D，S321，计算当前坐标点E1运动至下一坐标点E2的时间t，t＝DV；S341，计算各轴伺服电机的运行速度Vx、Vy和Vz；Vx＝|X2-X1|t，Vy＝|Y2-Y1|t，Vz＝|Z2-Z0|t；S351，计算各轴伺服电机的运行方向；当X2-X10时，X轴伺服电机正向运行；当X2-X10时，X轴伺服电机反向运行；X2-X1＝0时，X轴伺服电机待机；当Y2-Y10时，Y轴伺服电机正向运行；当Y2-Y10时，Y轴伺服电机反向运行；Y2-Y1＝0时，Y轴伺服电机待机；Z轴伺服电机正向运行；将Z0设置为零，即在当前坐标点上的操作完毕后先进行Z轴向归零，X轴和Y轴向坐标不变，再由E10X1,Y1,0计算至下一从标点E2X2,Y2,Z2过程中各轴伺服电机的转速；其中包含以下步骤：S312，根据空间直角坐标系的两点距离公式计算当前坐标点E10至下一坐标点E2的距离D，S322，计算当前坐标点E1运动至下一坐标点E2的时间t，t＝DV；S342，计算各轴伺服电机的运行速度Vx、Vy和Vz；Vx＝|X2-X1|t，Vy＝|Y2-Y1|t，Vz＝|Z2|t；S352，计算各轴伺服电机的运行方向；当X2-X10时，X轴伺服电机正向运行；当X2-X10时，X轴伺服电机反向运行；X2-X1＝0时，X轴伺服电机待机；当Y2-Y10时，Y轴伺服电机正向运行；当Y2-Y10时，Y轴伺服电机反向运行；Y2-Y1＝0时，Y轴伺服电机待机；Z轴伺服电机正向运行。

全文数据：

权利要求：

百度查询： 浙江生波智能装备有限公司 三轴移动机构多点移动控制方法

免责声明
1、本报告根据公开、合法渠道获得相关数据和信息，力求客观、公正，但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解，仅供参考使用，不能作为本公司承担任何法律责任的依据或者凭证。

阅读全文 双屏查看 官方信息 专利公告 收藏专利 下载PDF 下载WORD