Minor fix for servo