Started working on implementing AdvancedServo