The kd-tree builder now compiles! + added some more routines to Vector, Triangle and Box