kinematics forward and inverse 6189587