renamed methods to make more sense and made so robot gets the time of last finished when starting a task
added and removed some comments
almost fixed completely  made it use updateQ main problem is that i see that it teleports when not supposed to