fk position and velocity tests are being added