added servo control and camera refinement