Если кому-нибудь еще нужно. Выкладываю последнюю версию. Переделал все заново. Написано что-то на CFC, а что-то на ST. Использовал 8 датчиков. По два на каждом шлагбауме и по два перед выездами из тоннеля. Не доделана ситуация, когда машина застряла на шлагбауме, и пока нет пожарной кнопки.