To suppress the positioning error of wheeled robots in global navigation satellite system (GNSS) denial environments, kinematic constraints should be fully utilized. However, many wheeled robots have independent steering mechanisms for each wheel to move more flexibly, which do not meet the nonholonomic constraint in the vehicle frame. Hence, the conventional GNSS/inertial navigation system (INS)/ODO (odometer) integrated navigation algorithm (GIOW algorithm) is no longer suitable. We propose a GIOW algorithm to meet the need for all-wheel steering robot positioning. In the proposed algorithm, odometer speed and wheel angle are employed together to construct a kinematic constraint for wheeled robots, which can constrain the rapid drifting error of INS. Moreover, the odometer scale factor and wheel angle error are augmented into the error state of the extended Kalman filter to be estimated and compensated online. Field tests were carried out in an open-sky environment with a wheeled robot, which can run in both corner steering mode and all-wheel steering mode. The experimental results showed that the proposed algorithm can be applied to not only the corner steering motion model but also the all-wheel steering motion model. The accuracy of the proposed algorithm was almost the same as that of the conventional GNSS/INS/ODO algorithm in the corner steering motion model. In the all-wheel steering motion model, the accuracy of the proposed algorithm was maintained.
Read full abstract