ADDED IN PCL!!!!! Added in test visualization program to main