add kinematics solver and tests