船舶動力学と微分平坦性を活用したUSVの効率的軌道計画と制御
Efficient Trajectory Planning and Control for USV with Vessel Dynamics and Differential Flatness
微分平坦性でUSVの動力学モデルを線形化し、動的RRT*と局所最適化で軌道を生成、MPCで追従制御する手法を提案した。
著者: Tao Huang, Zhenfeng Xue, Zhe Chen, Yong Liu
分類: cs.RO
原文アブストラクト
Unmanned surface vessels (USVs) are widely used in ocean exploration and environmental protection fields. To ensure that USV can successfully perform its mission, trajectory planning and motion tracking are the two most critical technologies. In this paper, we propose a novel trajectory generation and tracking method for USV based on optimization theory. Specifically, the USV dynamic model is described with differential flatness, so that the trajectory can be generated by dynamic RRT* in a linear invariant system expression form under the objective of optimal boundary value. To reduce the sample number and improve efficiency, we adjust the trajectory through local optimization. The dynamic constraints are considered in the optimization process so that the generated trajectory conforms to the kinematic characteristics of the under-actuated hull, and makes it easier to be tracked. Finally, motion tracking is added with model predictive control under a sequential quadratic programming problem. Experimental results show the planned trajectory is more in line with the kinematic characteristics of USV, and the tracking accuracy remains a higher level.
