Use StackVector throughout and change data types if possible (consider removing dependency on PCL)
Use StackVector throughout and change data types if possible (consider removing dependency on PCL)