Disable bug servo when set to stop

This is still having problems, not sure if this has to do with hardware
(Galileo or servo motor) or software