Главная » Форумы » Общий

Робот с далномером

Нет ответов
Чт, 10/05/2012 - 16:10
trunker
Offline
Зарегистрирован: 05.05.2012

В общем имеется пара дальномеров, пара сервоприводов, 4 мотора с гирбоксом (в общем готовая платформа), Ардуино и мотор шилд.

Хочу собрать робота который будет объезжать препядстивия, и находить выход из пормещения.

У меня пока получилось так:

#include <Servo.h> 
 
int pos = 0;    // переменная для хранения позиции сервы 
#include <AFMotor.h>
 AF_DCMotor motor(1);
 AF_DCMotor motor2(2);
 AF_DCMotor motor3(3);
 AF_DCMotor motor4(4);
#include "Ultrasonic.h"

// sensor connected to:
// Trig - 12, Echo - 13
Ultrasonic ultrasonic(13, 2);

void setup()
{
  Serial.begin(9600); 
  myservo.attach(9);
} 

void loop()
{
  float dist_cm = ultrasonic.Ranging(CM);       // get distance
  Serial.println(dist_cm);                      // print the distance
  
  delay(100);                                   // arbitary wait time.


{if (dist_cm>40.00) //Прямо
   
{motor.run(FORWARD);
motor.setSpeed(255);
motor2.run(FORWARD);
motor2.setSpeed(255);
motor3.run(FORWARD);
motor3.setSpeed(255);
motor4.run(FORWARD);
motor4.setSpeed(255);}

if (dist_cm<40.00&&dist_cm>10.00)
 //право
{motor.run(FORWARD);
motor.setSpeed(255);
motor2.run(FORWARD);
motor2.setSpeed(255);
motor3.run(BACKWARD);
motor3.setSpeed(255);
motor4.run(BACKWARD);
motor4.setSpeed(255);}

if (dist_cm<10.00)

{motor.run(BACKWARD);
motor.setSpeed(255);
motor2.run(BACKWARD);
motor2.setSpeed(255);
motor3.run(BACKWARD);
motor3.setSpeed(255);
motor4.run(BACKWARD);
motor4.setSpeed(255);}}
}

хотел бы узнать как совместить взаимодействие сервы и дальномера (смотрел некоторые видео и не совсем понял как это все работает) и есть ли смысол крепить второй дальномер?

Верх