Remove assert to check if  init and goal configuration of planning problem are different
Remove assert to check if  init and goal configuration of planning problem are different

humanoid-path-planner/hpp-core