Fixed a warning that the map update missed
Lower the control rate
Merge pull request #41 from open-rdc/fix-costmap

Fixed a warning that the map update missed