Prep for new AMCL code.
Nav stack mod by Bill. Weights do not work yet.
Viz script for weighted particles. Also, some loose ends.
Leftover changes from paper submission and before.
Reorganizing scripts in probability_filter.