wip: switching particle swarm to use probability over paths rather than heuristics over momentary pose, nonfunctional ATM