Final version of the comparator that will be used by priority queue
Final version of the comparator that will be used by priority queue

TheSentinel454/hubo_footstep_planner,TheSentinel454/hubo_footstep_planner