По этому я решил опубликовать свой старый проект, так и не получивший в свою комплектацию Веб камеру с роутером Nexx wt3020
Проект получился достаточно бюджетным и простым, думаю что сынишка подрастет и доведет его до ума.
- plat9_mid.jpg (28.86 КиБ) Просмотров: 20134
Точить и сверлить я конечно люблю, но нет такой возможности, поэтому я купил готовый комплект деталей для робота.
Робот состоит из следующей комплектации
Роутер Nexx wt3020
Платформа
Arduino Nano v.7
Ультразвуковой датчик
Драйвер двигателей
Инструкция по сборке
Сборка робота заняла 10-15мин.
Код программы робота получился тоже простым, но он выполняет то что мне требуется
Робот обходит препятствия, даже с неподвижным дальномером. Мне так и не удалось создать такую ситуацию из которой бы он не смог выбраться
Для управления роботом и для стабильной работы дальномера, я использовал библиотеку CyberLib
Схема робота
Видео того что получилось
Исходник
- Код: Выделить всё • Развернуть
#include <CyberLib.h>
#include <avr/wdt.h>
#define motors_init {D4_Out; D5_Out; D6_Out; D7_Out;}
#define robot_go {D4_Low; D5_High; D6_High; D7_Low;}
#define robot_stop {D4_Low; D5_Low; D6_Low; D7_Low;}
#define robot_rotation_left {D4_Low; D5_High; D6_Low; D7_High;}
#define robot_rotation_right {D4_High; D5_Low; D6_High; D7_Low;}
#define size_buff 5 //размер массива sensor
uint16_t sensor[size_buff]; //массив для хранения замеров дальномера
uint8_t stat=0;
void setup()
{
motors_init; //инициализация выходов моторов
D11_Out; //динамик
D14_Out; D14_Low; //пин trig ультразвукового сонара
D15_In; //пин echo ультразвукового сонара
for(uint8_t i=0; i<12; i++) beep(50, random(100, 1000)); //звуковое оповещение готовности робота
wdt_enable (WDTO_500MS); //Сторожевая собака 1сек.
}
void loop()
{Start
uint16_t dist=GetDistance(); //производим замер
if( dist < 10) {rotation(stat, 255);} else
if( dist < 20) {rotation(stat, 200);} else
if( dist < 40) {rotation(stat, 130);} else
{robot_go; stat=~stat;} //поехали!!!
wdt_reset(); //покормить собаку
End;}
//***************************************************
void rotation(uint8_t arr, uint8_t dur)
{
switch (arr)
{
case 0: robot_rotation_right;
break;
case 255: robot_rotation_left;
break;
}
delay_ms(dur);
robot_stop;
}
//***************************************************
uint16_t GetDistance()
{
uint16_t dist;
for (uint8_t i = 0; i < size_buff; ++i) //производим несколько замеров
{
D14_High; delay_us(10); D14_Low; //запустить измерение
dist = pulseIn(15, HIGH, 2400); //считываем длительность времени прохождения эха, ограничить время ожидания
if(dist==0) dist=2400;
sensor[i]=dist;
delay_ms(40); //задержка между посылками
wdt_reset(); //покормить собаку, что бы она не сбежала
}
dist=(find_similar(sensor, size_buff, 58))/58; // //фильтруем показания датчика и переводим в см
return dist;
}
//***************************************************
void beep(uint8_t dur, uint16_t frq)
{
dur=(1000/frq)*dur; //расчет длительности бипа
for(byte i=0; i<dur; i++)
{
D11_High;
delay_us(frq);
D11_Low;
delay_us(frq);
}
}
Хотелось бы выслушать Вашу критику.
