Add param to hfn to not update map as frequently
Roboclaw tweaks
Get linear velocity from motors not laser