Added pcl bounding box calc