forward and inverse kinematics tested