机器人2024，Vol.46Issue(4)：488-502,15.DOI:10.13973/j.cnki.robot.230281
基于动态避障风险区域的仿生机器鱼路径规划方法
A Biomimetic Robotic Fish Path Planning Method Based on Dynamic Obstacle-avoidance Risk Region
摘要
Abstract
Aiming at the autonomous collision-avoidance problem of the pectoral and caudal fin co-propelled biomimetic robotic fish in a complex aquatic environment with a fixed incoming flow velocity and the presence of multiple static floating obstacles and dynamic obstacles,a path planning method based on dynamic avoidance risk region(DAR)is proposed.Firstly,an ellipsoid-like dynamic avoidance risk region along the direction of obstacle movement is constructed according to the established hydrodynamic model of the robotic fish by using extended Kalman filtering,whose long axis is proportional to the speed of obstacle movement,and the noise variance of the Kalman filtering process is estimated through a fuzzy control method,to get the precise boundary of the region.Secondly,the non-risky obstacles moving in the same direction as the robotic fish at a greater speed are removed according to the position and speed of obstacles in the field-of-view of the robotic fish,the set of obstacle avoidance risk regions in the dynamic environment is obtained in real time,and then the time-varying passable region of robotic fish is acquired.Finally,a spatial collision-avoidance strategy is preliminarily determined,in which the robotic fish steers firstly and then pitches according to the principles of avoiding the nearest obstacle firstly and then plenty of other obstacles,and keeping the shortest distance from the safe region boundaries.Taking the obstacles as an external perturbation,a nonlinear model predictive controller is designed with the desired pose as input to optimize the control parameters such as turning radius,pitch angle and phase difference between two pectoral fins in real time,so as to drive the robotic fish to pass through the current obstacle area safely and quickly.The experimental results show that when the robotic fish passes through the multi-obstacle area,the minimum distance from the boundary of the risk area is 0.15 m,the speed is up to 0.15 m/s,the spatial obstacle avoidance speed is up to 0.3 m/s,and the spatial maneuverability is high and the trajectory is relatively smooth,which verifies the effectiveness of the proposed method.关键词
仿生机器鱼/动力学分析/动态避障/风险区域/非线性模型预测控制Key words
biomimetic robotic fish/dynamic analysis/dynamic obstacle avoidance/risk region/nonlinear model predic-tive control引用本文复制引用
李宗刚,王治平,夏广庆,康会峰..基于动态避障风险区域的仿生机器鱼路径规划方法[J].机器人,2024,46(4):488-502,15.基金项目
国家自然科学基金(61663020,12175032,12102082,12275044,12211530449) （61663020,12175032,12102082,12275044,12211530449）
国防基础科研计划(JCKY2022407C009) （JCKY2022407C009）
甘肃省高等学校产业支撑计划(2022CYZC-33) （2022CYZC-33）
大连理工大学工业装备结构分析国家重点实验室开放课题(GZ22119) （GZ22119）
兰州交通大学军民融合创新团队培育基金(JMTD202211).. （JMTD202211）
