Arduino.ru

Езда за объектом.Ща все распишу

Имеем:

Комната, какой-то спецальный неподвижный объект, arduino, тележка, мотор шилд и все-все-все(есть алгоритм который огибает препятствия с помощью УЗ датчика(Arduino и все-все-все едет из китая)).

Нужно:

Ставим робота и он едет по направлению к спецальному неподвижному объекту огибая препятствия с помощью УЗ

и ещё если не трудно проверьти код

#include <Ultrasonic.h>
//Объявляем переменные
char incomingbyte; // переменная для приема данных
//motors A (RIGHT)
int R_A_IA = 9; // A-IA
int R_A_IB = 10; // A-IB
//motors B (LEFT)
int L_B_IA = 11; // B-IA
int L_B_IB = 12; // B-IB
//Радар
Ultrasonic ultrasonic(5, 6);
//Или 8
//Инициализация переменных
void setup() {
  Serial.begin(38400);
  //motors RIGHT
  pinMode(R_A_IA,OUTPUT);
  digitalWrite(R_A_IA, HIGH);
  pinMode(R_A_IB,OUTPUT);
  digitalWrite(R_A_IB, HIGH);
  //motors LEFT
  pinMode(L_B_IA,OUTPUT);
  digitalWrite(L_B_IA, HIGH);  
  pinMode(L_B_IB,OUTPUT);
  digitalWrite(L_B_IB, HIGH); 
}

void go_forward(){
  //motors LEFT
  digitalWrite(L_B_IA, LOW);  
  digitalWrite(L_B_IB, HIGH); 
  //motors RIGHT
  digitalWrite(R_A_IA, LOW);
  digitalWrite(R_A_IB, HIGH);
}

void go_back(){
  //motors LEFT
  digitalWrite(L_B_IA, HIGH);  
  digitalWrite(L_B_IB, LOW); 
  //motors RIGHT
  digitalWrite(R_A_IA, HIGH);
  digitalWrite(R_A_IB, LOW);
}

void go_right(){
  //motors LEFT
  digitalWrite(L_B_IA, LOW);  
  digitalWrite(L_B_IB, HIGH); 
  //motors RIGHT
  digitalWrite(R_A_IA, LOW);
  digitalWrite(R_A_IB, LOW);
}

void go_left(){
  //motors LEFT
  digitalWrite(L_B_IA, LOW);  
  digitalWrite(L_B_IB, LOW); 
  //motors RIGHT
  digitalWrite(R_A_IA, LOW);
  digitalWrite(R_A_IB, HIGH);
}

void stop_robot(){
  //motors LEFT
  digitalWrite(L_B_IA, LOW);  
  digitalWrite(L_B_IB, LOW); 
  //motors RIGHT
  digitalWrite(R_A_IA, LOW);
  digitalWrite(R_A_IB, LOW);
}

//Основной цикл программы
void loop() {      
  float distcm = ultrasonic.Ranging(CM); //измеряем расстояние  в см.
  if( (distcm<=10)&&(distcm>0) ){//если до препятствия менее 10 см.
  stop_robot();
  go_right();
  go_forward();
  //ИЛИ НЕ едем впреред 
  } 
  else 
  {
    go_forward();
  }
}