Add sensorVisualize and color contour routine