Entity collision performance improvements. ~30% improvement in performance from my limited testing.

Signed-off-by: Ross Allan <rallanpcl@gmail.com>