- minimap performance improved

- robot knows if he is stuck
- collision with goal
- check if direct path to goal exists