moved servo_switch to inherit from Singleton, refactored the method in method in method that was the writing thread into a single method which should help with the 50hz timer. Removed a kludge that fixed the serial port on the last motherboard