Added particle evaluation in dp_slam