运动学直接问题

direct kinematic problem