Arduino RC Car

[Vukasito]

Привет, помогите пожалуйста кто может, создал я машину на базе Ардуино. У нее 2 режима: автомат и ручной. Есть 2 сензора HC-SR04 Ultrasonic sensor, с левой и правой стороны машины, автомат режим продпологает читать дистанцию с сензоров и принять решенее куда свернуть, но у меня что-то не роботает как задумал, он просто здает назат чючють и все

Вот код для автомат режима:

NewPing sonar_stanga(TRIGGER_PIN_stanga, ECHO_PIN_stanga, MAX_DISTANCE_stanga); // левый сензор
NewPing sonar_dreapta(TRIGGER_PIN_dreapta, ECHO_PIN_dreapta, MAX_DISTANCE_dreapta); // правый сензор
int dist_stanga, dist_dreapta; //где мы будем сохранить дистанцию

unsigned int uS = sonar_stanga.ping(); // где будем сохранить дистанцию в милисекундах для левого сензора
unsigned int uD = sonar_dreapta.ping(); //

 

Функция для получения дистанций 

void citire_senzori(){
   sonar_stanga.ping();   
   sonar_dreapta.ping();
   dist_stanga=uS/US_ROUNDTRIP_CM; //дистанция в см
   dist_dreapta=uD/US_ROUNDTRIP_CM; //distanta pana la obstacol in centimetri pentru senzor dreapta
}

 

и само сабой уже код для авто режима:

if (regim_autonom == 1) // Pornire regim autonom
    {
      delay(50); 
      citire_senzori();
      if((dist_stanga||dist_dreapta)<20)
      {
        Speed = 75; //Seteaza viteza 
        robot_inapoi();
        delay(500);
       Stop();
      }
      else if ((dist_stanga||dist_dreapta)<40)
      {
        Stop();
        delay(200);
        sonar_stanga.ping(); // achizitie date
        sonar_dreapta.ping(); 
        delay(200);
        if(dist_stanga>dist_dreapta)
        {  
          Speed = 100;
          virare_stanga();
          delay(500);
          Speed = 80;
          robot_inainte();    
        }
        else if (dist_stanga<dist_dreapta)
        {
          Speed = 100;
          virare_dreapta();
          delay(500);
          Speed = 80;
          robot_inainte(); 
        }
      }
        if ((dist_stanga&&dist_dreapta)>40)
        {
          Speed = 120;
          robot_inainte();
          delay(200);
        }
    }
  }   

в чем проблема ?

Извините за ошибки, язык не родной, заранее спасибо !

Изменено 19 сентября, 2016 пользователем admin
Кнопка CODE для кого?

[Реклама]

Реклама: ООО ТД Промэлектроника, ИНН: 6659197470, Тел: 8 (800) 1000-321

[Alex]

4 часа назад, Vukasito сказал:

(dist_stanga||dist_dreapta)<20

Это что за условие такое ? 
 

[Реклама]

20% скидка на весь каталог электронных компонентов в ТМ Электроникс!

Акция "Лето ближе - цены ниже", успей сделать выгодные покупки!

Плюс весь апрель действует скидка 10% по промокоду APREL24 + 15% кэшбэк и бесплатная доставка!

Перейти на страницу акции

Реклама: ООО ТМ ЭЛЕКТРОНИКС, ИНН: 7806548420, info@tmelectronics.ru, +7(812)4094849

[Vukasito]

18 hours ago, Alex said:

Это что за условие такое ? 
 

дистанция с правого сензора и с левого, stanga=лево, dreapta= право

[Реклама]

Выбираем схему BMS для корректной работы литий-железофосфатных (LiFePO4) аккумуляторов

 Обязательным условием долгой и стабильной работы Li-FePO4-аккумуляторов, в том числе и производства EVE Energy, является применение специализированных BMS-микросхем. Литий-железофосфатные АКБ отличаются такими характеристиками, как высокая многократность циклов заряда-разряда, безопасность, возможность быстрой зарядки, устойчивость к буферному режиму работы и приемлемая стоимость. Но для этих АКБ, также как и для других, очень важен контроль процесса заряда и разряда, а специализированных микросхем для этого вида аккумуляторов не так много. Инженеры КОМПЭЛ подготовили список имеющихся микросхем и возможных решений от разных производителей. Подробнее>>

Реклама: АО КОМПЭЛ, ИНН: 7713005406, ОГРН: 1027700032161

[Alex]

Вы меня не поняли. Мой вопрос указывал Вам на ошибку.

Идём и читаем основы языка.

 

[dm37]

может так хотели
 

if((dist_stanga < 20) || (dist_dreapta < 20))
{
}

 

[Alex]

Да ничего он не хотел, в том числе читать книги.