adding lock to planner makePlan fail case
Merge pull request #281 from phil0stine/move-base-lock

adding lock to planner makePlan fail case