skeleton for rviz visualization
initial rviz implementation
basic rviz implementation working
rviz visualization working.  Visualization of normals does not work.
small cleanup of class