publish worst particle map and some other tweaks. Next: fix the gmapping sliding window issues!