
книги из ГПНТБ / Свешников А.А. Вероятностные методы в прикладной теории гироскопов
.pdf§ 9.7] ПРИМ ЕРЫ ОП РЕДЕЛЕН И Я СХЕМ И ПАРАМЕТРОВ ГУ 509
откуда передаточная функция разомкнутой квазиоптимальной
системы может быть |
записана |
в |
виде |
|
|
|
|
W (s) |
L ( S) |
1 6 0 s2 + |
( т - * 0 |
S + 1 |
(9.156) |
||
— L(s) ~~~ Су |
( Тз |
Г2 |
\* |
||||
1 |
|
U 2 0 6 ’/ 2 + 1 2 C / + V
соответствующем следящей системе с астатизмом первого порядка и добротностью по скорости
*. = £ . |
(9-157) |
Передаточную функцию TT(s) можно представить в виде (рис. 9.6)
W(S) = W0 (S)n /K(s), |
(9.158) |
где H^s) — передаточная функция неизменяемой части системы,
Ш) <7>—~ WJs) |
Wn(s) |
Z(t) |
Рис. 9.6. К определению передаточной функции корректиующего устройства гироскопической следящей системы.
представленной гироскопом; WK(s) — передаточная функция цепи коррекции, когда выходной величиной является момент кор рекции.
На основании прецессионной теории гироскопа можно записать
|
^ о ( * ) = ш » |
|
|
(9-159) |
|
где Н — кинетический момент г и р о с к о п а Ѵ* |
|
||||
Тогда передаточная функция |
цепи |
коррекции примет вид |
|||
|
Т 2 |
/ Т |
\ |
|
|
W M - |
Н 60 s2 + ( 2 — С і) s + 1 |
(9.160) |
|||
Wo(s)' |
2 |
|
fi |
||
|
т |
|
|
||
|
|
120С1 |
+ Ш і S + 1 |
|
Здесь коэффициент усиления цепи коррекции по моменту S=HIC1. Заметим, что пропорциональная коррекция не обеспечивает оптимальной точности ГСС при любых значениях S. Для сглажи вания помехи типа белого шума в цепь коррекции необходимо включить динамическое корректирующее устройство с переда точной функцией PFK(s). Выражение (160) представим в виде
ьр /<л |
В |
{ Т ',\S + |
1) ( r 4s + |
1) |
(9.161) |
|
а |
Сд |
(?> + |
1 )(7 у + |
1) > |
||
|
510 ВЫ БОР ОПТИМАЛЬНЫХ СХЕМ И ПАРАМЕТРОВ ГУ [ГЛ. 9
т |
т 1 |
т |
т 1 |
1 1 ~ 5 1 — Е ’ |
2 ~ 5 1 + Е • |
1 3 |
Г2 |
1 |
гг |
TZ |
1 |
(9.162) |
30 |
|
• |
|
|
|
|
|
|
|
|
|
|
|
|
Е |
= | / і - 4, 8 |
F = V & - ^ ) ' - T , |
(9.163) |
||
|
|
|
т. е. корректирующее устройство должно включать в свой состав два апериодических и два форсирующих звена. Реализация такой системы принципиальных трудностей не представляет. Например,
при С1 =0,3 сек и 7’=30 сек
w ( Л— Н |
(1 2 »+ !)(» + !) |
(9.164) |
|
К\Ъ) — 0)3 |
(247s + 1) (3s + 1) ’ |
||
|
т. е. система практически может быть осуществлена.
Пример 9.4. Пользуясь методом фильтрации Калмана, найти оптимальные оценки составляющих 8^, 8 вектора малого
поворота 8 выставляемой платформы относительно базовой, если координатная система 0 £т£, связанная с базовой платформой, ориентирована так, что ее оси (при отсутствии ошибок ориентации) направлены соответственно на восток, на север и по вертикали (см. рис. 3.23), а для начальной выставки платформы использу ется сравнение показаний двух пар акселерометров, расположен ных на базовой и выставляемой платформах и ориентированных (при отсутствии ошибок) таким образом, что их оси чувствитель ности совпадают с осями и Orj*).
Д а н о : акселерометры измеряют компоненты кажущегося уско рения объекта с ошибками Ь , Ьщ, обусловленными смещением
нулей; выставляемая платформа имеет уход, составляющие угло вой скорости которого е^, е , ес; измерение разностей показаний
скоростей, найденных по |
данным |
акселерометров, |
производится |
||||||
с ошибками Ѵ1 и |
Ѵ2. |
Предполагается, |
что |
b^, |
b^, е5, e^, ef — |
||||
независимые нормальные случайные процессы |
типа белого шума; |
||||||||
Ѵх и |
Ѵ2 — независимые гауссовские |
белые шумы измерений. |
|||||||
Р е ш е н и е . |
Примем |
за основу |
решение |
подобной задачи, |
|||||
данное А. Сатерлендом **). |
|
|
|
|
|
||||
*) |
См. А. Л и п т о н, |
Выставка |
инерциальных |
систем на подвижном |
|||||
основании, «Наука», 1971. |
А., |
The Kalman |
Filter |
in Transfer Alignment |
|||||
**) |
S u t h e r l a n d |
of Inertial Guidance System, Journal Spacecraft and Rockets, vol. 6, № 11, 1968. См. также Дополнение к книге А. Липтона, написанное Л. Г. Клибановым и В. Л. Леонидовым,
512 В Ы БО Р ОПТИМАЛЬНЫХ СХЕМ И ПАРАМЕТРОВ ГУ [ГЛ. 9
где в нашем случае вектор-столбец |
состояния X(t) определяется |
|||||
равенством |
|
|
|
|
|
|
|
|
|
hvE |
|
|
|
|
X( t) |
Д VN |
|
(9.170) |
||
|
|
|
|
|||
Матрица G (t) — единичная |
|
|
|
|
|
|
|
|
G = |
I. |
|
|
|
Вектор-столбец помех |
U (t) |
определяется выражением |
|
|||
|
|
|
Ьг |
|
|
|
|
U(t) = |
|
|
|
(9.171) |
|
Матрица системы F(t) |
в данной |
задаче |
имеет вид |
|
||
|
0 |
0 |
0 |
е |
— 1 |
|
|
0 |
0 |
— g |
0 |
а. |
|
|
|
1 |
|
|
|
|
т = |
0 - |
7Г |
0 |
— “ С |
(9.172) |
|
“ |
|
|||||
1 |
|
|
|
|
||
|
|
|
|
|
|
|
|
R |
0 |
“ С |
0 |
- с о , |
|
|
|
|
|
|
||
|
t g c p |
|
|
|
|
|
|
R |
0 |
“ ч |
|
0 |
|
|
- |
|
|
|
Матрица Н (t) вектора измерений может быть записана следующим образом:
*(*>= J! 2 |
2 21- |
<9-173) |
а вектор V (t) помех измерений имеет |
вид |
|
V(t)= Fl |
|
(9.174) |
Для дальнейшего решения задачи|следует использовать вероят ностные характеристики ошибок b^, из-за смещения нулей
акселерометров и е$, е^, е? из-за ухода платформы, а также помех
измерений Fx и Ѵ2, которые были указаны в условии рассматривае мой задачи. В методе Калмана корреляционные функции компо нент вектора помех U (t), по аналогии с (55), можно записать в виде
=<?„(*)& (*-*) |
(/, г = 1, 2, .... 5), (9.175) |
§ 9.7] |
ПРИМЕРЫ ОП РЕДЕЛЕН И Я СХЕМ И ПАРАМЕТРОВ ГУ |
513 |
где матрица коэффициентов q -t(t) обозначается через Q(t) [см. (56)]:
Q(t)=\\gji(t)\\. (9.176)
Аналогично, корреляционные функции вектора помех измерений V(t), согласно (59), можно записать в виде
М [ (É) |
(х)1 = г у1 ( і ) 8 ( t — X) |
(j,l = 1,2), |
(9.177) |
где матрица коэффициентов г.,(7) обозначается через |
R(t) [см. |
||
(60)]: |
7?(0 = ||гуг(01- |
|
(9-178) |
|
|
||
Для оценки X(t) вектора состояния Х(і), согласно (69), имеем |
|||
= |
F (t) & (t) + К (0 \Z (t) — |
Н (t) X (0]. |
(9.179) |
Матричный коэффициент усиления К{і), |
если принять во вни |
||
мание (74), имеет |
вид |
|
|
|
K(t) — P (t) H' (t) R - 1 (f). |
(9.180) |
Для корреляционной матрицы P (t) ошибки оценок, согласно (75), имеем уравнение
— F(t)P (t) + Р (t) F' (t) - P (t) H' (t) ІГ 1 (t) II (t) P (t) +
+ G(t)Q(t)G'(t). (9.181)
Соответствующая структурная схема решения задачи приведена на рис. 9.7.
Щ
Рис. 9.7. Структурная схема определения оценки рассогласования двух инерциальных платформ при начальной выставке.
Пример 9.5. Определить наилучшие оценки северных со ставляющих скорости и пути объекта, если он движется в пло скости меридиана, а параметры движения объекта определяются одноканальной инерциальной системой (северным каналом),
§ е.7] ПРИМЕРЫ ОП РЕДЕЛЕН И Я СХЕМ И ПАРАМЕТРОВ ГУ 515
В рассматриваемом случае объект движется с ускорением ѵ вдоль оси 0% ускорение силы земного тяготения, направленное
по оси ОС, |
обозначим через д 0. |
|
||
На ГСП |
установлен акселерометр А, ось” чувствительности |
|||
которого направлена вдоль оси Оу. |
Обозначим измеряемое акселе |
|||
рометром |
ускорение |
через а. Так как акселерометр измеряет ка |
||
жущееся |
ускорение, |
являющееся |
разностью между абсолютным |
ускорением объекта и гравитационным ускорением, то а = ѵ — д0. Проектируя приведенное векторное равенство на ось Оу, находим выражение для ускорения а , измеряемого акселеромет
ром А, в виде |
(9.183) |
а у = V cos ß — g0sin ß л# V — g0ß. |
С учетом величины смещения нуля акселерометра Ъего показа
ния будут равны |
|
ay ==ay Jrb- |
(9.184) |
Расчетные значения скорости объекта и пути, вырабатываемые системой ИНС, определяются путем одно- и двукратного интегри рования показаний акселерометра
t
v v = s s = |
^ |
a ya d - , |
(9.185) |
t |
о |
|
|
|
|
|
|
о |
|
|
(9.186) |
|
|
|
|
Для удержания платформы |
в |
горизонтальном |
положении |
в соответствии с принципом интегральной коррекции к гироскопу прикладывается момент, вызывающий вращение платформы вокруг оси Ох с угловой скоростью, расчетное значение которой состав ляет
ш |
(9.187) |
где R — радиус Земли, принимаемой за сферу.
Если принять во внимание собственный уход гироскопа, а сле довательно, и ГСП с угловой скоростью £, то фактическое враще
ние ГСП будет осуществляться с угловой скоростью |
о>, равной |
ш = о ) р + е = - ^ - + е . |
( 9 . 1 8 8 ) |
Пользуясь (183)—(185), можно записать одно из уравнений, характеризующих динамику рассматриваемой системы
vf = v — g^ + b |
(9.189) |
или |
|
Sp = s — g0ß + 6 ; |
(9.190) |
516 |
ВЫ БОР ОПТИМАЛЬНЫХ СХЕМ И ПАРАМЕТРОВ ГУ |
[ГЛ. 9 |
|
||
второе уравнение запишем в виде |
|
|
|
Р = ! - Т + *' |
(9.191) |
Последнее уравнение требует некоторого пояснения, для чего воспользуемся структурной схемой северного канала ИНС, при веденной на рис. 9.9. Здесь входной величиной является северная
Рис. 9.9. Структурная схема северного канала ИНС.
составляющая ускорения объекта ѵ, а выходной величиной — расчетное значение sp пройденного объектом пути. На вход си
стемы поступает северная составляющая ускорения ѵ, которая измеряется акселерометром А (передаточные коэффициенты аксе лерометра, интеграторов, датчика моментов гироскопа для просто ты принимаются равными единице). Показания акселерометра посту пают на первый интегратору^, принтом на^суммирующем устрой стве СУ2 учитывается величина b смещения ^нуля ^акселерометра.
Выходной сигнал с интегратора И ѵ пропорциональный рас четной скорости объекта ур, через датчик моментов (на рис. 9.9 не показан) вводится на коррекцию гироскопа Г. При этом на суммирующем устройстве СУ3 учитывается дрейф гироскопа
сугловой скоростью е.
Врезультате вращение ГСП будет осуществляться с угловой скоростью, определяемой выражением (188). В рамках прецес
сионной теории ГСП рассматривается как интегрирующее |
звено |
с передаточным коэффициентом МН (Н — кинетический |
мо |
мент гироскопа). ГСП |
поворачивается относительно инерциаль |
||||
ного |
пространства |
на |
угол |
ßa, который поступает на сумми |
|
рующее устройство |
СУ4. Другая линия на |
СУ4 характери |
|||
зует |
угол ß„— |
поворота |
земной системы |
координат относи |
тельно инерциальной, обусловленной движением объекта относительно Земли. В результате с суммирующего устройства СУі снимается относительный угол ß= ßa— ß„, т. е. угол наклона ГСП