Add servoing mode