fix for reverting PR #148
Merge pull request #152 from ros-planning/fix_pr_148

fix for reverting PR #148