СПОСОБ СНИЖЕНИЯ ПОГРЕШНОСТИ ОЦЕНОК СОБСТВЕННЫХ КООРДИНАТ АВТОНОМНОГО НЕОБИТАЕМОГО ПОДВОДНОГО АППАРАТА С ИНЕРЦИАЛЬНОЙ НАВИГАЦИОННОЙ СИСТЕМОЙ Российский патент 2014 года по МПК G01C21/00 

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

Известны способы навигации подвижных объектов (патенты России 2284544, 2338158, 2340874, 2385468), которые обеспечивают определение местоположения подвижных объектов.

Недостатком указанных способов навигации подвижных объектов является то, что управление движением объекта происходит по изначально известным системе навигации эталонным картам местности. Кроме того, местоположение подвижных объектов определяется только с использованием комплекса средств уточнения координат относительно априорно известных объектов.

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

Целью изобретения является коррекция собственных координат автономного необитаемого подводного аппарата, позволяющая снизить погрешность при его движении.

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

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

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

Пусть известна оценка одной координаты одного движущегося автономного необитаемого подводного аппарата $${\widehat{x}}_i$$ с дисперсией $${\sigma }_i^2$$ , причем: $${\sigma }_i^2=i{\gamma }^2$$ , где $${\gamma }^2$$ - приращение дисперсии за 1 шаг при использовании доплеровских систем.

Эту оценку определяют как: $${\widehat{x}}_i=x_i+{\varsigma }_i$$ , где $${\varsigma }_i={\displaystyle \sum _{l=1}^i{\delta }_l}$$ ; $${\delta }_l$$ - независимые случайные величины с дисперсиями $${\gamma }^2$$ [Лукомский Ю.А., Пешехонов В.Г., Скороходов Д.А. Навигация и управление движением. - СПб.: «Элмор», 2002. - 360 с.].

На i-м шаге после обнаружения, средствами технического зрения, заранее неизвестного неподвижного подводного объекта получают наблюдение с помощью технического зрения, которое имеет вид: $$z_i=x_i-x_0+{\xi }_i$$ , где $${\xi }_i$$ - ошибка технического зрения с дисперсией $${\sigma }_{\xi }^2.$$ Усредняя несколько наблюдений, определяют оценку координаты заранее неизвестного неподвижного обнаруженного подводного объекта: $${\widehat{x}}_0={\widehat{x}}_i-z_i$$ , с дисперсией $${\sigma }_0^2={\sigma }_{\xi }^2+{\sigma }_i^2$$ .

Теперь на (i+1) шаге, когда автономный необитаемый подводный аппарат переместился по траектории за время Δt, получают две оценки для его собственной координаты положения. Первую оценку получают по его модели движения: $${\widehat{x}}_{i+1}={\widehat{x}}_i+{\widehat{v}}_i\Delta t$$ с дисперсией $${\sigma }_{i+1}^2={\sigma }_i^2+{\sigma }_{vi}^2$$ . Вторую оценку получают за счет использования технического зрения на (i+1) шаге: z_i+1=x_i+1-x₀+ξ_i, $${\widehat{\widehat{x}}}_{i+1}=z_{i+1}+{\widehat{x}}_0$$ c дисперсией: $${\sigma }_{Ti+1}^2={\sigma }_{\xi }^2+{\sigma }_0^2={\sigma }_i^2+2{\sigma }_{\xi }^2$$ . После объединения этих двух оценок при условии, что погрешность технического зрения очень мала, по отношению к погрешности инерциальной системы $${\sigma }_{\xi }^2<<{\sigma }_{vi}^2$$ получают оценку координаты положения подводного аппарата $${\widehat{x}}_{i+1}$$ c дисперсией ошибки меньшей, чем в случае, без использования технического зрения на величину $${\sigma }_{vi}^2$$ , тогда $${\sigma }_{i+1}^2\approx {\sigma }_i^2$$ , т.е. при достаточно низкой погрешности технического зрения, ошибка определения собственных координат подводного аппарата практически не будет возрастать.

В случае обнаружения одновременно нескольких заранее неизвестных неподвижных подводных объектов получают наблюдения $$z_k=x_k-x_0+{\xi }_k$$ , с использованием которых определяют дополнительные оценки собственных координат движущегося автономного необитаемого подводного аппарата.

Объединив все оценки, корректируют собственные координаты автономного необитаемого подводного аппарата, что позволяет снизить погрешность управления его движением.

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

Способ снижения погрешности оценок собственных координат автономного необитаемого подводного аппарата с инерциальной навигационной системой и средствами технического зрения, заключающийся в том, что при движении автономного необитаемого подводного аппарата по заданной траектории выделяют один или несколько заранее неизвестных неподвижных подводных объектов, обнаруженных средствами технического зрения, далее с помощью итерационного процесса корректируют собственные координаты подводного аппарата с дисперсией , где - приращение дисперсии за 1 шаг, на основе формирования модели его относительного движения по отношению к наблюдаемым подводным объектам с заранее неопределенными координатами, а именно на i-м шаге после обнаружения, средствами технического зрения, заранее неизвестного неподвижного подводного объекта получают наблюдение с помощью технического зрения, которое формируют в виде: , где - ошибка технического зрения с дисперсией , затем усредняют несколько наблюдений, определяют оценку координаты заранее неизвестного неподвижного обнаруженного подводного объекта: , с дисперсией , на (i+1) шаге, когда автономный необитаемый подводный аппарат переместился по траектории за время Δt, получают две оценки для его собственной координаты положения, первую оценку получают по его модели движения: с дисперсией , вторую оценку получают за счет использования технического зрения на (i+1) шаге: z_i+1=x_i+1-x₀+ξ_i, c дисперсией: , после объединения этих двух оценок при условии, что погрешность технического зрения очень мала, по отношению к погрешности инерциальной системы , получают оценку координаты положения подводного аппарата c дисперсией ошибки меньшей, чем в случае без использования технического зрения на величину , в случае обнаружения одновременно нескольких заранее неизвестных неподвижных подводных объектов получают наблюдения для каждого из них, с использованием которых определяют дополнительные оценки собственных координат движущегося автономного необитаемого подводного аппарата.