Implemented waiting on red traffic light (TODO: refactor)
Merge branch 'sag-traffic_lights_check'