Modified servo control