Hitch Angle Estimation of a Towing Vehicle With Arbitrary Configuration

In this paper, ultra-sonic sensors along with kinematics and dynamics equations of a towing vehicle are used to develop three approaches for hitch angle estimation. The first approach is based on direct calculation of hitch angle using certain a priori geometric information and distance measurements of four ultra-sonic sensors. An angle estimate is generated for each of the six possible sensor-pair combinations, and these six estimates are passed through a voting algorithm to produce a single estimate. As the second and third approaches, kinematic and dynamic models of the tractor-trailer system are used to develop least-squares and Kalman filtering based recursive hitch angle estimations. A more reliable hitch angle estimation scheme is then proposed as the integration of the algorithms developed following each of the three approaches via a switching data fusion logic. It is shown that the proposed integrated hitch angle estimation scheme can be used for any ball type box trailer with a flat or symmetric V-nose frontal face without any priori information on the trailer parameters. Based on the validity of the assumptions, the proposed scheme can estimate the hitch angle in both low-speed using the kinematic model, and high-speed using the dynamic model of the tractor-trailer system. Experimental results corroborate the algorithms in estimating the hitch angle estimates in various cases conducted in this study.