CN111421555A - 一种高精度机器人的多轴同步控制方法 - Google Patents
一种高精度机器人的多轴同步控制方法 Download PDFInfo
- Publication number
- CN111421555A CN111421555A CN202010473140.6A CN202010473140A CN111421555A CN 111421555 A CN111421555 A CN 111421555A CN 202010473140 A CN202010473140 A CN 202010473140A CN 111421555 A CN111421555 A CN 111421555A
- Authority
- CN
- China
- Prior art keywords
- speed
- interface
- interpolation
- module
- curve
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 230000001360 synchronised effect Effects 0.000 title claims abstract description 13
- 238000000034 method Methods 0.000 title claims abstract description 12
- 238000004891 communication Methods 0.000 claims abstract description 7
- 238000012544 monitoring process Methods 0.000 claims abstract description 7
- 230000001133 acceleration Effects 0.000 claims description 18
- 238000012545 processing Methods 0.000 claims description 12
- 230000005540 biological transmission Effects 0.000 claims description 3
- 230000008859 change Effects 0.000 claims description 3
- 238000006073 displacement reaction Methods 0.000 claims description 3
- 230000003993 interaction Effects 0.000 claims description 3
- 238000004804 winding Methods 0.000 abstract description 8
- 239000000835 fiber Substances 0.000 abstract description 3
- 239000002131 composite material Substances 0.000 description 2
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000002708 enhancing effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1651—Programme controls characterised by the control loop acceleration, rate control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Numerical Control (AREA)
Abstract
本发明公开了一种高精度机器人的多轴同步控制方法,在硬件平台中嵌入相互联通的ARM芯片和FPGA芯片,ARM芯片设置接口包括LCD接口、RS‑232接口、JTAG接口、I/O接口、传感器接口和触摸屏接口,FPGA芯片设置接口包括按键接口、指示灯接口和驱动器接口;于硬件平台中通过软件封装译码模块、通信模块、插补模块、速度规划模块和监测模块;通过基于S形速度规划的NURBS插补算法,以ARM芯片和FPGA芯片为基础嵌入模块化的控制软件,具有极佳的控制反应速度,提高了多轴同步控制的精度,保障了纤维缠绕机在对复杂、异型的构件进行缠绕时能持续性得进行高速、高精度的缠绕工作。
Description
技术领域
本发明具体涉及一种高精度机器人的多轴同步控制方法。
背景技术
目前国产高水平缠绕机设备的自动化程度低,缠绕精度差,不能保证制品的高性能要求,随着限位缠绕复合材料制品向着复杂化、异型化的方向发展,对纤维缠绕复合材料的工艺装备技术性能的要求也相应提高,而多轴联动的控制是影响纤维缠绕质量的重要因素。
发明内容
本发明的目的是为了解决以上现有技术的不足,提出了一种高精度机器人的多轴同步控制方法,所述的方法包括如下步骤:
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)的约束条件对插补点的进给速度进行修正,
完成参数曲线的速度规划。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (3)
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所述的一种高精度机器人的多轴同步控制方法,其特征在于,所述的速度规划模块采用S形速度规划算法。
3.根据权利要求1所述的一种高精度机器人的多轴同步控制方法,其特征在于,所述的插补模块采用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)的约束条件对插补点的进给速度进行修正,
完成参数曲线的速度规划。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010473140.6A CN111421555A (zh) | 2020-05-29 | 2020-05-29 | 一种高精度机器人的多轴同步控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010473140.6A CN111421555A (zh) | 2020-05-29 | 2020-05-29 | 一种高精度机器人的多轴同步控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN111421555A true CN111421555A (zh) | 2020-07-17 |
Family
ID=71553295
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010473140.6A Pending CN111421555A (zh) | 2020-05-29 | 2020-05-29 | 一种高精度机器人的多轴同步控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111421555A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112327758A (zh) * | 2020-10-22 | 2021-02-05 | 哈尔滨工程大学 | 基于b样条拟合及分段插补的小线段刀轨局部光顺方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103728923A (zh) * | 2013-12-24 | 2014-04-16 | 嘉兴学院 | 一种高效高平稳的数控系统柔性加减速控制方法 |
CN104281099A (zh) * | 2014-10-28 | 2015-01-14 | 湘潭大学 | 一种考虑加工特性的nurbs直接插补方法及装置 |
CN105785921A (zh) * | 2016-03-25 | 2016-07-20 | 华南理工大学 | 一种工业机器人nurbs曲线插补时的速度规划方法 |
CN107817764A (zh) * | 2017-10-23 | 2018-03-20 | 山东大学 | 一种基于s曲线加减速算法的nurbs曲线双向自适应插补算法 |
CN109062145A (zh) * | 2018-08-13 | 2018-12-21 | 大古智能科技(上海)有限公司 | 基于wifi通信的数控机床运动控制卡 |
-
2020
- 2020-05-29 CN CN202010473140.6A patent/CN111421555A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103728923A (zh) * | 2013-12-24 | 2014-04-16 | 嘉兴学院 | 一种高效高平稳的数控系统柔性加减速控制方法 |
CN104281099A (zh) * | 2014-10-28 | 2015-01-14 | 湘潭大学 | 一种考虑加工特性的nurbs直接插补方法及装置 |
CN105785921A (zh) * | 2016-03-25 | 2016-07-20 | 华南理工大学 | 一种工业机器人nurbs曲线插补时的速度规划方法 |
CN107817764A (zh) * | 2017-10-23 | 2018-03-20 | 山东大学 | 一种基于s曲线加减速算法的nurbs曲线双向自适应插补算法 |
CN109062145A (zh) * | 2018-08-13 | 2018-12-21 | 大古智能科技(上海)有限公司 | 基于wifi通信的数控机床运动控制卡 |
Non-Patent Citations (1)
Title |
---|
李芮秉: "嵌入式多轴联动插补系统控制策略研究", 《中国优秀硕士学位论文全文数据库(工程科技Ⅰ辑)》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112327758A (zh) * | 2020-10-22 | 2021-02-05 | 哈尔滨工程大学 | 基于b样条拟合及分段插补的小线段刀轨局部光顺方法 |
CN112327758B (zh) * | 2020-10-22 | 2021-09-21 | 哈尔滨工程大学 | 基于b样条拟合及分段插补的小线段刀轨局部光顺方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Lyu et al. | Dynamic error of CNC machine tools: a state-of-the-art review | |
CN103699056B (zh) | 高速高精度数控加工的小线段实时平滑过渡插补方法 | |
Wang et al. | A look-ahead and adaptive speed control algorithm for high-speed CNC equipment | |
CN109623166A (zh) | 一种激光切割的拐角处理方法及系统 | |
CN102799146B (zh) | 用于数控设备控制系统的s形加减速控制的速度规划方法 | |
CN108333968B (zh) | 机器人单步运动的轨迹规划方法 | |
CN110968042B (zh) | 一种基于运动卡的数控倒角参数化编程加工方法 | |
US8972040B2 (en) | Control system for a machine tool | |
CN103154839B (zh) | 进给轴反转时的补正方法 | |
CN111421555A (zh) | 一种高精度机器人的多轴同步控制方法 | |
CN102789199A (zh) | 数控系统中多次误差加权叠加的补偿系统 | |
CN110874082A (zh) | 工件拐角的切割路径确定方法、设备和存储介质 | |
CN116483026B (zh) | 多模式多类型非对称s型柔性速度曲线双向快速规划方法 | |
CN109901518B (zh) | 一种恒力约束条件下的数控机床加减速速度规划方法 | |
CN108717288B (zh) | 工具轨迹显示装置 | |
CN114296404A (zh) | 一种计算五轴点胶机加工轨迹速度的方法 | |
CN109773584A (zh) | 机床的进给轴的运行状态显示装置及运行状态显示方法 | |
TWI401553B (zh) | 數位控制裝置之控制方法 | |
CN109894906A (zh) | 一种冗余驱动并联机床死点规避系统及方法 | |
CN101806580A (zh) | 一种用于高精密影像测量仪的运动控制系统和方法 | |
CN103294008B (zh) | 一种数控系统中单通道与多通道的切换控制方法 | |
Yan et al. | NC program evaluator for higher machining productivity | |
CN107664982A (zh) | 一种以平滑切削功率为目标对刀具轨迹进行优化的方法 | |
CN102306006A (zh) | 基于串联数控系统上实现混联控制的数控系统 | |
CN2919317Y (zh) | 缠绕机控制机构 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20200717 |