基于虚拟工作空间约束的AUVMS协调运动规划

doi:10.3901/JME.2020.12.249

机械工程学报 ›› 2020, Vol. 56 ›› Issue (12): 249-264.doi: 10.3901/JME.2020.12.249

• 交叉与前沿 • 上一篇

扫码分享

基于虚拟工作空间约束的AUVMS协调运动规划

于福杰, 陈原, 李庆中

山东大学(威海)机电与信息工程学院威海 264209

收稿日期:2019-12-23 修回日期:2020-04-09 出版日期:2020-06-20 发布日期:2020-07-14
通讯作者: 陈原(通信作者),男,1976年出生,博士,教授,博士研究生导师。主要研究方向为水下机器人技术。E-mail:cyzghysy@sdu.edu.cn
作者简介:于福杰,男,1995年出生,博士研究生。主要研究方向为水下机器人-机械手系统的协调运动规划。E-mail:yufujie1995@foxmail.com;李庆中,男,1991年出生,博士研究生。主要研究方向为水下机器人技术。E-mail:qingzhong125@163.com
基金资助:
国家自然科学基金（51375264）、山东省重大创新工程（2017CXGC0923）、山东省重点研发计划（2018GGX103025）、山东省自然科学基金（ZR2019MEE019）和中央高校基本科研业务费专项资金（2019ZRJC006）资助项目。

Coordinated Motion Planning Based on Virtual Workspace Constraints for AUVMS

YU Fujie, CHEN Yuan, LI Qingzhong

School of Mechanical, Electrical & Information Engineering, Shandong University, Weihai, Weihai 264209

Received:2019-12-23 Revised:2020-04-09 Online:2020-06-20 Published:2020-07-14

摘要/Abstract

摘要： 为避免自治型水下机器人-机械手系统（Autonomous underwater vehicle-manipulator system，AUVMS）的机械臂完全伸展引起振动冲击，提出一种基于虚拟工作空间约束的AUVMS协调运动规划方法。利用机械臂灵活工作空间的子集组成的虚拟工作空间对机械臂的运动范围进行约束，通过软关节角运动范围处理运载器和机械臂之间的运动干涉，采用基于凸包射线检测算法判断机械手末端与虚拟工作空间之间的位置关系；推导AUVMS不同自运动状态所对应的运载器命令速度，实现虚拟工作空间内机械臂尽可能少的移动目标。仿真与试验结果表明，基于虚拟工作空间约束的AUVMS协调运动规划方法解决了机械臂出现完全伸展的问题，其轨迹跟踪精度相比加权最小范数法有着明显提高，位置误差保持在±0.04 m内，姿态误差保持在±3°内。

关键词: 水下机器人-机械手系统, 协调控制, 灵活工作空间, 运动约束, 干涉

Abstract: In order to avoid the vibration shock caused by the full extension of the manipulator of autonomous underwater vehicle-manipulator system (AUVMS), a coordinated motion planning method based on virtual workspace constraints is proposed. A certain subset of the flexible workspace of the manipulator is selected as the virtual workspace in order to constraint the motion of the end effector. The soft joint limits is used to avoid self-interference, and the positional relationship between the end effector and the virtual workspace is determined by ray detection algorithm based on convex hull. The vehicle command velocity corresponding to the different self-movement states of AUVMS is deduced, so as to move the vehicle as little as possible. The results show that the proposed method not only solves the problem of the fully extended of the manipulator, but makes the tracking accuracy improved compared to the weighted minimum norm method. The position error is within ±0.04 m, and the orientation error is within ±3 °.

Key words: underwater vehicle-manipulator system, coordinated control, flexible workspace, motion constraint, interference

中图分类号:

TP242

于福杰, 陈原, 李庆中. 基于虚拟工作空间约束的AUVMS协调运动规划[J]. 机械工程学报, 2020, 56(12): 249-264.

YU Fujie, CHEN Yuan, LI Qingzhong. Coordinated Motion Planning Based on Virtual Workspace Constraints for AUVMS[J]. Journal of Mechanical Engineering, 2020, 56(12): 249-264.

参考文献

[1] SIMETTI E,CASALINO G,WANDERLINGH F,et al. Task priority control of underwater intervention systems:Theory and applications[J]. Ocean Engineering,2018,164:40-54.
[2] HUANG Hai,ZHANG Guocheng,LI Jiyong,et al. Model based adaptive control and disturbance compensation for underwater vehicles[J]. Chinese Journal of Mechanical Engineering,2018,31:19.
[3] TANG Qirong,LIANG Le,XIE Jianhua,et al. Task-priority redundancy resolution on acceleration level for underwater vehicle-manipulator system[J]. International Journal of Advanced Robotic Systems. 2017,14(4):1-9.
[4] WHITNEY D. Resolved motion rate control of manipulators and human prostheses[J]. IEEE Transactions on Man-Machine Systems,1969,10(2):47-53.
[5] LIEGOIS A. Automatic supervisory control of the configuration and behaviour of multibody mechanism[J]. IEEE Transactions on Systems,Man,and Cybernetics,1977,7(12):868-871.
[6] PETERSEN J G,BOWYER S A,BAENA F R Y. Mass and friction optimization for natural motion in hands-on robotic surgery[J]. IEEE Transactions on Robotics,2016,32(1):1-13.
[7] LYNCH B,ELLERY A. Efficient control of an AUV-manipulator system:An application for the exploration of Europa[J]. IEEE Journal of Oceanic Engineering,2014,39(3):552-570.
[8] PATRE B M,LONDHE P S,WAGHMARE L M,et al. Disturbance estimator based non-singular fast fuzzy terminal sliding mode control of an autonomous underwater vehicle[J]. Ocean Engineering,2018,159:372-387.
[9] MARANI G,CHOI S K,YUH J. Underwater autonomous manipulation for intervention missions AUVs[J]. Ocean Engineering,2009,36(1):15-23.
[10] ISMAIL Z H,MOKHAR M W,PUTRANTI V W,et al. A robust dynamic region-based control scheme for an autonomous underwater vehicle[J]. Ocean Engineering,2016,111:155-165.
[11] WANG Yu,WANG Shuo,WEI Qingping,et al. Development of an underwater manipulator and its free-floating autonomous operation[J]. IEEE/ASME Transactions on Mechatronics,2016,21(2):815-824.
[12] SATJA S,JOSEPH C,EDIN O,et al. Underwater manipulators:A review[J]. Ocean Engineering,2018,163:431-450.
[13] SOYLU S,BUCKHAM B J,PODHORODESKI R P. Redundancy resolution for underwater mobile manipu-lators[J]. Ocean Engineering,2010,37(2-3):325-343.
[14] SANTHAKUMAR M,KIM J. Indirect adaptive control of an autonomous underwater vehicle manipulator system for underwater manipulation tasks[J]. Ocean Engineer-ing,2012,54:233-243.
[15] CASTELLI G,OTTAVIANO E,CECCARELLI M. A fairly general algorithm to evaluate workspace character-istics of serial and parallel manipulators[J]. Mechanics Based Design of Structures & Machines,2008,36(1):14-33.
[16] SATJA S,MATIJA R,JOSEPH C,et al. Collision detection for underwater ROV manipulator systems[J]. Sensors,2018,18(4):1117.
[17] 赵智远,徐振邦,何俊培,等. 基于工作空间分析的9自由度超冗余串联机械臂构型优化[J]. 机械工程学报,2019,55(21):51-63. ZHAO Zhiyuan,XU Zhenbang,HE Junpei,et al. Confi-guration optimization of nine degree of freedom super-redundant serial manipulator based on workspace analysis[J]. Journal of Mechanical Engineering,2019,55(21):51-63.
[18] CASALINO G,CACCIA M,CASELLI S,et al. Underwater intervention robotics:An outline of the Italian national project MARIS[J]. Marine Technology Society Journal,2016,50(4):98-107.
[19] HACHICHA S,ZAOUI C,DALLAGI H,et al. Innovative design of an underwater cleaning robot with a two arm manipulator for hull cleaning[J]. Ocean Engineering,2019,181:303-313.
[20] 冯骁,贾英宏,徐世杰. 控制力矩陀螺驱动空间机器人的角动量平衡控制[J]. 北京航空航天大学学报,2017,43(6):1191-1198. FENG Xiao,JIA Yinghong,XU Shijie. Momentum equalization control of space robot with control moment gyroscopes for joint actuation[J]. Journal of Beijing University of Aeronautics and Astronautics,2017,43(6):1191-1198.
[21] ZHANG Zhaokun,WANG Liping,SHAO Zhufeng. Improving the kinematic performance of a planar 3-RRR parallel manipulator through actuation mode conversion[J]. Mechanism and Machine Theory,2018,130:86-108.

基于虚拟工作空间约束的AUVMS协调运动规划

Coordinated Motion Planning Based on Virtual Workspace Constraints for AUVMS

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 15

编辑推荐

Metrics

本文评价

[1]	李佳男, 魏兆成, 冯景洋, 王学勤. 整体叶轮圆角立铣刀五轴U摆线剥铣轨迹规划[J]. 机械工程学报, 2024, 60(7): 212-223.
[2]	贾康, 王浩, 任东旭, 洪军. 一种圆柱型车齿刀的安装模型及无干涉设计方法[J]. 机械工程学报, 2024, 60(5): 352-361.
[3]	李莹, 张嘉方, 张钊墉, 王鑫丞, 张晋, 孔祥东. 斜盘式轴向柱塞泵柱塞颈部最小直径设计[J]. 机械工程学报, 2024, 60(4): 430-437.
[4]	金旭阳, 栗心明, 刘耀, 杨萍, 郭峰, 高军斌. 周期性载荷下润滑剂回填效应试验观察[J]. 机械工程学报, 2024, 60(3): 203-213.
[5]	刘晓飞, 陈冉, 万波, 郭孟涛, 赵永生. 多冗余驱动并联机构2RPU+2UPR+RPR的动力学建模与控制策略研究[J]. 机械工程学报, 2024, 60(11): 237-249.
[6]	张寒, 刘开华, 王春燕, 赵万忠, 栾众楷. 四轮分布式线控转向系统稳定与协调控制研究[J]. 机械工程学报, 2024, 60(10): 425-438.
[7]	汪洪波, 周俊涛, 陈无畏, 郑文杰, 谢有浩. 基于转向/横摆纳什博弈的智能车辆路径跟踪协调控制[J]. 机械工程学报, 2024, 60(10): 439-452.
[8]	漆琪, 刘礼祥, 杨吉祥, 丁汉. 面向多联体叶片的机器人喷涂无干涉路径规划[J]. 机械工程学报, 2024, 60(1): 210-219.
[9]	吴建洋, 王震坡, 张雷, 丁晓林. 四轮轮毂电机驱动电动汽车纵侧向稳定性协调控制策略研究[J]. 机械工程学报, 2023, 59(4): 163-172.
[10]	贾琳华, 郑继辉, 张福民, 曲兴华. 基于光学频率梳的高精度测距技术研究进展[J]. 机械工程学报, 2023, 59(20): 244-260.
[11]	齐磊, 费嘉文, 温建锋, 涂善东. 拉伸载荷下穿透双裂纹干涉行为与合并准则研究[J]. 机械工程学报, 2023, 59(2): 113-126.
[12]	黄土地, 彭兆春, 柏松, 黄洪钟, 蔡吴斌. 概率双线性累积损伤模型与机械结构时变可靠性分析[J]. 机械工程学报, 2023, 59(16): 117-127.
[13]	漆琪, 杨吉祥, 丁汉. 面向航空发动机复杂机匣深腔测量的机器人位姿优化及关节路径平滑方法[J]. 机械工程学报, 2023, 59(15): 17-27.
[14]	张常友, 朱作滨. 基于储能协调的光储微网VSG控制策略研究[J]. 电气工程学报, 2023, 18(1): 228-234.
[15]	臧勇, 蔡英凤, 孙晓强, 徐兴, 陈龙, 王海. 基于可拓博弈的智能汽车轨迹跟踪协调控制方法研究[J]. 机械工程学报, 2022, 58(8): 181-194.