Added rosbag support
Camera pose optimization working for one view.
ToDo: clean this mess and generalize for all views