c常用算法程序集（第二版），徐士良，全书源代码

机器人学中的几何学基础，李群李代数，运动学，动力学，微分几何等