A Lie group formulation for closed chain kinematics

Will follow