一种高精度机器人的多轴同步控制方法技术

本发明专利技术公开了一种高精度机器人的多轴同步控制方法，在硬件平台中嵌入相互联通的ARM芯片和FPGA芯片，ARM芯片设置接口包括LCD接口、RS‑232接口、JTAG接口、I/O接口、传感器接口和触摸屏接口，FPGA芯片设置接口包括按键接口、指示灯接口和驱动器接口；于硬件平台中通过软件封装译码模块、通信模块、插补模块、速度规划模块和监测模块；通过基于S形速度规划的NURBS插补算法，以ARM芯片和FPGA芯片为基础嵌入模块化的控制软件，具有极佳的控制反应速度，提高了多轴同步控制的精度，保障了纤维缠绕机在对复杂、异型的构件进行缠绕时能持续性得进行高速、高精度的缠绕工作。

【技术实现步骤摘要】
一种高精度机器人的多轴同步控制方法
本专利技术具体涉及一种高精度机器人的多轴同步控制方法。
技术介绍
目前国产高水平缠绕机设备的自动化程度低，缠绕精度差，不能保证制品的高性能要求，随着限位缠绕复合材料制品向着复杂化、异型化的方向发展，对纤维缠绕复合材料的工艺装备技术性能的要求也相应提高，而多轴联动的控制是影响纤维缠绕质量的重要因素。
技术实现思路
本专利技术的目的是为了解决以上现有技术的不足，提出了一种高精度机器人的多轴同步控制方法，所述的方法包括如下步骤：S1：在硬件平台中嵌入相互联通的ARM芯片和FPGA芯片，ARM芯片设置接口包括LCD接口、RS-232接口、JTAG接口、I/O接口、传感器接口和触摸屏接口，FPGA芯片设置接口包括按键接口、指示灯接口和驱动器接口；S2：于硬件平台中通过软件封装译码模块、通信模块、插补模块、速度规划模块和监测模块；S3：译码模块根据输入的加工程序的语法规则对用户编写的加工零件的描述代码进行语法、语义的检查，并将整段NURBS参数曲线的加工指令全部译码存入缓冲区，由其他模块调用；S4：通信模块通过触摸屏和ARM控制器的数据传输实现人机交互；S5：插补模块从缓冲区读取NURBS参数曲线将参数曲线分段，计算出插补点的参数，将参数信息存入消息队列；S6：速度规划模块调用消息队列的数据，判断线段速度规划模式，根据不同的模式选择对应的加减速控制方案进行加减速规划，同时保证规划处的速度满足约束条件；S7：插补模块调用译码模块存入缓冲区的数据，同时根据速度规划模块规划的速度计算出各轴的位移增量，并将唯一增量换算成脉冲数来驱动电机，完成运动轨迹和加工速度的控制；S8：监测模块始终运行于ARM上，在硬件平台运行时监测故障，发生宜昌市进行任务切换，并将错误码发送至触摸屏进行显示。为了更好地实现多轴同步控制，优选地，所述的速度规划模块采用S形速度规划算法。优选地，所述的插补模块采用NURBS插补算法，NURBS插补算法的流程为：通过NURBS参数曲线的控制顶点、权因子等参数将参数曲线分段，确定插补点，记录插补点参数ui；根据插补点参数计算ui出曲线段两端的最大进给速度；通过当前插补点P(ui)的曲线参数ui、曲率半径Ri、插补周期T等计算出下一个插补点P(ui+1)的参数ui+1；根据式(1-1)、插补周期T和当前插补点P(ui)处的进给速度vi来求出曲率最大的插补点的位置，根据式(1-2)求得NURBS曲线各曲线段的曲率；将NURBS曲线内各插补点处的曲率ki同kr做比较，找出曲线内曲率变化较大的点，在曲率较大点处将曲线分段，并计算并修正各线段的进给速度vi、起始速度vs、终点速度ve、速度规划各阶段长度s(t)；通过对各线段的进给速度vi、起始速度vs、终点速度ve等参数的分析判断，对速度规划类型的分析分类，确定各线段包含的加减速阶段；通过对当前线段加减速类型的判断来确定速度规划算法的速度和加速度方程，进而求得速度规划所需要的各个参数，建立加速链表和减速链表，根据式(1-3)的约束条件对插补点的进给速度进行修正，完成参数曲线的速度规划。有益效果：本专利技术中通过基于S形速度规划的NURBS插补算法，以ARM芯片和FPGA芯片为基础嵌入模块化的控制软件，具有极佳的控制反应速度，提高了多轴同步控制的精度，保障了纤维缠绕机在对复杂、异型的构件进行缠绕时能持续性得进行高速、高精度的缠绕工作。附图说明图1是硬件平台的接口示意图；图2是插补算法的流程示意图；图3是封装软件的分类示意图；具体实施方式为了加深对本专利技术的理解，下面将结合实施例和附图对本专利技术作进一步详述，该实施例仅用于解释本专利技术，并不构成对本专利技术保护范围的限定。如图1-3所示，一种高精度机器人的多轴同步控制方法，所述的方法包括如下步骤：S1：在硬件平台中嵌入相互联通的ARM芯片和FPGA芯片，ARM芯片设置接口包括LCD接口、RS-232接口、JTAG接口、I/O接口、传感器接口和触摸屏接口，FPGA芯片设置接口包括按键接口、指示灯接口和驱动器接口；S2：于硬件平台中通过软件封装译码模块、通信模块、插补模块、速度规划模块和监测模块；S3：译码模块根据输入的加工程序的语法规则对用户编写的加工零件的描述代码进行语法、语义的检查，并将整段NURBS参数曲线的加工指令全部译码存入缓冲区，由其他模块调用；S4：通信模块通过触摸屏和ARM控制器的数据传输实现人机交互；S5：插补模块从缓冲区读取NURBS参数曲线将参数曲线分段，计算出插补点的参数，将参数信息存入消息队列；S6：速度规划模块调用消息队列的数据，判断线段速度规划模式，根据不同的模式选择对应的加减速控制方案进行加减速规划，同时保证规划处的速度满足约束条件；S7：插补模块调用译码模块存入缓冲区的数据，同时根据速度规划模块规划的速度计算出各轴的位移增量，并将唯一增量换算成脉冲数来驱动电机，完成运动轨迹和加工速度的控制；S8：监测模块始终运行于ARM上，在硬件平台运行时监测故障，发生宜昌市进行任务切换，并将错误码发送至触摸屏进行显示。为了更好地实现多轴同步控制，优选地，所述的速度规划模块采用S形速度规划算法。优选地，所述的插补模块采用NURBS插补算法，NURBS插补算法的流程为：通过NURBS参数曲线的控制顶点、权因子等参数将参数曲线分段，确定插补点，记录插补点参数ui；根据插补点参数计算ui出曲线段两端的最大进给速度；通过当前插补点P(ui)的曲线参数ui、曲率半径Ri、插补周期T等计算出下一个插补点P(ui+1)的参数ui+1；根据式(1-1)、插补周期T和当前插补点P(ui)处的进给速度vi来求出曲率最大的插补点的位置，根据式(1-2)求得NURBS曲线各曲线段的曲率；将NURBS曲线内各插补点处的曲率ki同kr做比较，找出曲线内曲率变化较大的点，在曲率较大点处将曲线分段，并计算并修正各线段的进给速度vi、起始速度vs、终点速度ve、速度规划各阶段长度s(t)；通过对各线段的进给速度vi、起始速度vs、终点速度ve等参数的分析判断，对速度规划类型的分析分类，确定各线段包含的加减速阶段；通过对当前线段加减速类型的判断来确定速度规划算法的速度和加速度方程，进而求得速度规划所需要的各个参数，建立加速链表和减速链表，根据式(1-3)的约束条件对插补点的进给速度进行修正，完成参数曲线的速度规划。以上所述仅为本专利技术的较佳实施例而已，并不用以限制本专利技术，凡在本专利技术的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本专利技术的保护范围之内。本文档来自技高网...

【技术保护点】
1.一种高精度机器人的多轴同步控制方法，其特征在于，所述的方法包括如下步骤：/nS1：在硬件平台中嵌入相互联通的ARM芯片和FPGA芯片，ARM芯片设置接口包括LCD接口、RS-232接口、JTAG接口、I/O接口、传感器接口和触摸屏接口，FPGA芯片设置接口包括按键接口、指示灯接口和驱动器接口；/nS2：于硬件平台中通过软件封装译码模块、通信模块、插补模块、速度规划模块和监测模块；/nS3：译码模块根据输入的加工程序的语法规则对用户编写的加工零件的描述代码进行语法、语义的检查，并将整段NURBS参数曲线的加工指令全部译码存入缓冲区，由其他模块调用；/nS4：通信模块通过触摸屏和ARM控制器的数据传输实现人机交互；/nS5：插补模块从缓冲区读取NURBS参数曲线将参数曲线分段，计算出插补点的参数，将参数信息存入消息队列；/nS6：速度规划模块调用消息队列的数据，判断线段速度规划模式，根据不同的模式选择对应的加减速控制方案进行加减速规划，同时保证规划处的速度满足约束条件；/nS7：插补模块调用译码模块存入缓冲区的数据，同时根据速度规划模块规划的速度计算出各轴的位移增量，并将唯一增量换算成脉冲数来驱动电机，完成运动轨迹和加工速度的控制；/nS8：监测模块始终运行于ARM上，在硬件平台运行时监测故障，发生宜昌市进行任务切换，并将错误码发送至触摸屏进行显示。/n...

【技术特征摘要】
1.一种高精度机器人的多轴同步控制方法，其特征在于，所述的方法包括如下步骤：
S1：在硬件平台中嵌入相互联通的ARM芯片和FPGA芯片，ARM芯片设置接口包括LCD接口、RS-232接口、JTAG接口、I/O接口、传感器接口和触摸屏接口，FPGA芯片设置接口包括按键接口、指示灯接口和驱动器接口；
S2：于硬件平台中通过软件封装译码模块、通信模块、插补模块、速度规划模块和监测模块；
S3：译码模块根据输入的加工程序的语法规则对用户编写的加工零件的描述代码进行语法、语义的检查，并将整段NURBS参数曲线的加工指令全部译码存入缓冲区，由其他模块调用；
S4：通信模块通过触摸屏和ARM控制器的数据传输实现人机交互；
S5：插补模块从缓冲区读取NURBS参数曲线将参数曲线分段，计算出插补点的参数，将参数信息存入消息队列；
S6：速度规划模块调用消息队列的数据，判断线段速度规划模式，根据不同的模式选择对应的加减速控制方案进行加减速规划，同时保证规划处的速度满足约束条件；
S7：插补模块调用译码模块存入缓冲区的数据，同时根据速度规划模块规划的速度计算出各轴的位移增量，并将唯一增量换算成脉冲数来驱动电机，完成运动轨迹和加工速度的控制；
S8：监测模块始终运行于ARM上，在硬件平台运行时监测故障，发生宜昌市进行任务切换，并将错误码发送至触摸屏进行显示。


2.根据权利要求1所述的一种高精度机器人的多轴同步控制方法...

【专利技术属性】
技术研发人员：祝龙云，
申请(专利权)人：镇江奥立特机械制造有限公司，
类型：发明
国别省市：江苏;32