Switched the Servo IO manipulations to atomic set/clear