Marginal KNN improvements, with the score results

Particle filter without collision detection included in score results for comparison.