Now have a working insert, find, and findNearest for the kd-tree. I have also added a test.c file which I have been using to test my code