Added visualization to new point addition. Fixed some data collection bugs.