Kinematics solver