Update from upstream QVectorND library
Addition of QKDTree library for use in RRT

Allows faster neighbor lookups