
- •Итоговый научно-технический отчет
- •Нир 304-5г
- •Реферат
- •Содержание
- •Обозначения и сокращения
- •Введение
- •Разработка алгоритмов и макета комплекса визуально-инерциальной навигации
- •Сравнительный анализ алгоритмов одновременной локализации и построения карты припомощи телекамеры
- •Модель центральной перспективной проекции
- •Описание модели
- •Переход от системы координат камеры к системе координат изображения
- •Однородные координаты
- •Внутренние и внешние параметры калибровки. Уравнение перспективной проекции
- •Структура из движения –StructureFromMotion
- •Обратное представление глубины
- •Проблема масштаба
- •Алгоритмы выделения устойчивых признаков
- •Детектор углов Харриса
- •Окрестность с субпиксельной точностью
- •GoodFeaturesToTrack
- •Выбор аппаратной платформы комплекса визуальной навигации
- •Разработка оптимальных алгоритмов одновременной локализации и построения карты при помощи телекамеры (V-slam) с учетом данных инерциальной навигации
- •Макет модуля визуальной навигации
- •Описание экспериментов и результаты
- •Коридор, движение близкое к прямолинейному.
- •Стенд мобильных роботов, различные траектории
- •Внутренний двор
- •Точность определения пройденного расстояния
- •Точность определения курсового угла
- •Разработка стерео-телевизионного модуля высокого разрешения
- •Литературный обзор по тематике создания телевизионных камер высокого разрешения
- •Структурная схема блока стереоизмерений
- •Описание работы структурной схемы устройства
- •Разработка принципиальной схемы блока стереоизмерений
- •Конструктив блока стереоизмерений, объективы, элементная база коммуникационного устройства
- •Описание конструктивного решения налобного козырька
- •Выбор элементной базы
- •Цифровые телевизионные матрицы
- •Микросхема семейства cyclone III фирмы Altera(сша)
- •Микросхемы синхронной динамической памяти sdram mt48lc4m32b2
- •Топология печатной платы
- •Интеллектуальное программируемое ядро вычисления диспарантности
- •Симуляционное моделирование работы программируемого ядра
- •Симуляционное моделирование алгоритмов направленного движения
- •Макетная печатная плата
- •Интерфейсное программное обеспечение
- •Интерфейсное программное обеспечение низкого уровня
- •Интерфейсное программное обеспечение высокого уровня
- •Анализ возможности реализации разработанных алгоритмов в системах охраны объектов, системах технического зрения для слепых и слабовидящих, беспилотных транспортных систем
- •Описание экспериментов и результаты
- •Заключение
- •Список использованных источников
- •Приложение а. Выписка из протокола заседания нтс
- •Приложение б. Список публикаций
- •Приложение в. Результаты, подлежащие регистрации
Однородные координаты
Декартовы координаты позволяют с помощью матриц 3х3 описывать преобразования, связанные с вращением и масштабированием, однако, они не позволяют одновременно описывать и смещение. Таким образом, декартовы координаты не позволяют использовать матричную запись для задания перспективного преобразования точек.
Для записи перспективного преобразования координат в матричном виде введем понятие однородных координат.
Однородные координаты – это математический механизм, связанный с определением положения точек в пространстве.
Однородными координатами точки P=(x1,x2,…..xn),
называются координатыPhom=(wx1,wx2,…..wxn,w),
,
причем хотя бы один элемент должен быть
отличен от нуля.
Однородные координаты точки (x,y) равны (wx,wy,w) для любого ненулевогоw. С другой стороны точке с однородными координатами (x,y,w) однозначно соответствует точка (x/w,y/w) (Вообще двумерное представление точки (x,y,w) есть ее проекция на плоскостьw=1). Таким образом, преобразование из однородных координат в евклидовы однозначно, преобразование из евклидовых координат в однородные – нет.
Однородные координаты позволяют:
описать бесконечно удаленную точку;
использовать унифицированный механизм работы с матрицами для выражения преобразований точек.
Внутренние и внешние параметры калибровки. Уравнение перспективной проекции
Введем следующие обозначения:
M=[X, Y, Z]T– вектор координат трехмерной точки М в системе координат камеры;
m=[u,v]T– вектор координат проекции точкиMв системе координат плоскости изображения;
M=[X, Y, Z, 1]T– вектор однородных координат точки М в системе координат камеры;
m=[u,v, 1]T– вектор однородных координат проекции точкиMв системе координат плоскость изображения;
Тогда– матрица внутренних параметров камеры
К внутренним параметрам камеры относятся следующие параметры:
α=f/k,β=f/l, где f – фокусное расстояние, а k, l – размеры пикселя (так как параметры f, k, l не являются независимыми, то вместо них используют два параметра: α и β, которые задают фокусное расстояние в пикселях по осям U и V соответственно);
координаты главной точки в системе координат изображения (u0, v0);
угол между двумя координатными осями изображения θ (θ1=
);
В данном случае предполагается, что камера оснащена идеальными линзами, и нет никаких искажений.
Используя введенные обозначения, можно записать в компактной векторно-матричной записи:
До сих пор мы рассматривали случай, когда трехмерные координаты точки заданы в системе координат, которая совпадает с системой координат камеры. В общем случае трехмерные координаты точки могут быть заданы в системе координат, не совпадающей со стандартной системой координат камеры. Назовем эту систему координат мировой или глобальной.
Пусть OXYZ– мировая система координат. Тогда переход от системыOXYZк системеOСXСYСZС можно осуществить поворотом координатных осей и последующим переносом начала координат. Тогда связь между координатами точкиMв мировой системе и системе координат камеры может быть представлена как:
,
где:
M– вектор пространственных координат точкиMв мировой системе координат;
Mc– вектор пространственных координат точкиMв системе координат камеры;
R– матрица вращения (3х3);
t– вектор переноса.
В матричном виде координаты точки Mв системе координат камеры можно записать
как,
гдеMc==[X,Y,Z, 1]T- вектор однородных координат точкиMв мировой системе координат.
Три угла определяющие поворот и три координаты вектора tназываются внешними параметрами калибровки.
Внешние параметры связывают между собой мировую систему координат и систему координат камеры, то есть позволяют определять координаты точки в системе координат камеры, если известны ее координаты в мировой системе координат.
Правило перехода от мировой системы координат к системе координат изображения (для модели перспективной проекции) можно записать как:
или
При этом, если через
обозначить три строки матрицыH,
то из уравнения (2.4.4) следует, чтоz=h3M(запись через скалярное
произведение двух векторов,z– представляет собой координату точки
М по осиZCв системе координат камеры, так как:
):
Это уравнение является самым общим видом уравнения перспективной проекции.
Проекционная матрица Hвключает в себя 11 параметров: 5 внутренних параметров и 6 внешних. Под полной калибровкой камеры подразумевается нахождение оценок как внутренних, так и внешних параметров.