Бидејќи кодот е малку подолг, за подобро разбирање, ќе го објавам изворниот код на
Значи, прво треба да ја вклучиме библиотеката за сериската комуникација на модулот
Bluetooth, како и серво библиотеката. И двете библиотеки се вклучени во Arduino IDE за да не мора да ги инсталирате надворешно. Потоа треба да ги дефинираме шесте серво, модулот Bluetooth HC-05 и некои варијабли за зачувување на тековната и претходната позиција на серво, како и низи за складирање на позициите или чекорите за автоматскиот режим.
Во делот за поставување треба да ги иницијализираме на серво моторите и модулот
Bluetooth и да ја поместиме роботската рака во почетната позиција. Тоа го правиме користејќи ја функцијата за пишување () што едноставно го поместува серво во која било позиција од 0 до 180 степени.
Следно, Loop кодот, користејќи ја функцијата Bluetooth.available (), постојано проверуваме
дали има дојдовни податоци од андроид уредот. Ако е точно, користејќи ја функцијата readString () ги читаме податоците како низа, и ги зачуваме во променливата dataIn. Во зависност од пристигнатите податоци, ќе ги контролираме различните серво мотори или останати функции на раката. На ред е кодот за извршување на меморирани позиции и вградена функција