Working BVHTree. Still working on collisions though.