CN110026986A - 多臂协同作业柔顺控制方法 - Google Patents
多臂协同作业柔顺控制方法 Download PDFInfo
- Publication number
- CN110026986A CN110026986A CN201910443259.6A CN201910443259A CN110026986A CN 110026986 A CN110026986 A CN 110026986A CN 201910443259 A CN201910443259 A CN 201910443259A CN 110026986 A CN110026986 A CN 110026986A
- Authority
- CN
- China
- Prior art keywords
- manipulator
- ith
- external force
- arm
- pose
- 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 16
- 150000001875 compounds Chemical class 0.000 title 1
- 238000000354 decomposition reaction Methods 0.000 claims abstract description 9
- 239000011159 matrix material Substances 0.000 claims description 9
- 238000013016 damping Methods 0.000 claims description 5
- 230000009471 action Effects 0.000 claims description 3
- 238000006073 displacement reaction Methods 0.000 claims description 3
- 230000006378 damage Effects 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 208000027418 Wounds and injury Diseases 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 230000009977 dual effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000009776 industrial production Methods 0.000 description 1
- 208000014674 injury Diseases 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000002195 synergetic effect Effects 0.000 description 1
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/1679—Programme controls characterised by the tasks executed
- B25J9/1682—Dual arm manipulator; Coordination of several manipulators
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种多臂协同作业柔顺控制方法，包括：获取协同作业的各个机械臂的外力观测值与作业对象的外力观测值；根据作业对象的导纳模型与外力观测值确定作业对象的规划位姿；基于各个机械臂之间的位置约束确定各个机械臂之间的运动分解关系，根据运动分解关系及作业对象的规划位姿确定每个机械臂之末端的期望位姿；根据机械臂的导纳模型与外力观测值分别确定每个机械臂之末端的规划位姿；根据每个机械臂之末端的期望位姿与规划位姿逆解确定每个机械臂上各个关节的期望角度，根据关节的当前角度与期望角度确定关节的转动角控制量。该多臂协同作业柔顺控制方法综合考虑多臂之间的运动协同要求，实现于协同作业下的精确柔顺控制。
Description
技术领域
本发明涉及机器人技术领域，特别涉及一种多臂协同作业柔顺控制方法。
背景技术
机械臂是一种多输入多输出、高度非线性、强耦合的复杂系统，因其独特的灵活性，在工业领域的应用日益广泛。相较于传统的单臂机器人，双臂机器人可实现不同的空间位姿，协作完成各种复杂作业，在工业生产中逐渐占据主流位置。
随着协作式机器人概念的提出，人机协同作业场景越来越常见。在双臂机器人的各机械臂的协同作业过程，需要保证作业人的安全，对各机械臂的各个关节的位置及作用力提出了严格的双重控制要求。
现有的双臂机器人多由两个相互独立的单臂机器人组成，两个单臂独立进行控制，仅将其中一个单臂作为另一个单臂的位置干扰源纳入考虑，双臂柔顺控制协同性不足而难以满足精确作业，且易发碰撞伤人损物事故，存在严重的安全风险。此外，现有的双臂机器人一般利用力传感器实现柔顺控制，成本较高、精度较低。
发明内容
为了克服现有技术的不足，本发明提供一种多臂协同作业柔顺控制方法，综合考虑多臂之间的运动协同要求，实现于协同作业下的精确柔顺控制。
本发明提供的多臂协同作业柔顺控制方法，包括：
获取协同作业的各个机械臂的外力观测值与作业对象的外力观测值；
根据所述作业对象的导纳模型与外力观测值确定所述作业对象的规划位姿；
基于所述各个机械臂之间的位置约束确定所述各个机械臂之间的运动分解关系，根据所述运动分解关系及所述作业对象的规划位姿确定每个机械臂之末端的期望位姿；
根据所述机械臂的导纳模型与外力观测值分别确定所述每个机械臂之末端的规划位姿；
根据所述每个机械臂之末端的期望位姿与规划位姿逆解确定所述每个机械臂上各个关节的期望角度，根据所述关节的当前角度与期望角度确定所述关节的转动角控制量。
进一步地，所述机械臂的外力观测值通过第一动量观测器获取，所述第一动量观测器为：
式中，Ki为第i个机械臂的增益矩阵；ri为第i个机械臂的外力矩观测值；Pi(t)为第i个机械臂的广义动量；为第i个机械臂的哥氏矩阵；Gi(q)为作用于第i个机械臂各关节的重力矩矢量；τm为给定的关节驱动力矩。
进一步地，所述作业对象的外力观测值通过第二动量观测器获取，所述第二动量观测器为：
式中，Kl为所述作业对象的增益矩阵；Pl(t)为所述作业对象的广义动量；Fi为第i个机械臂的外力观测值；Gl为作用于所述作业对象的重力矩矢量。
进一步地，所述作业对象的导纳模型为：
式中，ΔXl为所述作业对象的位移，Ml为所述作业对象的质量，Dl为所述作业对象的阻尼，Kl为所述作业对象的刚度，s为拉普拉斯变换，ΔFl为所述作业对象受到的外力。
进一步地，所述机械臂的导纳模型为：
式中，ΔXl为第i个机械臂之末端的位置偏差，Mi为第i个机械臂的质量，Di为第i个机械臂的阻尼，Ki为第i个机械臂的刚度，s为拉普拉斯变换，ΔFl为第i个机械臂末端与环境的接触力之偏差。
本申请实施例中提供的一个或多个技术方案，至少具有如下技术效果或优点：
基于作业对象的导纳模型与外力观测值确定作业对象的规划位姿，基于作业对象的规划位姿及协同作业的各个机械臂之间的运动分解关系确定每个机械臂的期望位姿，基于机械臂的导纳模型与外力观测值分别确定所每个机械臂的规划位姿，最终利用逆解方法确定每个机械臂上各个关节的期望角度，对作业对象的受力情况、各个机械臂之间的协同关系进行综合考虑，贴合实际协同作业的工作条件，实现于协同作业下的精确柔顺控制。
附图说明
图1为本发明实施例提供的多臂协同作业柔顺控制方法的流程示意图。
具体实施方式
请参阅图1，本实施例公开了多臂协同作业柔顺控制方法的一种具体步骤，包括：
步骤A：获取协同作业的各个机械臂的外力观测值与作业对象的外力观测值。作业对象为多臂协同作业的对象，例如待装配部件、被切削零件等。该外力观测值为作用于作业对象的外部力矩的观测值。
示范性地，机械臂的外力观测值通过第一动量观测器获取。其中，对应于第i个机械臂的第一动量观测器为：
式中，Ki为第i个机械臂的增益矩阵；ri为第i个机械臂的外力矩观测值；Pi(t)为第i个机械臂的广义动量；为第i个机械臂的哥氏矩阵；Gi(q)为作用于第i个机械臂各关节的重力矩矢量；τm为给定的关节驱动力矩。
利用该观测器，可有效地观测作用于各个机械臂之末端的外力/外力矩的变化，进而识别碰撞位置和碰撞力方向，实现碰撞检测，保证协同作业时的人身和财产安全。同时，利用该观测器进行观测，无需使用力传感器，从而降低使用成本并提高观测精度。
示范性地，所述作业对象的外力观测值通过第二动量观测器获取，所述第二动量观测器为：
式中，Kl为所述作业对象的增益矩阵；Pl(t)为所述作业对象的广义动量；Fi为第i个机械臂的外力观测值；Gl为作用于所述作业对象的重力矩矢量。
利用该观测器，可有效地观测作用于作业对象的外力/外力矩的变化，进而识别碰撞位置和碰撞力方向，实现碰撞检测，保证协同作业时的人身和财产安全。同时，利用该观测器进行观测，无需使用力传感器，从而降低使用成本并提高观测精度。
步骤B：根据所述作业对象的导纳模型与外力观测值确定所述作业对象的规划位姿。基于作业对象的导纳模型，根据作业对象受到的外力矩，即可对作业对象的位置及姿态进行规划，得到作业对象的规划位姿。
示范性地，所述作业对象的导纳模型为：
式中，ΔXl为所述作业对象的位移，Ml为所述作业对象的质量，Dl为所述作业对象的阻尼，Kl为所述作业对象的刚度，s为拉普拉斯变换，ΔFl为所述作业对象受到的外力。
步骤C：确定协同作业的各个机械臂之间的运动分解关系，根据所述运动分解关系及所述作业对象的规划位姿确定每个机械臂之末端的期望位姿。
于多臂(至少为双臂)机器人而言，由于各机械臂的空间位置保持相对确定，基于实现某一运动目标及各机械臂之间的位置约束，可对各个机械臂进行运动分解，从而确定每个机械臂的运动方式及彼此之间的关系。进而，基于前述的运动分解关系，即可将作业对象的规划位姿分解至各个机械臂，从而得到每个机械臂之末端的期望位姿。
步骤D：根据所述机械臂的导纳模型与外力观测值分别确定所述每个机械臂之末端的规划位姿。该外力观测值为作用于机械臂的外部力的观测值。对于任一机械臂而言，基于该机械臂的导纳模型，根据该机械臂受到的外力矩，即可对该机械臂之末端的位置及姿态进行规划，得到机械臂之末端的规划位姿。
示范性地，所述机械臂的导纳模型为：
式中，ΔXl为第i个机械臂之末端的位置偏差，Mi为第i个机械臂的质量，Di为第i个机械臂的阻尼，Ki为第i个机械臂的刚度，s为拉普拉斯变换，ΔFl为第i个机械臂末端与环境的接触力之偏差。
步骤E：根据所述每个机械臂的期望位姿与规划位姿逆解确定所述每个机械臂上各个关节的期望角度，根据所述关节的当前角度与期望角度确定所述关节的转动角控制量。根据该转动角控制量，即可实现对机械臂的各关节的精确控制，通过对应于该关节的伺服控制器控制该关节转动。所谓逆解，是指根据机械臂的末端位姿求解机械臂上各个关节的角度。
最后所应说明的是，以上具体实施方式仅用以说明本发明的技术方案而非限制，尽管参照实例对本发明进行了详细说明，本领域的普通技术人员应当理解，可以对本发明的技术方案进行修改或者等同替换，而不脱离本发明技术方案的精神和范围，其均应涵盖在本发明的权利要求范围当中。
Claims (5)
1.多臂协同作业柔顺控制方法，其特征在于，包括：
获取协同作业的各个机械臂的外力观测值与作业对象的外力观测值；
根据所述作业对象的导纳模型与外力观测值确定所述作业对象的规划位姿；
基于所述各个机械臂之间的位置约束确定所述各个机械臂之间的运动分解关系，根据所述运动分解关系及所述作业对象的规划位姿确定每个机械臂之末端的期望位姿；
根据所述机械臂的导纳模型与外力观测值分别确定所述每个机械臂之末端的规划位姿；
根据所述每个机械臂之末端的期望位姿与规划位姿逆解确定所述每个机械臂上各个关节的期望角度，根据所述关节的当前角度与期望角度确定所述关节的转动角控制量。
2.根据权利要求1所述的多臂协同作业柔顺控制方法，其特征在于，所述机械臂的外力观测值通过第一动量观测器获取，所述第一动量观测器为：
式中，Ki为第i个机械臂的增益矩阵；ri为第i个机械臂的外力矩观测值；Pi(t)为第i个机械臂的广义动量；为第i个机械臂的哥氏矩阵；Gi(q)为作用于第i个机械臂各关节的重力矩矢量；τm为给定的关节驱动力矩。
3.根据权利要求1所述的多臂协同作业柔顺控制方法，其特征在于，所述作业对象的外力观测值通过第二动量观测器获取，所述第二动量观测器为：
式中，Kl为所述作业对象的增益矩阵；Pl(t)为所述作业对象的广义动量；Fi为第i个机械臂的外力观测值；Gl为作用于所述作业对象的重力矩矢量。
4.根据权利要求1所述的多臂协同作业柔顺控制方法，其特征在于，所述作业对象的导纳模型为：
式中，ΔXl为所述作业对象的位移，Ml为所述作业对象的质量，Dl为所述作业对象的阻尼，Kl为所述作业对象的刚度，s为拉普拉斯变换，ΔFl为所述作业对象受到的外力。
5.根据权利要求1所述的多臂协同作业柔顺控制方法，其特征在于，所述机械臂的导纳模型为：
式中，ΔXl为第i个机械臂之末端的位置偏差，Mi为第i个机械臂的质量，Di为第i个机械臂的阻尼，Ki为第i个机械臂的刚度，s为拉普拉斯变换，ΔFl为第i个机械臂末端与环境的接触力之偏差。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910443259.6A CN110026986B (zh) | 2019-05-24 | 2019-05-24 | 多臂协同作业柔顺控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910443259.6A CN110026986B (zh) | 2019-05-24 | 2019-05-24 | 多臂协同作业柔顺控制方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN110026986A true CN110026986A (zh) | 2019-07-19 |
| CN110026986B CN110026986B (zh) | 2022-01-11 |
Family
ID=67243439
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201910443259.6A Active CN110026986B (zh) | 2019-05-24 | 2019-05-24 | 多臂协同作业柔顺控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN110026986B (zh) |
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111975770A (zh) * | 2020-07-29 | 2020-11-24 | 西北工业大学 | 一种采用空间双臂机器人的自旋目标抓捕方法 |
| CN112091972A (zh) * | 2020-08-24 | 2020-12-18 | 上海大学 | 一种基于刚度性能的多机器人系统姿态与布局方法 |
| CN115723139A (zh) * | 2022-12-02 | 2023-03-03 | 哈尔滨工业大学（深圳） | 一种绳驱柔性机械臂操作空间柔顺控制方法及装置 |
| CN119858171A (zh) * | 2025-03-25 | 2025-04-22 | 曜石机器人(上海)有限公司 | 多臂移动机器人协同控制框架及多臂移动机器人系统 |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2011068227A1 (en) * | 2009-12-02 | 2011-06-09 | Canon Kabushiki Kaisha | Dual arm robot |
| CN106426174A (zh) * | 2016-11-05 | 2017-02-22 | 上海大学 | 一种基于力矩观测和摩擦辨识的机器人接触力检测方法 |
| CN106695797A (zh) * | 2017-02-22 | 2017-05-24 | 哈尔滨工业大学深圳研究生院 | 基于双臂机器人协同操作的柔顺控制方法及系统 |
| CN108436913A (zh) * | 2018-04-19 | 2018-08-24 | 南京航空航天大学 | 一种力协调的多臂机器人柔顺控制方法 |
| CN109108981A (zh) * | 2018-09-28 | 2019-01-01 | 江苏省（扬州）数控机床研究院 | 一种基于扰动观测器的并联机器人阻抗控制方法 |
-
2019
- 2019-05-24 CN CN201910443259.6A patent/CN110026986B/zh active Active
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2011068227A1 (en) * | 2009-12-02 | 2011-06-09 | Canon Kabushiki Kaisha | Dual arm robot |
| CN106426174A (zh) * | 2016-11-05 | 2017-02-22 | 上海大学 | 一种基于力矩观测和摩擦辨识的机器人接触力检测方法 |
| CN106695797A (zh) * | 2017-02-22 | 2017-05-24 | 哈尔滨工业大学深圳研究生院 | 基于双臂机器人协同操作的柔顺控制方法及系统 |
| CN108436913A (zh) * | 2018-04-19 | 2018-08-24 | 南京航空航天大学 | 一种力协调的多臂机器人柔顺控制方法 |
| CN109108981A (zh) * | 2018-09-28 | 2019-01-01 | 江苏省（扬州）数控机床研究院 | 一种基于扰动观测器的并联机器人阻抗控制方法 |
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111975770A (zh) * | 2020-07-29 | 2020-11-24 | 西北工业大学 | 一种采用空间双臂机器人的自旋目标抓捕方法 |
| CN111975770B (zh) * | 2020-07-29 | 2022-07-26 | 西北工业大学 | 一种采用空间双臂机器人的自旋目标抓捕方法 |
| CN112091972A (zh) * | 2020-08-24 | 2020-12-18 | 上海大学 | 一种基于刚度性能的多机器人系统姿态与布局方法 |
| CN115723139A (zh) * | 2022-12-02 | 2023-03-03 | 哈尔滨工业大学（深圳） | 一种绳驱柔性机械臂操作空间柔顺控制方法及装置 |
| CN119858171A (zh) * | 2025-03-25 | 2025-04-22 | 曜石机器人(上海)有限公司 | 多臂移动机器人协同控制框架及多臂移动机器人系统 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN110026986B (zh) | 2022-01-11 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN106695797B (zh) | 基于双臂机器人协同操作的柔顺控制方法及系统 | |
| CN110026986A (zh) | 多臂协同作业柔顺控制方法 | |
| CN107589934B (zh) | 一种关节型机械臂逆运动学解析解的求取方法 | |
| JP6706489B2 (ja) | ロボットのダイレクト教示方法 | |
| CN106945043B (zh) | 一种主从式遥操作手术机器人多臂协同控制系统 | |
| JP6484213B2 (ja) | 複数のロボットを含むロボットシステム、ロボット制御装置、及びロボット制御方法 | |
| CN110757454B (zh) | 一种双机器人协同旋转的路径规划方法和装置 | |
| JP7015068B2 (ja) | ロボットによる衝突処理 | |
| CN108621163A (zh) | 一种面向汇榫工艺的冗余双臂机器人协作控制方法 | |
| CN106041932B (zh) | 一种ur机器人的运动控制方法 | |
| JP2011206886A (ja) | ロボットの制御装置及び方法 | |
| JP7003220B2 (ja) | ロボットを備えるハンドリング装置、方法及びコンピュータプログラム | |
| JP2010167515A (ja) | 多軸ロボット及びその速度制御装置 | |
| Zhang et al. | An inverse kinematics framework of mobile manipulator based on unique domain constraint | |
| CN111515928B (zh) | 机械臂运动控制系统 | |
| KR20170016631A (ko) | 여자유도 로봇 제어 시스템, 방법, 및 상기 방법을 실행시키기 위한 컴퓨터 판독 가능한 프로그램을 기록한 기록 매체 | |
| Zhang et al. | Offline motion planning and simulation of two-robot welding coordination | |
| JP2019063912A (ja) | ロボット制御データ処理方法、ロボット制御データ処理装置、およびロボットシステム | |
| JP5447150B2 (ja) | ロボットの制御装置およびロボットを制御する方法 | |
| CN111699079B (zh) | 协调系统、操作设备和方法 | |
| Sánchez et al. | Arm manipulation planning of tethered tools with the help of a tool balancer | |
| Zarafshan et al. | Manipulation control of a space robot with flexible solar panels | |
| CN102581842A (zh) | 一种三自由度全解析空间并联操作手 | |
| CN114347036B (zh) | 优化机械臂关节中心距离和关节运动范围的方法 | |
| JP5803179B2 (ja) | ロボットの制御方法およびロボットの制御装置 |
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 | ||
| CB03 | Change of inventor or designer information | ||
| CB03 | Change of inventor or designer information |
Inventor after: Ding Ning Inventor after: Yu Xinchen Inventor after: Zhang Yu Inventor after: Xu Chunjian Inventor after: Tao Mingrong Inventor after: Han Liang Inventor before: Gao Shan Inventor before: Kong Xiang Inventor before: Wang Yuntao Inventor before: Liu Yanling Inventor before: Zheng Ningjing |
|
| GR01 | Patent grant | ||
| GR01 | Patent grant |