Improved ROS compilability, including with Optris.
Also includes some bug fixes.