Collision Checking with Binary Search #101

collision_callback e.g. in sim/FR3.cpp should implemented using a binary search as the collisions are sorted. This would give us a runtime improvement from $\mathcal{O}(n)$ to $\mathcal{O}(\log(n))$.