use openCV Viz instead of PCL, introduce tests