Added small test for the servos
Swap around the two servo pins