Tested servo functions yesterday afternoon, values were off and weird, have now written code to test different servo values to determine the right ones.