CN110977991A - 一种飞机清洗机械臂运动控制方法 - Google Patents
一种飞机清洗机械臂运动控制方法 Download PDFInfo
- Publication number
- CN110977991A CN110977991A CN201911403959.9A CN201911403959A CN110977991A CN 110977991 A CN110977991 A CN 110977991A CN 201911403959 A CN201911403959 A CN 201911403959A CN 110977991 A CN110977991 A CN 110977991A
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- joint
- module
- motion
- airplane
- 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 43
- 238000004140 cleaning Methods 0.000 title claims abstract description 29
- 230000003993 interaction Effects 0.000 claims abstract description 4
- 230000008569 process Effects 0.000 claims description 21
- 238000006073 displacement reaction Methods 0.000 claims description 13
- 239000012636 effector Substances 0.000 claims description 12
- 230000007704 transition Effects 0.000 claims description 12
- 230000001133 acceleration Effects 0.000 claims description 9
- 238000004891 communication Methods 0.000 claims description 8
- 238000006243 chemical reaction Methods 0.000 claims description 7
- 230000004927 fusion Effects 0.000 claims description 4
- 238000005457 optimization Methods 0.000 claims description 2
- 238000011084 recovery Methods 0.000 claims description 2
- 238000004064 recycling Methods 0.000 claims description 2
- 238000005406 washing Methods 0.000 claims 4
- 230000006872 improvement Effects 0.000 description 12
- 238000004364 calculation method Methods 0.000 description 4
- 230000009471 action Effects 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005096 rolling process Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 238000002156 mixing Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 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
- B25J11/00—Manipulators not otherwise provided for
- B25J11/008—Manipulators for service tasks
- B25J11/0085—Cleaning
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本发明公开了一种飞机清洗机械臂运动控制方法,由人机交互的示教器将机器人当前位姿和目标位姿传输给倍福控制器,所述倍福控制器将得到的机械臂关节值和目标值通过控制器中的运动控制模块解算得到下一周期机械臂各关节运动位置数据参数,各关节运动位置数据参数再通过液压伺服系统来驱动清洗机械臂的各关节的液压缸来实现机械臂对飞机表面的清洗工作。
Description
技术领域
本发明涉及机器人控制领域,尤其涉及一种飞机清洗机械臂运动控制方法。
背景技术
飞机清洗机械臂是一种集机械、电子、液压一体化的全自动飞机表面清洗机械装置,该装置共有11个自由度,其中包括1个整车自由度、7个关节回转自由度、2个由传感器控制的滚刷位姿误差自适应调节自由度以及1个滚刷回转的局部自由度,通过对11个自由度的协调控制实现机械臂对飞机表面的清洗工作。现有的飞机清洗机械臂各关节的运动控制方法中,还存在诸多问题,如机械臂执行清洗工作时末端执行器的自适应反馈问题,时间、力矩等条件下机械臂各关节的最优规划问题以及机械臂的自重导致的末端执行器的控制误差问题。因此,解决这一类的问题显得尤为重要。
发明内容
针对上述问题,本发明提供了一种飞机清洗机械臂运动控制方法,以实现机械臂按照拟定轨迹对飞机表面进行清洗工作。
为了实现上述技术方案,本发明提供了一种飞机清洗机械臂运动控制方法,由人机交互的示教器将机器人当前位姿和目标位姿传输给倍福控制器,所述倍福控制器将得到的机械臂关节值和目标值通过控制器中的运动控制模块解算得到下一周期机械臂各关节运动位置数据参数,各关节运动位置数据参数再通过液压伺服系统来驱动清洗机械臂的各关节的液压缸来实现机械臂对飞机表面的清洗工作。
进一步改进在于:所述当前位姿是机械臂当前状态下末端执行器在基座标系下的位置参数和姿态参数,所述目标位姿为用户拟定的机械臂的目标位姿参数。
进一步改进在于:所述液压缸通过缸体位移来实现机械臂关节的转动。
进一步改进在于:所述示教器与倍福控制器之间通过TCP/IP通讯协议来实现通讯,所述倍福控制器与液压伺服系统采用UDP通讯协议。
进一步改进在于:所述运动控制模块包括关节点动模块、运动学模块、机械臂展开/回收模块和轨迹规划模块,用户根据需要选择运动控制模块中不同类型的模块来实现不同的控制要求。
进一步改进在于:用户通过关节点动模块对机械臂单一关节发送转动指令,根据关节点动模块中的多项式插值算法对关节转动过程进行插值,在确保关节转动过程平稳运行的条件下使控制关节达到用户要求的角度位置。
进一步改进在于:选用运动学模块时,基于用户设定的末端执行器的目标值和机械臂各关节当前值,运动学模块通过雅各比迭代算法解算得到各关节转动角度的最优解,所求解若符合关节限位要求,则输出最优关节转动值,若不满足,则对超限的关节角度进行重新赋值,再次利用雅各比迭代算法进行优化求解,直至获得满足要求的最优解。
进一步改进在于:用户通过机械臂展开/回收模块将初始状态下的机械臂展开至工作状态,或将工作状态下的机械臂回收至初始状态,不仅简化了展开或回收机械臂的精力投入,也确保了机械臂展开与回收时的控制精度。
进一步改进在于:选用轨迹规划模块时,用户根据工况需求输入机械臂末端起止点与中间点位置参数、末端运行速度与加速度阈值以及圆弧过渡半径,来对路径类型和目标路径进行规划,基于正弦加减数算法解算得到规划路径过程中不同时间下的速度与加速度,同时,依据用户给出的圆弧过渡半径并采用相融算法在两段不同路径之间进行插值,来处理不同路径之间平滑的情况,最后,将规划得到的末端执行器的位置参数输入运动学模块得到对应各关节转动角度值;由运动控制模块求解得到的关节转动角度值均通过液压缸角度位移转换模块计算得到对应的液压缸伸展位移参数,随后将参数传至液压伺服系统并由液压伺服系统控制机械臂执行清洗工序。
进一步改进在于:所述液压缸位移转换模块是将关节转动角度通过转化公式转化为液压缸的伸展位移,从而通过液压缸实现机械臂关节转动动作。
进一步改进在于:可在机械臂末端执行器处增加力矩反馈模块以提高机械臂在清洗飞机过程中的自适应能力。
进一步改进在于:所述运动学模块采用的迭代算法存在随机性,可在算法中增加关节转动限制,优化关节执行能力
进一步改进在于:可将机械臂灵活性作为路径规划的评价参数,优化机器人的执行能力。
本发明的有益效果是:
1、可实现对机械臂关节点动、空间直线与圆弧轨迹、一键展开与回收等功能的控制;
2、确保机械臂在执行清洗工作过程中整机的平稳性;
3、机械臂在执行用户拟定轨迹时的精度保证在50mm精度以内。
附图说明
图1为本发明的控制方法流程图。
图2为本发明的运动控制模块的系统框架图。
图3为本发明的轨迹规划模块的系统框架图。
具体实施方式
为了加深对本发明的理解,下面将结合实施例对本发明做进一步详述,本实施例仅用于解释本发明,并不构成对本发明保护范围的限定。
根据图1-图3所示,本实施例提供了一种飞机清洗机械臂运动控制方法,由人机交互的示教器将机器人当前位姿和目标位姿传输给倍福控制器,所述倍福控制器将得到的机械臂关节值和目标值通过控制器中的运动控制模块解算得到下一周期机械臂各关节运动位置数据参数,各关节运动位置数据参数再通过液压伺服系统来驱动清洗机械臂的各关节的液压缸来实现机械臂对飞机表面的清洗工作。
在本实施例中,所述当前位姿是机械臂当前状态下末端执行器在基座标系下的位置参数和姿态参数,所述目标位姿为用户拟定的机械臂的目标位姿参数。
在本实施例中,所述液压缸通过缸体位移来实现机械臂关节的转动。
在本实施例中,所述示教器与倍福控制器之间通过TCP/IP通讯协议来实现通讯,所述倍福控制器与液压伺服系统采用UDP通讯协议。
在本实施例中,所述运动控制模块包括关节点动模块、运动学模块、机械臂展开/回收模块和轨迹规划模块,用户根据需要选择运动控制模块中不同类型的模块来实现不同的控制要求。
在本实施例中,用户通过关节点动模块对机械臂单一关节发送转动指令,根据关节点动模块中的多项式插值算法对关节转动过程进行插值,在确保关节转动过程平稳运行的条件下使控制关节达到用户要求的角度位置。
在本实施例中,选用运动学模块时,基于用户设定的末端执行器的目标值和机械臂各关节当前值,运动学模块通过雅各比迭代算法解算得到各关节转动角度的最优解,所求解若符合关节限位要求,则输出最优关节转动值,若不满足,则对超限的关节角度进行重新赋值,再次利用雅各比迭代算法进行优化求解,直至获得满足要求的最优解。
在本实施例中,用户通过机械臂展开/回收模块将初始状态下的机械臂展开至工作状态,或将工作状态下的机械臂回收至初始状态,不仅简化了展开或回收机械臂的精力投入,也确保了机械臂展开与回收时的控制精度。
在本实施例中,选用轨迹规划模块时,用户根据工况需求输入机械臂末端起止点与中间点位置参数、末端运行速度与加速度阈值以及圆弧过渡半径,来对路径类型和目标路径进行规划,基于正弦加减数算法解算得到规划路径过程中不同时间下的速度与加速度,同时,依据用户给出的圆弧过渡半径并采用相融算法在两段不同路径之间进行插值,来处理不同路径之间平滑的情况,最后,将规划得到的末端执行器的位置参数输入运动学模块得到对应各关节转动角度值;由运动控制模块求解得到的关节转动角度值均通过液压缸角度位移转换模块计算得到对应的液压缸伸展位移参数,随后将参数传至液压伺服系统并由液压伺服系统控制机械臂执行清洗工序。
在本实施例中,所述液压缸位移转换模块是将关节转动角度通过转化公式转化为液压缸的伸展位移,从而通过液压缸实现机械臂关节转动动作。
轨迹规划模块由用户设定机械臂末端执行器初始点、中间点、终止点的位置参数、机械臂运行的速度与加速度阈值以及末端轨迹的圆弧过渡半径,实现机械臂末端执行器沿这直线或弧线执行工作轨迹,执行器初始点、中间点与终止点为机械臂运行轨迹的起止点与轨迹过渡点,机械臂运动速度与加速度阈值为执行直线轨迹或圆弧轨迹时机械臂运行达到的最大速度与加速度,圆弧过渡半径为机械臂工作过程中两段不同运行轨迹之间的过渡路径的圆弧半径。正弦加减数算法是基于正弦函数实现工作路径过程中机械臂末端速度的平稳变化,确保机械臂清洗过程的稳定性。相融算法是基于五次多项式比例系数实现不同轨迹之间的圆弧过渡,避免轨迹交替过程中机械臂出现抖动现象。
采用相融算法实现直线段轨迹和圆弧段轨迹的过渡,保证了机器人末端轨迹可同时满足直线段和圆弧段速度、位置要求;采用正弦加减数实现机器人的末端轨迹插值,保证了机器人在执行动作时各关节的平稳变化;通过提供了多个运动规划控制模块,可以满足不同工况下用户对于机械臂控制的要求;采用雅各比迭代算法解决机械臂运动学问题,使得运动学解算不再局限与机械臂关节数目,且运算精度得到了保证。
以上显示和描述了本发明的基本原理、主要特征和优点。本行业的技术人员应该了解,本发明不受上述实施例的限制,上述实施例和说明书中描述的只是说明本发明的原理,在不脱离本发明精神和范围的前提下,本发明还会有各种变化和改进,这些变化和改进都落入要求保护的本发明范围内。本发明要求保护范围由所附的权利要求书及其等效物界定。
Claims (9)
1.一种飞机清洗机械臂运动控制方法,其特征在于:由人机交互的示教器将机器人当前位姿和目标位姿传输给倍福控制器,所述倍福控制器将得到的机械臂关节值和目标值通过控制器中的运动控制模块解算得到下一周期机械臂各关节运动位置数据参数,各关节运动位置数据参数再通过液压伺服系统来驱动清洗机械臂的各关节的液压缸来实现机械臂对飞机表面的清洗工作。
2.根据权利要求1所述的一种飞机清洗机械臂运动控制方法,其特征在于:所述当前位姿是机械臂当前状态下末端执行器在基座标系下的位置参数和姿态参数,所述目标位姿为用户拟定的机械臂的目标位姿参数。
3.根据权利要求1所述的一种飞机清洗机械臂运动控制方法,其特征在于:所述液压缸通过缸体位移来实现机械臂关节的转动。
4.根据权利要求1所述的一种飞机清洗机械臂运动控制方法,其特征在于:所述示教器与倍福控制器之间通过TCP/IP通讯协议来实现通讯,所述倍福控制器与液压伺服系统采用UDP通讯协议。
5.根据权利要求1所述的一种飞机清洗机械臂运动控制方法,其特征在于:所述运动控制模块包括关节点动模块、运动学模块、机械臂展开/回收模块和轨迹规划模块,用户根据需要选择运动控制模块中不同类型的模块来实现不同的控制要求。
6.根据权利要求5所述的一种飞机清洗机械臂运动控制方法,其特征在于:用户通过关节点动模块对机械臂单一关节发送转动指令,根据关节点动模块中的多项式插值算法对关节转动过程进行插值,在确保关节转动过程平稳运行的条件下使控制关节达到用户要求的角度位置。
7.根据权利要求5所述的一种飞机清洗机械臂运动控制方法,其特征在于:选用运动学模块时,基于用户设定的末端执行器的目标值和机械臂各关节当前值,运动学模块通过雅各比迭代算法解算得到各关节转动角度的最优解,所求解若符合关节限位要求,则输出最优关节转动值,若不满足,则对超限的关节角度进行重新赋值,再次利用雅各比迭代算法进行优化求解,直至获得满足要求的最优解。
8.根据权利要求5所述的一种飞机清洗机械臂运动控制方法,其特征在于:用户通过机械臂展开/回收模块将初始状态下的机械臂展开至工作状态,或将工作状态下的机械臂回收至初始状态。
9.根据权利要求5所述的一种飞机清洗机械臂运动控制方法,其特征在于:选用轨迹规划模块时,用户根据工况需求输入机械臂末端起止点与中间点位置参数、末端运行速度与加速度阈值以及圆弧过渡半径,来对路径类型和目标路径进行规划;基于正弦加减数算法解算得到规划路径过程中不同时间下的速度与加速度,同时,依据用户给出的圆弧过渡半径并采用相融算法在两段不同路径之间进行插值,来处理不同路径之间平滑的情况,最后,将规划得到的末端执行器的位置参数输入运动学模块得到对应各关节转动角度值;由运动控制模块求解得到的关节转动角度值均通过液压缸角度位移转换模块计算得到对应的液压缸伸展位移参数,随后将参数传至液压伺服系统并由液压伺服系统控制机械臂执行清洗工序。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911403959.9A CN110977991A (zh) | 2019-12-31 | 2019-12-31 | 一种飞机清洗机械臂运动控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911403959.9A CN110977991A (zh) | 2019-12-31 | 2019-12-31 | 一种飞机清洗机械臂运动控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110977991A true CN110977991A (zh) | 2020-04-10 |
Family
ID=70079400
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911403959.9A Pending CN110977991A (zh) | 2019-12-31 | 2019-12-31 | 一种飞机清洗机械臂运动控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110977991A (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112297034A (zh) * | 2020-11-10 | 2021-02-02 | 安徽省六安恒源机械有限公司 | 一种抓臂式清污机机器人液压控制系统 |
CN112975983A (zh) * | 2021-03-16 | 2021-06-18 | 上海三一重机股份有限公司 | 作业机械的动臂矫正方法及装置 |
CN115157239A (zh) * | 2022-06-16 | 2022-10-11 | 华南农业大学 | 一种基于滚动观测和连续预测的液压机械臂控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007319970A (ja) * | 2006-05-31 | 2007-12-13 | Daihen Corp | 産業用ロボットのツールの位置・姿勢制御方法及び制御システム |
CN108115706A (zh) * | 2017-12-31 | 2018-06-05 | 芜湖哈特机器人产业技术研究院有限公司 | 一种多轴飞机清洗机器人的控制系统 |
CN109469328A (zh) * | 2018-09-28 | 2019-03-15 | 湖南希法工程机械有限公司 | 臂架末端位置控制方法及系统及包含该系统的工程机械 |
CN110549334A (zh) * | 2019-08-15 | 2019-12-10 | 大连大华中天科技有限公司 | 一种四自由度机械手臂的控制方法 |
-
2019
- 2019-12-31 CN CN201911403959.9A patent/CN110977991A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007319970A (ja) * | 2006-05-31 | 2007-12-13 | Daihen Corp | 産業用ロボットのツールの位置・姿勢制御方法及び制御システム |
CN108115706A (zh) * | 2017-12-31 | 2018-06-05 | 芜湖哈特机器人产业技术研究院有限公司 | 一种多轴飞机清洗机器人的控制系统 |
CN109469328A (zh) * | 2018-09-28 | 2019-03-15 | 湖南希法工程机械有限公司 | 臂架末端位置控制方法及系统及包含该系统的工程机械 |
CN110549334A (zh) * | 2019-08-15 | 2019-12-10 | 大连大华中天科技有限公司 | 一种四自由度机械手臂的控制方法 |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112297034A (zh) * | 2020-11-10 | 2021-02-02 | 安徽省六安恒源机械有限公司 | 一种抓臂式清污机机器人液压控制系统 |
CN112975983A (zh) * | 2021-03-16 | 2021-06-18 | 上海三一重机股份有限公司 | 作业机械的动臂矫正方法及装置 |
CN112975983B (zh) * | 2021-03-16 | 2022-04-01 | 上海三一重机股份有限公司 | 作业机械的动臂矫正方法及装置 |
CN115157239A (zh) * | 2022-06-16 | 2022-10-11 | 华南农业大学 | 一种基于滚动观测和连续预测的液压机械臂控制方法 |
CN115157239B (zh) * | 2022-06-16 | 2024-05-10 | 华南农业大学 | 一种基于滚动观测和连续预测的液压机械臂控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR101479233B1 (ko) | 로봇 및 그 협조작업 제어방법 | |
CN108340351B (zh) | 一种机器人示教装置、方法及示教机器人 | |
CN110977991A (zh) | 一种飞机清洗机械臂运动控制方法 | |
JP6268819B2 (ja) | 多軸型ロボットの軌道生成方法 | |
US20220063099A1 (en) | Framework of robotic online motion planning | |
JP7439206B2 (ja) | 情報処理方法、情報処理装置、プログラム、記録媒体、生産システム、ロボットシステム、物品の製造方法 | |
TWI704039B (zh) | 機械臂奇異點控制方法及系統 | |
JP2014193519A (ja) | 多軸型ロボットの軌道生成方法及び多軸型ロボットの制御装置 | |
CN111002306B (zh) | 一种基于电子凸轮的机器人运动控制方法及控制系统 | |
CN111890349A (zh) | 一种四自由度机械臂运动规划方法 | |
CN110914020B (zh) | 具有机器人的操纵装置以及方法和计算机程序 | |
CN108189034A (zh) | 一种机器人连续轨迹实现方法 | |
CN114654446A (zh) | 一种机器人示教方法、装置、设备和介质 | |
Pepe et al. | A hybrid teleoperation control scheme for a single-arm mobile manipulator with omnidirectional wheels | |
JP2020049554A (ja) | 軌道生成方法、軌道生成装置、およびロボットシステム | |
CN114055467A (zh) | 基于五自由度机器人的空间位姿在线仿真系统 | |
Reis et al. | Modeling and control of a multifingered robot hand for object grasping and manipulation tasks | |
CN111515954A (zh) | 一种机械臂高质量运动路径生成方法 | |
Ying-Shi et al. | Online minimum-acceleration trajectory planning with the kinematic constraints | |
CN111699079B (zh) | 协调系统、操作设备和方法 | |
Hernandez-Mendez et al. | A switching position/force controller for two independent finger gripper over ROS | |
CN113021344A (zh) | 一种主从异构型遥操作机器人工作空间映射方法 | |
Chen et al. | Uncertainty-aware arm-base coordinated grasping strategies for mobile manipulation | |
He et al. | Six-degree-of-freedom robot trajectory planning based on MATLAB | |
JP5829968B2 (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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20200410 |
|
RJ01 | Rejection of invention patent application after publication |