- Remove unreached waypoints from minimap

- Calculating new waypoint after collision
- Dont show reverse-waypoints o minimap
- Correct Robot-Stuck script
- Dont draw Blocked Elements from Sensordata
- Show Info-Messages