Performance improvements

- Minimize video_frame_ref_.get calls
- Don't use the filter (for the moment)
Octree was too slow, remove it for now