roboforum.ru

Читаю одну книжку, Enhancing the Pololu 3Pi with RobotBASIC. Там очень хорошо описана реализация нахождения своих координат в комнате с помощью двух маяков. Погрешность определения координат около 1см.

Заинтересованны?

Тогда начну по порядку.
Маяки:
Обычные ИК мояки, посылают пачку сигналов. Расположены в углах комнаты. У которых (смомощью рулетки) известно расстояние между ними.

Робот:
а) два ИК приемника расположенные по бокам робота, которые смогут определить направление к маяку. (повернутся так сказать лицом к маяку, чем точнее повернется, тем меньше погрешность).
б) компас - датчик который определяет насколько развернут робат в градусах относительно "севера".


К теме приложена картинка, где схематично обозначены углы.
Где:
B1 - ИК маяк 1
B2 - ИК маяк 2
rx,ry - искомое координаты
BA1, BA2 - углы ИК мояков (взятые из компаса)
A1, A2 - относительные углы

Алгоритм следующий.

Позицируемся на мояк 1
С компаса узнаем угол BA1 на который мы развернулись.
Позицируемся на мояк 2
Опять же с компаса узнаем угол BA2 поворота.

Считаем относительные углы (вообще они зависят от калибровки компаса, распложения вашей комнаты относительно севера итд.)
A1 = 180 - BA1
A2 = 360 - BA2

Высчитываем тангенс углов (Тангенс - это тригонометрическая функция, представляющая собой отношение синуса угла к косинусу этого же угла (с)КЭП) (еще тангенс обычно считают в радианах, так что нужно соотвественно перевести градусы в радианы)
M1 = tan(A1)
M2 = tan(A2)


Далее можно высчитать уже свои координаты.
Для этого возьмем еще одну переменную RW - это расстояние между маяками (можно взять в сантиметрах)
Тогда
rx = RW / ( M1- M2)
ry = M1 * rx

Вуаля!
Мы имеем координаты своего местоположения rx, ry

Какие могут быть проблемы?
Это мояки, чтобы сигналы мояков друг друга неперекрывали, их нужно пускать с разной частатой, либо включать встрого определеннмо времении. Или включать выклюяать дистационно через вайффайл или блютузом.
Также, былобы неплохо, чтобы мояки высылали не просто пачку сигналов, но свой индификатор + расстояние между маяками RW.

Ориентирование по веб камере, это немного другое. В таком варианте реализации, нужен стационарный комп, который бы работал все время. В некоторых проектах, это неприемлемо.
С камерой не так легко, как может показаться. Здесь нужно камеру весить ровно над потолком. Иначе будут перспективные искажения. Опять же, разрешение веб камеры очень низкое. Которое не позволит точно высчитать координаты. Скажем на расстоянии в 4 метра погрешность определения местоположения будет около 10 и более см. Тоесть, можно примерно узнать, где мы находимся, но точные координаты высчитать сложно. Нужна камера с хорошим разрешением.

"Но раз вы хотели по блютузу включать маяки - значит какой-то решатель есть" немного не понял о чем идет речь. Внешнего, стационарного компа нет, все вычисления идут на борту робота. Также робот управляет маяками. Управление можно вообще исключить, если маяки будут работать на разных частотах (в железе довольно таки муторно реализуется)
В своем проекте маяками буду управлять вот такими штуками
Хотя, мне до навигации еще очень далеко...

Погрешность измерения конечно зависит от размеров комнаты.
У меня получается, при 4 метрах, учитывая погрешность гироскопа в 2градуса, в тепличных условиях получается 1см. Хотя на практике, думаю будет намного больше. Если уложится в 5см то ито хорошо будет.

yozik0ff писал(а):Опять же, разрешение веб камеры очень низкое.

Ой ли? HD-камеры не редкость, и не бесценная штука.

Да не надо реально в помещениях обычно точность выше 3-5см. По крайней мере в помещениях с расстояниями 4-5м

Точность нужна, когда робот маленький, к примеру размером в 10см.

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

Да, а я правильно понимаю, что если маяка взять три, то компас можно выкинуть?
Крутиться целому роботу не обязательно, можно ему сделать "башню", которая и будет крутиться, постоянно, а на башню приемник.
2-3 градуса для компаса в квартире - малореально. Если дом железобетонный, на полу будет что попало, а не линейное магнитное поле Земли.

Имхо, маяки лучше поставить как можно дальше, по углам комнаты например. Точность позиционирования внутри треугольника между маяками будет максимальной.