Implement ServoWrite