Проектирование железнодорожной сигнализации

Добрый день, Форумчане.
Возникла необходимость спроектировать на ардуино железнодорожную автоблокировку.
Периферия: кнопки, которые отражают состояние блок-участка (занят или свободен); светодиоды (которые представляют собой железнодорожные светофоры); ну и собсно ардуино (Arduino Nano).

Ликбез по автоблокировке для непосвященных.
Система автоблокировки в общем случае работает так: весь перегон состоит из блок-участков, на границах которых стоят светофоры (светофоры показывают заняты ли впереди блок-участки). Когда поезд заезжает на блок-участок, светофор перед блок-участком загорается красным. Когда поезд заезжает на следующий блок-участок, светофор перед тем блок-участком загорается красным, а предыдущий светофор желтым. Ну и так далее.
Алгоритм софта должен быть примерно таким же, но вместо поезда у меня кнопки. А, еще нужно учесть ситуации, когда одновременно заняты два блок-участка.

Как бы я понимаю, что автоблокировку можно описать конечным автоматом, но я не совсем понимаю как именно это реализовать в программе.
Пока что я придумал только через switch(). Но хотелось бы иметь более изящный софт и возможность простого масштабирования системы.
Может у кого есть какие-нибудь идеи? Буду очень признателен и благодарен

P.S: Форум не разрешает добавлять файл RAR больше 25 Мб, поэтому держите ссылку на файл с моим кодом, фоткой и видео работы

Traffic_Light (Google Drive)

0