Fix in KDTree for types of insert data
int for indices, relaxes input size restrictions for matrix and indices