книги / Проектирование устройств фильтрации радиосигналов
..pdfгде Ф (?) = |
I„ cos ? |
I„ sin ? |
|
I„ sin ? |
I„ cos ? |
||
|
— матрица преобразования координат; 1Я — единичная матрица
размерностью п Х п (2л — размерность вектора оценки X(ft)). Весовой коэффициент Кь(Ь) в алгоритме (5.14) и ковариа ционная матрица Р& ошибок оценивания вектора X*,(ft) в силу отсутствия корреляции ошибок оценивания во вспомогатель
ной системе координат имеют вид |
( т = 2) |
|
|
||
К»(*) = |
О |
рь(к) = |
Pb(k) |
О |
|
Kl (II). |
О |
Pl(k)_ • |
|||
|
|
Элементы К& (Л) и К*(ft) матрицы Кь(Ь) представляют собой весовые коэффициенты фильтров 1 и 2 (см. рис. 5.2, г) и опре деляются в соответствии с методикой, изложенной в разделе 3.
Элементы Pû(ft) и P2 (ft) матрицы Рь (ft) есть ковариационные матрицы ошибок фильтров 1 и 2.
После вычисления матриц Kb(ft) и Pj,(ft) определяются эле менты весовой матрицы Ki(ft) алгоритма (5.12) с помощью со отношения (см. Приложение 3)
к„(*)' |
кU k ) |
, i = |
1,2, |
N, |
K,(ft) = LK2i(/e)J = \ - ' г Г»Ри |
Kl(k) |
|
(5.25)
; = / V - i , j ^ N
где Л = |
У |
r r lr r l |
|
/=i, /=/+i |
|
— ïrtq cos cp cos (at- — |
cp) |
|
[N |
|
' |
— \nq sin cp cos (a,. — cp) —
sin2(ai — a/);
ln s sin cp |
sin (ax- — cp) |
l n s cos cp |
sin (a, — cp) |
N |
|
Я — 2 r7l sin2 («i — ?); |
s = 2 rTl cos2 («/ — ?)• |
i—l |
i=1 |
Ковариационная матрица ошибок оценивания вектора X(ft) в заданной системе координат определяется выражением
Р(/0= Ф(-<р)Рй(/0Фг(-ф) =
Pô(ft) cos2? + P* sin2? |
{Р*(/г) — Р* (ft)) sin ? cos ? |
{Рг, (ft) — P* (ft)) sin ? cos ? |
PI (ft) sin2 ? -f- P* (ft) cos2 ? |
|
(5.26) |
Сравнение объема вычислений, необходимых для реализа ции расширенного фильтра Калмана (5.17) (с соответствую щими ковариационными уравнениями) и упрощенной процеду ры (5.12), (5.25) и (5.26), показывает следующее. Реализация расширенного фильтра Калмана требует 5(2л)3 + (2N +
+1) (2п)2+2ЛЦЛ)+1) (2n) +N 3 операций на один такт работы измерителя [35]. Процедура (5.12), (5.25) требует всего N (6n+5N/2+27/2) + 6 операций умножения.
Кроме существенного упрощения процедуры обработки сиг нала данный метод позволяет проводить аналитические иссле дования и оптимизацию навигационного измерителя (решение ковариационных уравнении возможно только численно), что очень важно при системном проектировании дальномерного на вигационного измерителя. Данный метод с успехом можно рас пространить и на случай проектирования разностно-дальномер- ных и псевдодальномерных устройств оценивания координат объекта.
П р и м с р 5.1. Исходные данные: движение объекта (по каждой коор динате) описывается уравнением
A(ft+ |
1)' |
|
1 |
т |
т |
- |
- |
” |
~А (ft)‘ |
|
|
|
1 |
J п |
1 |
|
|
|
|
||||
А (А "Ь 1) |
= |
0 |
1 |
та |
|
|
-V(ft) |
|
|
||
A (ft -j- 1)_ |
_0 |
0 |
|
1 |
|
|
.A (ft). |
|
|
||
число радиомаяков N = 2 ; Apjll = -у 1,м, = |
150 |
км; урм = x pMj == 0 |
км; A "(ft) = |
||||||||
= 62 км; у" (ft) « 1 2 км; |
7",, = |
0,03 |
с; ускорение объекта л = |
9,8 M'Cs; дис |
|||||||
персия ошибок измерения |
дальности |
rl = ri = |
|
г — 12^5 м;. |
|
|
|||||
|
|
|
|
|
|
|
|
|
Л |
/\ |
/\ |
Требуется построить фильтр, вырабатывающий оценку X(/е) =[дс(Л) vx(k)
тvv(k)]T
Ввиду небольшого числа радиомаяков (Af=m=2) необходимость в пред варительной компрессии данных отпадает. Поэтому алгоритм фильтрации имеет вид
|
X (ft) = |
Ф X(А - |
1) + |
2 Kf(ft) (ft,- (ft) - |
A, \x- (A), |
y- (ft)| !. |
|
|
||||||
|
|
|
1 |
1-1 |
0 |
|
|
|
|
|
|
|
|
|
|
|
|
т„ |
0 |
|
|
K„-(ft)| |
|
|
|
||||
|
где Ф= |
0 |
1 |
0 |
0 |
|
|
|
|
|
||||
|
0 |
0 |
1 |
тп |
|
|
К,,-(A)j |
|
|
|
||||
|
|
|
|
|
|
|
|
|||||||
|
|
|
LO 0 0 |
1. |
|
|
|
|
|
|
|
|
||
причем |
К,; (ft) и K îf(ft) — вектор-столбцы, |
состоящие |
из |
2 -х компонентов; |
||||||||||
М * - ( £ |
) . У " ( Л ) ] |
= ->/• [ ( ^ “ |
(Аг) — |
^ рм .)2 |
+ ( j ; - (Æ ) — v P Mf.) ‘2 ] . |
' ■ = ! . |
2 |
|
|
|||||
|
|
|
|
|
|
Фильтр |
состоит из двух следящих |
|||||||
|
|
|
|
|
систем |
с двумя |
|
интеграторами |
и |
для |
||||
|
|
|
|
|
выбранной |
модели |
сообщения является |
|||||||
|
|
|
|
|
субоптимальиым |
фильтром |
пониженного |
|||||||
|
|
|
|
|
порядка. Задача |
проектирования |
фильт |
|||||||
|
|
|
|
|
ра заключается |
в определении весового |
||||||||
|
|
|
|
|
коэффициента К»(£), 1= 1, 2 , и ошибок |
|||||||||
|
|
|
|
|
фильтрации |
Ее |
|
решение |
осуществля |
|||||
|
|
|
|
|
ется |
в |
следующей |
последователь |
||||||
|
|
|
|
|
ности: |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
1) |
ВЫЧИСЛЯЮТСЯ |
УГЛЫ |
Gdi |
и |
Ctj |
|||
|
|
|
|
|
(рис. 5.5) — |
|
|
|
|
|
|
|||
|
|
|
|
|
|
|
|
У |
( к ) — >'рм |
|
|
|
||
|
|
|
|
|
|
<*!= arctg |
Щ - |
■= 352,2°; |
|
|||||
|
|
|
|
|
|
|
|
|
х |
|
|
|
( k) |
Ур M., |
*i = arctg * |
= 114,2e; |
X( k ) — ■Л'рм*»
2)с помощью выражения (5.22) определяется угол
«= 0,5 arctg££1^ L± £ 2 L ^ ,
sin 2a{ -j- sin 2a2
функция arctg имеет период 180°, поэтому получается ряд значений угла <р, отличающихся на 90° п соответствующих разным ориентациям осей .Vj и у\ по осям эллипса рассеивания ошибок, выбирается значение с минимальным модулем : ф= —36,8°;
3) из выражения (5.25) находятся
А" 1 = [г--* sin5 (<*2 |
- V ] " 1 = 2,087-10«, |
|
|
(J— r~l [sin2 (ai — ç) -f |
sin*- (x, — о)) = |
3,84 |
-lО- * |
5 = r~l [cos5 («I — v) + |
cos5 (a2 — 9 )] = |
12.5-1 0 “4; |
4)согласно выражению (5.21) определяются
P2(Л, ?> = |
1 о |
'л - 19 |
о |
----I |
I f |
о __ |
А “*4- |
|
|
о |
|
|||
|
|
I |
|
|
5) вычисляются параметры
SCO,7 м2 |
0 |
1 |
0 2606 м-J 1
N |
Al . |
a-àt* |
Ni1-. |
|
: 2 - lü"H: |
|
f>U |
P? |
|||
|
|
1 2 |
|
|
|
6 ) учитывая малую величину |
периода |
обновления входных данных |
|||
(7 П=0,03 с), при |
вычислении весового коэффициента алгоритма (5.14) ис |
пользуются изложенные в разделе 3 результаты анализа фильтра с двумя интеграторами в непрерывном времени:
к! № = |
у ™ |
? |
_J 0,0521 |
|
||
Т ~ х1 |
|
[o.osoj ’ |
|
|||
|
|
|
||||
|
П ) |
|
|
|
|
|
к I (к) = |
№ |
|
0,041 |
|
||
5 / ' ~ |
0,055 |
|
||||
|
|
|||||
7) согласно выражению (5.25) вычисляются' Mf |
1=1, 2: |
|||||
|
•2,69 |
0 |
-3 ,6 4 |
0 |
|
|
Фп = 10-4. |
0 |
—2,69 |
0 |
-3 ,6 4 |
||
2 ,0 2 |
0 |
-4,85 |
0 |
_ |
||
|
||||||
|
0 |
2 ,0 2 |
0 |
—4,85. |
||
|
2,69 |
0 |
-3,64 |
0 |
|
|
|
0 |
2,69 |
0 |
-3 ,6 4 |
||
|
__9 | |
0 |
—4,85 |
0 |
|
|
|
-2 ,0 2 |
|
|
|||
|
о’0 |
- 2 ,0 2 |
0 |
—4,85 |
затем вычисляются Ki(А), * == 1. 2 :
Г-0,0-19-]
ГК,, (ft)] —0,075
—0,016
—0,015 J
8 ) оценивается точность |
фильтра: в соответствии с выражением |
(5.26) |
|||||
дисперсии ошибок оценивания координат объекта х ( к ) и у (к) |
равны соот |
||||||
ветственно с2 = 02J COS2 9 -(- Oyj sill2 а. а" = |
о2 , sin2<p + ау| cos2 <p, |
где |
a2, H |
||||
o2j — дисперсии ошибок оценивания |
координат объекта во вспомогательной |
||||||
системе координат, известно |
(см. |
раздел |
3), |
что a2 j = р у - ^ 1 2 ,2 1 7V *1 = |
|||
= 51,6 м2, о2, = Я ^ 2 у'Л 12,21 Л 7*1 = |
124 мг |
и, |
следовательно, |
о2 |
= 7 7 ,8 м>, |
о2 = 98 мг.
Расчеты показывают, что фильтрация позволяет существенно уменьшить ошибку местоопределения объекта (точность измерения дальности была за дана 1225 м2).
5.3. Угломерно-дальномерные системы местоопределения
Рассмотрим задачу местоопределения объекта на плоско сти угломерно-дальномерным методом: требуется оценить коор динаты объекта на плоскости в прямоугольной системе коор динат, пользуясь отсчетами азимута и дальности объекта от носительно совокупности из N радиомаяков с известными коор
динатами (рис. 5.6).
Заметим, что решение по ставленной задачи возможно при N = 1. Однако если имеется воз можность использовать навига ционную информацию от многих радиомаяков, то точность место определения объекта молено по высить.
Пусть прямоугольная система координат выбрана таким образом, что ось у совпадает с направлением на север, так что азимут 0j есть угол между осью у и радиус-вектором, сое диняющим точки местоположения объекта и i-ro радиомаяка. Закон изменения каждой координаты объекта по-прежнему описывается уравнением (5.15). Измерительный процесс опи сывается уравнениями
àu(t0 = в,(*)+*и(А>,
М * ) = Р, ( А ) + « « ( * ) , 1 = 1 . 2 , N,
где Vu( k ) и v2i ( k ) — ошибки измерения азимута и дальности объекта относительно i-ro радиомаяка. Результатом измерения азимута и дальности объекта относительно i-ro радиомаяка является вектор измерения:
bu {k)
|
bi |
ь « , т |
LP<W I |
UI ( A ) J |
+ |
Vi(k), |
|||
|
|
L p i W j |
|||||||
который нелинейно зависит от координат объекта: |
|
|
|||||||
|
|
arctg |
X (k) - |
jr pM. |
|
|
|
|
|
|
bi(k) = |
y (*) - |
Урм/ |
|
|
+ |
v,(A) = |
||
|
У [JC (A) - л |
|
|
|
|||||
|
|
рм.р |
[y(k) - y pUi]2 |
|
|
||||
|
= |
hi [HX(ft)] + |
vi (Æ), |
/ = |
1,2, |
|
N. |
(5.28) |
|
В |
результате линеаризации |
уравнения |
(5.28) |
получаете» |
|||||
векторное уравнение измерений: |
|
|
|
|
|
||||
|
Р/ (А) = |
ьг [ НХ- (k) ]• НХ (/г) + |
у, (k), |
i = |
1, 2, |
. . . , N, (5.29) |
|||
|
|
|
|
[ |
s in a i |
|
cos я,- -i |
|
|
|
|
|
|
Pi |
|
Pi |
I . |
|
|
Для |
|
|
|
— cos |
— sin atJ |
алгоритм |
|||
оценивания координат объекта |
используется |
(5.19). Весовой коэффициент в этом алгоритме вычисляется па упрощенной методике, подробно изложенной в разделе 5.2.
Линеаризованное уравнение измерений во вспомогательной системе координат, повернутой относительно основной системы
координат на угол <р (см. рис. 5.4), имеет вид |
|
|
||||
М *) = |
Ь«[чГ(*)]Ч* (*) + |
▼,(*), |
/ = 1 , 2, |
N, |
(5.30> |
|
где Ч4(й)=*НФХ«йи |
чГ(*) = НФХ"(Л); |
|
|
|||
|
|
sill (ai —(р) |
COS ( a i — ip ) |
|
|
|
h ü iK (/«)] = |
Pi |
|
—sin {oLt — cp) |
|
|
|
— cos (at*— cp) |
|
|
||||
|
|
|
|
|||
Вычисление |
углов ai, i = 1, 2, ..., N, |
осуществляется |
на |
каж |
дом шагу работы фильтра и представляет собой обычную гео
метрическую задачу при |
известных координатах |
радиомаяков. |
/\ |
|
|
и оценке Х~(&). |
компрессии данных |
используется |
Для предварительной |
оценка максимального правдоподобия во вспомогательной си стеме координат:
N
4 b № = [ x i ( k)y-i (6)]г = рN (k, <р) 2^“ [Ч* (*'] Т'М*).
i= l
причем ковариационная матрица ошибок предварительного оце нивания
Pli |
Г*N |
(5 31) |
P*(k, <р) = (detPiv1)-1 |
р22 |
|
P N |
Г N |
|
где cietP.v’ = |
^ |
(fVw>'’'7 / cos' ^ —av> + |
|
|||
|
|
|
|
г*=1,У=1 |
|
|
-Г |
2 |
|
K v . , ) * 1 ( p / ’i;)" + r 2Ï'r v ] 8 in * (*/ - * |
/ : |
||
|
1, y- M l |
|
|
|
||
|
|
A' |
K.V'i/Г' соь' (*/-?) -г >Т,' sin2(i|-?); 1 |
|||
|
Яд- = 2 |
|||||
|
|
i-1 |
|
|
|
|
|
|
A’ |
|
|
|
|
|
Ял- = |
2 |
UfV'M'1sin’ (*f - ? ) + '7 l cos:; (a<— ?;ïl |
|
||
|
|
i=1 |
Л‘ |
|
|
|
|
|
|
|
|
|
|
Я/i?= |
Яд- = - |
2 |
[ № и ) 1-f Q ‘] sin (я«— ? ) cos (®i — ? ; |
|||
|
|
|
i=l |
|
|
|
r/= | ,Qf |
,? |; |
r u (i г.л — дисперсии ошибок измерения |
азимута |
и дальности относительно /-го радиомаяка.
Угол поворота вспомогательной системы координат tp опреде ляется из условия некоррелированности ошибок оценивания компонентов вектора Ч(ё):
Л'
2 [(р/ги)"1+ '7 1] sin (“i - г cos («г— ?) = 0 . /-1
которое может быть записано в виде
Г ... . |
i/COSJe,- |
|
Ct£ 2? = - ^ * |
(5.32) |
|
£/ sin 2я,- |
||
|
||
где е ,= (ргГм)-' + г ^ \ i = 1 ,2 ,..., |
/V — весовые коэффициёнты |
характеризующие точность измерений при работе с t-м радио маяком.
Элементы ковариационной матрицы Рл-(/г, ф), расположенные на главной диагонали, определяют дисперсии ошибок оценива ния координат объекта во вспомогательной системе координат. Остальные элементы матрицы РЛ-(/г, ip) при выполнении условия (5.32) равны нулю, что позволяет дальнейшую фильтрацию осу ществлять раздельно по каждой координате вспомогательной си стемы (хь </i). При этом матрица РЛ(/г, ф) для последующего фильтра может рассматриваться как ковариационная матрица ошибок измерения.
Сумма диагональных элементов матрицы Рдг(/г, ф) инвари антна к углу ф и определяет дисперсию круговой ошибки ме стоопределен ия объекта угломерно-дальномерным методом Ог2уд(Л/) = s p Ps(k. ф) .
В качестве примера рассмотрим простейший случай работы с одним ра
диомаяком (Л'=1). Из |
выражения |
(5.32) |
следует |
тривиальный результат: |
|||
Ф = а, т. е. вспомогательная система |
повернута |
относительно |
основной |
систе |
|||
мы координат на угол |
а, так что одна из |
се |
осей |
(ось A*I) |
совпадает |
с на |
правлением на радиомаяк. Ошибка оценивания характеризуется ковариацион ной матрицей
pi<*- 3>= [о'-' |
Д ] . |
причем дисперсия ошибок оценивания координаты JCJ равна дисперсии ошибок |
|
измерения дальности г2? а дисперсия ошибок |
оценивания координаты у х рав |
на произведению дисперсии ошибки измерения угловой координаты (азимута) Г; и дальности р. Дисперсия круговой ошибки местоопределення равна
(0 =г2+рп.
6.ПРОЕКТИРОВАНИЕ КОМПЛЕКСНЫХ РАДИОНАВИГАЦИОННЫХ СИСТЕМ
При проектировании систем управления движением объектов радиотехнические системы обычно используются совместно с ав тономными измерителями координат. Подобное объединение систем различного типа необходимо для обеспечения надежно сти и точности измерения координат, поскольку радиотехниче ские системы подвержены действию помех в каналах связи и не могут обеспечить надежное измерение. Таким образом, воз никает необходимость в построении комплексных систем, в ко торых точность обеспечивается радиотехническими средствами, а надежность и непрерывность выдачи координат — автоном ными.
В этом разделе рассматриваются принципы объединения данных в комплексных системах, а также примеры проектиро вания комплексных систем как устройств фильтрации.
6.1.Принцип инвариантности
иуравнения комплексных систем
Существует два подхода к проектированию комплексных си стем, различающихся использованием априорной информации о движении объекта.
При первом подходе используются уравнения движения объ екта и данные о возмущениях, действующих при движении. До стоинством этого подхода является высокая точность измерения координат, обусловленная наличием априорных данных о ха рактере их изменения. Вместе с тем при построении такой ком плексной системы возникают трудности в связи с отсутствием априорных данных о движении объекта. Кроме того, уравнения движения могут оказаться сложными, что приведет к росту раз мерности фильтра, осуществляющего объединение данных.
При |
втором подходе данные о движении объекта исключа |
|
ются, "и |
комплексирующий фильтр оказывается |
инвариантным |
по отношению к параметрам движения объекта. |
Использование |
принципа инвариантности позволяет упростить алгоритм филь трации и снизить требования к объему априорных данных. Ко нечно, отказ от использования априорных данных снижает точ ностные характеристики системы, однако простота и надеж ность устройств фильтрации способствуют широкому примене нию комплексирования на основе принципа инвариантности.
Можно указать несколько способов построения комплексных систем на основе принципа инвариантности.
Рассмотрим систему, содержащую два источника информации о полезном параметре A.(A) (k—дискретное время), вырабатыва ющие измерения Yi(k) и Y2(k):
Yt (k) — X (k)- f I/, (It), Y2 (k) = X (k) 4 V2 (k). |
(6.1) |
Чтобы исключить влияние изменений параметра X(k), образуем разность Yi(k)—Y2(k). Тогда можно реализовать обработку на основе принципа компенсации (рис. 6.1,а). Выделив из разно-
Рис. 6.1.
сти V2(k)— V\(k) оптимальную оценку помехи Vi(k), компенси руем помеху V\(k) в канале Y\(k).
Для эффективной реализации идеи компенсации требуется существенное различие спектров шумов V\(k) и V2(k). Если объединяются источники информации разной природы, такое различие обычно имеется. Объединение радиотехнических и ав тономных данных использует существенную разницу в свойствах ошибок.этих систем. Радиотехнические системы имеют ошибку с широкополосным спектром, автономные — с низкочастотным.
Поменяв местами вычитающее устройство и фильтр в схеме компенсации на рис. 6.1, а, можно получить схему, содержащую
два |
фильтра и сумматор (см. рис. 6.1, б, в). Если фильтр в ка |
|
нале |
Y2(k) |
имеет частотную характеристику F2( z ) = F ( z ) , то |
фильтр в |
канале Y\(k) — F\(2) = 1—F(z) . Таким образом, вы |
полняется условие
2 F, (z) = 1 . |
(6.2) |
(VTI |
|
Условие (6.2) является эквивалентом условия инвариантно сти в частотной области. При его выполнении полезное сообще ние À(/г) при фильтрации не искажается. Формула (6.2) может быть обобщена на случай а источников сигнала.
Проектирование комплексной системы в частотной области сводится к оптимизации частотных характеристик фильтров при
выполнении ограничения |
(6.2). |
|
|
|
|
|
|
|
Условие (6.2) показывает недостаток идеи инвариантности- |
||||||||
система оказывается |
широкополосной, |
так |
как |
не |
использует |
|||
информацию о спектре полезного сообщения /.(ft). |
|
|
||||||
Схемы компенсации и |
фильтрации полезны при объяснении |
|||||||
|
|
принципов |
комплекснровання, |
|||||
|
|
одиако |
реализация |
комплекс |
||||
|
|
ных систем |
на основе |
принци |
||||
|
|
па |
инвариантности |
|
осущест |
|||
|
|
вляется с помощью |
следящих |
|||||
|
|
систем |
или |
программными |
||||
|
|
средствами. |
|
|
|
|
||
|
|
на |
Схема |
комплекснровання |
||||
|
|
основе |
следящего |
измери |
||||
|
|
теля (рис. 6.2) имеет два вхо |
||||||
передачи. Для входа |
|
да |
с |
различными |
функциями |
|||
У) (Л) функция |
передачи имеет |
вид |
||||||
с |
/_х |
UM2>ir,U) |
|
|
|
|
||
1 |
|
1-i- IV/jUi H7:;IZ| |
|
|
|
|
для входа y2(ft)
p
В линейной следящей системе происходит суммирование воз действий, поступающих со входов УД/г) и Y2(k). Поэтому сле дящий измеритель оказывается эквивалентным схеме фильтра
ции, показанной на рис. 6.1, в. |
(6.2) далее следует требование |
|
Из условия инвариантности |
||
\Vt (z) |
1\У3 (г )= 1 . |
(6.3) |
Выполнение условия инвариантности в следящем измерите ле позволяет получить новое качество — способность сохранять слежение при пропадании радиосигналов. Рассмотрим это свой ство подробнее. Положим, что автономные данные поступают на вход У](ft), а радиотехнические — на вход Y2{k) н выпол нено условие инвариантности (6.3). Тогда при приеме сигнала измеритель работает как схема фильтрации с-двумя фильтрами
по