ROS Fork of http://sicktoolbox.sourceforge.net/