Loop Closure Detection Based on Differentiable Manifold

Figure 4

Schematic diagram of torsion rate. and represent adjacent keyframe pose nodes on the robot motion trajectory , the corresponding binormal vectors of the two are and , respectively, and is the angle between them.