Abstract:The state estimation problem with a heading constraint, in which only the fixed heading of the target is prior known without any other information about the constraint, is investigated. This situation can be discovered in some practical applications, such as the tracking of a vehicle moving on a straight road. Then the heading of the target is limited to the direction of the road segment which may be known a priori. But the specific information of the road may not be available. The partly known prior information of the road constraint can be utilized to enhance the tracking performance. Since the existing estimation methods cannot be applied to produce constrained estimates in this situation, a filtering algorithm is proposed to address this issue. The state augmentation approach, which straightforwardly augment the intercept of the constraint line into the state vector, is presented. Then the heading constraint can be formulated using the state components and the prior known heading. The pseudo-measurements can be constructed accordingly and incorporated into the estimator, which is called heading constraint Kalman filter(HCKF). The performance of the HCKF is evaluated by comparing against one unconstrained state estimation algorithm as well as two popularly constrained state estimation methods. Simulation results demonstrate the effectiveness and the superior performance of the proposed method.

State Estimation with a Heading Constraint.