CN112847373A - 一种机器人轨迹同步控制方法、计算机可读存储介质 - Google Patents
一种机器人轨迹同步控制方法、计算机可读存储介质 Download PDFInfo
- Publication number
- CN112847373A CN112847373A CN202110038697.1A CN202110038697A CN112847373A CN 112847373 A CN112847373 A CN 112847373A CN 202110038697 A CN202110038697 A CN 202110038697A CN 112847373 A CN112847373 A CN 112847373A
- Authority
- CN
- China
- Prior art keywords
- robot
- joint
- pose
- acceleration
- control method
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 36
- 230000001360 synchronised effect Effects 0.000 title claims abstract description 12
- 230000001133 acceleration Effects 0.000 claims abstract description 42
- 230000033001 locomotion Effects 0.000 claims abstract description 18
- 238000013016 damping Methods 0.000 claims abstract description 7
- 238000006243 chemical reaction Methods 0.000 claims abstract description 3
- 239000011159 matrix material Substances 0.000 claims description 18
- 238000004590 computer program Methods 0.000 claims description 10
- 238000004364 calculation method Methods 0.000 claims description 9
- 230000009466 transformation Effects 0.000 claims description 6
- 230000008878 coupling Effects 0.000 claims description 3
- 238000010168 coupling process Methods 0.000 claims description 3
- 238000005859 coupling reaction Methods 0.000 claims description 3
- 230000008030 elimination Effects 0.000 claims description 3
- 238000003379 elimination reaction Methods 0.000 claims description 3
- 230000002441 reversible effect Effects 0.000 claims description 3
- 238000011426 transformation method Methods 0.000 claims description 3
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 claims description 2
- 230000005484 gravity Effects 0.000 claims description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 239000000126 substance Substances 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
- 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
-
- 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
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
Description
技术领域
本发明涉及机器人同步控制技术领域,特别涉及一种机器人轨迹同步控制方法、计算机可读存储介质。
背景技术
是否具有较高的轨迹精度是衡量机器人性能的重要指标之一。机器人的运动有四种类型:关节插补运动、直线插补运动、圆弧插补运动、样条插补运动,以从A点运动到B点为例,除了关节插补运动只需要控制机器人精确运动到终点B,其他三种插补运动还需要精确控制从起点A至终点B之间的运动轨迹(轨迹精度),机器人的轨迹精度受机器人运动学参数的准确性、机器人速度、机器人关节的同步性等因素的影响,而机器人关节的同步性对机器人的轨迹精度的影响最大。
现有机器人各个关节多采用传统三环PID控制方法,调节PID参数使机器人各个关节刚度处于近似水平,从而使机器人各个关节对指令的相应的近似相同,保证机器人的同步性。而当机器人位置发生改变时,机器人各轴的转动惯量改变、摩擦力改变,上述PID参数并不能使得各个关节对指令的响应近似相同,从而无法保证机器人位置改变时的同步性。
即上述三环PID控制方法本质上是独立地对机器人各个关节闭环控制,存在机器人各个关节对指令的跟随不完全相同,有些轴快,有些轴慢的缺陷,导致关节同步性较差,机器人轨迹精度无法保证。
发明内容
本发明的目的是克服上述背景技术中不足,提供一种机器人轨迹同步控制方法、计算机可读存储介质,可在传统的三环PID控制的基础上,根据机器人末端反馈位姿和理论位姿之间的偏差,实时调整机器人各个关节的运动,以保证机器人关节的同步性,从而提高机器人的轨迹精度。
为了达到上述的技术效果,本发明采取以下技术方案:
一种机器人轨迹同步控制方法,包括以下步骤:
步骤3.若通过步骤1和步骤2得到的机器人末端的位姿及关节速度与设定值存在偏差时,引入内环控制回路,控制机器人各个关节按照关节加速度
步骤4.在机器人每个控制插补周期内,根据机器人末端的设定位姿与实际位姿之间的偏差,计算每个关节的关节加速度并作用于机器人的内环控制回路的控制器上,使设定位姿与实际位姿之间的偏差趋于0以实现机器人轨迹同步。
进一步地,所述步骤1具体包括:
步骤1.1.根据机器人各个关节的反馈角度q,采用机器人正运动公式KIN(q)计算机器人末端的反馈位姿X;
步骤1.3.计算期望位姿Xd与反馈位姿X之间的位姿误差e;
进一步地,所述步骤1.1具体包括:
步骤1.1.1.采用标准D-H法建立机器人的运动学模型,得到机器人的D-H参数:d、a、α;
步骤1.1.2.根据坐标变换方法得到机器人末端坐标系{n}在机器人极坐标系下的齐次变换矩阵:
则X可表示为:
进一步地,所述步骤1.2中期望位姿Xd具体计算如下:
其中,
进一步地,所述步骤1.4中采用的二阶***可等效为质量弹簧阻尼模型。
位姿误差e满足如下方程:
其中,Kd和Kp均为6×6的正定矩阵,
进一步地,所述步骤2具体为:
根据机器人正向速度关系知:
将式(10)左右两端同时求导数得:
进一步地,所述步骤3中具体为:
根据拉格朗日动力学方程有:
在引入的内环控制回路中:
联立式(14)、(15)两个等式得:
由于M(q)可逆,故(17)式等价于:
其中,u为变量具体作为机器人的内环控制回路的控制器上的闭环输入;
同时,本发明还公开了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,所述计算机程序被处理器执行时实现上述机器人轨迹同步控制方法的步骤。
本发明与现有技术相比,具有以下的有益效果:
本发明的机器人轨迹同步控制方法在传统的三环PID控制的基础上,可实现根据机器人末端反馈位姿和理论位姿之间的偏差,实时调整机器人各个关节的运动,以保证机器人关节的同步性,从而提高机器人的轨迹精度。
附图说明
图1是本发明的机器人轨迹同步控制原理示意图。
具体实施方式
下面结合本发明的实施例对本发明作进一步的阐述和说明。
实施例:
实施例一:
一种机器人轨迹同步控制方法,本实施例中,具体由内控制回路和外控制环两部分组成,具体的,包括以下步骤:
具体包括:
步骤1.1:如图1所示,根据机器人各个关节的反馈角度q,采用机器人正运动公式KIN(q)计算机器人末端的反馈位姿X,方法如下:
采用标准D-H法建立机器人的运动学模型,得到机器人的D-H参数:d、a、α。根据坐标变换方法得到机器人末端坐标系{n}在机器人极坐标系下的齐次变换矩阵:
则X可表示为:
步骤1.3:计算位姿误差e。
其中,
具体的,位姿误差e满足如下方程:
其中,Kd和Kp均为6×6的正定矩阵。
具体的,根据机器人正向速度关系知:
步骤3.若通过步骤1和步骤2得到的机器人末端的位姿及关节速度与设定值存在偏差时,引入内环控制回路,控制机器人各个关节按照关节加速度进行加减速,以补偿机器人各个关节运动时对其他关节产生的耦合力矩。
具体为,根据拉格朗日动力学方程有:
在引入的内环控制回路中:
联立上述两个等式有:
由于M(q)可逆,故上式等价于:
在实际应用中,通过试验得出,使用传统三环PID控制方法,机器人高速运动时的轨迹精度,其最大值为1.7mm,用本控制方法机器人高速运动时的轨迹精度,其最大值为0.7mm,通过对比可知,本方法将轨迹精度提高了约2.5倍左右。
实施例二
本实施例中公开了一种计算机设备,该计算机设备可以是服务器,该计算机设备包括通过***总线连接的处理器、存储器、网络接口和数据库。其中,该计算机设备的处理器用于提供计算和控制能力。该计算机设备的存储器包括非易失性存储介质、内存储器。该非易失性存储介质存储有操作***、计算机程序和数据库。该内存储器为非易失性存储介质中的操作***和计算机程序的运行提供环境。该计算机设备的数据库用于存储机器人轨迹同步控制方法中涉及到的数据。该计算机设备的网络接口用于与外部的终端通过网络连接通信。该计算机程序被处理器执行时以实现机器人轨迹同步控制方法。
在另一个实施例中,提供了一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,处理器执行计算机程序时实现上述实施例一中机器人轨迹同步控制方法的步骤。为避免重复,这里不再赘述。
在另一个实施例中,提供了一种计算机可读存储介质,其上存储有计算机程序,计算机程序被处理器执行时实现上述实施例一中机器人轨迹同步控制方法的步骤。为避免重复,这里不再赘述。
可以理解的是,以上实施方式仅仅是为了说明本发明的原理而采用的示例性实施方式,然而本发明并不局限于此。对于本领域内的普通技术人员而言,在不脱离本发明的精神和实质的情况下,可以做出各种变型和改进,这些变型和改进也视为本发明的保护范围。
Claims (10)
1.一种机器人轨迹同步控制方法,其特征在于,包括以下步骤:
步骤3.若通过步骤1和步骤2得到的机器人末端的位姿及关节速度与设定值存在偏差时,引入内环控制回路,控制机器人各个关节按照关节加速度q进行加减速,以补偿机器人各个关节运动时对其他关节产生的耦合力矩;
6.根据权利要求5所述的一种机器人轨迹同步控制方法,其特征在于,所述步骤1.4中采用的二阶***可等效为质量弹簧阻尼模型。
10.一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现如权利要求1至9中任一项所述机器人轨迹同步控制方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110038697.1A CN112847373B (zh) | 2021-01-12 | 2021-01-12 | 一种机器人轨迹同步控制方法、计算机可读存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110038697.1A CN112847373B (zh) | 2021-01-12 | 2021-01-12 | 一种机器人轨迹同步控制方法、计算机可读存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112847373A true CN112847373A (zh) | 2021-05-28 |
CN112847373B CN112847373B (zh) | 2022-07-26 |
Family
ID=76003030
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110038697.1A Active CN112847373B (zh) | 2021-01-12 | 2021-01-12 | 一种机器人轨迹同步控制方法、计算机可读存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112847373B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113954070A (zh) * | 2021-10-27 | 2022-01-21 | 苏州艾利特机器人有限公司 | 机械臂运动控制方法、装置、存储介质及电子设备 |
CN114474068A (zh) * | 2022-03-11 | 2022-05-13 | 深圳市牛耳机器人有限公司 | 一种puma构型机器人腕关节奇异规避方法及*** |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20120072150A (ko) * | 2010-12-23 | 2012-07-03 | 한국기계연구원 | 복수 축의 동기화 방식에 기반한 고속 병렬형 로봇의 제어 방법 |
CN108132601A (zh) * | 2017-12-06 | 2018-06-08 | 西北工业大学 | 一种利用机械臂抑制航天器基座姿态干扰的方法 |
CN108638052A (zh) * | 2018-03-29 | 2018-10-12 | 南京航空航天大学 | 一种闭链式多臂机器人柔顺控制方法 |
CN108673495A (zh) * | 2018-04-13 | 2018-10-19 | 南京航空航天大学 | 一种力/位协调的多臂机器人柔顺控制方法 |
CN111037542A (zh) * | 2019-12-31 | 2020-04-21 | 华中科技大学 | 一种逆动力学控制机器人直线加工的轨迹误差补偿方法 |
-
2021
- 2021-01-12 CN CN202110038697.1A patent/CN112847373B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20120072150A (ko) * | 2010-12-23 | 2012-07-03 | 한국기계연구원 | 복수 축의 동기화 방식에 기반한 고속 병렬형 로봇의 제어 방법 |
CN108132601A (zh) * | 2017-12-06 | 2018-06-08 | 西北工业大学 | 一种利用机械臂抑制航天器基座姿态干扰的方法 |
CN108638052A (zh) * | 2018-03-29 | 2018-10-12 | 南京航空航天大学 | 一种闭链式多臂机器人柔顺控制方法 |
CN108673495A (zh) * | 2018-04-13 | 2018-10-19 | 南京航空航天大学 | 一种力/位协调的多臂机器人柔顺控制方法 |
CN111037542A (zh) * | 2019-12-31 | 2020-04-21 | 华中科技大学 | 一种逆动力学控制机器人直线加工的轨迹误差补偿方法 |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113954070A (zh) * | 2021-10-27 | 2022-01-21 | 苏州艾利特机器人有限公司 | 机械臂运动控制方法、装置、存储介质及电子设备 |
CN114474068A (zh) * | 2022-03-11 | 2022-05-13 | 深圳市牛耳机器人有限公司 | 一种puma构型机器人腕关节奇异规避方法及*** |
CN114474068B (zh) * | 2022-03-11 | 2023-10-31 | 深圳市牛耳机器人有限公司 | 一种puma构型机器人腕关节奇异规避方法及*** |
Also Published As
Publication number | Publication date |
---|---|
CN112847373B (zh) | 2022-07-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109159151B (zh) | 一种机械臂空间轨迹跟踪动态补偿方法和*** | |
WO2022007358A1 (zh) | 阻抗控制方法、装置、阻抗控制器和机器人 | |
JP7324932B2 (ja) | 動的計画コントローラ | |
CN108568814B (zh) | 机器人以及机器人的控制方法 | |
CN113681543B (zh) | 一种基于模型预测的机械臂零力控制方法 | |
CN112847373B (zh) | 一种机器人轨迹同步控制方法、计算机可读存储介质 | |
CN106406098B (zh) | 一种机器人***在未知环境下的人机交互控制方法 | |
CN105598968B (zh) | 一种并联机械臂的运动规划与控制方法 | |
CN107627303A (zh) | 一种基于眼在手上结构的视觉伺服***的pd‑smc控制方法 | |
CN110394801B (zh) | 一种机器人的关节控制*** | |
CN112417755A (zh) | 一种主从式手术机器人轨迹预测控制方法 | |
CN109445274B (zh) | 一种柔性空间机械臂振动控制方法及*** | |
CN108189034B (zh) | 一种机器人连续轨迹实现方法 | |
CN107505835A (zh) | 一种控制机械手运动的方法、装置及*** | |
CN109623812B (zh) | 考虑航天器本体姿态运动的机械臂轨迹规划方法 | |
CN111037568A (zh) | 四轴机器人末端负载辨识方法及模块 | |
CN115480583A (zh) | 飞行作业机器人的视觉伺服跟踪与阻抗控制方法 | |
CN114055467B (zh) | 基于五自由度机器人的空间位姿在线仿真*** | |
CN114578697A (zh) | 一种电机驱动机械手的多约束自适应控制方法 | |
CN113219825B (zh) | 一种四足机器人单腿轨迹跟踪控制方法及*** | |
CN112034869B (zh) | 一种无人机变参神经动力学控制器的设计方法及其应用 | |
CN110134135B (zh) | 基于改进mpc-pid的四旋翼飞行器控制方法 | |
WO2022179213A1 (zh) | 仿人机器人的解耦控制方法、装置和仿人机器人 | |
CN110647161A (zh) | 基于状态预测补偿的欠驱动uuv水平面轨迹跟踪控制方法 | |
CN114355771A (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 | ||
CB02 | Change of applicant information | ||
CB02 | Change of applicant information |
Address after: 610000 No. 42, Huatai Road, Chenghua District, Chengdu, Sichuan Applicant after: Chengdu kanop Robot Technology Co.,Ltd. Address before: No.199, Huaguan Road, Longtan Industrial Park, Chenghua District, Chengdu, Sichuan 610000 Applicant before: CHENGDU CRP AUTOMATION CONTROL TECHNOLOGY Co.,Ltd. |
|
GR01 | Patent grant | ||
GR01 | Patent grant |