Kinematics tested working first time!