Robot kinematics inverse problem solving program