книги / Проектирование устройств фильтрации радиосигналов
..pdfлинейных фильтров параллельного и последовательного дей ствия одинаковы [66].
Заметим, что в последовательном фильтре при неодновре менных измерениях b|, b2l . . Ьллегко учесть, движение объек та за время формирования вектора измерений введением до полнительной операции экстраполяции оценки вектора состоя
ния объекта в соответствии с выбранной переходной |
матри |
цей Ф<: |
|
Х£. = Ф, Х,_, + К, [Ь, — М НФ , X,., )], 1 = 1,2 , |
N. |
Недостатком параллельного и последовательного фильтров является большой объем вычислительных затрат, необходимый для их реализации. Эти затраты тем больше, чем больше раз мерность вектора измерений и вектора оценки. Для уменьше ния вычислительных затрат может быть рекомендован фильтр с предварительной компрессией данных (см. рис. 5.2,в). Ком прессор данных осуществляет предварительное сжатие (ком прессию) результатов измерений навигационных параметров,
уменьшая размерность вектора эквивалентных измерений |
А |
ц |
|
на входе основного фильтра и сокращая тем самым объем |
вы |
числительных затрат, необходимый для реализации этого фильтра. При этом устройство вторичной обработки радиотех нической информации в целом может оказаться проще рас смотренных ранее параллельного или последовательного филь тров. Объем суммарных вычислительных затрат в большой степени зависит от выбора вектора эквивалентных измерений
А
(предварительной оценки) у]. В качестве компонентов этого вектора могут быть, например, выбраны оцениваемые коорди наты объекта. Основной фильтр в этом случае осуществляет уточнение оценок координат объекта и построение оценок их производных.
Для компрессии входных данных целесообразно использо вать простейший нерекуррентный алгоритм оценивания, форми-
рующий оценку rj размерностью т (т — размерность прост ранства, в котором решается задача местоопределения) по со вокупности измерений bi, b2, ..., Ьл- в предположении, что век тор состояния объекта не меняется за время формирования вектора измерений: Y = [bib2, bjv]T, а линеаризованное уравнение измерений имеет вид
Р« = h, (î “) ч 4 v„ * = 1,2, |
, |
(5.6) |
Здесь новый вектор измерений р,- представляет собой сумму прежнего вектора измерений Ь{ и известных величин:
р, = Ь, — ь,(ч") + Мч')ч".
л
a h{(4~) '— строка, элементами которой являются производные нелинейной функции (1, ( 4 ) поЛкомпонентам вектора коорди-
нат ч» вычисленные в точке ч”- Это представление несколько отличается от выражений расширенного фильтра Калмана (см. (2.53)) тем, что производные нелинейной фильтрации вычис ляются по вектору координат 4 » а не по вектору состояния объекта X.
Задача нахождения наилучшей оценки ч ПРИ линейном уравнении (5.6) решается методами линейной фильтрации (см. Приложение 1, выражение (11)):
Ч = |
Ч- + К (Y — Н ч“), |
(5.7) |
где K = P H rR-1; P-1 = |
PôT1+ HR_1Hr; |
Р0 — ковариационная |
матрица априорных ошибок оценки ч- ; Н = [rifli-I .. йдг]; R — ковариационная матрица ошибок измерений; Р — ковариацион-
А
ная матрица ошибок оценки ч- |
как |
взвешенную |
||
Выражение (5.7) можно |
рассматривать |
|||
сумму априорной |
А |
и результата |
измерений Y: |
|
оценки i f |
||||
Ч = |
(1 — PHrR-1H )4“ + PHrR-1Y. |
(5.8) |
Если ошибки в каналах измерения не коррелированы, то матрица R диагональна, и выражение (5.8) может быть приве дено к виду
Ч = |
РР<Г*Ч" + Р 2 |
ЪТ(Ч~) гТ%, |
(5.9) |
|
t=i |
|
|
|
14 |
0 1 |
|
|
где R = |
гN |
|
|
О |
|
|
В качестве априорного среднего i f вектора |
ч можно ис |
||
пользовать оценку, |
построенную |
фильтром из |
экстраполиро- |
л |
|
|
|
ванной оценки X- . Поэтому использование алгоритма (5.9) для предварительной компрессии данных требует обратной связи, показанной на рис. 5.2, в пунктиром.
На практике для предварительной компрессии данных удоб нее использовать упрощенные алгоритмы оценивания, требую щие минимального объема априорных данных (априорными
А
данными в алгоритме (5.9) являются i f , Ро и R). Такими алго ритмами являются оценивание по максимуму функции правдо подобия и оценивание по методу наименьших квадратов. Если отказаться от использования априорной ковариационной мат
рицы ошибок оценивания вектора ц, т. е. положить Pô"1= 0 ,
то из алгоритма (5.9) получается выражение для оценки мак симального правдоподобия:
|
N |
|
|
?м.п — Рд 2 |
(ч >ri 1Р<* |
(5.10) |
|
|
;—1 |
)~1 |
|
|
( N |
(5.11) |
|
= |
|2 Л г(»Г) «T'h, 0j-)J |
||
В случае использования оценки по методу наименьших квад- |
|||
А |
коэффициенты г<, равные |
в алгоритме |
|
ратов TJM.U.к. весовые |
(5.10), (5.11) диагональным элементам ковариационной мат рицы ошибок измерения R, выбираются произвольно, но так, чтобы упростить алгоритм оценивания.
Таким образом, устройство вторичной обработки информа ции в радиотехнических системах может быть реализовано в виде параллельного или последовательного фильтра либо в ви де фильтра с предварительной компрессией данных. Выбор той или иной реализации зависит от объема вычислительных за трат, который, в свою очередь, определяется размерностями вектора оценки и вектора измерений. Для случая, когда раз
мерность вектора оценки п= 7 , а |
размерность вектора измере |
ний N = 9 , результаты сравнения |
трех, рассмотренных алгорит |
мов по объему вычислительных затрат, характеризуемых чис лом операций умножения на один такт работы фильтра, при ведены в табл. 5.1 [66].
|
|
|
|
Т а б л и ц а 5.1 |
|
|
А лгори тм для |
ф ильтра |
|
О перац ия |
п а р а л л ел ь |
п о с л е д о в а с к о м п р есси ей |
||
|
|
н ого |
т ел ьн о го |
данны х |
Экстраполяция |
588 |
588 |
588 |
|
Коррекция |
|
1330 |
945 |
394 |
Компрессия |
данных |
— |
— |
208 |
Суммарный |
объем |
1918 |
1533 |
1190 |
вычислений |
|
|
|
|
Результаты, приведенные в таблице, подтверждают эффек тивность использования фильтра с предварительной компресси ей данных в случае высоких размерностей векторов оценива ния и измерения. Заметим, что все измеряемые навигацион ные параметры должны поступать на вход компрессора дан ных синхронно (допускается поочередное измерение парамет ров ai, аг, ..., aw, но за время измерения всех N навигацион ных параметров вектор состояния объекта не должен изме няться). Если это условие не выполняется, то требуется до
полнительная обработка результатов измерений для их времен ной группировки. Для этой дели может быть использован, на пример, алгоритм полиномиального сглаживания [55].
Задача проектирования основного фильтра (см. рис. 5.2, в) сводится к вычислительной реализации рекуррентного алгорит
ма оценивания вектора состояния объекта |
(вектор |
X включает |
|||||
также производные координат объекта, |
причем |
Ï J = H X ): |
|||||
|
X (ft) == X -(ft) + К (ft) fi (ft) - |
HX" (ft)], |
|
||||
|
|
X~(ft) = |
Ф (ft — 1) X (ft — 1). |
(5.12) |
|||
Дискретное время ft в выражении |
(5.12) |
соответствует темпу |
|||||
обновления вектора измерений Y = [bib2 |
|
bjv]T. |
(размерно |
||||
Для вычисления весового коэффициента К (ft) |
|||||||
стью |
m n x N ) алгоритма |
(5.12), а |
также |
для оценки точно |
|||
стных |
характеристик всего устройства |
вторичной |
обработки |
||||
радиотехнической |
информации требуется |
решение |
известных |
||||
ковариационных |
уравнений (см. разд. 2), |
причем |
в качестве |
ковариационной матрицы ошибок измерения, входящей в эти уравнения, следует использовать ковариационную матрицу оши бок предварительного оценивания P.v. Реализация такой про
граммы |
требует достаточно |
мощных |
вычислительных |
средств, |
особенно |
при высокой размерности |
л |
реальной |
|
вектора X. В |
||||
аппаратуре, используемой |
для местоопределения |
объектов, |
применяются мини- и микроЭВМ, не обладающие обычно вы сокими быстродействием и объемом памяти. Поэтому возника ет также задача уменьшения вычислительных затрат, необхо димых для расчета весового коэффициента К(ft) и для реали зации основного фильтра. При этом такие способы упрощения основного фильтра, как предварительное (до начала оценива ния) вычисление весового коэффициента и, тем более, приме нение метода ’’замораживания” весового коэффициента (выбор постоянного весового коэфициента) в задаче местоопределе ния объекта неприемлемы по следующей причине. Решение ковариационных уравнений зависит вследствие нелинейности измерительного процесса от координат объекта. Поэтому тра
ектория движения объекта |
(зависимость координат объекта и |
их производных от времени) |
в случае предварительного вычис |
ления весового |
коэффициента должна |
быть заранее известна |
и заложена в память устройства обработки. Это требует уве |
||
личения объема |
памяти вычислителя |
и, главное, сужает круг |
решаемых устройством задач до задачи уточнения координат объекта в пределах некоторых допустимых отклонений объек та от заданной траектории (например, при управлении движе нием объекта по заданной траектории). Выбор постоянного ве сового коэффициента сужает область пространства, в котором применим алгоритм местоопределения, так как вне этой области
выбранный постоянный весовой коэффициент может сущест венно отличаться от оптимального значения.
Следовательно, в задаче местоопределения объекта Твесовой коэффициент основного фильтра необходимо в общем случае вычислять в реальном времени с учетом текущих оцениваемых координат объекта. Для упрощения алгоритма вычисления ве-i сового коэффициента имеет смысл отказаться от непосредст-' венного решения ковариационных уравнений и воспользовать ся результатами расчета простейших фильтров с одномерным', вектором измерений (см. раздел 3). Для этого основной фильтр разбивается на несколько фильтров (по числу оцениваемых координат объекта) и обеспечивается их независимая друг от друга работа. С этой целью вводится вспомогательная система координат, такая, при которой обеспечивается отсутствие кор реляции ошибок предварительного оценивания:
Р ^ = 0, i, у = 1, 2, , т, i=^=jy (5.13)
где P'N — элементы ковариационной матрицы ошибок предвари тельной компрессии данных.
Условие (5.13) определяет расположение вспомогательной системы координат относительно -заданной. Заметим, что рас
положение осей вспомогательной системы координат |
и осей |
||||||||||
эллипсоида рассеяния ошибок [33] совпадает. |
|
|
|
||||||||
Отсутствие корреляции ошибок предварительного оценива |
|||||||||||
ния |
координат объекта |
обеспечивает |
независимую |
работу т |
|||||||
фильтров, входящих в |
состав основного (см. рис. 5.2,г).Оцен- |
||||||||||
ки компонентов вектора |
А |
I А А |
/Ч |
1 7* |
|
построенного |
|||||
Ч&=[Ч*1Ч*в |
|
Чъ | |
|||||||||
во вспомогательной системе |
координат, |
поступают |
на |
входы |
|||||||
соответствующих фильтров, |
с помощью |
которых |
осуществля- |
||||||||
ется |
уточнение предварительных |
оценок |
л |
л |
|
л |
|||||
ÎJ*,I |
Д , » |
Д |
|||||||||
(по |
многим измерениям) |
и |
построение |
оценок |
производных |
||||||
координат объекта. Элементы ковариационной матрицы |
оши |
||||||||||
бок |
предварительного |
оценивания |
Р 6’ , |
i = |
1,2, |
|
т |
харак |
теризуют шумы измерения в каждом фильтре. Оценка Хь име ет вид
А /\ V |
|
л А |
А ♦ |
|
РА тЛ m |
|
||
Х ь = |
[ Д Д |
W |
|
ч л „ Г = ( х '*> |
|
|||
причем оценки |
А |
/= 1 , 2, |
т строятся по правилу |
|||||
Х,(*) |
||||||||
|
|
X, (к) = |
Ф, {к) % ( k - \ ) |
+ |
KÎ (к) X |
|
||
х |
А л * ) - I W |
ft) Ü |
( * - ! ) ) , |
|
* = 1 . 2 , |
(5.14) |
||
где Ф Д*)— переходная |
матрица i-ro |
фильтра; |
Н* — матрица |
|||||
измерений |
i-ro |
фильтра |
вида |
H j= [l |
0 |
]; Кь (* )— вектор- |
столбец весовых коэффициентов i-ro фильтра.
Расчет весовых коэффициентов К* (k) нетрудно сделать с помощью методики, изложенной в разделе 3. Искомый весо вой коэффициент К(&) алгоритма (5.12) вычисляется на основе
известных коэффициентов Кг. {к) |
и матрицы |
преобразования |
||
координат Ч*. Подробное изложение данного метода |
расчета |
|||
весового |
коэффициента К (А), а |
также доказательство |
эквива |
|
лентности |
алгоритма расширенного фильтра |
Калмана |
и алго |
ритма, показанного на рис. 5.2, г, представлено на примере проектирования дальномерной системы местоопределения.
5.2. Дальномерные системы местоопределения
Рассмотрим задачу местоопределения на плоскости дально мерным методом [27, 28], которая формулируется следующим образом: требуется оценить координаты объекта на плоскости в прямоугольной системе координат, пользуясь отсчетами
дальности |
объекта |
относительно |
|||
совокупности |
из N |
радиомаяков |
|||
с известными координатами |
(рис. |
||||
5.3). |
|
поставленной |
зада |
||
Решение |
|||||
чи следует |
начать |
с выбора |
и |
||
описания |
математической |
моде |
|||
ли сообщения, отражающей |
по |
ведение объекта 0 (закон изме нения его координат х(к) и у (к))
в характер измерительного процесса. Поведение маневрирую^ щего объекта достаточно хорошо описывается, например, мо делью (3.65) или (3.54), а для маломаневренных объектов можно пользоваться более простой полиномиальной моделью. При этом закон изменения каждой координаты объекта целе сообразно аппроксимировать марковским случайным процес
сом и описывать линейным векторно-разностным |
уравнением |
X (* + 1 ) = 0(A )X (£) + W(ft). |
(5.15) |
Компонентами вектора состояния объекта являются координа ты объекта и их производные. Например, для модели третьего порядка (3.65) вектор состояния объекта равен
X (k) = [х (k) v x (k) ах (k ) у (A) v y (к) ау (А)]г,
где x(k) и у {к) — координаты объекта; |
vx(k) и vv(k) — про |
екции вектора скорости объекта: ах(к) |
и ау( к ) — проекции |
ускорения объекта в системе координат (х, у).
Для синтеза алгоритма оценивания необходимо также опи сание измерительного процесса, дающее представление о том, какие и с какими погрешностями измеряются компоненты век тора X(k). В случае дальномерного метода местоопределения
измеряется дальность до i-ro радиомаяка (по принципу запросответ), поэтому уравнение измерений имеет вид
М *) = &(*) + «,(*), / = 1, 2, N. (5.16)
причем дальности p,(ft) нелинейно зависят от координат объек та и радиомаяков:
Ь, (к) = |
У [ * (*> — лрм^4+ |
[У (к) — Лм,]2 + |
V, (ft) = |
= |
ht [НХ(ft)] 4- V, (ft), |
/ = 1 ,2 , |
N. |
Линеаризованное скалярное уравнение измерений можно за
писать в виде |
|
МЛ) = Й,[НХ-(Л)].НХ(А) + а д . / = 1 ,2 , ... ,J V , |
(5.18) |
. А |
между |
где Н,-[НХ-(£)] = [—co saj(ft)— sinaj(ft)]; ou — угол |
осью х и радиус-вектором, соединяющим точки местоположе
ния объекта |
и t'-ro радиомаяка |
(см. рис. 5.3). Для вычисления |
|
углов ai(k) |
|
/\ |
радио |
используется оценка X_ (.ft) и координаты |
|||
маяков. |
|
|
|
Заметим, |
что аналогичным |
образом описывается |
измери |
тельный процесс в задаче местоопределения объекта на пло скости разностно-дальномерным методом. В этом случае изме ряется величина Ьц(1г) =Pi(ft) —Pi(ft)+»ü(ft), /, / = 1, 2, . . . , N и соответственно меняется вид нелинейной функции Л,-, причем
hi [HX“ (ft)] = [— cos ai (ft) -|- cos a;-(ft) — sin ai (ft) -f- sin a^(ft)].
К дальномерным относится также псевдодальномерный (однопутевой) метод местоопределения объекта, при котором измерение дальности на. борту объекта осуществляется по вре
менному |
интервалу |
между |
бортовой синхропоследовательно- |
|||
стыо и принимаемыми сигналами |
радиомаяка (без запроса ра |
|||||
диомаяка). В этом |
случае измеряется величина ô,(ft)=pi(ft) + |
|||||
-j-ц(ft) -j-Vi(ft), t = l , |
2,___, |
N, где «(ft)— разность фаз гене |
||||
раторов синхропоследовательностей объекта и радиомаяка. |
||||||
Для |
реализации |
псевдодальномерного метода |
измерения |
|||
дальности объекта |
относительно |
N радиомаяков |
необходима |
|||
синхронизация генераторов |
всех |
радиомаяков. |
Тогда величи |
|||
на «(ft) |
постоянна |
за время обращения ко всем радиомаякам |
||||
(при соответствующем ограничении величины |
взаимной неста |
бильности частот генераторов) и может быть оценена на борту объекта. Для, этого вектор состояния дополняется компонента
ми, характеризующими |
динамику взаимного ухода |
фаз «(ft): |
|
X { k ) = \ x { k ) v K{k) |
у ( ft) Vy ( ft) |
u ( k ) v a(k) |
. . . ] r, |
и соответственно расширяется модель сообщения. При лине аризации уравнения измерений нелинейная функция hi диффе ренцируется по х, у и «:
fi,- |HX"(A)] = l— cosa,(*) — sin ot£(Иг) 1].
Таким образом, в задаче местоопределения объекта на пло скости дальномерным методом в прямоугольной системе коор динат модель сообщения описывается уравнениями (5..15)— (5.18). На основании этих уравнении можно построить рекур рентный алгоритм оценивания вектора X в виде расширенно го фильтра Калмана:
X (к) = X- (k) + V К,- (k) \bl (к) - Л,- [ИХ" (к)] !,
i=i
(5.19)
X~(k)=<t>(k)X{k — 1).
Учитывая сложность вычисления весового коэффициента в расширенном фильтре Калмана, заменим в соответствии с со
ображениями, изложенными в |
разделе |
5.1, |
алгоритм |
(5.19) |
эквивалентной процедурой (см. рис. |
||||
5.2, г). Эквивалентность данного и |
||||
исходного |
алгоритмов понимается |
|||
в |
среднеквадратичном |
смысле |
||
(среднеквадратичная ошибка оце |
||||
нивания для эквивалентных |
проце |
|||
дур |
одинакова) |
и доказывается в |
|
|
Приложении 3. |
линеаризованное |
||
|
|
Рассмотрим |
|||
|
|
уравнение |
измерений |
во вспомога |
|
|
|
тельной системе |
координат, повер |
||
нутой относительно заданной системы на угол <р (рис. 5.4): |
|||||
M *) = |
hw&"(*)] %(*) + <>,(*', |
1 = 1 , 2 , |
,V, (5.20) |
||
где Tjb(А;) = |
НФХ(£) = |
Ух(к))т— вектор координат объ |
|||
екта во вспомогательной системе координат; |
|
|
|||
|
Нб (£)] = |
[— cos (а, — г) |
— sin (а, — |
»)]. |
Построение оценки r{b(k) осуществляется методом максималь ного правдоподобия в соответствии с выражением (5.10).
причем ковариационная матрица ошибок оценивания Р»(Л, <р) согласно выражению (5.11) равна [27]
'=-v-i,;=,v |
д-1 |
|
[ |
r~lr7} m \ 2 (а, — а.,) |
X |
|
||
'-1.У-1 + 1 |
|
|
V /=] К А*
— V
2 J
rr> si,г’ £— ?)
0
г г 1sin [оч — ç) COS (а, — -f)
1 - - 1
л* |
|
— |
г г 1 s i l l (7 - — х ) COS (•/,. — - f |
' -1 |
(5.21) |
Л’ |
" V Г Г 1 r u s - ( з г — s )
Из условия отсутствия корреляции между ошибками оценивания по осям х г и у,: г г 1 sin ( a f — ф) cos (а , •—-х.) = 0 по
лучаем (исключая тривиальный случай ср=0 или <р=90°) вы ражение для вычисления угла поворота ср вспомогательной си стемы координат относительно основной неподвижной системы:
cos 2чi
ctg 2-f |
|
Г; 1 |
s in 2а: |
|
|
(5.22) |
|
|
|
|
|
||
После вычисления угла |
ср (по |
результатам |
предыдущего |
|||
(к—1)-го оценивания вектора X) определяются диагональные |
||||||
элементы матрицы Рд-(А, |
ср), которые характеризуют диспер |
|||||
сии шумов измерения, необходимые |
для |
расчета |
фильтров |
|||
I и 2. |
|
|
|
|
|
|
Заметим, что эти элементы характеризуют также размеры |
||||||
осей эллипса рассеивания |
ошибок |
местоопределения объекта |
||||
по совокупности измерений |
р,(6), i = 1, 2, |
..., |
N, |
поскольку |
||
оси .«1 и у х совпадают с |
осями этого эллипса. |
Сумма диаго |
||||
нальных элементов (след |
матрицы P.y(k, ср)) инвариантна к ср и |
определяет дисперсию круговой ошибки местоопределения [33]:
|
|
|
|
ir=N~ 1, /«=.V |
|
1-1 N |
|||
°гд. „Ov ) = spP.v(A’, -i) |
|
у |
r - ' r r 1sin2 (a ,— a,) |
^ r r 1. |
|||||
|
|
|
|
»- 1,;W hi |
|
|
/=1 |
||
|
|
|
|
|
|
|
|
|
(5.23) |
В |
частных, |
наиболее |
интересных |
для |
практики |
случаях |
|||
N = 2 |
и N==3 |
из |
выражения |
(5.23) |
легко |
получаются |
извест |
||
ные соотношения |
[33, 25]: |
|
|
Г) + Г-2 |
|
|
|||
|
|
|
,(2) = |
|
|
|
|||
|
|
|
s ill2 (a , |
— a3) |
|
|
|||
|
о - |
_________________ Г х Г- 2 |
4- /1Г3 + г » г |
3_________________ |
|||||
|
r3s ill - ( 2д — |
а 2) + |
Го s i n 2 (a i — Оз) |
+ Г] s i n - С и — |
a n) * |
||||
|
г д. м |