Added a new driver interface and turned servo_switch in to a driver