A Robust Visual-Aided Inertial Navigation Algorithm for Pedestrians

Figure 5

An illustration of the pose fusion graph structure. Every node represents the pedestrian’s state in the world frame, which contains position yaw and IMU measurement bias. The edges between two consecutive nodes are constrained by both VO/VIO estimation and the INS pose increment. Others is looping constraint.