humanoid_planner_2d: Add another planning method (double)
humanoid_planner_2d: Fix map inflation for planning