Loop Closure Detection Based on Differentiable Manifold

Figure 3

Schematic diagram of manifold tangent space. S represents the motion trajectory of the robot, p represents a certain pose node on the trajectory, and , respectively, correspond to different tangent vectors in the manifold tangent space, indicating different robot motion directions.