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

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

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

#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 мс.    */
     }

 

DetSimen
DetSimen аватар
Онлайн
Зарегистрирован: 25.01.2017

очень надо было на лекции ходить. проблем бы не было. а щас уже боржоми пить позно. 

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

DetSimen пишет:

очень надо было на лекции ходить. проблем бы не было. а щас уже боржоми пить позно. 

сможете помочь?

DetSimen
DetSimen аватар
Онлайн
Зарегистрирован: 25.01.2017

Я - нет.  Здесь недоучек чмырят все более-менее здравомыслящие люди.  

Green
Онлайн
Зарегистрирован: 01.10.2015

Не, ну если у недоучки денег много - почему бы и нет.)

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

Green пишет:

Не, ну если у недоучки денег много - почему бы и нет.)

ну и как сможете помочь

Ворота
Ворота аватар
Offline
Зарегистрирован: 10.01.2016

anatoliy555 пишет:

Нужно добавить в программу еще один ультразвуковой датчик и сервопривод

Нужно - добавляй.

anatoliy555 пишет:

сможете помочь?

Помочь сможем, делать за тебя - пойди прогуляйся.

anatoliy555 пишет:

ну и как сможете помочь

Кстати, в университете штата Мичиган, как-то такому ухарю как ты аннулировали диплом через шесть лет после выдачи - обнаружили скачанную курсовую.

sadman41
Онлайн
Зарегистрирован: 19.10.2016

Ворота пишет:

Кстати, в университете штата Мичиган, как-то такому ухарю как ты аннулировали диплом через шесть лет после выдачи - обнаружили скачанную курсовую.

Для этого надо сначала чёрного президента выбрать...

Green
Онлайн
Зарегистрирован: 01.10.2015

anatoliy555 пишет:

ну и как сможете помочь

Есть платный раздел - помогут на 100%. Может даже и на 200.)

DetSimen
DetSimen аватар
Онлайн
Зарегистрирован: 25.01.2017

ТС, ты не сы, в том разделе есть много людей чей жизненный принцип - деньги.  Напишуть тебе диплом, хоть и задорого.  Штоп их потом, в старости, докторишки по советам с форумов лечили.