Add retrieval of focal length from camera and publishing it