bwi_kr_execution goal incorrectly defined as succeeded

[sxtejeda]

If a goal is sent which is identical in location to the most recently succeeded goal, this new goal is immediately returned as succeeded, regardless of whether the robot has actually arrived at the goal.

How to Replicate:

1. Start up the robot, ensure that bwi_kr_execution is running as well
2. $rosrun bwi_tasks go_to_door_node _door:=d3_414b1
3. Let the robot make it to the door successfully
4. Set some new arbitrary goal via RViz
5. Before this new goal is finished, interrupt it with
   $rosrun bwi_task go_to_door_node _door:=d3_414b1

Notice that ROS_INFO returns "Suceeded!" and the robot stops moving, despite the robot not being at the specified door.