fixing distance field bugs
Merge pull request #118 from ros-planning/fix-distance-field-bug

fixing distance field bugs