Managed to increase the speed of getSepForce, 50% fast in bench.

Simplified the algorithm, use more efficient datastructure.