Servo: add F3 support, eleminates OneShot jitter

Add functionality for F3. removed jitter in update phase.