Mechanism to manage dead robots

[hmhamza]

• Use the heartbeats to let the task planner know that some robot has died
• Store the last location of every agent so that if an agent dies, we know its location.