Improved ICP performance

-ICP now in proper thread
-Showing reference point cloud as purple overlay
-artificially scaled point cloud to match input data better (?)