首页|期刊导航|机械与电子|强反冲环境下超高压水射流清洗机器人模糊PID轨迹跟踪控制

强反冲环境下超高压水射流清洗机器人模糊PID轨迹跟踪控制OA

Fuzzy PID Trajectory Tracking Control for Ultra-high-pressure Water-jet Cleaning Robots in Strong Recoil Environments

中文摘要英文摘要

针对超高压水射流清洗机器人在强反冲环境下传感信息易畸变、全局路径搜索盲目及轨迹跟踪抗扰性差,进而导致清洗轨迹偏离与作业质量劣化的问题,提出强反冲环境下超高压水射流清洗机器人模糊比例-积分-微分(PID)轨迹跟踪控制.首先,针对传感信息畸变问题,采用均值滤波逐角度融合激光雷达与深度相机数据得到有效距离值,运用扩展卡尔曼滤波融合轮式里程计与惯性测量单元数据获得位姿估计,基于融合结果采用同步定位与建图(SLAM)算法构建静态二维栅格地图;其次,基于栅格地图,引入基于Hocaoglu 算法思想的引导函数与自适应信息素更新改进蚁群算法,经贝塞尔曲线平滑处理,生成全局最短光滑清洁路径;最后,设计模糊 PID 控制器,以规划生成的路径点序列为期望输入,计算偏差及偏差变化率,通过模糊推理调整比例系数、积分系数、微分系数,并采用重心法解模糊得到参数修正量,实现清洗轨迹的跟踪控制.实验结果表明,所提方法能够获得光滑无障碍的最短路径并实现精确跟踪控制,其最大跟踪误差为 0.031 m,上升时间缩短至 0.65 s,有效提升了清洁工作的质量和效率.

To address the problems of distorted sensor information,blind global path searching,and poor disturbance rejection in trajectory tracking for ultra-high-pressure water-jet cleaning robots oper-ating in strong recoil environments,which consequently lead to cleaning trajectory deviations and deteriora-ted operational quality,a fuzzy proportional-integral-derivative(PID)trajectory tracking control method for such robots under strong recoil environments is proposed.Firstly,to tackle sensor information distor-tion,mean filtering is employed to fuse laser radar and depth camera data at each angular step to obtain valid distance measurements,while extended Kalman filtering is applied to fuse wheel odometer and inertial measurement unit data for pose estimation.Based on the fusion results,a simultaneous localization and mapping(SLAM)algorithm is adopted to construct a static two-dimensional grid map.Secondly,based on the grid map,an improved ant colony algorithm incorporating a guidance function inspired by the Hoca-oglu algorithm and adaptive pheromone update is introduced,and the resulting path is smoothed via Bézier curve processing to generate a globally shortest and smooth cleaning path.Finally,a fuzzy PID controller is designed,taking the planned path point sequence as the desired input,computing the error and its rate of change,adjusting the proportional,integral,and derivative gains through fuzzy inference,and employing center-of-gravity method for the defuzzification to obtain parameter corrections,thereby achieving track-ing control of the cleaning trajectory.Experimental results demonstrate that the proposed method can ob-tain a smooth and obstacle-free shortest path and achieve precise tracking control,with a maximum track-ing error of 0.031 m and a reduced rise time of 0.65 s,effectively improving the quality and efficiency of the cleaning operation.

原玮

河南送变电建设有限公司,河南 郑州 450051

信息技术与安全科学

超高压水射流清洗机器人多传感器融合改进蚁群算法模糊PID轨迹跟踪控制

ultra-high-pressure water-jet cleaning robotmulti-sensor fusionimproved ant colony algorithmfuzzy PIDtrajectory tracking control

《机械与电子》 2026 (9)

57-65,73,10

河南送变电建设有限公司内部基金项目(SGTYHT/23-JS-003)

评论