Almost finish ObjectBVH and ObjectBVHNode. But the elementray test remains to be done.