摘要
基于级联方法提出一种欠驱动自主水面船的全局K指数稳定路径跟踪控制算法.采用以自由路径参考点为原点的Serret-Frenet坐标系建立路径跟踪误差的动态模型,以路径参数的变化率为附加控制输入,克服了以正交投影点为坐标原点时的奇异值问题.设计路径跟踪航向角指令,将路径跟踪模型分解为位置跟踪子系统和航向角、前向速度跟踪子系统两个子系统级联的形式,设计航向角和前向速度的全局指数稳定跟踪控制器,应用级联系统理论证明了路径跟踪误差的全局K指数稳定性.数学仿真和自主水面船湖上实验结果验证了该路径跟踪控制算法的有效性.
The globally KS-exponentially stable path following control of an underactuated autonomous surface vehicle (ASV) is proposed based on the cascaded approach. The dynamics model of the ASV path following errors is derived utilizing the Serret-Frenet coordinate originated at the free path reference point, which creates an added control input, i.e., the change rate of the path parameter, to avoid the singularity problem when adopting the coordinate originating at the orthogonal projection point. The path following reference yaw is designed, and the whole path following model is decomposed into two cascaded sub-models, named the position tracking sub-model and the yaw angle and surge velocity tracking sub-model. The global KS-exponential stability of the path following errors is proved using the cascaded system theory with the globally exponentially stable yaw angle and surge velocity tracking controllers. The results of the mathematic simulations and the lake trials of a real ASV demonstrate the performance of the proposed path following control algorithm.
出处
《机器人》
EI
CSCD
北大核心
2012年第3期329-336,共8页
Robot
基金
国家自然科学基金资助项目(50909082)
西北工业大学翱翔之星计划资助项目
关键词
自主水面船
欠驱动
路径跟踪控制
级联方法
autonomous surface vehicle
underactuated
path following control
cascaded approach