Fixed some bugs in the INSERT methods and "fully" tested INSERT and FIND.
Revert "Fixed some bugs in the INSERT methods and "fully" tested INSERT and FIND."

This reverts commit faac7d317153b9849099a67fd061b40b2ae6cdca.
Revert "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."

This reverts commit 6545b028a528a0287485850f70bd9cff9b605866.
Revert "Revert "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.""

This reverts commit 35d4ee5cbc3beca67ea7397584f42d4ac5f85945.