Może wystarczy skorzystać z AllServo AF ?