partially moved code into ROS package
drawing basic grid from sensor simulator in rviz working