Доработать код программы

anatoliy555
Offline
Зарегистрирован: 20.05.2019

Нужно добавить в программу еще один ультразвуковой датчик и сервопривод,чтобы использовались два датчика и два сервопривода.Программа должна при приближении препятствия с одной стороны  поворачивать  сервопривод и приближении с другой стороны поворачивать другой сервопривод .Заранее спасибо.Очень надо сделать. два датчика HC-SR04 и два серво SG90

#include <Servo.h>
 
#define coef 10 //(коэффициент соответствия 10 градусов на 1см)
#define dead_zone 4
#define max_value 22
#define servoPin1 7

#define Trig 2
#define Echo 3
#define ledPin 13
 
Servo myservo;

void setup() 
{ 
  pinMode(Trig, OUTPUT); //инициируем как выход
  pinMode(Echo, INPUT);  //инициируем как вход
  pinMode(ledPin, OUTPUT);
  myservo.attach(servoPin1);
  myservo.write(0);
}
 
unsigned int impulseTime=0;
unsigned int distance_sm=0;
 
void loop() 
{ 
  digitalWrite(Trig, HIGH); /* Подаем импульс на вход   trig дальномера */
  delayMicroseconds(10);  // равный 10 микросекундам
  digitalWrite(Trig, LOW); // Отключаем 
  impulseTime = pulseIn(Echo, HIGH); // Замеряем длину импульса 
  distance_sm = impulseTime/58; // Пересчитываем в сантиметры 
 
  if (distance_sm >= dead_zone && distance_sm <= max_value)
  {
    myservo.write(coef * (distance_sm - dead_zone));
  }
  else if (distance_sm < dead_zone)// если дистанция менее 4 см, серва в положении ноль градусов
  {
    myservo.write(0);
  }
  else
  {
    myservo.write(180);
  }
  delay(100); /* ждем 0.1 секунды,   Следующий импульс может быть излучён, только после исчезновения эха от предыдущего. Это время называется периодом цикла (cycle period). Рекомендованный период между импульсами должен быть не менее 50 мс.    */
     }

 

Gas311
Gas311 аватар
Offline
Зарегистрирован: 06.12.2018

Пишите gas31a@mail.ru

 

Green
Offline
Зарегистрирован: 01.10.2015

Ну, Скиф! Даже карамзин не берётся...

p.masyukov
p.masyukov аватар
Offline
Зарегистрирован: 14.11.2015

Наскольно - Очень надо сделать?

Когда нужно?

Gas311
Gas311 аватар
Offline
Зарегистрирован: 06.12.2018

вчера

ua6em
ua6em аватар
Offline
Зарегистрирован: 17.08.2016

Green пишет:

Ну, Скиф! Даже карамзин не берётся...

взяться жеж не значит сделать )))

karamzin01
Offline
Зарегистрирован: 08.03.2018

Р е а л и з у е м о - maslachenko767@mail.ru , консультации, подбор компонентов бесплатно, гарантии имеются

ЕвгенийП
ЕвгенийП аватар
Offline
Зарегистрирован: 25.05.2015

Green пишет:

Ну, Скиф! Даже карамзин не берётся...

Берётся :)

Gas311
Gas311 аватар
Offline
Зарегистрирован: 06.12.2018

Ну скиф с карамзиным всё могут