Simple servo control