В сегодняшней статье я расскажу вам, как сделать робота, обходящего препятствия, на базе микроконтроллера Ардуино своими руками.

Чтобы сделать робота в домашних условиях вам понадобится собственно сама плата микроконтроллера и ультразвуковой сенсор. Если сенсор зафиксирует препятствие, сервопривод позволит ему обогнуть препятствие. Сканируя пространство справа и слева, робот выберет наиболее предпочтительный путь для обхода препятствия.

Codebender – это браузерный IDE, это самый простой способ программировать вашего робота из браузера. Нужно кликнуть на кнопку «Run on Arduino» и все, проще некуда.

Вставьте батарейку в отсек и нажмите на функциональную кнопку один раз, и робот начнет движение вперед. Для остановки движения нажмите на кнопку еще раз.

/* Arduino Obstacle Avoiding Robot with a servo motor and an ultrasonic sensor HC-SR04 LED and buzzer */ //Библиотеки #include #include "Ultrasonic.h" //Константы const int button = 2; //Пин кнопки на пин 2 const int led = 3; //Пин светодиода (через резистор) на пин 3 const int buzzer = 4; //Пин пищалки на пин 4 const int motorA1= 6; //позитивный (+) пин мотора A на пин 6 (PWM) (от модуля L298!) const int motorA2= 9; //негативный пин (-) мотора A на пин 9 (PWM) const int motorB1=10; // позитивный (+) пин мотора B на пин 10 (PWM) const int motorB2=11; // негативный пин (-) мотора B на пин 11 (PWM) Ultrasonic ultrasonic(A4 ,A5); //Создаем объект ultrasonic(trig pin,echo pin) Servo myservo; //Создаём объект Servo, чтобы контролировать сервоприводы //Переменные int distance; //Переменная для хранения дистанции до объекта int checkRight; int checkLeft; int function=0; //Переменная для хранения функции робота: "1" – движение или "0" - остановлен. По умолчанию остановлен int buttonState=0; //Переменная для хранения состояния кнопки. По умолчанию "0" int pos=90; //переменная для хранения позиции серво. По умолчанию 90 градусов- датчик будет смотреть вперёд int flag=0; //полезный флаг для хранения состояния кнопки, когда кнопка отпущена void setup() { myservo.attach(5); //Серво-пин соединён с пином 5 myservo.write(pos); // говорит сервоприводу идти на позицию в переменной "pos" pinMode(button, INPUT_PULLUP); pinMode(led, OUTPUT); pinMode(buzzer, OUTPUT); pinMode(motorA1,OUTPUT); pinMode(motorA2,OUTPUT); pinMode(motorB1,OUTPUT); pinMode(motorB2,OUTPUT); } void loop() { //Проверка состояния кнопки buttonState = digitalRead(button); unsigned long currentMillis = millis(); //считаем... //Меняет главную функцию (остановлен/двигается) когда кнопка нажата if (buttonState == LOW) {//Если кнопка нажата единожды... delay(500); if (flag == 0){ function = 1; flag=1; //меняем переменную флага } else if (flag == 1){ //Если кнопка нажата дважды function = 0; flag=0; //меняем переменную флага снова } } if (function == 0){ //Если кнопка отжата или нажата дважды, то: myservo.write(90); //установить для серво 90 градусов – датчик будет смотреть вперёд stop(); //робот остаётся неподвижным noTone(buzzer); //пищалка выключена digitalWrite(led, HIGH);// и диод горит } else if (function == 1){//Если кнопка нажата, то: //Считываем дистанцию... distance = ultrasonic.Ranging(CM); //Совет: Используйте "CM" для сантиметров и "INC" для дюймов //Проверяем на наличие объектов... if (distance > 10){ forward(); //Всё чисто, двигаемся вперёд! noTone(buzzer); digitalWrite(led,LOW); } else if (distance <=10){ stop(); //Обнаружен объект! Останавливаемся и проверяем слева и справа лучший способ обхода! tone(buzzer,500); // издаём звук digitalWrite(led,HIGH); // включаем светодиод //Начинаем сканировать... for(pos = 0; pos =0; pos-=1){ //идём от 180 градусов к 0 myservo.write(pos); // говорим серво пройти на позицию в переменной "pos" delay(10); // ждём 10 мс, пока сервопривод достигнет нужной позиции } checkRight= ultrasonic.Ranging(CM); myservo.write(90); // Датчик снова смотрит вперёд //Принимаем решение – двигаться влево или вправо? if (checkLeft checkRight){ right(); delay(400); // задержка, меняем значение при необходимости, чтобы заставить робота повернуться. } else if (checkLeft <=10 && checkRight <=10){ backward(); //Дорога перекрыта... возвращаемся и идём налево;) left(); } } } } void forward(){ digitalWrite(motorA1, HIGH); digitalWrite(motorA2, LOW); digitalWrite(motorB1, HIGH); digitalWrite(motorB2, LOW); } void backward(){ digitalWrite(motorA1, LOW); digitalWrite(motorA2, HIGH); digitalWrite(motorB1, LOW); digitalWrite(motorB2, HIGH); } void left(){ digitalWrite(motorA1, HIGH); digitalWrite(motorA2, LOW); digitalWrite(motorB1, LOW); digitalWrite(motorB2, HIGH); } void right(){ digitalWrite(motorA1, LOW); digitalWrite(motorA2, HIGH); digitalWrite(motorB1, HIGH); digitalWrite(motorB2, LOW); } void stop(){ digitalWrite(motorA1, LOW); digitalWrite(motorA2, LOW); digitalWrite(motorB1, LOW); digitalWrite(motorB2, LOW); }

Нажав кнопку «Edit», вы можете редактировать скетч для своих нужд.

Например, изменив значение «10» измеряемого расстояния до препятствия в см, вы уменьшите или увеличите дистанцию, которую будет сканировать robot Arduino в поисках препятствия.

Если робот не двигается, может изменить контакты электромоторов (motorA1 и motorA2 или motorB1 и motorB2).

Шаг 7: Завершенный робот

Ваш самодельный робот, обходящий препятствия, на базе микроконтроллера Arduino готов.

Давайте поговорим о том как можно использовать Ардуино для создания робота, который балансирует как Сигвей.

Сигвей от англ. Segway – двухколесное средство передвижения стоя, оснащенное электроприводом. Еще их называют гироскутерами или электрическими самокатами.

Вы когда-нибудь задумывались, как работает Сигвей? В этом уроке мы постараемся показать вам, как сделать робота Ардуино, который уравновешивает себя точно так же, как Segway.

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

В итоге должен получиться примерно такой друг:

Схема робота

Модуль драйвера двигателя L298N:

Мотор редуктора постоянного тока с колесом:

Самобалансирующийся робот по существу является перевернутым маятником. Он может быть лучше сбалансирован, если центр массы выше относительно колесных осей. Высший центр масс означает более высокий момент инерции массы, что соответствует более низкому угловому ускорению (более медленное падение). Вот почему мы положили батарейный блок на верх. Однако высота робота была выбрана исходя из наличия материалов 🙂

Завершенный вариант самостоятельно балансирующего робота можно посмотреть на рисунке выше. В верхней части находятся шесть Ni-Cd-батарей для питания печатной платы. В промежутках между моторами используется 9-вольтовая батарея для драйвера двигателя.

Теория

В теории управления, удерживая некоторую переменную (в данном случае позицию робота), требуется специальный контроллер, называемый ПИД (пропорциональная интегральная производная). Каждый из этих параметров имеет «прирост», обычно называемый Kp, Ki и Kd. PID обеспечивает коррекцию между желаемым значением (или входом) и фактическим значением (или выходом). Разница между входом и выходом называется «ошибкой».

ПИД-регулятор уменьшает погрешность до наименьшего возможного значения, постоянно регулируя выход. В нашем самобалансирующем роботе Arduino вход (который является желаемым наклоном в градусах) устанавливается программным обеспечением. MPU6050 считывает текущий наклон робота и подает его на алгоритм PID, который выполняет вычисления для управления двигателем и удерживает робота в вертикальном положении.

PID требует, чтобы значения Kp, Ki и Kd были настроены на оптимальные значения. Инженеры используют программное обеспечение, такое как MATLAB, для автоматического вычисления этих значений. К сожалению, мы не можем использовать MATLAB в нашем случае, потому что это еще больше усложнит проект. Вместо этого мы будем настраивать значения PID. Вот как это сделать:

1. Сделайте Kp, Ki и Kd равными нулю.
2. Отрегулируйте Kp. Слишком маленький Kp заставит робота упасть, потому что исправления недостаточно. Слишком много Kp заставляет робота идти дико вперед и назад. Хороший Kp сделает так, что робот будет совсем немного отклоняться назад и вперед (или немного осциллирует).
3. Как только Kp установлен, отрегулируйте Kd. Хорошее значение Kd уменьшит колебания, пока робот не станет почти устойчивым. Кроме того, правильное Kd будет удерживать робота, даже если его толькать.
4. Наконец, установите Ki. При включении робот будет колебаться, даже если Kp и Kd установлены, но будет стабилизироваться во времени. Правильное значение Ki сократит время, необходимое для стабилизации робота.

Поведение робота можно посмотреть ниже на видео:

Код Ардуино самобалансирующего робота

Нам понадобилось четыре внешних библиотеки, для создания нашего робота. Библиотека PID упрощает вычисление значений P, I и D. Библиотека LMotorController используется для управления двумя двигателями с модулем L298N. Библиотека I2Cdev и библиотека MPU6050_6_Axis_MotionApps20 предназначены для чтения данных с MPU6050. Вы можете загрузить код, включая библиотеки в этом репозитории .

#include #include #include "I2Cdev.h" #include "MPU6050_6Axis_MotionApps20.h" #if I2CDEV_IMPLEMENTATION == I2CDEV_ARDUINO_WIRE #include "Wire.h" #endif #define MIN_ABS_SPEED 20 MPU6050 mpu; // MPU control/status vars bool dmpReady = false; // set true if DMP init was successful uint8_t mpuIntStatus; // holds actual interrupt status byte from MPU uint8_t devStatus; // return status after each device operation (0 = success, !0 = error) uint16_t packetSize; // expected DMP packet size (default is 42 bytes) uint16_t fifoCount; // count of all bytes currently in FIFO uint8_t fifoBuffer; // FIFO storage buffer // orientation/motion vars Quaternion q; // quaternion container VectorFloat gravity; // gravity vector float ypr; // yaw/pitch/roll container and gravity vector //PID double originalSetpoint = 173; double setpoint = originalSetpoint; double movingAngleOffset = 0.1; double input, output; //adjust these values to fit your own design double Kp = 50; double Kd = 1.4; double Ki = 60; PID pid(&input, &output, &setpoint, Kp, Ki, Kd, DIRECT); double motorSpeedFactorLeft = 0.6; double motorSpeedFactorRight = 0.5; //MOTOR CONTROLLER int ENA = 5; int IN1 = 6; int IN2 = 7; int IN3 = 8; int IN4 = 9; int ENB = 10; LMotorController motorController(ENA, IN1, IN2, ENB, IN3, IN4, motorSpeedFactorLeft, motorSpeedFactorRight); volatile bool mpuInterrupt = false; // indicates whether MPU interrupt pin has gone high void dmpDataReady() { mpuInterrupt = true; } void setup() { // join I2C bus (I2Cdev library doesn"t do this automatically) #if I2CDEV_IMPLEMENTATION == I2CDEV_ARDUINO_WIRE Wire.begin(); TWBR = 24; // 400kHz I2C clock (200kHz if CPU is 8MHz) #elif I2CDEV_IMPLEMENTATION == I2CDEV_BUILTIN_FASTWIRE Fastwire::setup(400, true); #endif mpu.initialize(); devStatus = mpu.dmpInitialize(); // supply your own gyro offsets here, scaled for min sensitivity mpu.setXGyroOffset(220); mpu.setYGyroOffset(76); mpu.setZGyroOffset(-85); mpu.setZAccelOffset(1788); // 1688 factory default for my test chip // make sure it worked (returns 0 if so) if (devStatus == 0) { // turn on the DMP, now that it"s ready mpu.setDMPEnabled(true); // enable Arduino interrupt detection attachInterrupt(0, dmpDataReady, RISING); mpuIntStatus = mpu.getIntStatus(); // set our DMP Ready flag so the main loop() function knows it"s okay to use it dmpReady = true; // get expected DMP packet size for later comparison packetSize = mpu.dmpGetFIFOPacketSize(); //setup PID pid.SetMode(AUTOMATIC); pid.SetSampleTime(10); pid.SetOutputLimits(-255, 255); } else { // ERROR! // 1 = initial memory load failed // 2 = DMP configuration updates failed // (if it"s going to break, usually the code will be 1) Serial.print(F("DMP Initialization failed (code ")); Serial.print(devStatus); Serial.println(F(")")); } } void loop() { // if programming failed, don"t try to do anything if (!dmpReady) return; // wait for MPU interrupt or extra packet(s) available while (!mpuInterrupt && fifoCount < packetSize) { //no mpu data - performing PID calculations and output to motors pid.Compute(); motorController.move(output, MIN_ABS_SPEED); } // reset interrupt flag and get INT_STATUS byte mpuInterrupt = false; mpuIntStatus = mpu.getIntStatus(); // get current FIFO count fifoCount = mpu.getFIFOCount(); // check for overflow (this should never happen unless our code is too inefficient) if ((mpuIntStatus & 0x10) || fifoCount == 1024) { // reset so we can continue cleanly mpu.resetFIFO(); Serial.println(F("FIFO overflow!")); // otherwise, check for DMP data ready interrupt (this should happen frequently) } else if (mpuIntStatus & 0x02) { // wait for correct available data length, should be a VERY short wait while (fifoCount < packetSize) fifoCount = mpu.getFIFOCount(); // read a packet from FIFO mpu.getFIFOBytes(fifoBuffer, packetSize); // track FIFO count here in case there is > 1 packet available // (this lets us immediately read more without waiting for an interrupt) fifoCount -= packetSize; mpu.dmpGetQuaternion(&q, fifoBuffer); mpu.dmpGetGravity(&gravity, &q); mpu.dmpGetYawPitchRoll(ypr, &q, &gravity); input = ypr * 180/M_PI + 180; } }

Значения Kp, Ki, Kd могут работать или не работать. Если они этого не делают, выполните шаги, описанные выше. Обратите внимание, что наклона в коде установлен на 173 градуса. Вы можете изменить это значение, если хотите, но обратите внимание, что это угол наклона, которым должен поддерживаться роботом. Кроме того, если ваши двигатели слишком быстры, вы можете отрегулировать значения motorSpeedFactorLeft и motorSpeedFactorRight.

На этом пока всё. До встречи.

Дорогие наши читатели, мы открываем цикл статей посвященных созданию робота на основе Arduino. Предполагается, что читатель является новичком и обладает лишь начальными знаниями данного вопроса. Постараемся изложить все как-можно более подробно и понятно.

Итак, введение в задачу:

Начнем с концепции: мы хотим робота, который может самостоятельно передвигаться по комнате, при этом объезжать все препятствия, встречаемые на своем пути. Задачу поставили.

Теперь разберемся, что нам понадобится:

1. Платформа (корпус). Здесь есть варианты: сделать самому всё, купить детальки и собрать из них, либо же купить готовое. Выбирайте, что душе угодно

В комплектеобычно идет платформа и по одному мотору на два ведущих колеса (гусенице) и отсек для батареек. Есть варианты полного привода - по мотору на 4 колеса. Для начинающих рекомендуем брать платформы танкового типа

Два ведущих колеса и третье опорное.

1. Далее, нам понадобиться дальномер. Сонар (он же дальномер, он же Ultrasonic module) В качестве дальномера изначально выбор был между ультразвуковым и инфракрасным. Поскольку характеристики ультразвукового существенно лучше (максимальная дальность около 4-5 метров, против 30-60 см), а цена примерно одинаковая, то выбор пал на Ultrasonic. Наиболее распространена модель HC-SR04.

1. Драйвер двигателей.

Как быть? Первое что приходит в голову это - поставить на выход микроконтроллера транзистор и с него уже питать моторы. Это конечно хорошо, но не прокатит, если мы захотим мотор в другую сторону пустить… Зато с этой задачей хорошо справится H - мост, который представляем собой немного более сложную схему, чем пара транзисторов. Но в данном случае их полно в виде готовых интегральных схем, так что думаю велосипед изобретать незачем - купим готовый. К тому же цена располагает - 2-3 доллара…Двинемся дальше. Для этих целей купим микросхему L293D, или что еще лучше, Motor Shield на ее основе.

Motor shield на микросхеме L298N

1. Генерация звука – пьезоизлучатель

Самым простым вариантом генерации звука является использование пьезоизлучателя.

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

Прямой пьезоэффект: в пьезозажигалках, для получения высокого напряжения на разряднике;

Обратный пьезоэлектрический эффект: в пьезоизлучателях (эффективны на высоких частотах и имеют небольшие габариты);)

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

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

Урок 2. Работа с ультразвуковым датчиком измерения расстояния (дальномером)

Урок 3. Arduino и Motor Shield на основе L298N

Урок 4. Воспроизведение звука – пьезоизлучатель

Урок 5. Сборка робота и отладка программы

Немного о роботе. В первую очередь проект должен был быть максимально недорогим. Корпус создавал без всяких расчетов и балансировки, основное требование к корпусу - минимальные габариты. Итак начнем собирать этого робота.

Список деталей:
1. Набор деталей корпуса и лап из оргстекла 1.5 мм.
2. Arduino Mega или Uno (используется Mega) - 1 шт.
3. Микро сервопривод (используются TowerPro SG90) - 8 шт.
4. Ультразвуковой дальномер HC-SR04 - 1 шт.
5. Аккумулятор размером 18560, 3.7V (используются TrustFire 2400 mAh) - 2 шт.
6. Держатель батарей размера 18560 (используется переделанный контейнер - упаковка) - 1 шт.
7. Стойка для печатной платы 25 мм. (используется вот такие стойки) - 4 шт.
8. Часть макетной платы.
9. Провода-перемычки.
10. Винт DIN 7985 M2, 8 мм. - 18 шт.
11. Гайка DIN 934 M2 - 18 шт

Сборка робота Z-RoboDog:

1. Корпус робота изготовлен из прозрачного оргстекла толщиной 1.5 мм. Все детали вырезаны лазером по чертежу сделанном в программе CorelDraw:

2. Склейте корпус секундным клеем. Прочности склеенного корпуса будет вполне достаточно. При сборке учитывайте положение отверстий на нижней крышке (смотрите на фото), а лучше приложите плату и убедитесь что всё совпадает. Боковые стенки крепите так, чтобы отверстия для проводов находились ближе к задней стенке. Более широкое отверстие на задней стенке предназначено для USB провода, учтите это при сборке.

3. Отметьте и просверлите отверстия (сверло 2 мм.). Закрепите сервоприводы в корпусе используя болты и гайки (пункты 10, 11 из списка). Валы передних сервоприводов должны быть ближе к передней стенке. Валы задних сервоприводов ближе к задней стенке.

4.1. Соберите лапы. Возьмите верхние части лап (с двумя отверстиями). Разметьте середину детали. Подставив качалку сервоприводов отметьте места крепления шурупами и просверлите отверстия (сверло 1.5 мм). Закрепите качалки так, чтобы шляпки шурупов были со стороны посадочных мест. Качалки закрепите с разных сторон и посадочные места для валов до были в противоположном направлении.

4.2. Отметьте и просверлите отверстия для крепления сервоприводов (сверло 2 мм). Валы закрепленных сервоприводов должны находиться ближе к узкому краю лапы.

4.3. Чтобы лапы не проскальзывали наклейте на них например резину. Но переднюю часть лапы заклеивать не стоит, при шагах собачка может зацепляться и застревать. Я наклеил полосочки липучего коврика из машины.

5. Отметьте и просверлите отверстия для крепления ультразвукового дальномера (сверло 2 мм). Установите дальномер, ножки контактов должны быть направлены вверх.

6. Установите держатель батарей так, чтобы в корпусе он располагался по середине. Закрепите плату Arduino и подключите все компоненты. Для разветвления питания использовалась часть макетной платы.

Настройка и запуск робота Z-RoboDog:

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

Вот как у моей собачки выглядят лапы в крайних точках углов сервопривода (переменные zs1, zs2, zs3 и т.д). Постарайтесь лапы выставить как на фото. Визуально лапы должны быть в одинаковых положениях.

В основной стойке вы так же сможете выставить лапы. После чего не забудьте прикрутить качалки к валам сервоприводов.

Программная часть Z-RoboDog:

Код очень простой, везде добавлены комментарии. Все движения находятся в массиве, чтобы не запутаться в цифрах я использовал переменные для каждого сервопривода. Например, s1 - сервопривод 1, s2 - сервопривод 2 и так далее. Для упрощения понимания предлагая вам вот такую схему.

На схеме пронумерованы лапы, каждая часть лапы ассоциируется с сервоприводом который её двигает. Также для каждой лапы указаны направления движения, знаки плюс и минус указывают куда будет двигаться лапа при увеличении или уменьшении угла. Исходными углами выбраны углы основной стойки (s1, s2, s3 и т.д.). Например если вам нужно вытянуть 2-ю лапу вы должны увеличить угол s3 и s4, в массиве это будет выглядеть так {s1,s2, s3+100,s4+50, s5,s6, s7,s8}. Вот полный скетч. Код писался в силу моих познаний, сообщите если я выбрал не правильный путь реализации.

Видео:

Скетч в архиве : У вас нет доступа к скачиванию файлов с нашего сервера

Всем привет. Эта статья небольшой рассказ о том, как сделать робота своими руками . Почему именно рассказ, спросите вы? Всё из-за того, что для изготовления подобной поделки необходимо использовать значительный багаж знаний, который очень трудно изложить в одной статье. Мы пройдёмся по процессу сборки, заглянем одним глазом в программный код и в конечном счете оживим детище «силиконовой долины». Советую посмотреть видео, чтобы иметь представление о том, что в итоге должно получится.

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

Шаг 1: Как это работает?

Робот имеет 4 ноги, с 3 сервоприводами на каждой из них, что позволяют ему перемещать конечности в 3-х степенях свободы. Он передвигается «ползучей походкой». Пусть она медленная, зато одна из самых плавных.

Для начала нужно научить робота двигаться вперед, назад, влево и вправо, затем добавить ультразвуковой датчик, что поможет обнаруживать препятствия/преграды, а после этого Bluetooth модуль, благодаря которому управление роботом выйдет на новый уровень.

Шаг 2: Необходимые детали

Скелет изготавливается из оргстекла толщиной 2 мм.

Электронная часть самоделки будет состоять из:

• 12 сервоприводов;
• arduino nano (можно заменить любой другой платой arduino);

• Шилда для управления сервоприводами;
• блока питания (в проекте использовался БП 5В 4А);

• ультразвукового датчика;
• hc 05 bluetooth модуля;

Для того, чтобы изготовить шилд понадобится:

• монтажная плата (предпочтительно с общими линиями (шинами) питания и земли);
• межплатные штыревые соединители — 30 шт;
• гнезда на плату – 36 шт;

• провода.

Инструменты :

• Лазерный резак (или умелые руки);
• Суперклей;
• Термоклей.

Шаг 3: Скелет

Воспользуемся графической программой, чтобы начертить составные части скелета.

После этого в любой доступный способ вырезаем 30 деталей будущего робота.

Шаг 4: Сборка

После резки снимаем защитное бумажное покрытие с оргстекла.

Далее приступаем к сборке ног. Крепежные элементы встроенные в части скелета. Всё, что остаётся сделать — это соединить детали воедино. Соединение довольно плотное, но для большей надежности можно нанести по капле суперклея на элементы крепежа.

Затем нужно доработать сервоприводы (приклеить по винту напротив валов сервоприводов).

Этой доработкой мы сделаем робота более устойчивым. Доработку нужно выполнить только для 8 сервоприводов, остальные 4 будут крепиться непосредственно на тело.

Прикрепляем ноги к связующему элементу (изогнутая деталь), а его в свою очередь к сервоприводу на теле.

Шаг 5: Изготавливаем шилд

Изготовление платы довольно простое, если следовать представленным в шаге фотографиям.

Шаг 6: Электроника

Закрепим выводы сервоприводов на плате arduino. Выводы следует соединять в правильной последовательности, иначе ничего не будет работать!

Шаг 7: Программирование

Пришло время оживить Франкенштейна. Сначала загрузим программу legs_init и убедимся в том, что робот находится в таком положении, как на картинке. Далее загрузим quattro_test, чтобы проверить реагирует ли робот на базовые движения, такие как движение вперед, назад, влево и вправо.

ВАЖНО: Вам необходимо добавить дополнительную библиотеку в программную среду arduino IDE. Ссылка на библиотеку представлена ниже:

Робот должен сделать 5 шагов вперед, 5 шагов назад, повернутся влево на 90 градусов, повернутся вправо на 90 градусов. Если Франкенштейн делает всё правильно, мы двигаемся в верном направлении.

P . S : установите робота на чашку, как на стенд, чтобы каждый раз не выставлять его на первоначальную точку. Как только тесты показали нормальную работу робота, можем продолжать испытания, поставив его на землю/пол.

Шаг 8: Инверсная кинематика

Инверсная (обратная) кинематика – именно она в действительности и управляет роботом (если вам не интересна математическая сторона этого проекта и вы торопитесь закончить проект можете пропустить данный шаг, но знание того, что движет роботом всегда будут полезны).

Простыми словами инверсная кинематика или сокращенно ик – «часть» тригонометрических уравнений, что определяют положение острого конца ноги, угла каждого сервоприводи и т.д., что в итоге определяют пару предварительных установочных параметров. Для примера, длина каждого шага робота или высота на которой будет располагаться тело во время движения/покоя. Используя эти предопределенные параметры, система будет извлекать величину, на которую следует сдвинуть каждый сервопривод, для того чтобы управлять роботом при помощи задаваемых команд.