舰船导航机器人的自动控制研究  

Research on automatic control of ship navigation robot

作　　者：吕世霞[1,2] LV Shi-xia(Tianjin University,Tianjin 300072,China;Beijing Polytechnic,Beijing 100176,China)

机构地区：[1]天津大学,天津300072 [2]北京电子科技职业学院,北京100176

出　　处：《舰船科学技术》2022年第19期138-141,共4页Ship Science and Technology

摘　　要：传统控制方法过分依赖于机器人运动力学,在流动海平面上容易出现偏航,为了解决这个问题,提出了舰船导航机器人的自动控制研究。使用激光雷达辨识障碍物边缘和轮廓信息,通过构建直角坐标系,确定目的地的位置信息。设计最优反馈控制器结构,构建最优控制函数,结合线性二次最优控制理论,使反馈最优控制函数值取得最小值,获取舰船导航机器人的自动控制规律,使系统控制具有动态响应性能。采用动态窗口法控制导航机器人避障功能,构建运动学模型,将输入偏差信号转换为论域上的点,通过设定合理阈值实现控制器平滑切换,推导出运动轨迹方程,实现对导航方向的自动控制。实验结果表明,该方法能够按照既定路线精准避障,角度偏差控制在-5°~5°范围内,位移偏差x,y,z方向分别控制在0~0.25 m,-1.0~0 m,-0.25~0 m范围内,能够达到自动精准控制的目的。Traditional control methods rely too much on robot motion mechanics,which is prone to yaw on flowing sea level.In order to solve this problem,the automatic control of ship navigation robot is proposed.The edge and contour information of the obstacle are obtained by liDAR identification,and the location information of the destination is determined by constructing a rectangular coordinate system.The structure of the optimal feedback controller is designed,and the optimal control function is constructed.Combined with the linear quadratic optimal control theory,the value of the feedback optimal control function is minimized,and the automatic control law of the ship navigation robot is obtained,so that the system control has dynamic response performance.The dynamic window method was used to control the obstacle avoidance function of the navigation robot,and the kinematics model was constructed.The input deviation signals were converted into points on the domain.The controller was smoothly switched by setting a reasonable threshold,and the motion trajectory equation was derived to realize the automatic control of the navigation direction.The experimental results show that the method can accurately avoid obstacles according to the established route,the Angle deviation is controlled within-5°~5°,and the displacement deviation x,y and z directions are controlled within 0~0.25 m,-1.0~0 m and-0.25~0 m,respectively,which can achieve the purpose of automatic and accurate control.

关 键 词：导航机器人 自动控制 直角坐标系 最优反馈控制器 

分 类 号：TP273[自动化与计算机技术—检测技术与自动化装置]