roboforum.ru

Технический форум по робототехнике.

 

Помогите исправить код - ато незнаю уже что делать...

Раздел создан специально для людей которым интересна робототехника, но в силу разных причин они не знают с чего начать.
Задавайте ваши вопросы, какими бы простыми они не казались, постоянные посетители форума постараются ответить на них по мере своих сил.
Робот своими руками. Самодельный робот.

Помогите исправить код - ато незнаю уже что делать...

Сообщение zafudafi » 04 апр 2015, 20:16

Код: Выделить всёРазвернуть
#include <Servo.h>

#define coef 10 //(коэффициент соответствия 10 градусов на 1см)
#define dead_zone 4
#define max_value 22
#define servoPin 10

#define Trig 9
#define Echo 8
#define ledPin 13

Servo myservo;

void setup()
{
  pinMode(Trig, OUTPUT); //инициируем как выход
  pinMode(Echo, INPUT);  //инициируем как вход
  pinMode(ledPin, OUTPUT);
  myservo.attach(servoPin);
  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 мс.
   */
     }

В общем хочу сделать так вот как тут https://www.youtube.com/watch?v=vEJSJSnEyIA ! Но у меня ничего не работает, серва как бы хочет стартануть но не может не ясно почему проблема в коде, тк по отдельности работает и сенсор и серво.
Оборудование :
MG 996R
Китайский аналог (adruino micro pro)
Cонар HC-SR04
Питание от блока питания на макетной плате.
В общем MG 996R - на 10
Cонар HC-SR04 - trig на 9, еcho на 8
Что сделано не так? Спасибо!
zafudafi
 
Сообщения: 2
Зарегистрирован: 04 апр 2015, 20:15

Re: Помогите исправить код - ато незнаю уже что делать...

Сообщение HarryStar » 05 апр 2015, 23:33

pinMode(servoPin, OUTPUT);
может пропустили в setupе?

а вообще добавьте тестовый вывод значений, может у вас что считается неправильно? С первого взгляда все верно.
Аватара пользователя
HarryStar
 
Сообщения: 973
Зарегистрирован: 15 ноя 2010, 13:56
Откуда: Нижний Новгород
прог. языки: С, С++, РНР

Re: Помогите исправить код - ато незнаю уже что делать...

Сообщение zafudafi » 06 апр 2015, 09:37

HarryStar писал(а):pinMode(servoPin, OUTPUT);
может пропустили в setupе?

а вообще добавьте тестовый вывод значений, может у вас что считается неправильно? С первого взгляда все верно.

Извините - я в этом деле делетант.... если не сложно, напишите код полностью - буду очень благодарен! :sorry:
zafudafi
 
Сообщения: 2
Зарегистрирован: 04 апр 2015, 20:15

Re: Помогите исправить код - ато незнаю уже что делать...

Сообщение slom » 25 апр 2015, 15:59

я подобную схему собирал, у меня все работало, так что со скетчем проблем поидее быть недолжно.
может вы перепутали провода? покажите фото вашей схемы...
Аватара пользователя
slom
 
Сообщения: 632
Зарегистрирован: 07 сен 2014, 19:29
Откуда: Севастополь
Skype: slom_3d
прог. языки: 3d max :)


Вернуться в Новичкам или основы основ роботостроения.

Кто сейчас на конференции

Сейчас этот форум просматривают: нет зарегистрированных пользователей и гости: 2

Mail.ru counter