В продолжении развития проекта работаем над одометрией (будь она не ладна!), и задумались над тем, как уменьшить слепую зону впереди робота создаваемую сенсором KINECT. Я имею в виду то, что, как известно, сенсор начинает "видеть" объекты с расстояния от 80 см и до 3,5 метров. Дальность три с половиной метра в условиях помещения вполне достаточно для робота, а вот 80 см слепой зоны спереди это очень много! Одним из первоначальных решений было установить сенсор как можно ближе к задней части робота, это сократило слепую зону на 20 см., но и этого в реальности не достаточно. И вот одному из нас в голову приходит идея развернуть сенсор вертикально. Как известно угол обзора сенсора составляет по горизонтали - 57 градусов, по вертикали - 43 градуса, т.е. теоретически развернув сенсор можно получить больший угол обзора. Мы провели эксперимент. Поставили рябом с роботом на подставке еще одни сенсор, но развернули его на 90 градусов:
Вложение:
IMAG0343.jpg [ 918.71 КиБ | Просмотров: 3942 ]
Результаты эксперимента обнадежили. Действительно в таком положении сенсор захватывал по вертикали бОльшую зону, правда, естественно, обзор сузился по горизонтали, но это особо не является проблемой, т.к. такого угла зрения, по горизонтали, вполне достаточно для одометрии. Таким образом, у нас появилась надежда расширить угол обзора по вертикали и еще немного сократить слепую зону впереди робота.
Но возникла новая трудность - картинка возвращаемая сенсором тоже повернулась на 90 градусов. Нет проблем с видео, средствами OpenCV все это быстро приводится в порядок, а вот с картой глубины, которая как раз и используется в одометрии все намного сложнее. Пришлось написать алгоритм пересчета данных из линейного потока в структуру cvMat. Сложность была в том, что строки должны были стать столбцами, а столбцы напротив строками, и эту информацию (о строках и столбцах) нужно было извлечь из прямолинейного потока кадра, который изначально не представляет из себя ничего общего с видео кадром. Кроме того нужно было сохранить самое главное - данные о глубине сцены. В общем, после некоторых мучений, наконец добились положительного результата. Теперь угол зрения по горизонтали стал больше, а главное еще почти на 10 см. сократилась слепая зона и теперь составляет чуть больше 50-ти см. Конечно и это еще большое значение, но здесь помогают инфракрасные датчики и механический бампер установленные в передней части робота.
Для установки сенсора в тело робота пришлось немного видоизменить конструкцию туловища. Теперь робот с вертикальным KINECT-ом выглядит вот так:
Вложение:
IMAG0348.jpg [ 682.66 КиБ | Просмотров: 3919 ]
А вот первые результаты печати на 3D принтере. Нарисовали и распечатали прототипы шестеренок для рук-манипуляторов робота:
Вложение:
IMAG0349.jpg [ 820.69 КиБ | Просмотров: 3924 ]
Вход
Регистрация
FAQ
Поиск
как LUM тыкается, как слепой котенок, о дверной косяк или угол шкафа, благо IR сенсоры спереди срабатывали и не давали роботу столкнуться с препятствием и окончательно разбить наши надежды и самого робота. Решение пришло, как обычно, нежданно. В очередной из таких печальных столкновений, голова робота от резкой остановки опустилась вперед вниз (привод шеи был отключен и башка болталась просто так, сама по себе). И на мониторе ПК мы увидели замечательную картинку с сенсора головы LUM-а. Как на ладони виден был пол, со всеми предметами лежащими на нем. Таким образом было принято совершенно дикое и безумное решение установить ТРЕТИЙ!!! KINECT на робота. За то теперь мы имеем следующие возможности - сенсор в голове следит за человеком, а так же предполагается что частично будет задействован в навигации. Сенсор установленный в теле робота отвечает собственно за навигацию и SLAM. Третий сенсор работает как детектор возможных препятствий на полу, так же он детектирует перепады высот (ступени вниз или вверх). Главное что сенсор видит буквально от переднего бампера робота и до 80 см. вперед. Таким образом, мы перекрыли слепую зону спереди LUM-а, можем определять и объезжать как предметы лежащие на полу (причем любого размера), так и детектировать лестницу вниз (т.е. робот не упадет со ступенек).
