WO2020083844A1 - Verfahren zum navigieren eines unterwasserfahrzeugs und unterwasserfahrzeug - Google Patents

Verfahren zum navigieren eines unterwasserfahrzeugs und unterwasserfahrzeug Download PDF

Info

Publication number
WO2020083844A1
WO2020083844A1 PCT/EP2019/078589 EP2019078589W WO2020083844A1 WO 2020083844 A1 WO2020083844 A1 WO 2020083844A1 EP 2019078589 W EP2019078589 W EP 2019078589W WO 2020083844 A1 WO2020083844 A1 WO 2020083844A1
Authority
WO
WIPO (PCT)
Prior art keywords
values
time
variable
underwater vehicle
state
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Ceased
Application number
PCT/EP2019/078589
Other languages
English (en)
French (fr)
Inventor
Robert Schäfer
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
ThyssenKrupp AG
ThyssenKrupp Marine Systems GmbH
Original Assignee
ThyssenKrupp AG
ThyssenKrupp Marine Systems GmbH
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by ThyssenKrupp AG, ThyssenKrupp Marine Systems GmbH filed Critical ThyssenKrupp AG
Publication of WO2020083844A1 publication Critical patent/WO2020083844A1/de
Anticipated expiration legal-status Critical
Ceased legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/04Control of altitude or depth
    • G05D1/06Rate of change of altitude or depth
    • G05D1/0692Rate of change of altitude or depth specially adapted for under-water vehicles
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B63SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63BSHIPS OR OTHER WATERBORNE VESSELS; EQUIPMENT FOR SHIPPING 
    • B63B79/00Monitoring properties or operating parameters of vessels in operation
    • B63B79/20Monitoring properties or operating parameters of vessels in operation using models or simulation, e.g. statistical models or stochastic models
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B63SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63BSHIPS OR OTHER WATERBORNE VESSELS; EQUIPMENT FOR SHIPPING 
    • B63B79/00Monitoring properties or operating parameters of vessels in operation
    • B63B79/40Monitoring properties or operating parameters of vessels in operation for controlling the operation of vessels, e.g. monitoring their speed, routing or maintenance schedules
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B63SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63GOFFENSIVE OR DEFENSIVE ARRANGEMENTS ON VESSELS; MINE-LAYING; MINE-SWEEPING; SUBMARINES; AIRCRAFT CARRIERS
    • B63G8/00Underwater vessels, e.g. submarines; Equipment specially adapted therefor
    • B63G8/14Control of attitude or depth

Definitions

  • an underwater vehicle can usually neither measure its own actual geoposition nor the actual direction of travel over the ground with sufficient reliability. Nevertheless, an underwater vehicle should be able to navigate safely through the water even when diving.
  • the object of the invention is to provide a method with the features of the preamble of claim 1 and an underwater vehicle with the features of the preamble of claim 1 1, which require less effort to carry out the prediction of the system state.
  • the first training phase can be carried out during a regular trip of the underwater vehicle. It is possible to use the coefficient matrix C after the first training phase and then to carry out a second training phase in which the coefficient matrix Q is adapted. As a result, the coefficient matrix C can be adapted step by step to an ever increasing sample or to environmental conditions that change during the journey can. It is possible, but thanks to the invention, it is not necessary to carry out test drives under specific predetermined test conditions or environmental conditions in order to enable the prediction.
  • the number of sample elements can be adapted to the time available for the first training phase and the sampling rate that can be achieved on board the underwater vehicle.
  • Submarine 1 comprises the following actuators, which influence the submarine 1 travel through the water:
  • the submarine 1 extends along a longitudinal axis X, a transverse axis Y and a floe axis Z.
  • the system state x (t0) is measured at a time tO.
  • the values of the navigation variables at this time tO can be derived from the measured current system state x (t0) at this time t0.
  • the values of the navigation variables for the future point in time t1 are predicted from at least one System state x ⁇ [t1) derived for this future point in time t1.
  • the system state x ⁇ (t1) at time t1 is therefore not measured, but predicted.
  • the current manipulated variable vector u [t (k)] Ui [t (k)], ..., u M [t (k) j is measured at each sampling time.
  • the P predetermined functional dependencies F ⁇ ..., F P are applied to the measured system states x and measured manipulated variable vectors u.
  • Submarine 1 is located near an area Ar and must not go into this area Ar.
  • M manipulated variable values are given on a trial basis, which together form a vector u '(t0).
  • the system state at time tO is measured, whereby a state quantity vector x (t0) is provided.
  • the system state x ⁇ (t5) is predicted at a later time t5.
  • several system states are predicted in succession at intermediate times t2, t3, ...

Landscapes

  • Engineering & Computer Science (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Physics & Mathematics (AREA)
  • Mechanical Engineering (AREA)
  • Ocean & Marine Engineering (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Probability & Statistics with Applications (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

Die vorliegende Erfindung betrifft ein Verfahren zum Navigieren eines Unterwasserfahrzeugs sowie ein Unterwasserfahrzeug (1), welches dieses Verfahren durchführen kann. Zu einem ersten Zeitpunkt t0 werden M Stellgrößen u und N Zustandsgrößen x des Unterwasserfahrzeugs (1) gemessen. Die N Zustandsgrößen x werden für einen nachfolgenden Zeitpunkt t1 vorhergesagt. Für die Vorhersage wird ein linearer Zusammenhang y = <u>X</u> * <u>C</u> T mit einer Koeffizienten-Matrix <u>C</u> verwendet. Die Komponenten dieser Koeffizienten-Matrix <u>C</u> werden mit Hilfe einer Stichprobe { <u>y</u>[t(k)], <u>X</u>[t(k)] } berechnet, welche in einer Trainingsphase aus gemessenen Werten für die Stellgrößen <u>u</u> und die Zustandsgrößen <u>x</u> gewonnen wird.

Description

Verfahren zum Navigieren eines Unterwasserfahrzeugs und Unterwasserfahrzeug
Die Erfindung betrifft ein Verfahren, um ein Unterwasserfahrzeug zu navigieren, sowie ein Unterwasserfahrzeug, in welchem dieses Verfahren angewendet wird.
Insbesondere während einer Tauchfahrt kann ein Unterwasserfahrzeug in der Regel weder die eigene tatsächliche Geoposition noch die tatsächliche Fahrtrichtung über Grund mit ausreichender Zuverlässigkeit direkt messen. Trotzdem soll ein Unterwasserfahrzeug auch bei einer Tauchfahrt sicher durch das Wasser navigieren können.
Aufgabe der Erfindung ist es, ein Verfahren mit den Merkmalen des Oberbegriffs des Anspruchs 1 und ein Unterwasserfahrzeug mit den Merkmalen des Oberbegriffs des Anspruchs 1 1 bereitzustellen, welche weniger Aufwand erfordern, um die Vorhersage des Systemzustands durchzuführen.
Gelöst wird diese Aufgabe durch ein Verfahren mit den in Anspruch 1 angegebenen Merkmalen und ein Unterwasserfahrzeug mit den in Anspruch 1 1 angegebenen Merkmalen. Vorteilhafte Weiterbildungen ergeben sich aus den Unteransprüchen, der nachfolgenden Beschreibung sowie den Zeichnungen.
Gemäß dem lösungsgemäßen Verfahren werden zu einem Zeitpunkt tO die M Werte u(t0) von M Stellgrößen u und die Werte x(t0) von N Zustandsgrößen x des Unterwasserfahrzeugs gemessen. Aus diesen gemessenen M + N gemessenen Werten werden die P Werte von P veränderlichen Größen X für diesen Zeitpunkt tO hergeleitet. Die N Werte x(t1 ), welche die N Zustandsgrößen x zu einem späteren Zeitpunkt t1 annehmen, werden wenigstens näherungsweise vorhergesagt und für die weitere Fahrt des Unterwasserfahrzeugs verwendet. Um x(t1 ) vorherzusagen, wird ein linearer Zusammenhang y = X * Wt verwendet, wobei y(t0) = x(t1 ) - x(t0) ein Differenz-Vektor zwischen den Systemzuständen an den beiden Zeitpunkten t1 und tO und C eine Koeffizienten-Matrix mit N Zeilen und P Spalten ist. Die Koeffizienten für die Koeffizienten-Matrix C werden unter Verwendung einer ersten Stichprobe berechnet. Diese erste Stichprobe wird in einer ersten Trainingsphase gewonnen. In der ersten Trainingsphase werden zu K+1 vorgegebenen Zeitpunkten t(1 ), ..., t(K+1 ) jeweils die Stellgrößen u[t(k)] und die Zustandsgrößen x[t(k)] gemessen. Hieraus wird eine erste Stichprobe mit K Wertepaaren { y[t(k)], X[t(k)] } abgeleitet (k=1 , ..., K). Die Koeffizienten Cj der Koeffizienten-Matrix Q werden unter Verwendung dieser ersten Stichprobe berechnet.
Bei herkömmlichen Verfahren wird ein vorgegebenes physikalisches Modell verwendet, um den Systemzustand des Unterwasserfahrzeugs zum Zeitpunkt t1 vorherzusagen. Dieses physikalische Modell beschreibt den Systemzustand zum Zeitpunkt t1 als Funktion des Systemzustands zum Zeitpunkt tO und der Werte der M Stellgrößen zum Zeitpunkt tO. Das physikalische Modell ist in der Regel nichtlinear und hängt von physikalischen Parametern ab, also Parametern mit einer physikalischen Bedeutung. Um die Werte dieser Parameter zu bestimmen, sind häufig aufwändige Versuche, beispielsweise Versuchsfahrten des Unterwasserfahrzeugs, erforderlich. Es kann notwendig sein, diese Versuche nach einiger Zeit erneut durchzuführen, beispielsweise weil nach Umbauten am Unterwasserfahrzeug oder durch Alterung Parameter-Werte sich verändert haben können.
Die Erfindung vermeidet die Notwendigkeit, derartige Versuche durchzuführen. Stattdessen wird die erste Stichprobe verwendet, welche in der ersten Trainingsphase gewonnen wurde. Die Koeffizienten-Matrix Q wird unter Verwendung dieser ersten Stichprobe berechnet. Die Koeffizienten Cj dieser Koeffizienten-Matrix C haben nicht notwendigerweise eine physikalische Bedeutung und werden unter Verwendung der ersten Stichprobe automatisch berechnet.
Die erste Trainingsphase lässt sich während einer regulären Fahrt des Unterwasserfahrzeugs durchführen. Möglich ist, nach der ersten Trainingsphase die Koeffizienten-Matrix C anzuwenden und anschließend eine zweite Trainingsphase durchzuführen, in welcher die Koeffizienten-Matrix Q angepasst wird. Dadurch lässt die Koeffizienten-Matrix C sich schrittweise an eine immer größer werdende Stichprobe anpassen oder auch an Umgebungsbedingungen, welche sich im Laufe der Fahrt ändern können. Möglich, aber dank der Erfindung nicht erforderlich ist es, Versuchsfahrten unter speziellen vorgegebenen Versuchsbedingungen oder Umgebungsbedingungen durchzuführen, um die Vorhersage zu ermöglichen. Die Anzahl der Stichproben- Elemente lässt sich an die Zeit anpassen, welche für die erste Trainingsphase zur Verfügung steht, sowie die Abtastrate, welche sich an Bord des Unterwasserfahrzeugs erzielen lässt.
Lösungsgemäß werden P veränderliche Größen
Figure imgf000005_0001
..., XP verwendet. Mit Hilfe dieser P veränderlichen Größen lässt sich in einer vorhergehenden Designphase ein linearer Zusammenhang y = X * GT mit zunächst unbekannten Koeffizienten der Matrix Q aufstellen. Um diesen linearen Zusammenhang aufzustellen, wird nicht notwendigerweise die Kenntnis eines physikalischen Modells für das Unterwasserfahrzeug benötigt. Weiterhin werden keine Werte für physikalische Parameter benötigt. Vielmehr wird lösungsgemäß der Zusammenhang zwischen Stellgrößen und Zustandsgrößen für verschiedene Zeitpunkte automatisch und in der ersten Trainingsphase unter Verwendung der ersten Stichprobe berechnet.
In Versuchen hat sich überraschenderweise gezeigt, dass mit dem lösungsgemäßen Verfahren eine Vorhersage für erheblich größere Zeiträume möglich ist als mit herkömmlichen Verfahren. Mit anderen Worten: Zwischen dem Mess-Zeitpunkt tO und dem Vorhersage-Zeitpunkt t1 kann ein erheblich größerer zeitlicher Abstand liegen als bei herkömmlichen Verfahren, beispielsweise mehrere Minuten anstelle mehrerer Sekunden.
Bevorzugt wird das Verfahren„Partial Least Squares Regression“ (PLSR) verwendet, um in der ersten Trainingsphase unter Verwendung der ersten Stichprobe und dem Zusammenhang y = X * QT die Koeffizienten der Matrix Q zu berechnen. PLSR berücksichtigt nicht nur die maßgebliche Varianz von X, um die Varianz in y zu erklären. Vielmehr ermittelt PLSR auch automatisch diejenigen Komponenten in X, die y bestmöglich erklären, und projiziert hierfür y und X auf latente Variablen in einem gemeinsamen Raum. Das Verfahren PLSR ist insbesondere dann besonders geeignet, wenn eine hohe Multikollinearität zwischen den einzelnen Komponenten von X vorliegt, also die einzelnen Komponenten von X stark miteinander korrelieren. Dies ist bei den P veränderlichen Größen X für das Unterwasserfahrzeug häufig der Fall.
Nachfolgend ist das erfindungsgemäße Verfahren anhand eines in den Zeichnungen dargestellten Ausführungsbeispiels näher erläutert. Hierbei zeigen:
Fig. 1 ein beispielhaftes Unterseeboot mit mehreren Stellgliedern, für welches das Verfahren angewendet wird;
Fig. 2 eine beispielhafte Fahrtroute des Unterseeboots mit zwei Trainingsphasen und zwei Tauchfahrten;
Fig. 3 eine Ausgestaltung, bei der probeweise Stellgrößen-Werte vorgegeben werden und die Konsequenz ermittelt wird.
Im Ausführungsbeispiel wird die Erfindung an Bord eines bemannten Unterseeboots (U-
Boots) eingesetzt, welches einen eigenen Antrieb aufweist. Das U-Boot umfasst eine
Stellglieder-Anordnung mit M Stellgliedern (M >= 1 ), welche die Fahrt des U-Boots beeinflussen, insbesondere mindestens eines der folgenden Stellglieder:
- Stellglieder für die Höhenruder,
- Stellglieder für die Seitenruder,
- Stellglieder, welche die Vortriebs-Geschwindigkeit des U-Boots durch das Wasser verändern („kommandierte Geschwindigkeit“), beispielsweise die Rotationsgeschwindigkeit einer Welle für einen Propeller oder im Falle eines elektrisch angetrieben U-Boots die Spannung, die an dem Elektromotor anliegt,
- optional Stellglieder, die einen Trimmzustand des U-Boots im Wasser verändern, und
- optional Stellglieder, welche die aktuelle Position eines Bestandteils, der sich ausfahren und einziehen lässt, verändern.
Fig. 1 zeigt beispielhaft ein bemanntes Unterseeboot 1 , welches in eine Fahrtrichtung FR durch das Wasser fährt. Dieses Unterseeboot 1 umfasst die folgenden Bestandteile:
- eine Fahrzeughülle 10, - ein Steuerbord-Seitensonar 12, welches auf der Steuerbordseite an der Fahrzeughülle 10 befestigt ist,
- ein entsprechendes nicht gezeigtes Backbord-Seitensonar,
- ein Bug-Sonar 13, welches am Bug der Fahrzeughülle 10 befestigt ist, und
- einen Turm 11 mit mehreren ausfahrbaren und einziehbaren Bestandteilen.
Das Unterseeboot 1 umfasst die folgenden Stellglieder, welche die Fahrt des Unterseeboots 1 durch das Wasser beeinflussen:
- einen angetriebenen Propeller 14,
- ein vorderes Steuerbord-Flöhenruder 15,
- ein hinteres Steuerbord-Flöhenruder 16,
- zwei korrespondierende nicht gezeigte Backbord-Flöhenruder,
- ein Seitenruder 17 und
- nicht gezeigte Stellglieder zum Ausfahren und Einziehen von Bestandteilen.
Das Unterseeboot 1 erstreckt sich entlang einer Längsachse X, einer Querachse Y und einer Flochachse Z.
Die aktuellen Zustände der Stellglieder der Stellglieder-Anordnung werden durch einen Vektor mit M Elementen beschrieben. Diese aktuellen Zustände der Stellglieder werden zu jedem Abtast-Zeitpunkt t(k) (k=1 , 2, ...) sowie zu Zeitpunkten tO, t1 , t2 gemessen, beispielsweise mittels Positions-Sensoren, und sind daher für das folgende Verfahren bekannt. Für jeden Zeitpunkt t(k) ist also ein Stellgrößen-Vektor u[t(k)] = u^k), ..., uM[t(k)j bekannt.
Damit das U-Boot 1 durch das Wasser fahren kann, werden insbesondere folgende Größen benötigt, die über die Zeit veränderlich sind und im Folgenden als Navigationsgrößen bezeichnet werden:
- die aktuelle Geoposition des U-Boots1 ,
- die 3D-Lage des U-Boots 1 im Wasser, beispielsweise als die Orientierung der Längsachse X, der horizontalen Querachse Y und der Flochachse Z des U-Boots 1 in einem absoluten 3D-Koordinatensystem, welches zum Nordpol zeigt, also der Kurs (heading) des U-Boots 1 , und
- die Geschwindigkeit des U-Boots 1 relativ zum umgebenden Wasser.
Während einer Tauchfahrt des U-Boots 1 lässt sich insbesondere die tatsächliche aktuelle Geoposition nicht oder zumindest nicht zu jedem Zeitpunkt exakt bestimmen, weil Signale von einem Satelliten nicht von einem Empfänger des U-Boots 1 empfangen werden können. Daher werden die gesuchten und nicht direkt messbaren Werte der Navigationsgrößen abhängig von den Werten einer zeitlich veränderlichen Zustandsgröße x berechnet, welche aus N einzelnen Zustandsgrößen besteht. Der Wert x[t(k)] = xi[t(k)], ..., xN[t(k)], x(t0), x(t1 ), x(t2), ... der vektor-wertigen Zustandsgröße x zum Zeitpunkt t(k), tO, t1 , t2 beschreibt jeweils einen Systemzustand des U-Boots zum Zeitpunkt t(k). Zu den einzelnen Zustandsgrößen des U-Boots 1 gehören insbesondere folgende Größen:
- die drei linearen Geschwindigkeiten u, v, w des U-Boots 1 in einem lokalen 3D- Koordinatensystem, welches an die aktuelle Lage des U-Boots 1 angepasst ist, wobei bevorzugt die Längsachse X des U-Boots 1 die x-Achse des lokalen 3D- Koordinatensystems definiert, die horizontale Querachse Y die y-Achse und die Hochachse Z die z-Achse,
- die drei aktuellen Winkelgeschwindigkeiten des U-Boots 1 in diesem lokalen 3-D Koordinatensystem und
- die Lage der drei Achsen X, Y, Z des U-Boots 1 im Wasser in einem absoluten Koordinatensystem.
Der aktuelle Systemzustand x[t(k)] lässt sich zumindest zeitweise vollständig messen, beispielsweise unter Verwendung mindestens eines Inertialnavigationssystems an Bord des U-Boots 1. Insbesondere dann, wenn das U-Boot 1 eine längere Tauchfahrt durchgeführt oder wenn ein Sensor des Inertialnavigationssystems ausgefallen ist oder Messwerte liefert, die in der aktuellen Situation physikalisch unmöglich sind, verliert das U-Boot 1 kurzfristig die Fähigkeit, die Position präziser zu koppeln. Die Erfindung vermeidet die Notwendigkeit, dass das U-Boot 1 deshalb nach kurzer Zeit auftaucht, um seine aktuelle Geoposition auf eine Weise zu bestimmen, die nur nach dem Auftauchen möglich ist, beispielsweise indem das aufgetauchte U-Boot 1 Geopositions-Signale empfängt und bei Bedarf die Sensoren des Inertialnavigationssystems neu aufsetzt.
Fig. 2 zeigt beispielhaft einen Ausschnitt aus der Fahrtroute des U-Boots 1 . Diejenigen Teile der Fahrtroute, in denen sich der Systemzustand x zu jedem Zeitpunkt messen lässt, insbesondere eine Fahrtstrecke im aufgetauchten Zustand, sind durch jeweils eine durchgezogene Linie dargestellt. Diejenigen Teile der Fahrtroute, in denen der Systemzustand x nicht gemessen, sondern vorhergesagt wird, sind durch jeweils eine gestrichelte Linie dargestellt. Die Stellgrößen u lassen sich während der gesamten Fahrtroute messen. Im Beispiel von Fig. 2 werden nacheinander zwei Trainingsphasen durchgeführt. In jeder Trainingsphase lassen sich nicht nur der Stellgrößen-Vektor u, sondern auch der Systemzustand x zu jedem Zeitpunkt messen.
Im Ausführungsbeispiel wird der Systemzustand x(t0) zu einem Zeitpunkt tO gemessen. Aus dem gemessenen aktuellen Systemzustand x(t0) zu diesem Zeitpunkt tO lassen sich die Werte der Navigationsgrößen zu diesem Zeitpunkt tO herleiten. Gesucht werden die Werte der Navigationsgrößen für mindestens einen zukünftigen Zeitpunkt t1 , also für einen Zeitpunkt t1 , der zeitlich nach dem Mess-Zeitpunkt tO liegt, beispielsweise t1 = tO + D. Die Werte der Navigationsgrößen für den zukünftigen Zeitpunkt t1 werden aus mindestens einem vorhergesagten Systemzustand x^[t1 ) für diesen zukünftigen Zeitpunkt t1 hergeleitet. Der Systemzustand x^(t1 ) zum Zeitpunkt t1 wird also nicht gemessen, sondern vorhergesagt. Weil der Systemzustand für den Zeitpunkt t1 vorhergesagt und nicht gemessen wird, wird er mit x^(t1 ) und nicht mit x(t1 ) bezeichnet. Möglich ist, zusätzlich den Systemzustand x^(tT) für mindestens einen weiteren Zeitpunkt tT vorherzusagen, wobei tT zwischen tO und t1 liegt, und die Werte der Navigationsgrößen für den Zeitpunkt t1 abhängig von den beiden vorhergesagten Systemzuständen x^[t1 ) und x^(t1‘) zu berechnen. Beispielsweise wird über eine zeitliche Abfolge von Systemzuständen integriert.
Der tatsächliche Systemzustand x(t1 ) zu einem zukünftigen Zeitpunkt t1 hängt von dem zum Zeitpunkt tO gemessenen Systemzustand x(t0) sowie vom Stelleingriff u(t0) zu diesem Zeitpunkt tO ab. Diese Abhängigkeit wird durch ein physikalisches Modell beschrieben. Ein solches Modell wird beispielsweise in DE 102017200468 A1 und in DE 102017200470 A1 angegeben.
Eine physikalische Randbedingung ist, dass zu jedem Zeitpunkt die Kräfte und die Momente, die auf das fahrende U-Boot 1 wirken, im Gleichgewicht sein müssen. Insbesondere sind daher die Kräfte in der x-Achse (Längsachse des U-Boots 1 ), in der y- Achse (horizontale Querachse) und in der z-Achse (Hochachse) im Gleichgewicht, außerdem die Drehmomente beim Rollen (Drehung um die x-Achse), beim Nicken (Drehung um die y-Achse) und beim Gieren (Drehung um die z-Achse). Diese sechs Randbedingungen liefern sechs nichtlineare Differenzialgleichungen. Diese sechs Randbedingungen und optional weitere physikalische Randbedingungen liefern insgesamt ein nichtlineares Modell x^(t1 ) = x^(t0+A) = f[x(t0), u(t0)]. Dieser Zusammenhang f gilt bei fester Differenz D für jeden Zeitpunkt tO. Die Schreibweise x^(t1 ) deutet an, dass ein Modell die physikalische Realität natürlich immer nur näherungsweise abbildet.
Der nichtlineare System-Zusammenhang f enthält Parameter, die bekannt sein müssen, um mit ihm direkt den Systemzustand x Vorhersagen zu können. Diese Parameter des System-Zusammenhangs f haben physikalische Bedeutungen und hängen von physikalischen Eigenschaften des U-Boots 1 ab, welche sich experimentell und / oder durch Simulation ermitteln lassen. Diese Ermittlung kann zu fehlerhaften Parameter- Werten führen. Außerdem ist es möglich, dass ein Parameter-Wert sich im Laufe der Zeit ändert, beispielsweise aufgrund von baulichen Änderungen an dem U-Boot 1 , neuen Einsatzbedingungen oder Alterung. Dank der Erfindung ist es nicht nötig, diese physikalischen Parameter zu bestimmen.
Das oben erwähnte Modell mit physikalischen Parametern wird verwendet, um den Systemzustand x^(t1 ) zum Zeitpunkt t1 vorherzusagen, und zwar auf eine Weise, welche im Folgenden beschrieben wird.
Bevor ein Systemzustand vorhergesagt wird, werden im Ausführungsbeispiel einmal vorab eine Designphase und anschließend mindestens eine Trainingsphase durchgeführt. Die Designphase kann an jedem Ort stattfinden. Die oder jede Trainingsphase wird an Bord des U-Boots 1 durchgeführt.
In der Designphase werden P veränderliche Größen
Figure imgf000011_0001
..., XP festgelegt. Für jede veränderliche Größe X1 ; ..., XP wird jeweils eine funktionale Abhängigkeit Fj (j=1 ,..., P) festgelegt. Die funktionale Abhängigkeit Fj beschreibt die veränderliche Größe Xj (j=1 ,..., P) als Funktion mindestens einer Zustandsgröße x, (i=1 ,..., N) und / oder mindestens einer Stellgröße u, (i= 1 , ... , M). Möglich ist, dass eine veränderliche Größe Xj von mehreren oder sogar allen Zustandsgrößen x, (i=1 ,..., N) und / oder von mehreren oder sogar allen Stellgrößen u, (i= 1 , ... , M) abhängt.
Beispielsweise gehört jede veränderliche Größe Xj zu genau einer der folgenden zehn Gruppen von veränderlichen Größen:
- Staudruck-lineare Terme - nur abhängig von Geschwindigkeitskomponenten,
- Staudruck-lineare Terme - nur abhängig von Drehraten,
- Staudruck-lineare Terme - abhängig von Geschwindigkeiten und Drehraten,
- nichtlineare Partialkräfte und -Momente - nur abhängig von
Geschwindigkeitskomponenten,
- nichtlineare Partialkräfte und -Momente - nur abhängig von Drehraten,
- nichtlineare Partialkräfte und -Momente - abhängig von Geschwindigkeiten und
Drehraten,
- Fourierglied des Rollmomentes,
- auftriebsabhängige Kräfte und Momente als Funktion der Lagewinkel,
- Brückenwirbelanteile, hervorgerufen von dem Turm 1 1 des U-Boots 1 , und
- Stellgrößenanteile in Abhängigkeit von der Stellgröße u.
Für jede Zustandsgröße x, (i=1 ,..., N) wird jeweils ein linearer funktionaler Zusammenhang x,(t+A) - x,(t) = g,(ί) mit yi(t) = Ci,i *Xi(t) + ... + ci P *XP(t) aufgestellt und für das nachfolgend beschriebene Verfahren vorgegeben. Dieser Zusammenhang gilt wenigstens näherungsweise für jeden Zeitpunkt t und wird für die Vorhersage verwendet. Diese Zusammenhänge enthalten N*P zunächst unbekannte Koeffizienten ci j, wobei N die Anzahl der Zustandsgrößen und P die Anzahl der veränderlichen Größen ist Diese io
Koeffizienten Cjj, haben nicht notwendigerweise eine physikalische Bedeutung und werden nicht durch Versuche oder Simulationen, sondern automatisch mit Hilfe mindestens einer Stichprobe berechnet, was weiter unten beschrieben wird. Diese N*P Koeffizienten Cjj werden zu einer Koeffizienten-Matrix Q mit N Zeilen und P Spalten zusammengefasst. Die P veränderlichen Größen
Figure imgf000012_0001
..., XP werden zu einem Vektor X mit P Komponenten zusammengefasst. Die N Differenzgrößen
Figure imgf000012_0002
..., yN werden zu einem Vektor y mit N Komponenten zusammengefasst. Der lineare funktionale Zusammenhang lässt sich dann auch als y = X * GT schreiben, wobei die GT die zu Q transponierte Matrix ist, welche P Zeilen und N Spalten aufweist.
Für die erste Trainingsphase wird eine Abfolge mit K+1 Abtast-Zeitpunkten t(1 ), t(2), ..., t(K+1 ), beispielsweise äquidistant angeordneten Abtast-Zeitpunkten, vorgegeben, vgl. Fig. 2. Diese K+1 Abtast-Zeitpunkte decken bevorzugt die erste Trainingsphase ab. Zu jedem Abtast-Zeitpunkt t(k) wird der aktuelle Systemzustand x[t(k)] = Xi [t(k)], ..., xN[t(k)] gemessen (k = 1 , ..., K+1 ). Aus zwei zeitlich aufeinanderfolgenden Systemzuständen wird jeweils ein Systemzustands-Differenzvektor y[t(k)] = x[t(k+ 1 )] - x[t(k)] hergeleitet, welcher N Komponenten yj[t(k)] = x,[t(k+1 )] - x,[t(k)] aufweist (i=1 ,..., N, k=1 , ..., K). Dadurch werden K Systemzustands-Differenzvektoren y[t(1 )], ..., y[t(K)] bereitgestellt.
Weiterhin wird zu jedem Abtast-Zeitpunkt der aktuelle Stellgrößen-Vektor u[t(k)] = Ui[t(k)], ..., uM[t(k)j gemessen. Die P vorgegebenen funktionalen Abhängigkeiten F^ ..., FP werden auf die gemessenen Systemzustände x und gemessenen Stellgrößen-Vektoren u angewendet. Dadurch werden für jede veränderliche Größe X1 ; ..., XP jeweils K+1 Werte Xj[t(k)] berechnet, welche die veränderliche Größe Xj zum Zeitpunkt t(k) annimmt (j=1 , ..., P, k=1 , ..., K). Dadurch werden K Größen-Vektoren X[t(1 )], ..., X[t(K)] bereitgestellt. Die K Systemzustands-Differenzvektoren und die K Größen-Vektoren bilden insgesamt eine Stichprobe mit K vektor-wertigen Wertepaaren { y[t(k)], X[t(k)] } (k=1. K).
In dem Zusammenhang y = X * CT gibt die erste Stichprobe K Werte für y und X vor. Unter Verwendung der ersten Stichprobe werden die P*N Komponenten Cjj der Koeffizienten- Matrix G automatisch bestimmt. Dadurch ist die Koeffizienten-Matrix G festgelegt. Am Ende der oder jeder Trainingsphase werden also die Koeffizienten der Koeffizienten- Matrix Q automatisch und unter Verwendung einer in der Trainingsphase gewonnenen Stichprobe bestimmt, was im Folgenden am Beispiel der ersten Stichprobe beschrieben wird. Im Ausführungsbeispiel wird das Verfahren „Partial Least Squares Regression“ (PLSR) angewendet, welches in der folgenden Veröffentlichung für Anwendungen der chemischen Analyse (Chemometrik) beschrieben wird: S. Wold, M. Sjöström, L. Eriksson: „PLS-regression: a basic tool of chemometrics“, Chemometrics and Intelligent Laboratoy Systems 58 (2001 ), pp. 109 - 130.
Im vorliegenden Ausführungsbeispiel wird PLSR angewendet, um die Koeffizienten c, (i=1 ,...,N; j=1 ,...,P) der Koeffizienten-Matrix Q zu berechnen und hierbei den linearen Zusammenhang y = X * Q und die erste Stichprobe { y[t(1 )], X[t(1 )], ..., y[t(K)], X[t(K)] } zu verwenden. Der Differenzen-Vektor y hat N Komponenten (Anzahl der Zustandsgrößen), der Vektor X hat P Komponenten (Anzahl der variablen Größen), die Koeffizienten-Matrix Q hat N Zeilen und P Spalten und die Transponierte CT somit P Zeilen und N Spalten.
Die erste Stichprobe enthält für jeden Mess-Zeitpunkt t(k) (k=1 ,...,K) jeweils einen Vektor X[t(k)] mit P Elementen und einen Vektor y[t(k)] mit N Elementen. Die K Messwerte Xj[t(1 ), ..., Xj[t(K)] für eine veränderliche Größe Xj bilden einen Messwerte-Vektor, der mit C bezeichnet wird (j=1 ,...,P). Gemäß PLSR werden A so genannte X-Scores Si, ..., SA berechnet, wobei A in der Regel deutlich kleiner als P ist, jeder Vektor Sg K Elemente aufweist (a=1 ,..., A) und K die Anzahl der Mess-Zeitpunkte ist. Die Anzahl A kann vorgegeben werden, beispielsweise abhängig von der Rechenkapazität an Bord des U- Boots 1 . Möglich ist auch, probeweise im Laufe des Verfahrens verschiedene Werte für A zu verwenden. Jeder X-Score sa wird als eine gewichtete Zusammenfassung, also als eine Linearkombination, der P Messwerte-Vektoren von X berechnet (a = 1 , ..., A), also wie folgt:
Sa = Wa.1 * Xi‘ + . . . + Wa,p*Xp‘.
In Komponenten-Schreibweise:
Sa(k) = wa Ί * X-i[t(k)j + ... + wa,p *Xp[t(k)] (k=1 ,. .,K).
Die Gewichtsfaktoren wa (a=1 ,...,A; j=1 ,. .,R) werden so bestimmt, dass die A X-Scores Si , ..., SA paarweise senkrecht (orthogonal) aufeinander stehen. Ein weiteres Kriterium, um die Gewichtsfaktoren wa zu bestimmen, ist das, dass die so genannten X-Residuen e1 ; ..., eP minimiert werden (möglichst nahe bei Null), beispielsweise durch eine multiple lineare Regression. Die zu minimierenden X-Residuen sind die Abweichungen zwischen den Messwerte-Vektoren für X und der bestmöglichen linearen Kombination aller X- Scores:
e = Xj‘- {Pi,j *Si + ... + PA/SA} (j=1 ,...,P).
Hierbei sind pa die Gewichtsfaktoren, die zu den kleinstmöglichen Residuen ej führen. In
Komponenten-Schreibweise:
Figure imgf000014_0001
Möglich ist auch, dass die Anzahl A der X-Scores vergrößert wird, wenn einzelne Residuen auch bei bestmöglichen Gewichtsfaktoren noch zu weit von Null entfernt sind.
Nachdem die X-Scores bestimmt sind, werden N*A Regressions-Koeffizienten bi a (i=1 ,...,N; a=1 ,...,A) berechnet, wobei N die Anzahl der Zustandsgrößen und A die Anzahl von X-Scores ist. Diese N*A Regressions-Koeffizienten bi a werden so bestimmt, dass die N so genannten Y-Residuen
Figure imgf000014_0002
..., fN minimiert werden:
£ = Yi‘ - { bi,i*_si + ... + bi,A *SA } (i=1. N).
In Komponenten-Schreibweise:
£(k) = yi[t(k)] - { bi, ^(k) + ... + b| A *SA(k) } (k = 1 , ..., K).
Aus den N * A Regressions-Koeffizienten bi a (a=1 ,...,A; i=1 ,...,N) und den P*A Gewichtsfaktoren wa,j (a=1 ,...,A; j=1 ,...,P) werden die N * P Koeffizienten c, der Koeffizienten-Matrix Q wie folgt bestimmt:
Cij = bi,i *Wi j + . . . , bi,A*WA,j.
Nach der ersten Trainingsphase wird die Koeffizienten-Matrix C mindestens einmal angewendet. Wie bereits dargelegt, werden zu einem Zeitpunkt tO der Systemzustand x(t0) mit N Komponenten sowie der Stellgrößen-Vektor u(t0) mit M Komponenten gemessen. Im Ausführungsbeispiel kann dieser Zeitpunkt tO am Ende der ersten Trainingsphase oder nach der ersten Trainingsphase liegen. Im Beispiel von Fig. 2 liegt der Zeitpunkt tO nach der ersten Trainingsphase und ist beispielsweise der letzte Zeitpunkt vor einer Tauchfahrt, an dem der Systemzustand noch gemessen werden kann. Aus diesen beiden Vektoren x(t0) und u(t0) wird der Vektor X(t0) mit P Komponenten berechnet. Der lineare Zusammenhang y = X * CT mit der in der ersten Trainingsphase berechneten Koeffizienten-Matrix C wird auf den durch die Messungen gewonnenen Vektor X(t0) angewendet und liefert einen Vektor y(t0) = x^(t1 ) - x(t0). Der gesuchte Systemzustand x^(t1 ) für den Zeitpunkt t1 wird gemäß x^(t1 ) = y(t0) + x(t0) berechnet und somit vorhergesagt. Aus diesem vorhergesagten Systemzustand x^(t1 ) zum Zeitpunkt t1 werden die Navigationsgrößen zum Zeitpunkt t1 abgeleitet und dadurch vorhergesagt.
Möglich ist, dass diese Vorhersage mehrmals durchgeführt wird. Vorgegeben wird eine Abfolge von Zeitpunkten t1 , t2, ... Für jeden Zeitpunkt soll der jeweilige Systemzustand vorhergesagt werden. Zu jedem Vorhersage-Zeitpunkt wird der Stellgrößen-Vektor u gemessen, so dass die Messwerte u(t1 ), u(t2), ... vorliegen. Der Systemzustand x^(t1 ) für den Zeitpunkt t1 wird so wie gerade beschrieben vorhergesagt. Anschließend werden die funktionalen Zusammenhänge F-i , ..., FP erneut angewendet, und zwar auf den gemessenen Stellgrößen-Vektor u(t1 ) und auf den vorhergesagten Systemzustand x^(t1 ). Diese Anwendung liefert einen Vektor X(t1 ) mit den P Werten der P veränderlichen Größen ..., XP für den Zeitpunkt t1 . Der lineare Zusammenhang y = X * CTwird erneut angewendet und liefert einen Vektor y(t1 ) = x^(t2) - x^(t1 ). Flieraus wird der gesuchte vorherzusagende Systemzustand x(t2) berechnet. Dieses Verfahren wird für die nachfolgenden Vorhersage-Zeitpunkte t4, t5, ... entsprechend durchgeführt.
Im Beispiel von Fig. 2 wird zunächst unter Verwendung der gemessenen Vektoren x(t0) und u(t0) der Systemzustand x^(t1 ) für den Zeitpunkt t1 vorhergesagt. Anschließend wird unter Verwendung des gemessenen Stellgrößen-Vektors u(t1 ) und des vorhergesagten Systemzustands-Vektors x^(t1 ) der Systemzustands-Vektor x^(t2) für einen nachfolgenden Zeitpunkt t2 vorhergesagt.
In einer Ausgestaltung werden nacheinander eine erste Trainingsphase und eine zweite Trainingsphase durchgeführt. In der ersten Trainingsphase werden so wie gerade beschrieben die Schritte durchgeführt, dass eine Stichprobe mit K vektor-wertigen Stichproben-Elementen ermittelt wird und die P * N Komponenten Ci der Koeffizienten- Matrix Q bestimmt werden. In einem nachfolgenden Anwendungszeitraum wird so wie gerade beschrieben der jeweilige Systemzustand x(t1 ), x(t2), ... für mehrere Vorhersage- Zeitpunkte t1 , t2, ... berechnet.
Anschließend wird eine zweite Trainingsphase durchgeführt, in welcher sich erneut der Systemzustand x messen lässt und beispielsweise insbesondere die aktuelle Geoposition des U-Boots gemessen werden kann. Für die zweite Trainingsphase wird eine Abfolge mit K1 +1 Abtast-Zeitpunkten t1 (1 ), t1 (2), ..., t1 (K1 +1 ) vorgegeben. K1 kann gleich K sein oder sich von K unterscheiden. Zu jedem Zeitpunkt t1 (k) werden jeweils
- die N Werte x-! [t1 (k)], ..., xN[t1 (k)], welche die N Zustandsgrößen zum Zeitpunkt t1 (k) jeweils annehmen, und
- die M Werte u-i [t1 (k)], ..., uN[t1 (k)], welche die M Stellgrößen zum Zeitpunkt t1 (k) jeweils annehmen, gemessen (k=1 ,..., K1 +1 ). K1 Differenz-Werte y,[t1 (k)] = Xj[t1 (k+1 )] - x,[t1 (k)] werden berechnet (i=1 ,..., N, k = 1 K1 ). Für jede veränderliche Größe Xj werden jeweils K1 Werte Xj[t1 (k)] berechnet, welche die veränderliche Größe Xj zum Zeitpunkt t1 (k) annimmt (j=1 ,..., P, k=1 ,..., K1 ). Aus den berechneten K Differenz-Werten und den berechneten P * K Werten der P veränderlichen Größen
Figure imgf000016_0001
..., XP wird eine zweite Stichprobe mit K1 vektor-wertigen Wertepaaren { y[t1 (k)], X[t1 (k)] } abgeleitet. Unter Verwendung der zweiten Stichprobe wird die Koeffizienten-Matrix Q, die in der ersten Trainingsphase bestimmt wird, an die zweite Stichprobe angepasst. Möglich ist, dass in der zweiten Trainingsphase alle Elemente der zweiten Stichprobe oder auch nur einige automatisch ausgewählte Stichproben-Elemente verwendet werden. Möglich ist, die Koeffizienten-Matrix Q aus der ersten Trainingsphase anzupassen oder auch die vollständige Berechnung der Koeffizienten-Matrix C erneut„von Null an“ durchzuführen.
In einer Ausgestaltung wird eine Gesamt-Stichprobe erzeugt. Diese Gesamt-Stichprobe wird unter Verwendung der ersten Stichprobe, die in der ersten Trainingsphase ermittelt wurde, und unter Verwendung der zweiten Stichprobe, die in der zweiten Trainingsphase ermittelt wurde, erzeugt. Diese Gesamt-Stichprobe kann alle Elemente der ersten Stichprobe und alle Elemente der zweiten Stichprobe enthalten oder auch nur automatisch ausgewählte Elemente der ersten und / oder der zweiten Stichprobe. In der zweiten Trainingsphase wird die Gesamt-Stichprobe verwendet, um die Koeffizienten- Matrix C erneut zu bestimmen oder um die bereits bestimmte Koeffizienten-Matrix C anzupassen.
In den bislang beschriebenen Anwendungen wurden die M Stellgrößen ui , uM zu jedem Abtastzeitpunkt gemessen. Möglich ist auch, probeweise Werte für die Stellgrößen vorzugeben und durch eine Vorhersage zu ermitteln, welchen Systemzustand das Unterseeboot 1 zu einem nachfolgenden Zeitpunkt t5 haben würde, wenn die M Stellgrößen tatsächlich auf die probeweise vorgegebenen Werte eingestellt werden. Dies wird im Folgenden mit Bezug auf Fig. 3 erläutert. Der Zeitpunkt t5 kann gleich dem Zeitpunkt t1 sein oder von ihm abweichen.
Das Unterseeboot 1 befindet sich in der Nähe eines Areals Ar und darf nicht in dieses Areal Ar fahren. Zum Zeitpunkt tO werden probeweise M Stellgrößen-Werte vorgegeben, die zusammen einen Vektor u‘(t0) bilden. Der Systemzustand zum Zeitpunkt tO wird gemessen, wodurch ein Zustandsgrößen-Vektor x(t0) geliefert wird. So wie gerade beschrieben wird der Systemzustand x^(t5) zu einem späteren Zeitpunkt t5 vorhergesagt. In einer Ausgestaltung werden nacheinander mehrere Systemzustände an Zwischen- Zeitpunkten t2, t3, ... vorhergesagt. Um den Systemzustand x^(t5) zum Zeitpunkt t5 vorherzusagen, wird in dieser Ausgestaltung jedes Mal derselbe vorgegebenen Stellgrößen Vektor u‘(t0) oder auch eine Abfolge von probeweise vorgegebenen Stellgrößen-Vektoren u‘(t0), u‘(t1 ), ... verwendet. Der vorhergesagte Systemzustand x^(t5) wird mit einem vorgegebenen Kriterium verglichen. Beispielsweise wird die Geoposition vorhergesagt, die gemäß der Vorhersage bei dieser Abfolge von probeweise vorgegebenen Stellgrößen-Vektoren u‘(t0), u‘(t1 ), ... und den vorhergesagten Systemzuständen x^(t1 ), ..., x^(t5) zum Zeitpunkt t5 erreicht wird. In dem in Fig. 3 gezeigten Beispiel wäre das Unterseeboot 1 dann in dem Areal Ar, was unzulässig ist. Daher wird statt des probeweise vorgegebenen Stellgrößen-Vektors u‘(t0) ein geänderter Stellgrößen-Vektor u(t0) verwendet. Dieser führt zu einer Fahrtroute, die an dem Areal Ar vorbeiführt.
Bezugszeichen
Figure imgf000018_0001
Figure imgf000019_0001

Claims

Patentansprüche
1. Verfahren zum Navigieren eines Unterwasserfahrzeugs (1 ),
wobei das Unterwasserfahrzeug (1 ) eine Stellglieder-Anordnung (14, 15, 16, 17) mit mindestens einem Stellantrieb umfasst,
wobei die Stellglieder-Anordnung durch M einstellbare und messbare Stellgrößen Ui,..., uM mit M >= 1 veränderbar ist,
wobei ein Systemzustand, der N zeitlich veränderliche Zustandsgrößen x-\,..., xN umfasst und mit der Bewegung des Unterwasserfahrzeugs (1 ) durch das Wasser korreliert, vorgegeben ist, wobei N >= 1 , und
wobei das Verfahren die Schritte umfasst, dass
- die N Werte x^tO),..., xN(t0), welche die N Zustandsgrößen x\,..., xN zu einem Zeitpunkt tO annehmen, gemessen werden,
- die M Werte Ui(t0),..., uM(t0), welche die M Stellgrößen ui,..., uM zum Zeitpunkt tO annehmen, gemessen oder vorgegeben werden,
- unter Verwendung der N Zustandsgrößen-Werte Xi(t0),..., xN(t0), der M
Stellgrößen-Werte u^tO),..., uM(t0) und eines vorgegebenen funktionalen
Zusammenhangs automatisch die N Werte cL ! (t1 ),..., xA N(t1 ), welche die N Zustandsgrößen x-\,..., xN zu einem vorgegebenen späteren Zeitpunkt t1 annehmen, wenigstens näherungsweise vorhergesagt werden und
- die vorhergesagten N Zustandsgrößen-Werte cL ! (t1 ),..., xA N(t1 ) für das
Navigieren des Unterwasserfahrzeugs (1 ) verwendet werden, dadurch gekennzeichnet, dass
P veränderliche Größen
Figure imgf000020_0001
..., XP und für jede veränderliche Größe Xi, ..., XP jeweils eine funktionale Abhängigkeit Fj, welche die veränderlichen Größe Xj (j=1
P) als Funktion mindestens einer Zustandsgröße x, (i=1 N) und / oder
mindestens einer Stellgröße u, (i=1 M) beschreibt, vorgegeben sind,
für jede Zustandsgröße x, (i=1 ,..., N) ein linearer funktionaler Zusammenhang
Xi(t+A) - Xj(t) = yi(t) mit yi(t) = ci 1*X1(t) + ... + ci P*XP(t) vorgegeben ist,
wobei die zunächst unbekannten Koeffizienten Cj zu einer Koeffizienten-Matrix Q mit
N Zeilen und P Spalten, die P veränderlichen Größen
Figure imgf000020_0002
..., XP zu einem Vektor X und die N Differenzgrößen y-i , yN zu einem Vektor y zusammengefasst sind, so dass y = X * QT gilt,
wobei in einer ersten Trainingsphase die Schritte durchgeführt werden, dass
- das Unterwasserfahrzeug (1 ) durch das Wasser bewegt wird,
- K+1 Zeitpunkte t(1 ), ..., t(K+1 ) vorgegeben sind,
- für jeden Zeitpunkt t(k) (k = 1 , ..., K+1 ) die N Werte Xi[t(k)], ..., xN[t(k)] gemessen werden, welche die N Zustandsgrößen
Figure imgf000021_0001
xN zum Zeitpunkt t(k) jeweils annehmen,
- für jeden Zeitpunkt t(k) (k = 1 , ..., K) die M Werte u-i [t(k)j, ..., uM[t(k)j gemessen werden, welche die M Stellgrößen ui,..., uM zum Zeitpunkt t(k) jeweils
annehmen,
- K Differenz-Werte y,[t(k)] = x,[t(k+1 )]— Xj[t(k)] berechnet werden (i=1 ,..., N, k=1 ,
- durch Anwendung der funktionalen Abhängigkeit Fj für jede veränderliche Größe
Xj jeweils K+1 Werte Xj[t(k)] berechnet werden, welche die veränderliche Größe Xj zum Zeitpunkt t(k) annimmt (j=1 , P, k=1 , K),
- aus den berechneten K Differenz-Werten und den berechneten P * K Werten der P veränderlichen Größen C^ ..., XP eine erste Stichprobe mit K vektor-wertigen Wertepaaren { y[t(k)j, X[t(k)] } abgeleitet wird (k=1 , ..., K) und
- unter Verwendung der ersten Stichprobe und des Zusammenhangs y = X * GT die Koeffizienten-Matrix Q berechnet wird und beim Schritt, die Werte xAi(t1 ),..., xA N(t1 ) der N Zustandsgrößen für den späteren
Zeitpunkt t1 vorherzusagen, die Schritte durchgeführt werden, dass
- unter Verwendung der funktionalen Abhängigkeiten F-i , ... , FP, der für den
Zeitpunkt tO gemessenen N Zustandsgrößen-Werte Xi(t0),..., xN(t0) und der M Stellgrößen-Werte u^tO),..., uM(t0) die P Werte Xi(t0), ..., XP(t0) berechnet werden, welche die P veränderlichen Größen
Figure imgf000021_0002
..., XP zum Zeitpunkt tO annehmen,
- unter Verwendung der in der ersten Trainingsphase berechneten Koeffizienten- Matrix Q und der P Werte Xi(t0), ..., XP(t0) N Differenz-Werte
y,(t0) = Ci,i *Xi(t0) + ... + ci P *XP(t0) (i=1 , ..., N) berechnet werden und - die N Zustandsgrößen-Werte CL Ί (t1 xA N(t1 ) für den späteren Zeitpunkt t1 unter Verwendung der für den früheren Zeitpunkt tO gemessenen N
Zustandsgrößen-Werte Xi(tO),..., xN(tO) und der berechneten N Differenz-Werte UΪ (tO), ... , UN(ΪO) vorhergesagt werden .
2. Verfahren nach Anspruch 1 ,
dadurch gekennzeichnet, dass
beim Schritt, unter Verwendung der ersten Stichprobe die Koeffizienten-Matrix C zu berechnen, mindestens eines der folgenden Verfahren angewendet wird:
- eine lineare Regressionsanalyse,
- eine Hauptkomponentenanalyse (principal component analysis),
- das Verfahren„Partial Least Squares Regression (PLSR)“.
3. Verfahren nach einem der vorstehenden Ansprüche,
dadurch gekennzeichnet, dass
das Unterwasserfahrzeug (1 ) sich entlang
- einer Längsachse (X),
- einer senkrecht auf der Längsachse (X) stehenden horizontalen Querachse (Y) und
- einer senkrecht auf der Längsachse (X) und der Querachse (Y) stehenden
Hochachse (Z) erstreckt und
mindestens eine der folgenden Größen gemessen und als eine Zustandsgröße x, verwendet wird:
- die Geschwindigkeit des Unterwasserfahrzeugs (1 ) über Grund in eine Richtung parallel zur Längsachse (X),
- die Geschwindigkeit des Unterwasserfahrzeugs (1 ) über Grund in eine Richtung parallel zur Querachse (Y),
- die Geschwindigkeit des Unterwasserfahrzeugs (1 ) über Grund in eine Richtung parallel zur Hochachse (Z),
- die Winkelgeschwindigkeit des Unterwasserfahrzeugs (1 ) über Grund um eine Achse parallel zur Längsachse (X), - die Winkelgeschwindigkeit des Unterwasserfahrzeugs (1 ) über Grund um eine Achse parallel zur Querachse (Y),
- die Winkelgeschwindigkeit des Unterwasserfahrzeugs (1 ) über Grund um eine Achse parallel zur Hochachse (Z).
4. Verfahren nach einem der vorstehenden Ansprüche,
dadurch gekennzeichnet, dass
das Unterwasserfahrzeug (1 ) einen Antrieb (14) aufweist, der dazu ausgestaltet ist, das Unterwasserfahrzeug (1 ) durch das Wasser zu bewegen,
wobei mindestens eine Stellgröße u, eine Größe ist, die mit der Fahrgeschwindigkeit des Unterwasserfahrzeugs (1 ) relativ zum umgebenden Wasser korreliert.
5. Verfahren nach einem der vorstehenden Ansprüche,
dadurch gekennzeichnet, dass
das Unterwasserfahrzeug (1 )
- einen Fahrzeugkörper (10),
- ein Richtungs-Veränderungs-Element (15, 16, 17) und
- einen Antrieb zum Bewegen des Richtungs-Veränderungs-Elements umfasst,
wobei mindestens eine Stellgröße u, eine Größe ist, die mit der Position des
Richtungs-Veränderungs-Elements (15, 16, 17) relativ zum Fahrzeugkörper (10) korreliert.
6. Verfahren nach einem der vorstehenden Ansprüche,
dadurch gekennzeichnet, dass
die M Werte Ui(t1 ),..., um(t1 ), welche die M Stellgröße Ui,..., uM zu dem
nachfolgenden Zeitpunkt t1 annehmen, gemessen oder vorgegeben werden und die Werte xA 1(t2),..., xA N(t2) der N Zustandsgrößen für einen nachfolgenden
Zeitpunkt t2, der nach dem Zeitpunkt t1 liegt, vorhergesagt werden,
wobei die Vorhersage für den Zeitpunkt t2 die Schritte umfasst, dass
- unter Verwendung der funktionalen Abhängigkeiten F ,..., FP, der für den
Zeitpunkt t1 vorhergesagten N Zustandsgrößen-Werte xA ! (t1 ),..., xA N(t1 ) und der M Stellgrößen-Werte u^tl ),..., uM(t1 ) für den Zeitpunkt t1 die P Werte Xi(t1 ), XP(t1 ) berechnet werden, welche die P veränderlichen Größen
Figure imgf000024_0001
XP zum
Zeitpunkt t1 annehmen,
- unter Verwendung der in der ersten Trainingsphase berechneten Koeffizienten- Matrix Q und der P Werte X-i (t1 ), ... , XP(t1 ) N Differenz-Werte
Yi(t1 ) = Ci,i *Xi(t1 ) + ... + Ci,P*XP(t1 ) (i=1 , ..., N) berechnet werden und
- die N Zustandsgrößen-Werte xA 1(t2),..., xA N(t2) für den nachfolgenden Zeitpunkt t2 unter Verwendung der für den Zeitpunkt t1 vorhergesagten N Zustandsgrößen- Werte xAi(t1 ),..., xA N(t1 ) und der berechneten N Differenz-Werte y-i (t1 ),..., yN(t1 ) vorhergesagt werden.
7. Verfahren nach einem der vorstehenden Ansprüche,
dadurch gekennzeichnet, dass
nach der Vorhersage der N Werte xAi(t1 ),..., xA N(t1 ), welche die N Zustandsgrößen x-!,.. xN zum nachfolgenden Zeitpunkt t1 annehmen,
in einer zweiten Trainingsphase die Schritte durchgeführt werden, dass
an K1 + 1 vorgegebenen Zeitpunkten t1 (1 ), ..., t1 (K1 +1 )
- die N Werte Xi [t1 (k)], ..., xN[t1 (k)], welche die N Zustandsgrößen zum Zeitpunkt t1 (k) jeweils annehmen, und
- die M Werte u-i [t1 (k)], ..., uN[t1 (k)], welche die M Stellgrößen zum Zeitpunkt t1 (k) jeweils annehmen, gemessen werden,
K Differenz-Werte y,[t1 (k)] = x,[t1 (k+1 )] - x,[t1 (k)] berechnet werden (i=1 ,..., N, k = 1 ,..., K1 ),
für jede veränderliche Größe Xj jeweils K1 Werte Xj[t1 (k)] berechnet werden, welche die veränderliche Größe Xj zum Zeitpunkt t1 (k) annimmt (j=1 , ... , P, k=1 ,..., K1 ), aus den berechneten K Differenz-Werten und den berechneten P * K1 Werten der P veränderlichen Größen C^ ..., XP eine zweite Stichprobe mit K1 vektor-wertigen Wertepaaren { y[t1 (k)], X[t1 (k)] } abgeleitet wird,
die Koeffizienten-Matrix Q an die zweite Stichprobe angepasst wird und
anschließend erneut eine Vorhersage durchgeführt wird, bei welcher die Schritte durchgeführt werden, dass - die N Werte x^tS),..., xN(t3), welche die N Zustandsgrößen Xi , . .. , xN zu einem nachfolgenden Zeitpunkt t3 annehmen, gemessen werden,
- die M Werte u^tS),..., um(t3), welche die M Stellgröße u-i,..., uM zu dem Zeitpunkt t3 annehmen, gemessen oder vorgegeben werden,
- unter Verwendung der N Zustandsgrößen-Werte x^tS),..., xN(t3), der M
Stellgrößen-Werte u^tS),..., uM(t3) und der angepassten Koeffizienten-Matrix Q die N Werte xAi(t4),..., xA N(t4), welche die N Zustandsgrößen
Figure imgf000025_0001
xN zu einem vorgegebenen späteren Zeitpunkt t4 annehmen, wenigstens näherungsweise vorhergesagt werden und
- die vorhergesagten N Zustandsgrößen-Werte xAi(t4),..., xA N(t4) für das weitere Navigieren des Unterwasserfahrzeugs (1 ) verwendet werden.
8. Verfahren nach Anspruch 7,
dadurch gekennzeichnet, dass
der Schritt, die Koeffizienten-Matrix C an die zweite Stichprobe anzupassen, die Schritte umfasst, dass
- in der zweiten Trainingsphase unter Verwendung der ersten Stichprobe und der zweiten Stichprobe eine Gesamt-Stichprobe erzeugt wird und
- unter Verwendung der Gesamt-Stichprobe und des Zusammenhangs y = X * GT die Koeffizienten-Matrix Q erneut berechnet wird.
9. Verfahren nach einem der vorstehenden Ansprüche,
dadurch gekennzeichnet, dass
M Werte Ui (t0), . .. , uM(t0) der M Stellgrößen für den Zeitpunkt tO probeweise vorgegeben werden,
unter Verwendung der N für den Zeitpunkt tO gemessenen Zustandsgrößen-Werte Xi(t0),..., X|\i(t0), der M für den Zeitpunkt tO probeweise vorgegebenen Stellgrößen- Werte Ui(t0),..., uM(t0) und der linearen Abhängigkeiten Fj die P Werte Xi(t0) ..., Xp(t0) berechnet werden, welche die P veränderlichen Größen
Figure imgf000025_0002
..., XP gemäß der Vorgabe für den Zeitpunkt tO annehmen,
unter Verwendung der N gemessenen Zustandsgrößen-Werte Xi(t0),..., xN(t0), der P berechneten Werte Xi(t0) ..., Xp(t0) und der Koeffizienten-Matrix Q die N Werte xA 1(t5),..., xA N(t5) wenigstens näherungsweise vorhergesagt werden, welche die N Zustandsgrößen x^,..., xN zu einem vorgegebenen Zeitpunkt t5 haben, falls die probeweise vorgegebenen Stellgrößen-Werte Ui(t0), ... , uM(t0) tatsächlich verwendet werden,
die für den Zeitpunkt t5 vorhergesagten N Zustandsgrößen-Werte xA 1(t5),..., xA N(t5) mit einem vorgegebenen Kriterium verglichen werden und
abhängig vom Ergebnis des Vergleichs entschieden wird, ob die probeweise vorgegebenen M Werte Ui (tO), ... , uM(t0) der M Stellgrößen tatsächlich für das Navigieren des Unterwasserfahrzeugs (1 ) verwendet werden.
10. Verfahren nach einem der vorstehenden Ansprüche,
dadurch gekennzeichnet, dass
die Geoposition des Unterwasserfahrzeugs (1 ) zum Zeitpunkt tO gemessen oder vorgegeben wird und
unter Verwendung mindestens eines vorhergesagten Wertes für eine Zustandsgröße eine Geoposition des Unterwasserfahrzeugs (1 ) zu einem zukünftigen Zeitpunkt vorhergesagt wird.
11. Unterwasserfahrzeug (1 ) mit
- einer Stellglieder-Anordnung (14, 15, 16, 17) mit mindestens einem Stellglied,
- einer Stellgrößen-Sensor-Anordnung
- einem Zustandsgrößen-Sensor-Anordnung und
- einem Rechner, wobei die Stellglieder-Anordnung (14, 15, 16, 17) durch M einstellbare und messbare Stellgrößen ui,..., uM mit M >= 1 veränderbar ist,
wobei die Stellgrößen-Sensor-Anordnung dazu ausgestaltet ist, die M Stellgrößen u-i uM ZU messen,
wobei die Zustandsgrößen-Sensor-Anordnung dazu ausgestaltet ist, N
Zustandsgrößen x-\,..., xN eines Systemzustands zu messen, wobei N >= 1 , wobei der Systemzustand mit der Bewegung des Unterwasserfahrzeugs (1 ) durch das Wasser korreliert und wobei der Rechner dazu ausgestaltet ist, automatisch ein Verfahren gemäß einem der vorhergehenden Ansprüche durchzuführen.
PCT/EP2019/078589 2018-10-24 2019-10-21 Verfahren zum navigieren eines unterwasserfahrzeugs und unterwasserfahrzeug Ceased WO2020083844A1 (de)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
DE102018218231.0 2018-10-24
DE102018218231.0A DE102018218231B3 (de) 2018-10-24 2018-10-24 Verfahren zum Navigieren eines Unterwasserfahrzeugs und Unterwasserfahrzeug

Publications (1)

Publication Number Publication Date
WO2020083844A1 true WO2020083844A1 (de) 2020-04-30

Family

ID=68342913

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/EP2019/078589 Ceased WO2020083844A1 (de) 2018-10-24 2019-10-21 Verfahren zum navigieren eines unterwasserfahrzeugs und unterwasserfahrzeug

Country Status (2)

Country Link
DE (1) DE102018218231B3 (de)
WO (1) WO2020083844A1 (de)

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102017200470A1 (de) 2017-01-12 2018-07-12 Thyssenkrupp Ag Vorrichtung und Verfahren zur Steuerung eines Unterwasserfahrzeugs
DE102017200468A1 (de) 2017-01-12 2018-07-12 Thyssenkrupp Ag Verfahren zur Bestimmung von hydrodynamischen Koeffizienten bei Unterseebooten

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE10153212A1 (de) * 2001-10-31 2003-06-05 Stn Atlas Elektronik Gmbh Navigationssystem zur Kursbestimmung eines Fahrzeugs
DE102012222812A1 (de) * 2012-12-11 2014-06-12 Raytheon Anschütz Gmbh Verfahren und Vorrichtung zur Regelung von Unterwasserfahrzeugen

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102017200470A1 (de) 2017-01-12 2018-07-12 Thyssenkrupp Ag Vorrichtung und Verfahren zur Steuerung eines Unterwasserfahrzeugs
DE102017200468A1 (de) 2017-01-12 2018-07-12 Thyssenkrupp Ag Verfahren zur Bestimmung von hydrodynamischen Koeffizienten bei Unterseebooten

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
ØYVIND HEGRENAES ET AL: "Model-Aided INS With Sea Current Estimation for Robust Underwater Navigation", IEEE JOURNAL OF OCEANIC ENGINEERING, IEEE SERVICE CENTER, PISCATAWAY, NJ, US, vol. 36, no. 2, 1 April 2011 (2011-04-01), pages 316 - 337, XP011324562, ISSN: 0364-9059, DOI: 10.1109/JOE.2010.2100470 *
RANDENI P S A ET AL: "Parameter identification of a nonlinear model: replicating the motion response of an autonomous underwater vehicle for dynamic environments", NONLINEAR DYNAMICS, KLUWER, DORDRECHT, NL, vol. 91, no. 2, 25 November 2017 (2017-11-25), pages 1229 - 1247, XP036404120, ISSN: 0924-090X, [retrieved on 20171125], DOI: 10.1007/S11071-017-3941-Z *
S. WOLDM. SJÖSTRÖML. ERIKSSON: "PLS-regression: a basic tool of chemometrics", CHEMOMETRICS AND INTELLIGENT LABORATOY SYSTEMS, vol. 58, 2001, pages 109 - 130, XP004320297, DOI: 10.1016/S0169-7439(01)00155-1

Also Published As

Publication number Publication date
DE102018218231B3 (de) 2020-02-13

Similar Documents

Publication Publication Date Title
DE102019001948B4 (de) Steuerung und maschinelle Lernvorrichtung
DE102005058081B9 (de) Verfahren zur Rekonstruktion von Böen und Strukturlasten bei Flugzeugen, insbesondere Verkehrsflugzeugen
EP0856784B1 (de) Verfahren und Vorrichtung zur bordautonomen Bestimmung der Position eines Satelliten
DE69109266T2 (de) Vorrichtung zum halten eines satelliten auf seiner umlaufbahn.
DE3436839C2 (de) Lenkprozessor
DE102014201815B4 (de) Messung von Messgrößen und/oder Probenentnahme unter Wasser
EP0046151A1 (de) Vorrichtung zur Lagestabilisierung von elastischen Fahrzeugen
DE102013204833A1 (de) Spurhalteassistenz-System und -Verfahren
DE102011056777B4 (de) Schwerpunktermittlung
DE102018217845A1 (de) Einrichtung und Verfahren zum Regeln eines Prozesses
EP1094002A2 (de) Regelungsanordnung und Regelungsverfahren für Satelliten
EP3746850B1 (de) Verfahren zum ermitteln eines zeitlichen verlaufs einer messgrösse, prognosesystem, aktorsteuerungssystem, verfahren zum trainieren des aktorsteuerungssystems, trainingssystem, computerprogramm und maschinenlesbares speichermedium
DE69614048T2 (de) Vorrichtung zur Lenkung eines Flugkörpers durch Ausrichten auf ein Ziel
DE112018006219T5 (de) Verwendung eines Unterstützungsmotors eines Servolenkungssystems zum Erzeugen von Testzyklen gemäß einem Krafterfassungszyklus
DE102021114768A1 (de) Fahrzeugsteuerung unter Verwendung eines Controllers eines neuronalen Netzes in Kombination mit einem modellbasierten Controller
DE112018006220T5 (de) Verwendung eines Unterstützungsmotors eines Servolenkungssystems zum Erzeugen von Testzyklen gemäß einem Schwingungserfassungszyklus
DE102021104433A1 (de) Verfahren zum Ermitteln mindestens eines Systemzustands mittels eines Kalman-Filters
DE69601853T2 (de) Verfahren und System zur Steuerung der Lage oder der Orientierung eines Raumfahrzeuges
EP3139221B1 (de) Autonomer l1-adaptiver regler mit exakter polvorgabe
DE2750128A1 (de) Verfahren und einrichtung zur gravitationskompensation bei lenkbaren flugkoerpern
EP3201710B1 (de) Ein trajektorien-planungsverfahren zur ermittlung eines steuerprofils für ein kraftfahrzeug
DE102018218231B3 (de) Verfahren zum Navigieren eines Unterwasserfahrzeugs und Unterwasserfahrzeug
DE102021207830A1 (de) Verfahren zur Steuerungsassistenz eines Fahrzeugs
DE102019134632A1 (de) Positionsbestimmung und Kartenerstellung
EP4061704B1 (de) Vorrichtung, anordnung und verfahren für die steuerung und regelung eines stellsystems eines flugzeugs

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 19794124

Country of ref document: EP

Kind code of ref document: A1

122 Ep: pct application non-entry in european phase

Ref document number: 19794124

Country of ref document: EP

Kind code of ref document: A1