Set pin 2 and 4 to servo mode