CN112428273A - 一种考虑机械臂物理约束和模型未知的控制方法及*** - Google Patents
一种考虑机械臂物理约束和模型未知的控制方法及*** Download PDFInfo
- Publication number
- CN112428273A CN112428273A CN202011278491.8A CN202011278491A CN112428273A CN 112428273 A CN112428273 A CN 112428273A CN 202011278491 A CN202011278491 A CN 202011278491A CN 112428273 A CN112428273 A CN 112428273A
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- joint
- parameters
- expected
- module
- 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
- 238000000034 method Methods 0.000 title claims abstract description 62
- 239000011159 matrix material Substances 0.000 claims abstract description 22
- 239000012636 effector Substances 0.000 claims abstract description 19
- 239000013598 vector Substances 0.000 claims description 12
- 230000001133 acceleration Effects 0.000 claims description 11
- 238000013528 artificial neural network Methods 0.000 claims description 6
- 125000004432 carbon atom Chemical group C* 0.000 claims description 3
- 230000007704 transition Effects 0.000 description 4
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 241001123248 Arma Species 0.000 description 1
- 239000002904 solvent 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
-
- 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/1607—Calculation of inertia, jacobian matrixes and inverses
-
- 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/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种考虑机械臂物理约束和模型未知的控制方法及***,该方法包括:预设机械臂的初始姿态和期望参数;根据传感器读取机械臂当前关节参数和末端执行器信息;以期望参数和初始姿态为约束,基于雅可比矩阵估计方法和二次规划方法构建期望位置方程组;根据期望位置方程组、初始姿态、期望参数、当前关节参数和末端执行器信息得到关节角度运动数据;将关节角度运动数据发送至机械臂控制器,控制机械臂运动。该***包括:参数预设模块、信息读取模块、方程组构建模块、求解模块和控制模块。通过使用本发明,能够控制机械臂完成跟踪控制任务,同时还具有关节极限躲避的功能。本发明作为一种考虑机械臂物理约束和模型未知的控制方法及***,可广泛应用于机械控制领域。
Description
技术领域
本发明属于机械控制领域,尤其涉及一种考虑机械臂物理约束和模型未知的控制方法及***。
背景技术
现有的机械臂控制方法是采用正向运动学模型为基础,求其中解获得机械臂每个时刻的数据并根据机械臂每个时刻的数据控制机械臂运动,雅可比矩阵由机械臂的正向运动学模型确定,然而即使是同一批次、型号的机械臂,雅可比矩阵也可能由于机械臂的组装差异而各自不同,导致在应用该算法时产生误差,影响解的精确度,其次,机械臂的型号繁多,有些机械臂的正向运动学模型难以测算,导致该方法的可移植性不强。
发明内容
为了解决上述技术问题,本发明的目的是提供一种考虑机械臂物理约束和模型未知的控制方法及***,使机械臂的末端执行器能够按照预设的路径运动,并且使机械臂在运动过程中可以躲避自己的关节角度、速度极限,良好地完成任务。
本发明所采用的第一技术方案是:一种考虑机械臂物理约束和模型未知的控制方法,包括以下步骤:
预设机械臂的初始姿态和期望参数;
根据传感器读取机械臂当前关节参数和末端执行器信息;
以期望参数和初始姿态为约束,基于雅可比矩阵估计方法和二次规划方法构建期望位置方程组;
根据期望位置方程组、初始姿态、期望参数、当前关节参数和末端执行器信息得到关节角度运动数据;
将关节角度运动数据发送至机械臂控制器,控制机械臂运动。
进一步,所述期望参数包括期望轨迹、关节速度极限和角度极限,所述当前关节参数包括机械臂关节角度、机械臂关节速度和机械臂关节加速度,所述末端执行器信息包括机械臂末端实际加速度和机械臂末端实际速度。
进一步,所述以期望参数和初始姿态为约束,基于雅可比矩阵估计方法和二次规划构建期望位置方程组这一步骤,其具体包括:
基于二次规划方法得到机械臂逆向运动方程;
通过原对偶神经网络对机械臂逆向运动方程进行处理,得到微分方程;
基于雅可比矩阵估计方法得到位置方程;
根据微分方程和位置方程得到期望位置方程组。
进一步,所述微分方程如下:
上式中,u(t)是待求解的变量,m是机械臂的末端的任务空间的维度,n是机械臂的自由度,γ是原对偶神经网络的收敛率参数,P(·)是投影函数,M(t)是矩阵,q(t)是向量。
进一步,所述位置方程如下:
进一步,所述得到关节角度运动数据还包括根据关节速度极限和角度极限验证关节角度运动数据是否在极限范围内。
进一步,所述关节角度运动数据包括关节在某个时刻所应处的角度信息和关节速度信息。
本发明所采用的第二技术方案是:一种考虑机械臂物理约束和模型未知的控制***,包括以下模块:
参数预设模块,用于预设机械臂的初始姿态和期望参数;
信息读取模块,用于根据传感器读取机械臂当前关节参数和末端执行器信息;
方程组构建模块,用于以期望参数和初始姿态为约束,基于雅可比矩阵估计方法和二次规划方法构建期望位置方程组;
求解模块,用于根据期望位置方程组、初始姿态、期望参数、当前关节参数和末端执行器信息得到关节角度运动数据;
控制模块,用于将关节角度运动数据发送至机械臂控制器,控制机械臂运动。
本发明方法及***的有益效果是:在不使用机械臂的先验的正向运动学模型的情况下,能够控制机械臂完成跟踪控制任务,同时还具有关节极限躲避的功能,提高解的精确度且使得该方法可移植性强。
附图说明
图1是本发明一种考虑机械臂物理约束和模型未知的控制方法的步骤流程图;
图2是本发明一种考虑机械臂物理约束和模型未知的控制***的结构框图;
图3是本发明具体实施例输入初始姿态后的机械臂状态图。
具体实施方式
下面结合附图和具体实施例对本发明做进一步的详细说明。对于以下实施例中的步骤编号,其仅为了便于阐述说明而设置,对步骤之间的顺序不做任何限定,实施例中的各步骤的执行顺序均可根据本领域技术人员的理解来进行适应性调整。
如图1所示,本发明提供了一种考虑机械臂物理约束和模型未知的控制方法,该方法包括以下步骤:
S1、预设机械臂的初始姿态和期望参数;
具体地,设置机械臂的初始姿态为:[-1.596;4.612;1.474;-2.498;2.011;-0.792],每个值从左到右依次表示机械臂从基座到末端的每个关节的角度,单位为rad,将关节角度发送到机械臂的控制器,机械臂将运动到该位置,此时机械臂的状态如图3。
另外,定义机械臂末端在三维空间中的期望轨迹:
x=x0+r·sin(2πt/T)
z=z0
其中,r=0.06m,t表示当前时刻,T表示轨迹跟踪任务的总时长,T=10。x0、y0和z0分别表示机械臂末端的初始位置。
S2、根据传感器读取机械臂当前关节参数和末端执行器信息;
S3、以期望参数和初始姿态为约束,基于雅可比矩阵估计方法和二次规划方法构建期望位置方程组;
具体地,方程组为:
S4、根据期望位置方程组、初始姿态、期望参数、当前关节参数和末端执行器信息得到关节角度运动数据;
S5、将关节角度运动数据发送至机械臂控制器,控制机械臂运动。
具体地,将u(t)的数值通过SendJointAngle方法发送到机械臂,即可让机械臂按照求解出来的在t时刻的期望关节角度进行运动。
进一步作为本方法的优选实施例,所述期望参数包括期望轨迹、关节速度极限和角度极限,所述当前关节参数包括机械臂关节角度、机械臂关节速度和机械臂关节加速度,所述末端执行器信息包括机械臂末端实际加速度和机械臂末端实际速度。
进一步作为本方法的优选实施例,所述以期望参数和初始姿态为约束,基于雅可比矩阵估计方法和二次规划构建期望位置方程组这一步骤,其具体包括:
基于二次规划方法得到机械臂逆向运动方程;
具体地,首先使用二次规划方法来求解机械臂的逆向运动学问题:
约束条件为:
J(t)x(t)=b(t)
ξ-≤x(t)≤ξ+
其中,x(t)是待实时求解的决策变量。是机械臂的关节的角速度,n 是机械臂的自由度。系数矩阵W是行数和列数都为n的单位矩阵。系数向量c=l(θ(t)-θm),其中θm是每个关节的可动角度的中间位置,θ(t)是当前时刻t的关节角度,l是一个调节关节可动范围的参数,默认为1。b(t)是机械臂的末端执行器在任务空间的期望轨迹,是一个向量,并且是时间的函数。
ξ-和ξ+都是n维向量,分别表示机械臂的关节的物理极限。假设机械臂的关节具有速度极限和角度极限:
θ-≤θ≤θ+
则这两个约束可以通过关节极限转换统一化为一条双端约束:
通过原对偶神经网络对机械臂逆向运动方程进行处理,得到微分方程;
基于雅可比矩阵估计方法得到位置方程;
根据微分方程和位置方程得到期望位置方程组。
进一步作为本方法优选实施例,所述微分方程如下:
上式中,u(t)是待求解的变量,m是机械臂的末端的任务空间的维度,n是机械臂的自由度,γ是原对偶神经网络的收敛率参数,P(·)是投影函数,M(t)是矩阵,q(t)是向量。
另外,投影函数P(·)、矩阵M(t)和向量q(t)的定义如下:
θ-≤θ≤θ+
则这两个约束可以通过关节极限转换统一化为一条双端约束:
进一步作为本方法优选实施例,所述位置方程如下:
进一步作为本方法优选实施例,所述得到关节角度运动数据还包括根据关节速度极限和角度极限验证关节角度运动数据是否在极限范围内。
具体地,为了验证所提出方法的有效性,将机械臂的关节速度极限(单位为rad/s)设置为:
[∞;∞;∞;0.2;∞;∞]
将机械臂的关节角度极限(单位为rad)设置为:
[2π;2π;1.6;2π;2π;2π]
将关节4的最大速度设置为0.1rad/s,并将关节3的最大角度设置为1.6rad。
进一步作为本方法的优选实施例,所述关节角度运动数据包括关节在某个时刻所应处的角度信息和关节速度信息。
具体地,令α=1,并使用Matlab中的ode15s方法求解该位置方程组,最终可得到随时间变化的向量函数u(t)的数值解。该函数的输入为时刻t,输出为一个n+m维的向量u。向量u的前n项就是机械臂的n个关节在t时刻所应处的角度,根据该信息便可控制机械臂完成轨迹跟踪任务。
如图2所示,一种考虑机械臂物理约束和模型未知的控制***,包括以下模块:
参数预设模块,用于预设机械臂的初始姿态和期望参数;
信息读取模块,用于根据传感器读取机械臂当前关节参数和末端执行器信息;
方程组构建模块,用于以期望参数和初始姿态为约束,基于雅可比矩阵估计方法和二次规划方法构建期望位置方程组;
求解模块,用于根据期望位置方程组、初始姿态、期望参数、当前关节参数和末端执行器信息得到关节角度运动数据;
控制模块,用于将关节角度运动数据发送至机械臂控制器,控制机械臂运动。
上述方法实施例中的内容均适用于本***实施例中,本***实施例所具体实现的功能与上述方法实施例相同,并且达到的有益效果与上述方法实施例所达到的有益效果也相同。
以上是对本发明的较佳实施进行了具体说明,但本发明创造并不限于所述实施例,熟悉本领域的技术人员在不违背本发明精神的前提下还可做作出种种的等同变形或替换,这些等同的变形或替换均包含在本申请权利要求所限定的范围内。
Claims (8)
1.一种考虑机械臂物理约束和模型未知的控制方法,其特征在于,包括以下步骤:
预设机械臂的初始姿态和期望参数;
根据传感器读取机械臂当前关节参数和末端执行器信息;
以期望参数和初始姿态为约束,基于雅可比矩阵估计方法和二次规划方法构建期望位置方程组;
根据期望位置方程组、初始姿态、期望参数、当前关节参数和末端执行器信息得到关节角度运动数据;
将关节角度运动数据发送至机械臂控制器,控制机械臂运动。
2.根据权利要求1所述一种考虑机械臂物理约束和模型未知的控制方法,其特征在于,所述期望参数包括期望轨迹、关节速度极限和角度极限,所述当前关节参数包括机械臂关节角度、机械臂关节速度和机械臂关节加速度,所述末端执行器信息包括机械臂末端实际加速度和机械臂末端实际速度。
3.根据权利要求2所述一种考虑机械臂物理约束和模型未知的控制方法,其特征在于,所述以期望参数和初始姿态为约束,基于雅可比矩阵估计方法和二次规划构建期望位置方程组这一步骤,其具体包括:
基于二次规划方法得到机械臂逆向运动方程;
通过原对偶神经网络对机械臂逆向运动方程进行处理,得到微分方程;
基于雅可比矩阵估计方法得到位置方程;
根据微分方程和位置方程得到期望位置方程组。
6.根据权利要求5所述一种考虑机械臂物理约束和模型未知的控制方法,其特征在于,所述得到关节角度运动数据还包括根据关节速度极限和角度极限验证关节角度运动数据是否在极限范围内。
7.根据权利要求6所述一种考虑机械臂物理约束和模型未知的控制方法,其特征在于,所述关节角度运动数据包括关节在某个时刻所应处的角度信息和关节速度信息。
8.一种考虑机械臂物理约束和模型未知的控制***,其特征在于,包括以下模块:
参数预设模块,用于预设机械臂的初始姿态和期望参数;
信息读取模块,用于根据传感器读取机械臂当前关节参数和末端执行器信息;
方程组构建模块,用于以期望参数和初始姿态为约束,基于雅可比矩阵估计方法和二次规划方法构建期望位置方程组;
求解模块,用于根据期望位置方程组、初始姿态、期望参数、当前关节参数和末端执行器信息得到关节角度运动数据;
控制模块,用于将关节角度运动数据发送至机械臂控制器,控制机械臂运动。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011278491.8A CN112428273A (zh) | 2020-11-16 | 2020-11-16 | 一种考虑机械臂物理约束和模型未知的控制方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011278491.8A CN112428273A (zh) | 2020-11-16 | 2020-11-16 | 一种考虑机械臂物理约束和模型未知的控制方法及*** |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112428273A true CN112428273A (zh) | 2021-03-02 |
Family
ID=74701142
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011278491.8A Pending CN112428273A (zh) | 2020-11-16 | 2020-11-16 | 一种考虑机械臂物理约束和模型未知的控制方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112428273A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114237233A (zh) * | 2021-11-30 | 2022-03-25 | 深圳市优必选科技股份有限公司 | 机器人下棋方法、装置、计算机可读存储介质及机器人 |
CN114714351A (zh) * | 2022-04-06 | 2022-07-08 | 上海工程技术大学 | 用于移动机械臂的抗饱和目标跟踪控制方法及控制*** |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101890718A (zh) * | 2010-06-01 | 2010-11-24 | 中山大学 | 一种冗余度机械臂运动规划的初始化方法 |
CN107972030A (zh) * | 2017-11-10 | 2018-05-01 | 浙江科技学院 | 一种冗余机械臂重复运动中的初始位置修正方法 |
CN107972031A (zh) * | 2017-11-10 | 2018-05-01 | 浙江科技学院 | 一种冗余机械臂可重复运动的初始位置定位方法 |
WO2018103908A1 (de) * | 2016-12-09 | 2018-06-14 | Abb Schweiz Ag | Verfahren zur minimierung von belastungen der gelenkverbindungen eines manipulators |
CN109591020A (zh) * | 2019-01-21 | 2019-04-09 | 兰州大学 | 一种多冗余度机械臂自适应可操纵性最优化的分布式协同控制方法与装置 |
CN110561441A (zh) * | 2019-10-23 | 2019-12-13 | 中山大学 | 一种冗余度机械臂位姿控制的单94lvi迭代算法 |
CN111230861A (zh) * | 2020-01-02 | 2020-06-05 | 腾讯科技(深圳)有限公司 | 连续体机器人轨迹跟踪控制方法、装置和计算机设备 |
-
2020
- 2020-11-16 CN CN202011278491.8A patent/CN112428273A/zh active Pending
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101890718A (zh) * | 2010-06-01 | 2010-11-24 | 中山大学 | 一种冗余度机械臂运动规划的初始化方法 |
WO2018103908A1 (de) * | 2016-12-09 | 2018-06-14 | Abb Schweiz Ag | Verfahren zur minimierung von belastungen der gelenkverbindungen eines manipulators |
CN107972030A (zh) * | 2017-11-10 | 2018-05-01 | 浙江科技学院 | 一种冗余机械臂重复运动中的初始位置修正方法 |
CN107972031A (zh) * | 2017-11-10 | 2018-05-01 | 浙江科技学院 | 一种冗余机械臂可重复运动的初始位置定位方法 |
CN109591020A (zh) * | 2019-01-21 | 2019-04-09 | 兰州大学 | 一种多冗余度机械臂自适应可操纵性最优化的分布式协同控制方法与装置 |
CN110561441A (zh) * | 2019-10-23 | 2019-12-13 | 中山大学 | 一种冗余度机械臂位姿控制的单94lvi迭代算法 |
CN111230861A (zh) * | 2020-01-02 | 2020-06-05 | 腾讯科技(深圳)有限公司 | 连续体机器人轨迹跟踪控制方法、装置和计算机设备 |
Non-Patent Citations (1)
Title |
---|
张雨浓等: "基于原对偶神经网络的PUMA560机器手臂重复运动规划", 《大连大学学报》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114237233A (zh) * | 2021-11-30 | 2022-03-25 | 深圳市优必选科技股份有限公司 | 机器人下棋方法、装置、计算机可读存储介质及机器人 |
CN114237233B (zh) * | 2021-11-30 | 2024-02-23 | 深圳市优必选科技股份有限公司 | 机器人下棋方法、装置、计算机可读存储介质及机器人 |
CN114714351A (zh) * | 2022-04-06 | 2022-07-08 | 上海工程技术大学 | 用于移动机械臂的抗饱和目标跟踪控制方法及控制*** |
CN114714351B (zh) * | 2022-04-06 | 2023-06-23 | 上海工程技术大学 | 用于移动机械臂的抗饱和目标跟踪控制方法及控制*** |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109382828B (zh) | 一种基于示教学习的机器人轴孔装配***及方法 | |
Cheah et al. | Adaptive vision and force tracking control for robots with constraint uncertainty | |
Wang et al. | Uncalibrated visual tracking control without visual velocity | |
CN101402199B (zh) | 基于视觉的手眼式低伺服精度机器人抓取移动目标的方法 | |
CN110253574B (zh) | 一种多任务机械臂位姿检测和误差补偿方法 | |
CN112428273A (zh) | 一种考虑机械臂物理约束和模型未知的控制方法及*** | |
CN109358507B (zh) | 一种时变性能边界约束的视觉伺服自适应跟踪控制方法 | |
Qi et al. | Stable indirect adaptive control based on discrete-time T–S fuzzy model | |
CN109352656B (zh) | 一种具有时变输出约束的多关节机械臂控制方法 | |
CN101396830A (zh) | 机器人装置的控制方法以及机器人装置 | |
CN112605996A (zh) | 一种面向冗余机械臂的无模型碰撞避免控制方法 | |
Li et al. | Sliding mode variable structure control for visual servoing system | |
CN109623812B (zh) | 考虑航天器本体姿态运动的机械臂轨迹规划方法 | |
Chen et al. | Neural-learning trajectory tracking control of flexible-joint robot manipulators with unknown dynamics | |
Qiu et al. | Model predictive control for uncalibrated and constrained image-based visual servoing without joint velocity measurements | |
CN111515928B (zh) | 机械臂运动控制*** | |
CN114942593A (zh) | 一种基于干扰观测器补偿的机械臂自适应滑模控制方法 | |
Walter et al. | Industrial Robot Learns Visuo-motor Coordination by Means of" Neural-Gas" Network | |
Ji et al. | Terminal traction control of teleoperation manipulator with random jitter disturbance based on active disturbance rejection sliding mode control | |
CN111673742A (zh) | 一种工业机器人轨迹跟踪控制算法 | |
Chang et al. | Toward fast convergence and calibration-free visual servoing control: A new image based uncalibrated finite time control scheme | |
Heyn et al. | Application of artificial neural networks in force-controlled automated assembly of complex shaped deformable components | |
Li et al. | Skill learning for robotic insertion based on one-shot demonstration and reinforcement learning | |
CN114055467A (zh) | 基于五自由度机器人的空间位姿在线仿真*** | |
CN116512259A (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 |
Application publication date: 20210302 |
|
RJ01 | Rejection of invention patent application after publication |