This paper addresses two interrelated problems concerning the planar three degree-of-freedom motion of a vehicle, namely, the path planning problem and the guidance problem. The monotone cubic Hermite spline interpolation (CHSI) technique by Fritsch and Carlson is employed to design paths that provide the user with better shape control and avoid wiggles and zigzags between the two successive waypoints. The conventional line-of-sight (LOS) guidance law is modified by proposing a time-varying equation for the lookahead distance, which is a function of the cross-track error. This results in a more flexible maneuvering behavior that can contribute to reaching the desired path faster as well as obtaining a diminished oscillatory behavior around the desired path. The guidance system along with a heading controller form a cascaded structure, which is shown to be κ-exponentially stable when the control task is to converge to the path produced by the aforementioned CHSI method. In addition, the issue of compensating for the sideslip angle β is discussed and a new κ-exponentially stable integral LOS guidance law, capable of eliminating the effect of constant external disturbances for straight-line path following, is derived.
9 March 2015 in International Journal of Adaptive Control and Signal Processing
This paper presents a three-layered hybrid collision avoidance (COLAV) system for autonomous surface vehicles, compliant with rules 8 and 13–17 of the International Regulations for Preventing Collisions at Sea (COLREGs). The COLAV system consists of a high-level planner producing an energy-optimized trajectory, a model-predictive-control-based mid-level COLAV algorithm considering moving obstacles and the COLREGs, and the branching-course model predictive control algorithm for short-term COLAV handling emergency situations in accordance with the COLREGs. Previously developed algorithms by the authors are used for the high-level planner and short-term COLAV, while we in this paper further develop the mid-level algorithm to make it comply with COLREGs rules 13–17. This includes developing a state machine for classifying obstacle vessels using a combination of the geometrical situation, the distance and time to the closest point of approach (CPA) and a new CPA-like measure. The performance of the hybrid COLAV system is tested through numerical simulations for three scenarios representing a range of different challenges, including multi-obstacle situations with multiple simultaneously active COLREGs rules, and also obstacles ignoring the COLREGs. The COLAV system avoids collision in all the scenarios, and follows the energy-optimized trajectory when the obstacles do not interfere with it.