高翔SLAM十四讲学习笔记——三维空间刚体运动