Создание программы на ардуино

Написать алгоритм и программу работы комплекса датчиков для робота на ардуино.

1) Ультрозвуковые датчики по передней части робота прямо направо и налево, работают постоянно для определения наличия препятствий

(показатели выводятся на дисплей в виде диаграммы как на стандартном

парктронике)

2) Лазерный датчик, подвижный на сервоприводе, включается только в том случае если 1ый датчик обнаружит приближение препятствия, может быть

несколько штук, определяет точное расстояние до предмета и его границы,

(показатели выводятся на экран ввиде цифр, но если придумать как

красиво можно отразить границы припятствия относительно объекта, нужно

обсудить)

3) Инфракрасный датчик работает всегда отражает наличие бордюра или обрыва, устанавливается под бампер направлен вниз

Все это нужно в виде кода, блок схемы и пояснением в коде что бы была понятна структура кода. Так же нужна программа где можно будет смоделировать работу всего комплекса