Loosen the MajorOptimalityTolerance in testIKtraj to avoid time out