Octree optimizations
Merge branch 'octree' of https://github.com/colavitam/Racing into octree