Первая проба софта.

Опубликовано 23.08.2014 автором admin

Не долго думая взял за основу пример одного человека. Оригинал можно посмотреть здесь.
Соответственно пришлось поменять подпрограмки управления двигателями, чтобы они вращались в нужную мне сторону.
Принял за зад платформы ту сторону на которой расположено поворотное колесо.

В моем случае получились такие подпрограмки:
//------------------STOP--------------------- void stop_motors() // Функция остановки моторов { digitalWrite(LM1, LOW); digitalWrite(LM2, LOW); digitalWrite(RM1, LOW); digitalWrite(RM2, LOW); } //---------------FORWARD----------------------- void forward() // Функция движения ВПЕРЁД { digitalWrite(LM1, LOW); digitalWrite(LM2, HIGH); digitalWrite(RM1, HIGH); digitalWrite(RM2, LOW); } //----------------BACK------------------------ void back() // Функция движения НАЗАД { digitalWrite(LM1, HIGH); digitalWrite(LM2, LOW); digitalWrite(RM1, LOW); digitalWrite(RM2, HIGH); } //----------------LEFT------------------------ void left() // Функция поворота ВЛЕВО { digitalWrite(LM1, HIGH); digitalWrite(LM2, LOW); digitalWrite(RM1, HIGH); digitalWrite(RM2, LOW); } //----------------RIGHT------------------------ void right() //Функция поворота ВПРАВО { digitalWrite(LM1, LOW); digitalWrite(LM2, HIGH); digitalWrite(RM1, LOW); digitalWrite(RM2, HIGH); }