reset the voxel grid as part of updateOrigin
Merge pull request #274 from mikeferguson/voxel_grid_update_origin_fix

Fix voxel grid update when robot base moves