用于水工结构水下清刷作业的履带式机器人力/位混合控制

Hybrid Force/Position Control of a Tracked Robot for Underwater Cleaning of Hydraulic Structures

  • 摘要: 针对输水建筑物的水下清洁作业,研制了一种履带式水下清刷机器人,包括履带式爬行器、五功能电动机械臂和电动旋转刷。提出了一种用于水下清刷作业的力/位混合控制器,该控制器由力控制器和轨迹跟踪控制器两部分组成。力控制器采用基于神经网络的自适应PID(NNPID)方法实现作业面垂直方向的接触力控制。轨迹跟踪控制器采用基于扩张状态观测器(ESO)的鲁棒性模型预测控制(RMPC)方法,可有效补偿模型内部误差和水下环境扰动,实现作业面水平方向的末端轨迹跟踪。陆上测试与实际工程水下实验结果表明,机器人能以末端接触力误差±1 N和轨迹跟踪误差±2 mm的控制精度沿期望轨迹完成水下清刷任务且有效去除表面污垢。

     

    Abstract: For the underwater cleaning of water conveyance structures, a tracked underwater cleaning robot is developed, including a crawler, a five-function electric manipulator and an electric rotary brush. A hybrid force/position controller for underwater cleaning is proposed, consisting of a force controller and a trajectory tracking controller. The force controller adopts an adaptive PID based on neural network(NNPID) to control the vertical contact force on the work surface. The trajectory tracking controller adopts a robust model predictive control(RMPC) based on an extended state observer(ESO), which can effectively compensate for internal model errors and underwater environmental disturbances, achieving end-effector trajectory tracking in the horizontal direction of the work surface. Onshore tests and actual underwater engineering experiments demonstrate that the robot can perform underwater cleaning operation and effectively clean surface dirt along the desired trajectory with the end-effector contact force errors of ±1 N and the trajectory tracking errors of ±2 mm.

     

/

返回文章
返回