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

Использование автономной навигационной системы высокоточного позиционирования пешехода на местности Текст научной статьи по специальности «Физика»

CC BY
643
150
i Надоели баннеры? Вы всегда можете отключить рекламу.
Область наук
Ключевые слова
АВТОНОМНАЯ НАВИГАЦИЯ / ИНЕРЦИАЛЬНАЯ НАВИГАЦИОННАЯ СИСТЕМА / ФИЛЬТР КАЛМАНА / АКСЕЛЕРОМЕТР / ГИРОСКОП / AUTONOMOUS NAVIGATION / INERTIAL NAVIGATION SYSTEM / KALMAN FILTER / ACCELEROMETER / GYROSCOPE

Аннотация научной статьи по физике, автор научной работы — Каплин Александр Юрьевич, Степанов Михаил Георгиевич

Постановка проблемы: в настоящее время для определения координат человека на плоскости используется автономная навигационная система, куда входят трехосевой акселерометр и трехосевой гироскоп. Недостатком данной системы является накопление со временем ошибки информации, поступающей от составляющих системы за счет неучтенных систематических погрешностей. Эту ошибку невозможно компенсировать без дополнительного внешнего источника информации. Цель: исследовать возможность адаптации алгоритмов обработки инерциальной системы определения координат с использованием данных от внешнего источника и разработать алгоритм комплексирования информации в целях компенсации ошибок при позиционировании человека на местности. Результаты: показана возможность и предложен метод комплексирования информации от автономной инерциальной навигационной системы и внешнего независимого источника информации, в качестве которой выступает информационный сигнал от биомеханической модели движения пешехода. Метод представлен в виде двух алгоритмов. Первый алгоритм реализован в виде разомкнутой схемы, при котором структура инерциальной системы не меняется; второй в виде замкнутой схемы с обратной связью, при этом структура инерциальной системы меняется, однако она более устойчива к изменению предположений, принятых при синтезе предложенных алгоритмов. Практическая значимость: высокоточное определение координат человека на местности необходимо во многих ситуациях, в частности, при проведении спасательных работ сотрудниками МЧС.

i Надоели баннеры? Вы всегда можете отключить рекламу.
iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.
i Надоели баннеры? Вы всегда можете отключить рекламу.

Using Autonomous Navigation Systems for High-Precision Positioning of a Pedestrian on the Ground

Introduction: Currently, to determine the coordinates of a pedestrian on the ground, an autonomous navigation system is used, which includes a triaxial accelerometer and a triaxial gyroscope. A disadvantage of this system is the gradual accumulation of erroneous information from its components, due to unaccounted systematic errors. This accumulated error cannot be compensated without an additional external source of information. Purpose: The goal of this work is investigating the possibility to adapt the algorithms of an inertial coordinate reference system using data from an external source, and developing an algorithm to integrate the information in order to compensate for the errors in the positioning of the pedestrian. Results: The possibility is demonstrsated and a method is suggested for integrating the information from an autonomous inertial navigation system and an external independent source of information which is an information signal from a biomechanical model of pedestrian movement. The method is represented by two algorithms. The first algorithm is implemented in the form of an open circuit in which the structure of the inertial system does not change. The second one is implemented as a closed circuit with a feedback. The structure of the inertial system changes, but it is more resistant to changes in the assumptions made during the synthesis of the proposed algorithms. Practical relevance: High-precision determination of the coordinates of a pedestrian on the ground is necessary in many situations, particularly when performing rescue operations.

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

ИНФОРМАЦИОННО-ИЗМЕРИТЕЛЬНЫЕ СИСТЕМЫ X

УДК 621.396.96

с1о1:10.15217/1ззп1684-8853.2015.6.86

ИСПОЛЬЗОВАНИЕ АВТОНОМНОЙ НАВИГАЦИОННОЙ СИСТЕМЫ ВЫСОКОТОЧНОГО ПОЗИЦИОНИРОВАНИЯ ПЕШЕХОДА НА МЕСТНОСТИ

А. Ю. Каплина, канд. техн. наук

М. Г. Степанова, доктор техн. наук, профессор

аОАО «Радиоавионика», Санкт-Петербург, РФ

Постановка проблемы: в настоящее время для определения координат человека на плоскости используется автономная навигационная система, куда входят трехосевой акселерометр и трехосевой гироскоп. Недостатком данной системы является накопление со временем ошибки информации, поступающей от составляющих системы за счет неучтенных систематических погрешностей. Эту ошибку невозможно компенсировать без дополнительного внешнего источника информации. Цель: исследовать возможность адаптации алгоритмов обработки инерциальной системы определения координат с использованием данных от внешнего источника и разработать алгоритм комплексирования информации в целях компенсации ошибок при позиционировании человека на местности. Результаты: показана возможность и предложен метод комплексирования информации от автономной инерциальной навигационной системы и внешнего независимого источника информации, в качестве которой выступает информационный сигнал от биомеханической модели движения пешехода. Метод представлен в виде двух алгоритмов. Первый алгоритм реализован в виде разомкнутой схемы, при котором структура инерциальной системы не меняется; второй — в виде замкнутой схемы с обратной связью, при этом структура инерциальной системы меняется, однако она более устойчива к изменению предположений, принятых при синтезе предложенных алгоритмов. Практическая значимость: высокоточное определение координат человека на местности необходимо во многих ситуациях, в частности, при проведении спасательных работ сотрудниками МЧС.

Ключевые слова — автономная навигация, инерциальная навигационная система, фильтр Калмана, акселерометр, гироскоп.

Введение

Система определения координат человека на местности реализуется в виде модуля автономной навигации (МАН), который крепится на талии или торсе человека. В своей основе МАН строится как бесплатформенная инерциальная навигационная система (ИНС), реализующая счисление скорости и ее коррекцию от источника внешней информации. МАН состоит из 1) канала определения скорости и текущих координат человека и 2) угломерного азимутального канала.

В канал скорости и текущих координат входят: инерциальная навигационная система, в составе которой имеется трехоcевой акселерометр и трехосевой гироскоп; вычислитель, реализующий алгоритмы работы МАН; внешний источник информации — биомеханическая модель движения пешехода. В угломерном канале используется тот же трехоcевой акселерометр, датчик угловой скорости и трехоcевой магнитометр. В работе рассматривается канал определения скорости и текущих координат, при этом используются данные об азимуте, получаемые из угломерного канала.

Система координат МАН

В модуле автономной навигации используются три системы координат (рис. 1).

1. Система Охуг — местная географическая система координат с началом в центре масс МАН. Оси Ох и Оу лежат в плоскости местного горизонта, причем ось Ох направлена на восток, а ось Оу — на север. Ось Ог совпадает с местной вертикалью. В этой системе координат представляется конечное решение задачи навигации человека.

2. Связанная система координат, соответствующая номинальному (горизонтальному) положению ИНС в отсутствие возмущений по азимуту а

вигации

и углам горизонтального наклона (идеальная ИНС). Ось Oy' системы совпадает с направлением движения. Данная система координат предполагает, что горизонтальное положение обеспечивается точным пересчетом (компенсацией горизонтальных углов наклона) данных акселерометра по угловым скоростям ю„, и юУ,, измеряемым дат-

X y

чиком угловой скорости.

3. Ox"y"z" — возмущенная по азимуту связанная система координат, положение горизонтальных осей Ox", Oy" которой отличается от осей Ox', Oy' на угол х в силу «виляющей» походки человека, «болтания» корпуса МАН на его теле и других причин. Угол х определяется по измерениям угловой скорости ю2 датчиком угловой скорости. Оси чувствительности акселерометра и датчика угловой скорости совпадают с соответствующими осями системы Ox"y"z".

Алгоритм работы идеальной ИНС. Анализ погрешностей реальной ИНС

Рассмотрим сначала работу идеальной ИНС, которая описывается известными базовыми соотношениями. При невозмущенном по азимуту движении (х = 0) проекции кажущегося ускорения a(t), фиксируемые горизонтальными осями акселерометра, равны ax,(t) = 0, ay,(t) = a(t) (см. рис. 1).

x У

В дальнейшем, для сокращения записи, зависимость от времени t, где это возможно, опустим.

При возмущенном движении акселерометр фиксирует проекции ax,, = a sin х, ay,, = a cos х, которые при известном х легко приводятся к a:

а = ах" sin х + ауп cos х- (1)

По измеренному ускорению a путем интегрирования (первый интегратор ИНС) определяется текущая скорость в момент t

t

V(t) = ¡ a(r )dr, (2)

где t0 — начальный момент движения.

По известным скорости V и азимуту a можно вычислить географические компоненты Vx = = V sin a, Vy = V cos a, повторное интегрирование которых (второй интегратор ИНС) дает искомые текущие координаты

t t x(t) =¡ Vx (r)dr; y(t) =¡ Vy (r )dr. (3)

t0 t0

В современных быстродействующих цифровых ИНС интегрирование в (2) и (3) достаточно точно выполняется суммированием дискретных данных.

В реальных ИНС прямое использование соотношений (2) и (3) без дополнительных мер по обе-

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

В научной литературе по инерциальной навигации и оптимальной фильтрации содержится подробный анализ погрешностей наземных и околоземных ИНС различных типов [1-3]. Применительно к рассматриваемой пешеходной ИНС анализ показывает [4], что при скорости 5-7 км/ч и продолжительности движения около 1-1,5 ч наиболее значимыми являются медленно меняющиеся погрешности 8Ух, 8Уу компонентов вычисляемых скоростей Ух, Уу, связанные с ошибками горизонтирования Рх, Ру (остаточными, не скомпенсированными углами горизонтальных наклонов), проекциями смещений нулей акселерометров Вх, Ву и дрейфов гироскопов ех, гу. Погрешности 8УХ, 8Уу также вызываются такими систематическими факторами, как неточность масштабных коэффициентов, неточный учет кориолисова ускорения, несоосность чувствительных и строительных осей инерциаль-ных датчиков и др.

Для рассматриваемых условий к погрешностям ИНС применим метод аппроксимации погрешностей колебаниями на частоте Шулера (период колебаний 84,4 мин) [2]. При этом подходе погрешности моделируются дифференциальными уравнениями [4, 5]

5ТХ =~ё$у +ВХ; ру = —Х + еу;

Л

• • §Vy

SVy = gPx + By; Px =-—y + ex.

R

(4)

где g — ускорение силы тяжести; Я — радиус Земли.

Заметим, что при сделанных допущениях горизонтальные каналы компонентов Ух, Уу и вертикальный канал (используется далее) никак не связаны, и их данные могут обрабатываться независимо и раздельно друг от друга. Ниже, для конкретности, рассматривается канал компонента Ух. Обработка данных в канале Уу ведется аналогично.

От уравнений (4) перейдем к матричному уравнению состояния (формирующего фильтра)

(sVx ^ (0 -

8 У

V y /

1 0 R 0

0 1

0 0

А,

SVx

8y V y /

(w ^

(5)

где wa, w8 — шумы системы (шумы инерциаль-ных датчиков).

t

0

В выражении (5) учтено, что для пешеходных ИНС смещение нуля акселерометра Bx имеет меньшее значение, чем остальные погрешности. Поэтому без потери строгости рассмотрения вклад Bx включен в величину 5Fx.

Переходя в (5) к векторно-матричной форме, получим

x (t) = F • x(t) + w(t), (6)

где x(t) = _SVX(t), py (t), By (t)] — вектор состояния; w(t) =\_wa(t), 0, wB (t)]T — вектор шумов си-f 0 -g 0 1

стемы; F =

1 0 R

0

1

0 0

матрица состояния.

Дискретный аналог уравнения состояния (6) имеет вид

x(tk) = Ф(tk, tk-1) • x(tk-i) + w(tk-i), k = 1,2,..., (7)

где x(tk) = \8V*(tk Ъ Py (tk), By (tk)]T;

T

w(tk ) =\_wa (tk ), 0 wb (tk )] ;

r 1 -gTk

Ф (tk, tk-1 ) =

Tk 1

R

0 0

Л

переходная матри-

ца, Тк = ^ _ tk_1 — шаг во времени.

Считается, что ковариационная матрица

Q(ík) = М ) • (^ )] шумов системы (7) постоянна во времени, равна

Q(tk) = Q =

^2 ста

0 0

0 0

0 0

0 _2

и определяется известными дисперсиями а„, шумовых составляющих погрешностей инерци-альных датчиков. Здесь М[ ] — знак математического ожидания.

Итак, формируемое ИНС мгновенное значение компонента скорости Ух представляет собой сумму УИНС = Ух + 8Ух истинного (естественно, неизвестного) значения Ух и погрешности 5Ух, являющейся первым элементом вектора состояния x в (6), (7).

Аналогичное представление уИНС = Уу + 5Уу

F =

( 0 g 0 1 ( 1 gTk 01

-1 R 0 1 ; Ф(Ч, tk-1) = -Tk R 1 Tk

0 V 0 0 / 0 V 0 1 /

справедливо для другого компонента скорости, пРи этом х = [дУу, , ]Т.

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

Комплексирование ИНС и внешнего источника. Алгоритм расчета «виртуальной» скорости

Известно [2], что за счет «внутренних резервов» (введением каких-либо внутренних связей

и дополнений) скоростные ошибки ИНС 5Ух, 5У„

х у

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

Рассмотрим метод комплексирования скорости пешеходной ИНС с использованием биомеханической модели движения человека, позволяющей формировать «виртуальное» измерение средней скорости на шаге.

Из числа известных моделей выберем наиболее простую и наглядную кинетическую модель бесколенного двуногого робота, совершающего движения способом поворотного маятника с длиной ноги I (длина ноги пешехода) и вертикальным перемещением центра масс к [4, 6]. Из простых геометрических построений следует, что в этом случае величина шага АЬ рассчитывается по формуле

АЬ = - Н2.

На практике для реального пешехода коэффициент «2» перед квадратным корнем может быть заменен на постоянную «с», определяемую предварительно при калибровке. Величина к рассчитывается двойным пошаговым интегрированием ускорения а2, измеряемого акселерометром в вертикальном канале ИНС:

h = Я a

-drdt.

Для этой модели средняя скорость на к-м шаге равна отношению длины шага АЬ(^) к его длительности Тк = tk _ tk_1 (в общем случае переменной), где tk, tk_1 — моменты начала и конца шага:

АЩк)

Vвн (tk) =-

Tk

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

Важной составляющей алгоритма «виртуального» измерения средней скорости является способ фиксации моментов начала и конца шага. Известны способы идентификации шага, основанные на сравнении измеряемого вертикального ускорения с установленным порогом [7, 8]. Однако подобные способы требуют большого объема индивидуальных экспериментальных данных, набора порогов для различных типов движения (ходьба, бег, подъем, спуск, ползанье и др.), а также набора поверхностей, по которым движется пешеход (твердая, рыхлая, скользкая и т. п.), и носят эмпирический характер.

Наиболее предпочтительным является способ идентификации шага по величине модуля векто-

I 2 2 2~

ра ускорения а = Л а х- - + ау - - + а2 - -, определяемого

по измерениям трехосевого акселерометра [9]. При этом способе начало (конец) шага определяется как момент перехода через ноль разности измеренного модуля а и ускорения силы тяжести g в данном месте. Важным преимуществом способа является независимость от ориентации пешехода (стоя, лежа, в наклонном положении).

Среднюю скорость УВН можно, как и ранее,

разложить на два компонента УВН, Уун. Важным отличием УХВЖ, У™ от компонентов УИНС, УИНС является то, что погрешности первых обусловлены действием большого числа независимых, различных по природе источников случайных ошибок: погрешностей модели движения, ошибок измерений акселерометра, неточностей определения моментов начала и конца шага, погрешностей расчета вертикального смещения к и др. Поэтому компоненты УХн, Уун можно рассматривать как несмещенные относительно истинных значений УХ, Уу (без систематических медленно меняющихся ошибок) случайные величины:

УХИ = Ух + Пх; УВН = Уу + Пу,

где ^ п

некоррелированные друг с другом и с погрешностями горизонтального канала ИНС

у

гауссовы шумы (в силу аддитивного воздействия перечисленных выше случайных факторов).

Экспериментальные данные показывают, что даже при движении пешехода с почти постоянной скоростью профиль скорости на каждом шаге имеет колебательный характер с амплитудой порядка 0,3 м/с относительно средней скорости ходьбы [4]. Поскольку мгновенное значение компонента УИНС (аналогично У|ИНС), формируемого ИНС, имеет тот же профиль, сравнивать его с УВН нельзя. Поэтому от УИНС следует перейти к пошаговой средней скорости

1 **

уинс = 1 Г уИНСйг =

х х

1 _

= — | (Ух +8Ух)Лг = Ух +8Ух.

1к-1

Здесь учтено, что медленно меняющаяся погрешность скорости 8Ух в течение шага практически постоянна.

В результате комплексирование ИНС и кинетической модели пешехода с использованием средних скоростей УхИНС (¿г), УвН (¿к) позволяет перейти к разности (скалярной величине) «х (¿Г) = УхИНС (¿к ) - УхВН (¿Г) = 8Ух (¿Г ) + Пх (Ч), где пх(к — гауссов шум средней скорости УВН (¿г ) с дисперсией ах. Разность 8х^к) при дальнейшей обработке служит входным измерением для фильтра Калмана [10], формирующего пошаговую оптимальную оценку 8У) погрешности 8Ух(^). Эта оценка и используется при расчете сигналов коррекции ИНС (рис. 2). При этом возможны два подхода: коррекция ИНС по разомкнутой схеме, которая не затрагивает структуру ИНС, и по замкнутой схеме, с использованием отрицательной обратной связи. На рис. 2 показана последовательность изложенных алгоритмов и процедур, моделирующих ИНС с комплексирова-нием от внешнего источника.

вта

а(г)

/ (■ №

У(0 У&)

x(0) w(t*-l) +

1 4

VI(■

Ух(Ч)

x(t*)

x(tk/tk-l)

4-1)

Тъ

Н

ЗУх(^к)

Модель ИНС

УхИНС(^к)

У^к)

^х^к)

■ Рис. 2. Структурная схема модели ИНС

Алгоритм коррекции ИНС по разомкнутой схеме

При разомкнутой схеме коррекции фильтр Калмана имеет традиционную структуру [10], повторяющую уравнение состояния (7), описывающее динамику оцениваемого вектора состояния х(Ь) = [5Ух), ву %), )]т. Уравнение фильтра имеет вид

х(%) = ф(%, \-1) • х(^-1) + К(?к) х X (ъ) - Н • Ф(гк, гк-1) • Х(^-1)),

х(0) — начальное условие, (8)

где Н = [1,0,0].

Коэффициент усиления K(tk) = [К1(Ь]), К2(^), К^У равен

[ Рц(Ч)"

К^к) = ^т Р&) • Нт = ±

ах

Р21 (Ч ) Рз1(*к)

(9)

где [Ри(^), Р21(У, Р31(У]Т — первый столбец ковариационной матрицы P(tk) ошибок калма-

новской оценки х^) = [5Ух ^к), в у (Ч), ё у (Ч)] .

Матрица P(tk) определяется соотношениями

) = ф&, ^к-1) • Р(^к-1) • Фт (ч, *к-1)+

(

Р(^к) =

(

-1

Р-1 ^фк-\) +

стх 0 0 0 0 0 0

Л -1

Н

V

ЛЛ -1

(10)

Здесь Q — матрица дисперсий шумов инер-циальных датчиков. Значение первого элемен-

та 5Ух^к /tк-l) экстраполированной векторной оценки х = (tk/tk-l) = Ф(£к,^к-1)• х^к^) подается на выход ИНС, где происходит коррекция (компенсация) ошибки 5Ух(;к) в выходном сигнале ИНС:

^0рр )=ухяс ) - 5ух (tk/ tk-l)=

= ^к (tk) + (дУх ^) - 5Т^х(tk / tk-l)). (11)

Алгоритм коррекции (11) иллюстрируется структурной схемой (рис. 3). В левой части рисунка приведен фрагмент модели ИНС, представленной на рис. 2.

Рассмотренная разомкнутая схема коррекции не затрагивает структуру и динамику ИНС (вектор состояния x(tk)), а только «сбрасывает» ее ошибку на выходе. В этом случае роль ошибки ИНС играет ошибка экстраполированной оценки 5Ух ^к / tk-l), определяемая первым диагональным элементом ковариационной матрицы P(tk / ^-1). В номинальном режиме работы фильтра Калмана эта ошибка существенно меньше исходной погрешности 5Ух^к).

Алгоритм коррекции ИНС по замкнутой схеме

Замкнутая схема предусматривает изменение структуры ИНС за счет отрицательной обратной связи фильтра Калмана по экстраполированной оценке х^к / tk-l). В этом случае коррекции подвергается исходный вектор состояния

х^к) = [5УхК ву (tk X еу (tk)]Т т. е. формируется

разность х^к) - х^к / tk-l), которая далее оценивается фильтром Калмана. Иными словами, уравнение состояния (7) трансформируется к виду

х(%) = Ф(%, tk-1 ) • х^к-1 ) + w(tk-l ) -- Ф(tk, tk-1) • х(^-1).

(12)

Рассматривая корректирующее слагаемое Ф(tk ,tk-l) • х^к-1) в (12) как известную детерми-

■ Рис. 3. Структурная схема алгоритма коррекции по разомкнутой схеме

ИНФОРМАЦИОННО-ИЗМЕРИТЕЛЬНЫЕ СИСТЕМЫ

Vx(th)

x(th)

Н

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

8 Vx(th)

Модель ИНС

vr(h)

Sx(th)

8Vx(h/h-x)

■ Рис. 4. Структурная схема алгоритма коррекции по замкнутой схеме

x(0)

x(tk) Tk 1-1

V(tk- i)

x(tk/tk-i)

ф(^> tk-1)

нированную управляющую функцию [2], приходим к более простой по сравнению с (8) форме фильтра Калмана

) = ) • ^к), х(0) — начальное условие. (13)

Для фильтра (13) остаются справедливыми соотношения (9), (10).

Структурная схема алгоритма применительно к рассматриваемой задаче коррекции ИНС по ошибке скорости 5Ух^к) приведена на рис. 4. Заметим, что в этом случае входное измерение для фильтра Калмана равно Sx(tk) =

= (Ч) - 5Ух (Ч / )+пх (Ч )•

В номинальных условиях разомкнутый и замкнутый алгоритмы коррекции по точности эквивалентны. Свидетельством этому является общность для обоих алгоритмов априорной ковариационной матрицы ошибок фильтрации P(tk). Однако на практике в условиях неизбежных отличий принятых моделей ИНС и внешнего источника и, как следствие, настроек фильтров от реальной динамики процесса навигации пешехода более предпочтительным является алгоритм коррекции по замкнутой схеме. Причина этого — наличие в структуре ИНС обратной связи, демпфирующей возникающие рассогласования. Немаловажно и то, что фильтр (13) более прост в реализации, чем фильтр (8).

Итоговые координаты рассчитываются по очевидным формулам

к _

х(гк) = х(г0) + ^ ух, КоРР Щ;

1=1

y(tk) = y(to) + Х V™ (ti Ti,

(14)

i=1

численно реализующим исходные соотношения (3). Здесь х^0), у^0) — координаты пешехода в момент начала движения t0.

Приведенные соотношения и структурные схемы алгоритмов (см. рис. 2-4), начиная с процедур формирования средних скоростей , У%ш (аналогично , УуН), определяют последовательность вычислительных операций, подлежащих реализации в модуле автономной навигации.

Заключение

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

Литература

1. Красовский А. А., Лебедев А. В., Невструев В. В.

Теоретические основы пилотажно-навигационных комплексов. — М.: ВВИА им. Н. Е. Жуковского, 1981. — 373 с.

2. Кузовков Н. Т., Салычев О. С. Инерциальная навигация и оптимальная фильтрация. — М.: Машиностроение, 1982. — 216 с.

3. Ярлыков М. С. Статистическая теория радионавигации. — М.: Радио и связь, 1985. — 344 с.

4. Дэвидсон П., Такала Я. Разработка алгоритмов инерциальной навигационной системы с учетом особенностей походки человека // Гироскопия и навигация. 2013. № 1. С. 54-86.

5. Salychev O. S. Applied Inertial Navigation: Problems and Solutions. — M.: BMSTU Press, 2004. — 306 p.

6. Jahn J., Batzer U., Seitz J., Patino-Studencka L., Bo-ronat J. G. Comparison and Evaluation of Acceleration Based Step Length Estimators for Handheld Devices // Proc. of IEEE 2nd Conf. on Indoor Positioning and Indoor Navigation, Zurich, Switzerland, 1517 Sept. 2010. P. 1-6.

7. Ladetto Q., Merminod B. Digital Magnetic Compass and Gyroscope Integration for Pedestrain Navigation // 9th St. Petersburg Intern. Conf. on Integrated Navigation Systems, Saint-Petersburg, 27-29 May 2002. P. 10.

8. Leppakoski H., Kappi J., Syrjarinne J., Takala J. Error Analysis of Step Length Estimation in Pedestrian Dead Reckoning // Proc. of ION GPS/GNSS. Portland, OR, 24 -27 Sept. 2002. The Institute of Navigation, 2002. P. 1136-1142.

9. Matthews C., Ketema Y., Gebre-Egziabher D., Schwartz M. In-Situ Step Size Estimation Using a Kinetic Model of Human Gait // Proc. of ION GNSS, Portland, OR, 21-24 Sept. 2010. P. 511-524.

10. Браммер К., Зиффлинг Г. Фильтр Калмана — Бью-си. — М.: Наука, 1982. — 200 с.

UDC 621.396.96

doi:10.15217/issn1684-8853.2015.6.86

Using Autonomous Navigation Systems for High-Precision Positioning of a Pedestrian on the Ground

Kaplin A.Y.a, PhD, Tech., [email protected]

Stepanov M. G.a, Dr. Sc., Tech., Professor, [email protected]

aOAO «Radioavionika», 4B, Troitskii Pr., 190005, Saint-Petersburg, Russian Federation

Introduction: Currently, to determine the coordinates of a pedestrian on the ground, an autonomous navigation system is used, which includes a triaxial accelerometer and a triaxial gyroscope. A disadvantage of this system is the gradual accumulation of erroneous information from its components, due to unaccounted systematic errors. This accumulated error cannot be compensated without an additional external source of information. Purpose: The goal of this work is investigating the possibility to adapt the algorithms of an inertial coordinate reference system using data from an external source, and developing an algorithm to integrate the information in order to compensate for the errors in the positioning of the pedestrian. Results: The possibility is demonstrsated and a method is suggested for integrating the information from an autonomous inertial navigation system and an external independent source of information which is an information signal from a biomechanical model of pedestrian movement. The method is represented by two algorithms. The first algorithm is implemented in the form of an open circuit in which the structure of the inertial system does not change. The second one is implemented as a closed circuit with a feedback. The structure of the inertial system changes, but it is more resistant to changes in the assumptions made during the synthesis of the proposed algorithms. Practical relevance: High-precision determination of the coordinates of a pedestrian on the ground is necessary in many situations, particularly when performing rescue operations.

Keywords — Autonomous Navigation, Inertial Navigation System, Kalman Filter, Accelerometer, Gyroscope.

References

1. Krasovskii A. A., Lebedev A. V., Nevstruev V. V. Teo-reticheskie osnovy pilotazhno-navigatsionnykh kompleksov [Theoretical Basis of Flight Control and Navigation Systems]. Moscow, VVIA im. N. E. Zhukovskogo Publ., 1981. 373 p. (In Russian).

2. Kuzovkov N. T., Salychev O. S. Inertsial'naia navigatsiia i optimal'naia fil'tratsiia [Inertial Navigation and Optimal Filtering]. Moscow, Mashinostroenie Publ., 1982. 216 p. (In Russian).

3. Iarlykov M. S. Statisticheskaia teoriia radionavigatsii [Statistical Theory Navigation]. Moscow, Radio i sviaz' Publ., 1985. 344 p. (In Russian).

4. Devidson P., Takala J. Development of Algorithms of Inertial Navigation System Based on Features of Human Gait. Giroskopiia i navigatsiia [Gyroscopy and Navigation], 2013, no. 1, pp. 54-86 (In Russian).

5. Salychev O. S. Applied Inertial Navigation: Problems and Solutions. Moscow: BMSTU Press, 2004. 306 p.

6. Jahn J., Batzer U., Seitz J., Patino-Studencka L., Boro-nat J. G. Comparison and Evaluation of Acceleration

Based Step Length Estimators for Handheld Devices. Proc. of IEEE 2nd Conf. on Indoor Positioning and Indoor Navigation, Zurich, Switzerland, 15-17 September 2010, pp. 1-6.

7. Ladetto Q., Merminod B. Digital Magnetic Compass and Gyroscope Integration for Pedestrain Navigation. 9th St. Petersburg Intern. Conf. on Integrated Navigation Systems, Saint-Petersburg, 27-29 May 2002, p. 10.

8. Leppakoski H., Kappi J., Syrjarinne J., Takala J. Error Analysis of Step Length Estimation in Pedestrian Dead Reckoning. Proc. of ION GPS/GNSS, Portland, OR, The Institute of Navigation, 24-27 September 2002, pp. 11361142.

9. Matthews C., Ketema Y., Gebre-Egziabher D., Schwartz M. In-Situ Step Size Estimation Using a Kinetic Model of Human Gait. Proc. of ION GNSS, Portland, OR, 21-24 September 2010, pp. 511-524.

10. Brammer K., Siffling G. Fil'tr Kalmana-B'iusi [Kalman-Bucy-Filter]. Moscow, Nauka Publ., 1989. 200 p. (In Russian).

i Надоели баннеры? Вы всегда можете отключить рекламу.