Update to the testing code, some refactoring
The testing code now runs from the data in the repository. The PointXYZI code references were removed and the appropriate headers are now in the PointXYZIR.h to allow the implementation of the functions such as kdtree