Fixed some stuff, need pcl 1.7.2 to continue