Updates to AABB and BVH