Modded micro code and controller to add functionality to turn off servos when not in use