Add retrieval of focal length from camera and publishing it
Merge pull request #3 from Tobias-Fischer/master

Add retrieval of focal length from camera and publishing it