Add tests for inverse kinematics. AH-101