parameter tweaking; probably still want to tune variances in MapParticle to make localization work better.  Sonar variance of .2 seemed to work better than the current one we have (.01), but I think our x y and theta variances might need to be smaller to make motion work.  I think this is something we should focus on and maybe try to find a more principled way to do.