physics-bh: rearrange and fix upper octree functions

Works better now. Only crashes with more than one threads. But it's consistent. And always crashes after a single cycle. Now, where is it...