put autofocusing code back into camera.cpp