Refine result of footstep planning 

Refine result of footstep planning in order to ignore recognition error