A little bit more graceful shutdown
Merge branch 'master' of https://github.com/potocpav/vslam
Fixed an omitted change during the prev update.
Added a part of the new ros-integrated main loop
Completed the ROS two-way integrationx