Add debug_scripts and writeout maps for invalid particles
Merge branch 'master' of git://github.com/auv-avalon/orogen-uw_particle_localization