Даже и пытаться не буду "ардуино-совместимые" процедуры делать. Уже имел опыт в теме Еще один трекер для беспилотника : вы как-то организовали себе рабочую среду, а у меня не получается, поскольку вы необходимой конфигурации среды программирования (библиотек, путей, файлов...) не описали (о них надлежит "догадываться"), и у вас "оно работает", а остальным "основы основ изучать"...
Ладно, мне легче подпаяться к выводу Меги. А поскольку обычно вы предлагаете "догадаться самому", сделаю попытку: это по всей видимости вывод №1 Меги (PD3). Угадал?