Further improved the preformance of the  KDTree by putting in iterators in place of vector indexing and by removing (hopefully) unecessary bounds checking code. (THough that code is still in there, just commented out)
Further improved the preformance of the  KDTree by putting in iterators in place of vector indexing and by removing (hopefully) unecessary bounds checking code. (THough that code is still in there, just commented out)

fengzhyuan/visionworkbench,AveRapina/visionworkbench,DougFirErickson/visionworkbench,fengzhyuan/visionworkbench,DougFirErickson/visionworkbench,AveRapina/visionworkbench,fengzhyuan/visionworkbench,fengzhyuan/visionworkbench,AveRapina/visionworkbench,DougFirErickson/visionworkbench,fengzhyuan/visionworkbench,DougFirErickson/visionworkbench,DougFirErickson/visionworkbench,fengzhyuan/visionworkbench,fengzhyuan/visionworkbench,DougFirErickson/visionworkbench,AveRapina/visionworkbench,AveRapina/visionworkbench,AveRapina/visionworkbench