Added some AABB utils (WIP)