Fixed some focus logic in camera2 mode.