roboforum.ru

Веду кружок (в том числе) робототехники на ардуино. Постепенно развиваемся, в этом учебном году вплотную занялись отработкой задач с движущимися машинками. В основном всё получается, но иногда встречаются грабли.
Вот задача довольно стандартная для разных соревнований (которые большей частью на лего): робот движется по чёрной линии, на пути препятствие (или другой робот), и его нужно обойти (или хотя бы остановиться и подождать). Используем аналоговые датчики линии (2 штуки) и ультразвуковой дальномер.
Проблема: без использования дальномера движение по линии идёт нормально. Но как только включаю функцию измерения расстояния - машинка начинает сильно сбиваться. Как я понимаю, проблема в том, что отслеживание линии критично к времени: чуть отвлёкся (на дальномер) - и сорвался. А УЗ дальномер измеряет не мгновенно. Может кто-то посоветовать алгоритм, свободный от этой проблемы? Хотя бы идеи. Наверняка эта задача имеет какое-то красивое решение.
Основа скетча у меня примерно такая:

Если убрать проверку расстояния из циклов while - ездит по линии нормально.

Может сначала уменьшить скорость движения по трассе и убедиться окончательно в своих догадках?

Не совсем понял вашу мысль. "Догадка" о том, что обращение к дальномеру приводит к постоянным сходам с линии основана на том, что сходы прекращаются, если это обращение из программы убрать. Изменять скорость в некоторых пределах пробовали, это не помогает. Без дальномера на всех рассматриваемых скоростях (50, 70, 100) движение по линии происходит достаточно надёжно. Наверное, можно пытаться уменьшить скорость до предела и получить какой-то результат, но это не решение, так как скорость в таких заданиях тоже важна, если рассчитывать на какие-то соревнования. На данный момент она у нас и так едет медленнее чем хотелось бы.

Тогда можно ограничить в функции pulseIn(pin, value, timeout) значение 3 аргумента до времени возврата на дистанцию не более 40 см и убирать
delay (); из скетча. Или прерывания попробовать использовать. Или спросить на профильном форуме.

Нужно по прерываниям.

Да, точно, с таймаутом надо поэкспериментировать... Только нули нужно будет отсекать.
Про прерывания думал. Но не придумал как их использовать, ведь прерывание обрабатывает ограниченный набор событий, связанных с изменением сигнала на цифровом порте. А дальномер этого не даёт. Есть идея как можно сделать?

А какой форум более профильный? Я тут пока плохо ориентируюсь, показалось, что этот самый подходящий, так как про ардуино.

Добавлено спустя 1 минуту 7 секунд:

Есть идея как это сделать? Может, я туплю, но я не придумал как сделать, ведь прерывание обрабатывает ограниченный набор событий, связанных с изменением сигнала на цифровом порте. А дальномер такого типа сигналов не даёт. Найти бы что-то типа цифрового дальномера, который просто сам выдаёт HIGH при расстоянии меньше заданного. Но я не встречал таких. С другой стороны, все пользуются обычными HC-SR04 и вроде, не жалуются. Должно же быть решение...

Добавлено спустя 1 час 33 минуты 21 секунду:

Попробовал уменьшить таймаут до примерного соответствия 40 см (при большем расстоянии функция даёт ноль, он заменяется на 100). Действительно, стало гораздо лучше! Теперь линию не теряет, хотя всё же виляет немного больше, чем без обращения к дальномеру. Спасибо за совет, что-то я сам не догадался.
Но всё же если как-то придумать с прерыванием - было бы, наверное, ещё лучше.
Кстати, в прошлый раз забыл ответить про delay. Какой delay вы имели в виду? У меня в скетче вроде бы и нет delay.

Вот тут можно спросить.
http://arduino.ru/forum
Про delay(); - это извечная тема, скетч желательно полностью приводить, а не часть. Вряд ли это "зло" совсем удастся победить
А развить успех можно ища компромисс между скоростью прохождения и "дальностью взгляда робота".

А ещё, нужно уменьшить в скетче число опросов дистанции до потенциальной преграды по сравнению с числом опросов датчиков линии...
Мысль вдогонку.

А как? Может, в цикл while вставить не одно, а 2-3 вычисления поправки с последующим движением? Или лучше сделать опрос дальномера стабильно раз в 100-200 миллисекунд и записывать в переменную. Видимо, для этого нужно использовать прерывание по таймеру. Я с ним ещё не разбирался, плохо представляю как это работает, наверняка сделаю неправильно. Но надо будет попробовать.

Мне кажется прерывания не обязательно использовать совсем. Просто, используя "миллис" можно опрашивать дальномер раз в ... миллисекунд.

УЗ датчики очень тормозные. А учитывая что их иногда плющит и они не слышат отражение и соотв ждут максимальный таймаут, то использование их тут нежелательно. Вы можете добавить еще одну ардуину, которая будет только тем и заниматься, что опрашивать УЗ. А первая будет с ней связываться например по I2C и получать последние данные почти мгновенно.