Adds trees header file

- Trees header file added. This will eventually contain kd-tree
functionality without the use of structs and pointers.