SE446664B - Anordning och sett for att undanroja lasning i ett fjederupphengt ringlasergyro - Google Patents
Anordning och sett for att undanroja lasning i ett fjederupphengt ringlasergyroInfo
- Publication number
- SE446664B SE446664B SE8002138A SE8002138A SE446664B SE 446664 B SE446664 B SE 446664B SE 8002138 A SE8002138 A SE 8002138A SE 8002138 A SE8002138 A SE 8002138A SE 446664 B SE446664 B SE 446664B
- Authority
- SE
- Sweden
- Prior art keywords
- diter
- angle
- period
- signal
- gyro
- Prior art date
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C19/00—Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
- G01C19/58—Turn-sensitive devices without moving masses
- G01C19/64—Gyrometers using the Sagnac effect, i.e. rotation-induced shifts between counter-rotating electromagnetic beams
- G01C19/66—Ring laser gyrometers
- G01C19/68—Lock-in prevention
- G01C19/70—Lock-in prevention by mechanical means
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Optics & Photonics (AREA)
- Electromagnetism (AREA)
- Power Engineering (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Gyroscopes (AREA)
- Lasers (AREA)
Description
lO
15
20
25
30
35
446 664
2
amplitud med avtagande ingångsvinkelhastighet. Varje momentkälla är dock
begränsad i amplitud och kan därför inte producera det moment, som reglersyste-
met kräver vid mycket små ingående vinkelhastigheter. Denna "mättnadseffekt"
sätter en undre praktisk gräns på den ingående vinkelhastighet, vid vilken gyrot
kommer att fungera.
Ett syfte med uppfinningen är att åstadkomma en lösning pâ detta
problem, vilken inte kräver applicering av alltför stora ingângsmoment.
Föreliggande uppfinning övervinner det ovan skisserade problemet
genom kontroll av insignalen till ditermomentgivaren med hjälp av ett återkopp-
lingssystem med en återkopplingssignal, som är baserad på gyrots optiska fas och
som beräknas endast en gång varje diterperiod, varvid den sedan hålls konstant
under hela perioden. Detta får till resultat att man ändrar fasen pâ diterperioden
utan att nämnvärt ändra amplituden. Mycket stora moment krävs inte ens vid
mycket låga ingângshastigheter. Systemet är därför effektivt vid mycket låga
ingângsvinkelhastigheter.
Systemet utnyttjar en momentgivare som styrs med hjälp av en
âterkopplingsreglerenhet, som har insignaler härledda från gyrots optiska
fasvinkel, ditervinkelhastigheten och ditervinkeln. Återkopplingsreglerenheten
alstrar en momentstyrsignal, som har en analog àterkopplingskomponent för att
eliminera förluster beroende på dämpning, och en annan komponent som
beräknas periodískt och hålls konstant under en eller flera diterperioder för att
justera fasen på ditervinkelhastigheten. Regler- eller styrenheten kan
konstrueras med användning av analoga eller digitala komponenter, eller en
kombination därav.
I de bifogade ritningarna är
Fig. l ett schematiskt diagram, som illustrerar flödet av informations-
signaler i ett system för att reglera ditern hos ett fjäderupphängt lasergyro i
enlighet med uppfinningen,
Fig. 2 är ett schematiskt diagram av en âterkopplingsreglerenhet,
som utnyttjar en mikroprocessor och som kan användas ikretsen enligt Fig. l,
Fig. 3 är ett schematiskt diagram av ett alternativt reglersystem,
Fig. l; är ett schematiskt diagram av en återkopplingsreglerenhet
användbar i kretsen enligt Fig. I och som utnyttjar en analog dator,
Fig. 5 är ett schematiskt diagram av en linjär analog krets för
användning i apparaten enligt Fig. 4, och
Fig. 6 är ett diagram över det optimala förhållandet mellan konstanta
Kalman-filterförstärkningar användbara för beräkning av den periodvis konstan-
ta komponenten i âterkopplingssignalen.
l0
15
20
25
30
35
446 664
a
Fig. l är ett diagram, som illustrerar informationsflödet i ett system,
enligt uppfinningen, för att reglera insignalerna till en ditermomentgivare med
hjälp av återkoppling. I systemet svarar ett ringlasergyro-avkännande element l
pâ en yttre vinkelhastighet m 1 och en överlagrad ditervinkelhastighet u: , som är
vinkelhastigheten för det avkännande elementet l relativt dess hölje. Det
ringlasergyroavkännande elementet l uppbärs i sitt (ej visade) hölje med hjälp av
elastisk fjäderupphängning 2, som har låg dämpning och som
sinusformigt med en naturlig resonansfrekvens å S2 (rad/sekJ.
karaktäristiskt att föga energi krävs för att upprätthålla svängning av sådana
svänger nära
Det är
upphängningssystem. Ett drivsystem 3, som kan vara en momentgivare av inom
tekniken välkänt slag, t.ex. en piezo-elektrisk givare eller en elektromagnet,
producerar ett reglermoment LTOT. Drivsystemet 3 verkar som ett förstärk-
ningselement, och reglermomentet LTOT är sålunda lika med en konstant gånger
den elektriska styrsignal B, som matas till drivsystemingången. Styrsignalen B
beräknas i en âterkopplingsreglerenhet 14, vars ingångar är den optiska fasvinkeln
ip , ditervinkelhastigheten in , och ditervinkeln 6 . De senare signalerna genereras
av avkännare 5, 6 resp. 7, som är kopplade med, och drivs av, det ringlasergyro-
avkännande elementet l på sätt som är välkänt inom denna teknik. Den optiska
fasvinkeln up kan mätas med en optisk avtagare, ditervinkelhastigheten w kan
avläsas med en takometer eller en piezo-elektrisk givare, och ditervinkeln 6 kan
avläsas optiskt eller med hjälp av en piezo-elektrisk givare.
Återkopplingsreglerenheten 4 ger momentstyrsignalen B som »summan
av tvâ signaler V och U. Signalen V är en kontinuerlig analog positiv-
âterkopplingssignal proportionell mot diterhastigheten m som exakt utbalanserar
förluster i systemet beroende på dämpning. Den alstras genom förstärkning av
utsignalen från ditervinkelhastighetavkännaren 6 i en förstärkare 15 till den för
detta syfte nödvändiga nivån. Den driver det gyroavkännande elementet vid
konstant amplitud och frekvens pâ svängningen. Signalen U å andra sidan
beräknas en gång varje diterperiod och hålls konstant under perioden, dvs.
U(t) = Un = konst. för nT 5 t 5 (n+l)T (1)
där T = 2 1r/ 52 . Syftet med att addera den "periodvis konstanta" signalen U(t) till
signalen V är att justera den effektiva ditervinkelhastighetsfasen i varje period i
förhållande till den optiska fasen vid början av diterperioden. En diterperiod
börjar i det ögonblick, då ditervinkeln skär genom noll i riktning uppåt, och den
optiska fasen i detta ögonblick
Ibn = W (nT) . (2)
används för att bestämma reglersignalen Un,såsom förklaras nedan. Den optiska
fasen vid början av en diterperiod erhålls genom att man pâtrycker utsignalen
från en nollskärningsdetektor 8, som avkänner den punkt vid vilken ditervinkeln
10
15
20
25
30
446 664
a
skär genom noll, på. en OCH-grind 17, och åstadkommer avläsning av den optiska
signalen 7, som pàtrycks pâ den andra ingången till OCH-grinden 17. Fasen vi: n
erhålls sålunda vid början av diterperioden. Fasvinkeln il; n matas till en
mikrodator 10, som utför den nedan beskrivna beräkningen och genererar den
periodvis konstanta signalen U(t). Processen med addering av den analoga
positiv-återkopplingssignalen V och den periodvis konstanta signalen U illustreras
symboliskt som uppträdande vid en summeringsförbindningspunkt 9.
Alternativa anordningar för âterkopplingsreglerenheten ü visas Fig. 2,
3 och ll, vilka kommer att beskrivas efter den efterföljande diskussionen av
arbetsprincipen för uppfinningen.
Den optiska vinkeln xp för ett ringlasergyro satisfierar följande
differentialekvation av första ordningen
â-ï = om, + i., - uLsin w (a)
där
u, är vinkelhastigheten för gyrohöljet (dvs. den externa vinkelhastíg-
heten),
u, är ditervinkelhastigheten (dvs. vinkelhastigheten för det avkännande
elementet relativt höljet)
a, L är låsningsfrekvensen,
G är gyroskalfaktorn.
I den resonanta upphängningen är ditervinkeln 6 och ditervinkelhastighetenw
givna av
ao' _
f, " W _ - (4)
d _ ~ Ll-ÜT 5
T: I fl 6 - Bm + -f ( )
där
Q är resonansfrekvensen för upphängningen,
är dämpningen för upphängningen,
- J är trögheten hos det avkännande elementblocket,
LTOT är det av drivsystemet producerade momentet, dvs.
där K är drivsystem-(momentgivare)-skaliaktorn.
Den positiva âterkopplingssignalen V väljs för att exakt upphäva dämpnings-
termen, dvs.
5
10
15
20
25
446 664
5
Kv _
T - B (7)
och sålunda blir (5)
.'12 . 2 k s
d: -n e + J i )
där L är det moment som alstras av den periodvis konstanta signalen U.
För enkelhet vid analysen är det lämpligt att normalisera de dynamiska
ekvationerna (3) - (5) under införande av följande nya, dimensionslösa variabler:
6 = G 6 = optisk ditervinkel
al: -çlqlj-L :normaliserad ingångshastighet
a = = normaliserad diterhastighet
aL = Gå) L = normaliserad lâsningshastighet
G L = G K . .
u = -- - -- - U = normahserad reglerszgnal
92 3 92 J
1 = m = normaliserad tid.
Uttryckta i dessa dimensionslösa variabler blir ekvationerna (3), (il)
resp. (8) -
S!!! . '_
d* al + a aLsinw (9)
gå I
af _ a (lo)
da
a? ' 'i * “ (n)
Låt 6 n = 6(2 1m) = normaliserad ditervinkel vid början av mte
an = a(2 un) = normaliserad ditervinkeihastighet diffifPefßden
I överensstämmelse med ekvation (1) är u periodvis konstant:
u(t)=un för 21m 5 T 5 21T(n+l)
Med användning av standardmetoder befinns lösningen på (10) och (ll) över den
nzte diterperioden vara
Nta-inn) - óncost Fansint + un(1-cost) (12)
-1(T+2"fi) I -ónsint + ancost + unsint
(13)
Sålunda gäller vid slutet av den nzte diterperioden, som är början av den (n+l):te
perioden
446 664
6 I 6(2n+2¶n) ' Ön
n+1
8 - ¿(2n+2nn) I a
n+1 U
Sålunda återgår ditervínkeln och ditervinkelhastigheten vid slutet av perioden till
sina värden vid början av perioden. Under perioden kan dock den normaliserade
5 diterhastigheten, given enligt (13), skrivas
a(r+2nn) I Ahcos(r-Sn) (14)
där A = J az + (u -6 )
_ n n n n
u -6
n n
8
n
Man kan sålunda notera, att den effektiva amplituden An och fasen Bn pâ
tanß '
. I!
1_0 ditersignalen kan regleras genom den stegvis konstanta reglersignalen u.
Även om början av diterperioden kan definieras som ön = öml =
godtycklig vinkel, är det mest praktiskt att anta att diterperioden börjar vid ön
= 5 ml = 0 enligt bestämningen med nollskärningsdetektorn. I detta fall gäller
A = I az + u (15)
h n n
“ (16)
11
15 tanßn = g;
Det bör noteras, att en liten reglersignal u (un << an) huvudsakligen påverkar
fasen och endast har liten effekt på amplituden, dvs.
U
Il
A x a
n fl
20 lnsättande av (14) i (9) ger
få - sl + inwsG-ßn) - aLsinw e (n)
där T är tiden till den n:te diterperioden (T = t - 2 un).
Någon exakt lösning av (17), som är en icke-linjär differentialekvation,
, har inte hittats. Genom numerisk integrering över en enda diterperiod med
25 många olika värden på den optiska fasvinkeln vid början av diterperioden,
nämligen
5 Wn+l - lPn I' ZWHL- íflaUAnmI) *_- f2(aL,An,a1)s1n(
10
l5
20
446 664
N30) =v(t=21fn) ~ vn
och många parametervärden al, An, Bn, aL har det dock konstaterats, att
lösningen på (17) över en diterperiod väl approximeras av ett uttryck med
formeln
Il» +41
Jil-z-'w i ans) <1ß>
n n
där f1(aL, An, ax) och f2(aL, An, al) är konstanter som beror av aL, An, och a!
och bestäms empiriskt genom numerisk integrering av (17).
Ekvation (18) är nyckeln till reglersystemkonstruktionen. l ett idealt
gyro skall ändringen i avläsningsvinkel över en diterperiod vara exakt Znal;
sålunda resulterar f 1- och fz-termerna i fel. Eftersom fz-termen är kontrollerbar
(genom An och B n) genom reglering av un, är det möjligt att välja un för att
eliminera felen genom att låta fl-termen upphäva fz-termen, dvs. att välja An
och Bn så att
+ Ansinßn)
(19)
Û + 2“a +11
_ _ _ ) in _fl____1__fl
f1(d]|^n9'|l) fz(aLa^nnal s 2
eller
flbvhnfill)
. smupnflta +A“s1nßn)
f2(aL,An,aI) I
För denna ekvation finns ingen lösning för |fl/f2| > l, men för praktiska
värden pâ aL och An (med An >> aL) befinns förhållandet mellan f l och fz vara
mycket mindre än ett, och (19) kan lösas. Den sökta lösningen är
' _ f (a ,A ,al)
W + nal + Ansinßn - sin 1< > I h*
“ 2 1.' n' 1
Av (15) och (16) framgår att
Anslnßn ~ un
Följaktligen ges den normaliserade reglersignal un, som utbalanserar felet, av
10
15
20
25
446 664
' . f (a ,A ,a) .'
u - din - 'nal + sin 16 >i 21k (ÅO)
n _ 2 L' n' l
Teoretiskt kan k i (20) vara ett godtyckligt heltal, men av det praktiska skälet
att minimera regleramplituden väljs k för att hälla un mellan - 'n och rr .
Eftersom An (något) beror på un, mæte (20) betraktas som en implicit
ekvation av un. Eftersom f ll/fz i de flesta fall är helt litet kan det dock vara
tillåtet att approximera sin' (f llfz) genom f llfz och att använda an i stället för
An i approximationen. Detta ger det enklare regleruttrycket
f1(“1.'°f.'°1)
+ zflk (21)
u I-'nlø -na +------
n _ n -I f2(aL,an,aI) -
Den normaliserade ingångsvinkeln a] förekommer i (20) och (21), men
om denna storhet vore känd skulle det från början inte finnas något behov för
gyrot. Vid tillämpningen använder man sålunda ett uppskattat värde pâ al i
stället för det sanna värdet, som inte är känt förutom genom driften av
instrumentet. Om instrumentet fungerar korrekt och avkännarutgången för optisk
fasvinkel är relativt brusfri, så ges en giltig uppskattning 'åh av al genom
. L. _. (22)
'sin 21: wn 'kn-l)
Mera generellt, om man antar att brus förekommer i mätningen av 'll n
så kan ett "Kalman-fílter" konstrueras för att få ett utjämnat värde lll n av
avläsningsvinkeln tillsammans med en uppskattning aïn. Tillämpning av välkänd
Kalman-filtreringsteori ger estimeringsekvationerna:
in' - in + twin-Én) (23)
fm - Smk” + xaän-Äïn; (24)
med .Qi-n _ 'åk-l + Ngum” (25)
där i: = brushaltig utläsning = vi) n + brus. °
Konstanterna K och K a är konstanta filterförstärkningar, som beror
på brusstandardavvikelsen. När brusstandardavvikelsen går mot noll gäller K + 1
10
15
20
25
446 664
och KZ + 1/2 1:. Da hur (23)
.var = vn
och (24) ' reduceras till (22). Förstärkningarna Kw och K a beräknas med
användning av välkänd Kalman-filtreringsteori. Ett diagram som visar det
optimala förhållandet mellan Kg och 2 -nKa och som härrör från tillämpning av
denna teori visas i Fig. 6. De mindre värdena på Ka och Kw skulle tendera att
ge mer brusfiltrering, på bekostnad av trögare dynamiskt gensvar, än som skulle
uppnås med de högre förstärkningarna. Ekvationerna (23) - (25) tillsammans med
(20) eller (21) kan tillämpas i en mikrodator.
Det faktiskt erforderliga momentet beräknas från un med användning
av den tidigare givna definitionen, dvs.
2
U _¿fl_,,
n GK n (26)
eller, med insättning av de optimala estimaten (23) via (25) i (21) och resultatet i
(26) ger
2 h n
-hv _ _ fllaha-à lim:
“n-arliifla: *
n fziåLf an: alu)
Det torde stå klart för fackmannen på omrâdet, att den belysande
utföringsformen av uppfinningen, som beskrivits i anslutning till Fig.1, kan
utföras på andra sätt. Det torde ocksâ stå klart, att det inte är nödvändigt att
ändringen i optisk fasvinkel över en period är den som ges av ekvationen (18) för
att uppfinningen skall kunna utövas. Ett mera generellt funktionellt beroende kan
inrymmas. Speciellt kan varje lösning på (17) skrivas som
~ ' 27)
- *in I ZIIBI + E(3L,Ån.3I|wn+lvÛn¶8n) (
där E är någon godtycklig funktion som resulterar från numerisk integrering av
(17). För att upphäva felet är det nödvändigt att välja An och Sn så att
fil(nL.l\n,al.Wn'i'-zflvli'n,ßn) = 0 (23)
Detta är en implicit funktion som, tillsammans med (15) och (16), bestämmer den
nödvändiga regleringen. Ekvationerna (20) och (21) är specialfall av denna mera
generella ekvation.
10
15
20
25
30
35
446 664
io
Återkopplingsreglerenheten ll i Fig. l kan åstadkommas med använd-
ning av en mikroprocessor, såsom visas i Fig. 2. Där förekommer en
mikroprocessor ll, som innehåller eller arbetar med tillräckligt minne för att
rymma reglerprogrammet (mindre än l kilobyte), en analog-till-digital-omvandlare
12 och en digital-till-analog -omvandlare 13. Om mikroprocessorchipet inte
innefattar någon klocka torde det för fackmannen stå klart, att man måste
tillföra en sådan.
Funktionen för OCH-grinden 9 i Fig.l är inkluderad i arbetssättet för
Av enkelhetsskäl har växelströmsanslutningar utelämnats.
mikroprocessorn, varför det inte behövs någon separat OCH-grind.
Signalen från noll-skärningsdetektorn tjänstgör som en brytsignal.
innan denna signal uppträder är processorn programmerad för att utföra ett
godtyckligt "bakgrunds"-program "A" (Lex. en NO-OP-slinga). Den analoga
fassignalen q; från den optiska gyroutläsningen 7 (Fig. l) kopplas till ingången pä
analog-till-digital-omvandlarchipet 12, där den kontinuerligt omvandlas till
digital form. I digital form kopplas den till en ingång på mikroprocessorn ll.
Mikroprocessorns utgång är samtidigt den tidigare beräknade reglersignalen, som
(i digital form) matas till digital-till-analog-omvandlaren 13. Där genereras ett
_ konstant korrigeringsvärde U tills nästa brytsignal från noll-skärningsdetektorn
uppträder.
När brytsignalen uppträder utför mikroprocessorn reglerprogrammet.
Eftersom beräkning av en ny reglersignal Un i mikroprocessorn kan kräva en
betydande andel av diterperioden för att fullbordas, används ett filter, som
svarar för en hel diterperiods fördröjning, i stället för det som beskrivs av
ekvationerna (23) - (25) ovan. Ekvationerna för detta filter är
Å ,, u A
“in I .wn-l :van-l + íwlín-l-ín-l) (29)
Å A
an s an-l + Kavhn-l-wn-l
) (30)
Förstärkningarna l-(q, och 'Ka är inte desamma som Kq; resp. Ka i ekvationerna
(23) och (241) och de kan också ses i Fig. 6. Den matematiska rutinen i STEG 3 i
datorprogrammet som följer svarar mot ekvationerna (29) och (30) i stället för
ekvationerna (23) - (25).
När brytsignalen från noll-skärningsdetektorn uppträder utför mikro-
processorn reglerprogrammet, vilket består av följande steg:
STEG 1. Den digitala representationen av den optiska fassignalen ll»
överförs från ingången till ett minnesläge.
STEG 2. Den tidigare beräknade reglersignalen, som då finns i minnet,
10
15
20
25
30
446 664
ll
överförs till utgången (där den omedelbart omvandlas till analog form).
STEG 3. En matematisk reglerrutin utförs, vilken beräknar en ny
reglersignal och kvarhâller den i minnet tills nästa brytsígnal ankommer.
STEG ll. Datorn âterställs för att utföra det godtycklíga programmet
"A" eller förblir helt enkelt i ett "vänta-pâ-brytningfltíllstånd.
Det kan noteras, att de första tvâ operationerna utförs på nâgra få
maskinperioder, och följaktligen blir tidsfördröjningen mellan uppträdandet av
noll-skärningsbrytningen, läsningen av fasen och uppdateringen av utsignalen
försumbar. Tidsintervallet på nästan en hel diterperiod (av storleksordningen 4 -
5 millisekunder) är tillgänglig för att utföra den matematiska rutinen i STEG 3.
Med hänsyn till enkelheten hos de erforderliga operationerna är detta god tid för
att utföra beräkningarna. Pâ grundval av analysen på sidorna 7 och 8 mäste en
sekvens av beräkningar utföras, såsom anges av följande matematiska rutin:
1 R = P_- PH
2 Pa = PH + TP*AH + WR
3 AH = An + xA*R
4 U = -PH - F*An
5 IF U < P1 Go To 8
5 IF u > PI THEN u = U - TP
7 RETURN
3 u = u + TP = RETURN
Denna sekvens av operationer är uttryckt på BASlC-sprâk där
R representerar rn (en mellanprogramvariabel)
P '- own
PS " vi: n
PH " il: n
AH " an
U " Un
Pl " 1!
TP " 2 1!
F “ fr + c
10
15
20
25
30
446 664
12
K representerar Kp
KA " Ka
där í (21) _
fl .r Q
fz .r caI
(Erfarenheten har visat att detta är en god approximation.)
Det bör noteras, att den ovanstående matematiska rutinen har
uttryckts på BASlC-språk endast i förklarande syfte. Man inser att programmet
kodas på lämpligt sätt i maskinkoden för det mikroprocessorchip som används.
Det bör också noteras, att det kan vara önskvärt att proportíonera variablerna
för att åstadkomma maximal programmeringseffektivitet och att använda
analog-till-digital-omvandlaren på mest effektiva sätt.
Fig. 3 visar en utföringsform av uppfinningen, som illustrerar använd-
ning av den ofta utnyttjade "fringemönstefl-typen av detektor för utläsning av
ringlasergyrot l i stället för den tidigare diskuterade optiska fasvinkeln ip .
I detta fail är utläsningsdetektorn, som visas schematiskt, uppdelad på
två delar, av vilka den ena 7a genererar en signal proportionell mot sinus för xp
och den andra 7b en signal proportionell mot cosinus för q; , dvs.
än) = Kl sin un) (31)
c(t) = X2 cos Mt)
(32)
där K 1 och Kz är kända proportionalitetskonstanter.
Fig. 3 illustrerar också ett sätt att bestämma fasen xp , vid ögonblicket
för fringeskärningen, vilket är baserat på användning av tvâ noll-skärnings-
detektorer. Däri används noll-skärningsdetektorn 14, som svarar på ditervinkeln
6 , för att starta en digital "klocka" i mikroprocessorn 10 eller en separat digital
klocka, och noll-skärningssignalen från noll-skärningsdetektorn 16 används för att
stoppa "klockan". För detta ändamål matas noll-skärningsdetektorn l6 med
signalen sin ip från detektorn 7b. Tidsskillnaden mellan noll-skärningarna, mätt
enligt klockan, är proportionell mot fasvinkeln il: i det ögonblick ditervinkeln 6
går genom noll. Det sålunda uppnådda värdet kan, liksom tidigare, behandlas i
mikroprocessorn för att bilda ett reglervärde U.
Proportionaliteten mellan fasvinkeln ml: och nollskärningarna framgår
av följande analys:
10
15
20
25
30
446 664
13
Vid den tidpunkt to, då ditervinkeln a skär genom noll, är den totala
vinkelhastighetsingången maximal och gyrot är inte låst. Den totala vinkelhastig-
heten är S) + Qi, men Q är mycket större än Qi, så att vinkelhastigheten kan
antas vara Q. Sålunda gäller
Mt) å Wro) + Xiu-co) (33)
Vid tidpunkten T för noll-skärning gäller S(T) = O och följaktligen
w<=°>+ nrr-fo) - o (as)
Sålunda ges den erforderliga fasvinkeln för reglerlagen \l1(t0), fasvinkeln vid
tidpunkten för diternollskärníng, av
I _ I _
där A = T - to är tiden mellan nollskärningen för ditersignalen och
nollskärningen för den slutliga detektorsignalen s(t). Signalen c(t) används för att
lösa kvadranten för Mt).
Ett annat sätt att använda signalerna s(t) och c(t) är att omvandla
dem till digital form och sedan använda bakgrundsprogrammet "A" för att utföra
en tabelluppslagning av vinkeln W med användning av de digitala represen-
tationerna av s(t) och c(t). En fackman på maskinspråkprogrammering kan lätt
skriva ett sådant program; eftersom programmet i hög grad skulle bero på den
tillgänliga instruktionsutrustningen görs här ingen specificering av sådan algoritm
i ett språk av högre ordning såsom BASIC, såsom gjordes för det ovan beskrivna
reglerprogrammet.
Fig. 4 illustrerar användning av en analog signalprocessor i stället för
mikroprocessorn för att utföra funktionerna hos återkopplingsreglerenheten 4
enligt Fig. l. Vid denna utföringsform av uppfinningen är två kretsar 24 och 28
för fasthållning av ögonblicksvärden kopplade på ömse sidor om en linjär analog
krets 26. Kretsarna 24 och 28 aktiveras av en brytsignal, som liksom tidigare
alstras av nollskärningsdetektorn 8 från ditervinkeln G . Brytsignalen bringar
fasthållningskretsen 20 att bestämma värdet på den optiska fasen W vid tiden för
nollskärning och att fasthålla denna till nästa nollskärning för ditersignalen. Den
10
15
20
25
446 664
lll»
sålunda fasthâllna signalen som uppträder vid utgången på fasthâllningskretsen 21+
matas till ingången på den linjära analoga kretsen 26 (se Fig. 5), som har en
transferfunktion H(s). Utsignalen från den analoga kretsen 26 matas till den
andra fasthàllningskretsen 28, där den fasthålls och görs tillgänglig som
korrigeringssignal U.
Arbetssättet för kretsen enligt Fig. 4 kan karaktäriseras genom
"pulstransferfunktionen"
Lial
um ' m) m)
där U(z) och 'l'(z) är Z-transformationer av utsignalen U och den optiska
fassignalen q; . Z-transformationer definieras i sådana läroböcker som "Sampled-
Data Control Systems" av J. R. Ragazzinl och G. F. Franklin, publicerad av
McGraw Hill 1958.
i enlighet med välkänd teori ges pulstransferfunktionen av
U(z). 'Ål-z-llå
där 5, representerar operationen med tagning av Z-transformation på ett
(38)
samplingdatasystem.
Den nödvändiga pulstransferfunktionen H(z) bestäms genom Z-trans-
formering av de differensekvationer, som beskriver databehandlíngsalgoritmen.
Så snart den nödvändiga transferfunktionen H(z) bestämts, kan H(s) finnas och
syntetiseras med välkända metoder. I fallet med den algoritm, som definieras av
ekvationerna (29) och (30) med reglersignalen given av
unfl--pn-r,ln (39)
sågällef ud) - Jm) _ p AIM mo)
och man får, vid tagning av Z-transformationer av ekvationerna (29) och (30)
^ .
m; - :hån + :Jim + ïvcvm - ~?<=m m)
lim - flnïïm +ïazvm - iom (42)
446 664
15
Vid lösning av dessa ekvationer med avseende på if: (z) och ÃI(z) och insättning i
uttrycket för U(z) får man
' bz+b
ïf-š-aiza--z-l-l- ~ (43)
YZ Äëalzíraz
där
5 a
lfl-Zfk
. v
az - 1. _ E* + Zuïa
sl - - k* r i!
bl -ïtfrïa- zaía
En analog transferfunktion H(s), som syntetiserar denna pulstransfer-
10 funktion, är av andra ordningen och har den allmänna transferfunktionen
8s+82
m) - 2 (44)
3 +GlS+G2
Förhâllandena mellan al, az, Bl, 82, och al, 32, bl, bz kan
bestämmas med hjälp av en tabell över Z-transformationer.
Fig. 5 visar en linjär analog krets 26, i vilken den i Fig. li erforderliga
15 transferfunktionen H(s) kan syntetiseras. Däri matas det värde på optisk fas ü ,
som fasthålles i fastlåsningskretsen 24, till ett första summeringselement 30,
vilket kan omfatta en förstärkare med multipla ingångsmotstånd. Utsignalen
från summeringselementet 30 matas till en integrator 32, vars utgång i sin tur
matas till en integrator 31+. Integratorerna 32 och 34 kan var och en omfatta en
20 operationsförstärkare med motstândsingâng och kondensatoràterkoppling, såsom
är väl känt inom tekniken. lntegratorns 31+ utsignal matas, via ett konstant-
förstärkningselement 38, till ena ingången på ett andra summeringselement 36,
som också kan omfatta en förstärkare med motstånd i ingångskretsarna.
Utsignalen från integratorn 32 behandlas också genom konstantförstärknings-
25 element #2 och 44 och matas till ingângarna på. summeringselementen 36 och 30.
lntegratorns 34 utsignal matas också till summeringselementet 30 via ett kon-
stantförstärkningselement 40. Konstantförstärkningselementen 38, #0, 42 och 41:
kan omfatta potentiometrar när förstärkningar mindre än ett behövs, eller
förstärkare när förstärkningar större än ett behövs. Beträffande konstantför-
30 stärkningselementen 40 och ßll kan användning av inverterande förstärkare vara
föredragna för att enkelt ge inverterade signaler till ingângarna pâ summerings-
10
...ewva-ë. _
446 664
16
elementet 30. Det är också uppenbart för fackmannen, att vissa funktioner kan
kombineras. Sålunda kan summeringselementet 36 och konstantförstärkningsele-
menten 38 och #2 åstadkommas med hjälp av en enda operationsförstärkare och
tvâ ingångsmotstând, och summeringselementet 30 kan kombineras med integra-
torn 32.
I sådana fall då fassignalen \|: inte är tillgänglig vid ögonblicket för
diternollskärning kan man använda signalen för nollskärning av det ovan
beskrivna fríngemönstret. I stället för att starta en klocka kan nollskärningen för
ditersignalen användas för att trigga en íntegrator och nollskärningen för
fringesignalen användas för att stoppa integreringen. Den analoga signal, som
genereras på integratorutgângen när integreringen avbryts, är proportionell mot
fasförskiutningen d: och skulle matas till ingången på den linjära analoga kretsen
26 i Fig. 4.
Claims (15)
10 l5 20 25 30 446 664 17 PATENTKRAV l. Anordning vid íjäderupphängda ringlasergyron för att åstadkomma en gyroutläsning proportionell mot vinkelinsignal, k ä n n e t e c k n a d av en momentgivare (3) för ditering av gyrot och en åter- kopplingsenhet (4) för reglering av momentgivaren genom att alstra en reglersignal (B), som är en funktion av den optiska fasvinkeln (lll), ditervinkeln ( 9) och ditervinkelhastigheten (w) hos gyrot.
2. Apparat enligt patentkravet 1, k ä n n e t e c k n a d av att reglersígnalen (B) innefattar en komponent (V), som är proportionell mot ditervinkelhastigheten (w ) för att undanröja systemförluster beroende på dämpning, och en periodvis konstant komponent (U), som är en funktion av fasvinkeln för den optiska utläsningen för justering av fasen för den effektiva dítervinkelhastigheten relativt den optiska fasvinkeln.
3. Apparat enligt patentkravet 2, k ä n n e t e c k n a d av att den periodvis konstanta komponenten (U) genereras en gång för ett helt antal perioder och hålls konstant under en tidrymd lika med den för antalet hela perioder. .r
4. Apparat enligt patentkravet 2, k ä n n e te c k n a d av att den periodvis konstanta komponenten (U) genereras en gång varje period och hålls konstant under perioden.
5. Apparat enligt patentkravet 4, k ä n n e t e c k _n a d av att den periodvis konstanta reglersignalkomponenten (U) genereras i enlighet med formeln A . 2 Å .m ^ f fl,fl,a U =ë-K-l"l11n~fiaIn+ “( L ,. )É2nk] f2(aL' an' aIn) där U är värdet på den periodvis konstanta komponenten hos momen- tet genom den nzte diterperioden är trögheten hos det avkännande elementblocket är resonsansírekvensen för upphängningen är gyroskalfaktorn är drivsystem(momentgivaàskalfaktorn G°7CD=OU :J är ett estimat av den optiska fasvinkeln är ett estimat av ingångshastigheten _ m) llfl 10 15 20 25 30 446 664 18 f 1 är en empiriskt bestämd funktion av aL, an, a, fz är en empiriskt bestämd funktion av aL, an, a, aL är den normaliserade lâsningshastigheten an är den normaliserade diteramplituden k är ett heltal valt för att hålla värdet inom parenteserna mellan - n och Ir .
6. Apparat enligt patentkravet 4 eller 5, k ä n n e t e c k n a d av att âterkopplingsenheten (4) innefattar organ (12) för omvandling av gyroutläsningsvinkeln till ett mot fasen proportionellt digitalt värde, organ inkluderande en mikroprocesser (10) for att beräkna den periodvis konstanta komponenten från det digitala värdet en gång varje diterperiod och för att omvandla den digitala utsignalen från mikroprocessorn till en analog regler- signal, och organ som svarar på ditervinkeln för att initiera beräkning genom mikroprocessorn en gång varje diterperiod.
7. Apparat enligt patentkravet lr, k ä n n e t e c k n a d av att gyroutläsningsvinkeln är i form av fringedetektor- signaler proportionella mot sinus och cosinus för fasen på vinkeln, och att *âterkopplingsenheten (4) innefattar organ inklucerande en mikroprocessor för beräkning av den periodvis konstanta komponenten från fringedetektorsignaler- na, för omvandling av den beräknade signalen till analog form, och för att hålla den beräknade signalen konstant, och organ som svarar på ditervinkeln för att initiera beräkning i mikroprocessorn en gång varje diterperiod.
8. Apparat enligt patentkravet lt, k ä n n e t e c k n a d av att återkopplingsenheten (4) innefattar organ för att sampla gyroutläsningen och för att ge en signal proportionell mot utläsnings- vinkeln en gång varje diterperiod, en linjär analog krets som svarar på utsignalen från gyrosamplingsorganen, organ för att generera den periodvis konstanta komponenten, och organ för att sampla utsignalen från den linjära analoga kretsen en gång varje diterperiod och hålla detta värde konstant.
9. Apparat enligt patentkravet 8, k ä' n n e t e c k n a d av att den analoga kretsen har transferfunktionen B iii-s) = -l S + G15 + G2 s+ß2 där al, 1:2, Bl och 62 är konstanter. l0 15 20 25 30 446 664 19
10. Sätt att ditera ett fjäderupphängt gyro för att undvika låsning, k ä n n e t e c k n a t av att man applicerar moment på fjäderupphängniiwgen i en mängd, som är kontinuerligt variabel i proportion till ditervinkelhastigheten för att upphäva systemförluster, och att man samtidigt applicerar ytterligare moment på upphängningen vid en nivå, som upprättas en gång för ett helt antal perioder, för att justera den effektiva ditervinkelhastighetsfasen med upprepade intervall.
ll. Sätt enligt patentkravet 10, k ä n n e t e c k n a t av att nivån upprättas en gång varje period.
12. Sätt enligt patentkravet 10 eller ll, kännetecknat utläsningsfasvinkel. av att den fixerade nivån är en funktion av gyrots
13. Sätt enligt patentkravet ll, k ä n n e t e c k n a t av att nivån för konstant moment beräknas ur ekvationen 2 ,. ^ _ JR ^ firat» a am) Un _ Ö-lš-l-wn-"aln + I n' ^ t znk] - fzet- an, ann där Un tet genom den n:te diterperioden är värdet pâ den periodvis konstanta komponenten hos momen- J är trögheten hos det avkännande elementblocket S2 är resonsansfrekvensen för upphängningen G är gyroskalfaktorn l< är drivsystem(momentgivafiskalfaktorn f n är ett estimat av den optiska fasvinkeln am är ett estimat av íngångshastigheten f l är en empiriskt bestämd funktion av aL, an, a! fz är en empiriskt bestämd funktion av aL, an, al aL är den normaliserade låsningshastigheten an är den normaliserade diteramplituden k är ett heltal valt för att hålla värdet inom parenteserna mellan - fioch Tf. 11+.
Sätt enligt patentkravet 12, k ä n n e t e c k n alt av det inbegriper beräkning av signalen för reglering av nivån av konstant moment i en mikroprocessor eller analog dator, vilken som en ingångssignal, tagen en gäng varje diterperiod, har en signal proportionell mot fasen för gyroutläsningsvinkeln. 446 664 zo
15. Sätt enligt patentkravet 14, k ä n n e t e c k n a t av att den analoga datorn har transferfunktionen 8 +ß H(s)=-s 2 S +GlS+fl2 där al, az, Bl och 82 är konstanter.
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US06/022,557 US4243324A (en) | 1979-03-21 | 1979-03-21 | Feedback system for controlling lock-in in spring suspended ring laser gyroscope |
Publications (2)
Publication Number | Publication Date |
---|---|
SE8002138L SE8002138L (sv) | 1980-09-22 |
SE446664B true SE446664B (sv) | 1986-09-29 |
Family
ID=21810208
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
SE8002138A SE446664B (sv) | 1979-03-21 | 1980-03-19 | Anordning och sett for att undanroja lasning i ett fjederupphengt ringlasergyro |
Country Status (9)
Country | Link |
---|---|
US (1) | US4243324A (sv) |
JP (1) | JPS55128115A (sv) |
CA (1) | CA1134484A (sv) |
DE (1) | DE3011043A1 (sv) |
FR (1) | FR2452086A1 (sv) |
GB (1) | GB2044984B (sv) |
IL (1) | IL59246A (sv) |
NO (1) | NO154537C (sv) |
SE (1) | SE446664B (sv) |
Families Citing this family (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4695160A (en) * | 1981-07-06 | 1987-09-22 | Honeywell Inc. | Error cancelling bias system |
US4445779A (en) * | 1981-07-06 | 1984-05-01 | Honeywell Inc. | Dither system for a spring mass system |
DE3150160A1 (de) * | 1981-12-18 | 1983-06-30 | Honeywell Gmbh, 6050 Offenbach | Ringlaserkreisel |
US4605307A (en) * | 1982-06-21 | 1986-08-12 | Honeywell Inc. | Apparatus for laser gyro |
US4657392A (en) * | 1982-08-05 | 1987-04-14 | Honeywell Inc. | Lock-in rate discriminate apparatus for ring laser angular rate sensors |
WO1987002140A1 (en) * | 1982-11-20 | 1987-04-09 | Mueller Paul | Process for determining speed of rotation |
US4597667A (en) * | 1982-12-09 | 1986-07-01 | Litton Systems, Inc. | Dither controller for ring laser angular rotation sensor |
IL77856A0 (en) * | 1985-02-25 | 1986-12-31 | Sundstrand Data Control | Inertial reference system utilizing ring laser gyro data resynchronization |
US4783169A (en) * | 1985-08-09 | 1988-11-08 | Litton Systems, Inc. | Control of a ring laser gyro cavity according to a preselected model |
DE3621953A1 (de) * | 1986-06-30 | 1988-01-14 | Bodenseewerk Geraetetech | Traegheitssensoranordnung |
US4888705A (en) * | 1987-10-26 | 1989-12-19 | Kearfott Guidance And Navigation Corp. | System for measuring the position of vibrating object |
US4856901A (en) * | 1988-05-04 | 1989-08-15 | Kearfott Guidance & Navigation Corporation | Velocity control system using piezoelectric transducers |
FR2645263B1 (fr) * | 1989-03-30 | 1991-07-26 | Salaberry Bernard De | Capteur de position optique pour gyrometre a laser |
US4981359A (en) * | 1989-06-19 | 1991-01-01 | Litton Systems, Inc. | Ring laser gyroscope dither drive system and method |
JP2000329565A (ja) * | 1999-03-16 | 2000-11-30 | Canon Inc | ジャイロ装置 |
US6229615B1 (en) * | 2000-01-06 | 2001-05-08 | Honeywell International Inc. | Automatic dither pickoff gain select |
CN101609956B (zh) * | 2009-06-05 | 2011-06-08 | 北京工业大学 | 可调谐激光器的闭环反馈智能控制系统 |
CN108732933B (zh) * | 2018-06-01 | 2021-03-16 | 广东工业大学 | 基于lmi的周期分段振动协同系统的时变连续控制器设计 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3373650A (en) * | 1965-04-02 | 1968-03-19 | Honeywell Inc | Laser angular rate sensor |
US3743969A (en) * | 1969-11-12 | 1973-07-03 | North American Rockwell | Modulation servo control for frequency modulated ring laser gyro |
FR2271542A1 (en) * | 1973-12-27 | 1975-12-12 | Minisini Pierre | Rotation measuring ring laser rate gyroscope - has two electro-optics crystals and two sensors for two laser beams |
US4152071A (en) * | 1976-08-02 | 1979-05-01 | Honeywell Inc. | Control apparatus |
CA1085031A (en) * | 1976-11-08 | 1980-09-02 | Litton Systems, Inc. | Laser gyro with phased dithered mirrors |
US4115004A (en) * | 1976-11-15 | 1978-09-19 | Litton Systems, Inc. | Counterbalanced oscillating ring laser gyro |
US4132482A (en) * | 1977-09-12 | 1979-01-02 | The Singer Company | Feedback system for a ring laser gyro |
-
1979
- 1979-03-21 US US06/022,557 patent/US4243324A/en not_active Expired - Lifetime
-
1980
- 1980-01-25 CA CA000344409A patent/CA1134484A/en not_active Expired
- 1980-01-28 IL IL59246A patent/IL59246A/xx not_active IP Right Cessation
- 1980-02-06 GB GB8003958A patent/GB2044984B/en not_active Expired
- 1980-02-13 FR FR8003175A patent/FR2452086A1/fr active Granted
- 1980-03-17 JP JP3280180A patent/JPS55128115A/ja active Granted
- 1980-03-19 SE SE8002138A patent/SE446664B/sv not_active IP Right Cessation
- 1980-03-20 NO NO800804A patent/NO154537C/no unknown
- 1980-03-21 DE DE19803011043 patent/DE3011043A1/de active Granted
Also Published As
Publication number | Publication date |
---|---|
FR2452086A1 (fr) | 1980-10-17 |
JPS6410763B2 (sv) | 1989-02-22 |
GB2044984A (en) | 1980-10-22 |
SE8002138L (sv) | 1980-09-22 |
NO154537B (no) | 1986-06-30 |
CA1134484A (en) | 1982-10-26 |
JPS55128115A (en) | 1980-10-03 |
FR2452086B1 (sv) | 1983-06-24 |
NO154537C (no) | 1986-10-22 |
DE3011043A1 (de) | 1980-10-02 |
DE3011043C2 (sv) | 1990-03-08 |
IL59246A (en) | 1984-11-30 |
US4243324A (en) | 1981-01-06 |
NO800804L (no) | 1980-09-22 |
GB2044984B (en) | 1983-06-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
SE446664B (sv) | Anordning och sett for att undanroja lasning i ett fjederupphengt ringlasergyro | |
EP0389281A2 (en) | Adaptive control system | |
US6825631B1 (en) | Prediction controlling device | |
JPH0956183A (ja) | 機械振動検出装置および制振制御装置 | |
JPH0635505A (ja) | 自動制御装置 | |
KR100242447B1 (ko) | 로봇 제어를 위한 경로 계획 장치 및 경로 계획 방법 | |
US5455495A (en) | Control device for servocontrolling an object to a given position | |
WO1996004708A1 (fr) | Dispositif de commande de la vitesse d'un moteur | |
JPH0795243B2 (ja) | 動力サ−ボ装置 | |
US6145381A (en) | Real-time adaptive control of rotationally-induced vibration | |
EP0510649A2 (en) | Feedback controller | |
US5410228A (en) | Method and apparatus for suppressing torsional vibration in an electric motor speed control system | |
JPS63197202A (ja) | 動力サーボシステム | |
JPH06222806A (ja) | デジタル変調方法とその装置 | |
US4888705A (en) | System for measuring the position of vibrating object | |
RU2103715C1 (ru) | Способ формирования пи-закона регулирования | |
WO2002082194A1 (fr) | Dispositif de commande asservie | |
US5467190A (en) | Digital to analog interface conversion circuit | |
US4969757A (en) | Motor torque control | |
RU2027212C1 (ru) | Адаптивная нелинейная система управления | |
SU924659A1 (ru) | Способ демпфировани автоколебаний в аналого-цифровых след щих системах | |
SU1158974A1 (ru) | Самонастраивающа с система управлени | |
JP3269198B2 (ja) | 位置制御装置 | |
SU1718245A1 (ru) | Линейный интерпол тор | |
SU888141A1 (ru) | Дифференцирующее устройство |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
NUG | Patent has lapsed |
Ref document number: 8002138-9 Effective date: 19911009 Format of ref document f/p: F |