[impersonalis]

Ээээ EvilChaotic в ТЗ не было пункта " у нас уже есть супер-двиг с хитрыми оптимизациями и разибенеиями на группы по произвольному критерию за 0msec".
Уводишь несолкько задчау, имхо.
С точки зрения вопроса глобальной оптимизации - прав, но автор спрашивает не про это (возможно у него это и так реализовано), осталось дело за малым (разработка сверху-вниз).
Решение Venom2 подкупает ещё и тем, что даже EntityDistance пашет быстрее чем ручная реализация Т.Пифагора: втроенные методы предпочтительнее, хотя бы из-за уровня удаления от ядра.
Пост Randomize обязателен к изучению:
1) понимание механизма
2) подобные алгоритмы имеют множесто применений (маст рид!)