updateParticle stepLength fix, WiFi observtion model still problematic