Fix the servo sample