Add unit tests

[ivan-pi]

A good start would be the single index KDTree. The tests should cover primarily the Fortran interface (e.g. if the underlying c_ptr is associated, if the passed lengths are correct). Testing the correctness of the KD-Tree searches could also be helpful.