-
Die Erfindung betrifft ein Lichtlaufzeitkamerasystem und ein Verfahren zum Betreiben eines solchen nach Gattung der unabhängigen Ansprüche.
-
Mit Lichtlaufzeitkamerasystem sollen nicht nur Systeme umfasst sein, die Entfernungen direkt aus der Lichtlaufzeit ermitteln, sondern insbesondere auch alle Lichtlaufzeit bzw. 3D-TOF-Kamerasysteme, die eine Laufzeitinformation aus der Phasenverschiebung einer emittierten und empfangenen Strahlung gewinnen. Als Lichtlaufzeit bzw. 3D-TOF-Kameras sind insbesondere PMD-Kameras mit Photomischdetektoren (PMD) geeignet, wie sie u.a. in den Anmeldungen
EP 1 777 747 ,
US 6 587 186 und auch
DE 197 04 496 beschrieben und beispielsweise von der Firma 'ifm electronic GmbH’ oder 'PMD-Technologies GmbH' als Frame-Grabber O3D bzw. als CamCube zu beziehen sind. Die PMD-Kamera erlaubt insbesondere eine flexible Anordnung der Lichtquelle und des Detektors, die sowohl in einem Gehäuse als auch separat angeordnet werden können. Insbesondere sollen unter Lichtlaufzeitkamerasystem auch Systeme mit umfasst sein, bei dem der Lichtlaufzeitsensor nur ein Pixel oder eine geringe Anzahl von Pixeln aufweist.
-
Für die Bestimmung einer Entfernung bzw. einer entsprechenden Phasenverschiebung des reflektierten Lichts wird, wie in der
DE 197 04 496 ausführlich beschrieben, im PMD-Sensor das reflektierte Licht mit dem modulierenden Signal gemischt. Diese Mischung liefert ein in Phase liegendes Signal (0°) und ein um 180° versetztes Signal, aus dem in bekannter Weise eine Entfernung bestimmt werden kann. Zur Verbesserung der Qualität der Entfernungsmessung kann es vorgesehen sein, die Sendemodulation gezielt beispielsweise um 90°, 180° oder 270° zu verschieben und vorzugsweise mittels einer IQ (Inphase, Quadratur)-Demodulation einen Phasenwinkel des reflektierten in Relation zum gesendeten Signal zu bestimmen. Dieses Vorgehen ist insbesondere nützlich zur Gewinnung von redundanten Informationen, um beispielsweise verschiedene parasitäre Effekte wie fixed pattern noise (FPN), Hintergrundlicht oder Asymmetrien des Sensors zu kompensieren.
-
Aufgabe der Erfindung ist es, die Entfernungsmessung eines Lichtlaufzeitkamerasystems zu verbessern.
-
Die Aufgabe wird in vorteilhafter Weise durch das erfindungsgemäße Lichtlaufzeitkamerasystem und Verfahren nach Gattung der unabhängigen Ansprüche gelöst.
-
Vorteilhaft ist ein Verfahren zum Betreiben eines Lichtlaufzeitkamerasystems vorgesehen, mit den Schritten:
- a) Ermittlung einer Phasenverschiebung eines emittierten und empfangenen Signals für eine Modulationsfrequenz in einem Phasenmesszyklus,
- b) Durchführung mehrerer Phasenmesszyklen, wobei in mindestens drei aufeinander folgenden Phasenmesszyklen unterschiedliche Modulationsfrequenzen verwendet werden,
- c) Ermittlung von Entfernungswerten anhand der in jeweils zwei aufeinander folgenden Phasenmesszyklen ermittelten Phasenverschiebungen.
-
Dieses Vorgehen hat den Vorteil, dass aufgrund der Verwendung mehrerer Modulationsfrequenzen der Eindeutigkeitsbereich der Entfernungsmessung erhöht und zudem die Ermittlung eines eindeutigen Entfernungswerts verbessert werden kann. Darüber hinaus wird eine Störung mehrere Lichtlaufzeitkamerasysteme untereinander durch den ständigen Wechsel der Modulationsfrequenzen reduziert.
-
Insbesondere ist es vorteilhaft, dass trotz einer Auswertung mehrerer Phasen durch die zyklische Messung die effektive Framerate nicht reduziert wird.
-
Im Weiteren ist das Verfahren derart ausgebildet, dass ein Entfernungswert nur dann als gültig bewertet wird, wenn eine festgelegte Anzahl der unmittelbar zuvor ermittelten Entfernungswerte innerhalb tolerierter Abweichungsgrenzen liegen.
-
Die Anzahl der zu bewertenden Entfernungswerte kann entsprechend der gewünschten Sicherheits- oder Zuverlässigkeitsanforderungen festgelegt werden. Vorteilhaft sollten mindestens zwei Entfernungswerte berücksichtigt werden.
-
Die tolerierten Abweichungsgrenzen werden nach unten typischerweise durch Signalrauschen, Eigenbewegung und Objektbewegungen begrenzt, wobei vorteilhaft die Abweichungsgrenze so festgelegt wird, dass vornehmlich Entfernungs-Fehlzuordnungen erkannt werden.
-
Durch dieses Vorgehen wird vorteilhaft verhindert, dass Entfernungswerte, beispielsweise aus einer gestörten Messung oder Überreichweiten, verwendet werden. Eine nachfolgende Auswertung erfolgt somit nur anhand gültiger Entfernungswerte.
-
Besonders vorteilhaft ist es, wenn die zu tolerierenden Entfernungsgrenzen ausgehend von dem zuletzt ermittelten Entfernungswert festgelegt werden. Dies erlaubt eine einfache und schnelle Plausibilisierung der Messergebnisse.
-
Ebenso vorteilhaft ist ein Lichtlaufzeitkamerasystem für das oben genannte Verfahren ausgebildet mit einem Modulator, der mit einer Beleuchtung und einem Empfänger des Lichtlaufzeitkamerasystems verbunden ist, wobei ferner ein Modulationssteuergerät mit dem Modulator verbunden ist und derart ausgestaltet ist, dass der Modulator mit mindestens drei Modulationsfrequenzen betreibbar ist, und das eine Auswerteeinheit dem Empfänger zugeordnet und derart ausgestaltet ist, dass ein Entfernungswert nur dann als gültig ausgegeben wird, wenn eine festgelegte Anzahl der unmittelbar zuvor ermittelten Entfernungswerte innerhalb tolerierter Abweichungsgrenzen liegen.
-
Es zeigen:
-
1 schematisch das grundlegende Prinzip der Photomischdetektion,
-
2 eine modulierte Integration der erzeugten Ladungsträger,
-
3 zwei zeitliche Verläufe der Ladungsintegration mit unterschiedlichen Phasenlagen,
-
4 Relation der Integration in einem IQ-Diagramm,
-
5 eine Distanzmessung mit einer Wellenlänge,
-
6 eine Distanzmessung mit zwei unterschiedlichen Wellenlängen,
-
7 einen Verlauf der Phasenverschiebungen mit dem Abstand,
-
8 einen Verlauf der Distanzwerte für unterschiedliche Wellenlängen,
-
9 bis 11 schematisch eine Entfernungsbestimmung für unterschiedliche Wellenlängen,
-
12 einen zeitlichen Ablauf der Distanzmessungen
-
Bei der nachfolgenden Beschreibung der bevorzugten Ausführungsformen bezeichnen gleiche Bezugszeichen gleiche oder vergleichbare Komponenten.
-
1 zeigt eine Messsituation für eine optische Entfernungsmessung mit einer Lichtlaufzeitkamera, wie sie beispielsweise aus der
DE 197 04 496 bekannt ist.
-
Das Lichtlaufzeitkamerasystem 1 umfasst eine Sendeeinheit bzw. ein Beleuchtungsmodul 10 mit einer Beleuchtung 12 und einer dazugehörigen Strahlformungsoptik 15 sowie eine Empfangseinheit bzw. Lichtlaufzeitkamera 20 mit einer Empfangsoptik 25 und einem Lichtlaufzeitsensor 22.
-
Der Lichtlaufzeitsensor 22 weist mindestens ein Laufzeitpixel, vorzugsweise auch ein Pixel-Array auf und ist insbesondere als PMD-Sensor ausgebildet. Die Empfangsoptik 25 besteht typischerweise zur Verbesserung der Abbildungseigenschaften aus mehreren optischen Elementen. Die Strahlformungsoptik 15 der Sendeeinheit 10 kann beispielsweise als Reflektor oder Linsenoptik ausgebildet sein. In einer sehr einfachen Ausgestaltung kann ggf. auch auf optische Elemente sowohl empfangs- als auch sendeseitig verzichtet werden.
-
Das Messprinzip dieser Anordnung basiert im Wesentlichen darauf, dass ausgehend von der Phasenverschiebung des emittierten und empfangenen Lichts die Laufzeit und somit die zurückgelegte Wegstrecke des empfangenen Lichts ermittelt werden kann. Zu diesem Zwecke werden die Lichtquelle 12 und der Lichtlaufzeitsensor 22 über einen Modulator 30 gemeinsam mit einem bestimmten Modulationssignal Mo mit einer Basisphasenlage φ0 beaufschlagt. Im dargestellten Beispiel ist ferner zwischen dem Modulator 30 und der Lichtquelle 12 ein Phasenschieber 35 vorgesehen, mit dem die Basisphase φ0 des Modulationssignals M0 der Lichtquelle 12 um definierte Phasenlagen φvar verschoben werden kann. Für typische Phasenmessungen werden vorzugsweise Phasenlagen von φvar = 0°, 90°, 180°, 270° verwendet.
-
Entsprechend des eingestellten Modulationssignals sendet die Lichtquelle 12 ein intensitätsmoduliertes Signal Sp1 mit der ersten Phaselage p1 bzw. p1 = φ0 + φvar aus. Dieses Signal Sp1 bzw. die elektromagnetische Strahlung wird im dargestellten Fall von einem Objekt 40 reflektiert und trifft aufgrund der zurückgelegten Wegstrecke entsprechend phasenverschoben ∆φ(tL) mit einer zweiten Phasenlage p2 = φ0 + φvar + ∆φ(tL) als Empfangssignal Sp2 auf den Lichtlaufzeitsensor 22. Im Lichtlaufzeitsensor 22 wird das Modulationssignal Mo mit dem empfangenen Signal Sp2 gemischt, wobei aus dem resultierenden Signal die Phasenverschiebung bzw. die Objektentfernung d ermittelt wird.
-
Zur Verbesserung der Messgenauigkeit und/oder zur Erweiterung des Eindeutigkeitsbereichs ist es vorteilhaft, die Lichtlaufzeitmessungen mit unterschiedlichen Modulationsfrequenzen durchzuführen. Zu diesem Zweck ist der Modulator 30 mit einem Modulationssteuergerät 38 verbunden, das vorzugsweise innerhalb eines vorgegebenen Frequenzspektrums Modulationsfrequenzen vorgeben kann.
-
Der Modulator 30 könnte beispielsweise als Frequenzsynthesizer ausgebildet sein, der über das Modulationssteuergerät 38 für die jeweilige Messaufgabe angesteuert wird. Auch ist ein Umschalten zwischen Quarzoszillatoren mit festen Frequenzen denkbar.
-
Ferner ist die Empfangseinheit 20 mit einer Auswerteeinheit 27 verbunden. Die Auswerteeinheit 27 kann gegebenenfalls auch Bestandteil der Empfangseinheit 20 und insbesondere auch Teil des Lichtlaufzeitsensors 22 sein. Aufgabe der Auswerteeinheit 27 ist es, anhand der empfangenen Signale in Relation zur Modulationsfrequenz Phasenverschiebungen zu ermitteln und/oder auszuwerten. Die Mischung der empfangen Lichtstrahlen mit der Modulationsfrequenz erfolgt vorzugsweise im Lichtlaufzeitsensor 22 bzw. PMD-Sensor. Ferner kann das Modulationssteuergerät 38 auch Bestandteil der Auswerteeinheit 27 sein. Insbesondere kann es auch vorgesehen sein, dass die Auswerteeinheit 27 die Funktion des Modulationssteuergeräts 38 vollständig oder teilweise übernimmt.
-
Als Beleuchtungsquelle bzw. Lichtquelle 12 eignen sich vorzugsweise Infrarot-Leuchtdioden. Selbstverständlich sind auch andere Strahlungsquellen in anderen Frequenzbreichen denkbar, insbesondere kommen auch Lichtquellen im sichtbaren Frequenzbereich in Betracht.
-
Das Grundprinzip der Phasenmessung ist schematisch in 2 dargestellt. Die obere Kurve zeigt den zeitlichen Verlauf des Modulationssignals M0 mit der die Beleuchtung 12 und der Lichtlaufzeitsensor 22 angesteuert werden. Das vom Objekt 40 reflektierte Licht trifft als Empfangssignal Sp2 entsprechend seiner Lichtlaufzeit tL phasenverschoben ∆φ(tL) auf den Lichtlaufzeitsensor 22. Der Lichtlaufzeitsensor 22 sammelt die photonisch erzeugten Ladungen q über mehrere Modulationsperioden in der Phasenlage des Modulationssignals M0 in einem ersten Akkumulationsgate Ga und in einer um 180° verschobenen Phasenlage M0 + 180° in einem zweiten Akkumulationsgate Gb. Aus dem Verhältnis der im ersten und zweiten Gate Ga, Gb gesammelten Ladungen qa, qb lässt sich die Phasenverschiebung ∆φ(tL) und somit eine Entfernung d des Objekts bestimmen.
-
3a und 3b zeigen Verläufe der Ladungsdifferenz ∆q = qa – qb/(qa + qb) in Abhängigkeit der Phasenverschiebung ∆φ(tL) des empfangenen Lichtsignals Sp2 mit unterschiedlichen Phasenlagen. Die 3a zeigt einen Verlauf für eine unverschobene Modulationsphase M0 mit einer Phasenlage φvar = 0°.
-
Bei einem Auftreffen des Signals Sp2 ohne Phasenverschiebung also ∆φ(tL) = 0°, beispielsweise, wenn das Sendesignal Sp1 direkt auf den Sensor gelenkt wird, sind die Phasen der Modulation M0 und vom empfangenen Signal Sp2 identisch, so dass alle erzeugten Ladungsträger phasensynchron am ersten Gate Ga erfasst werden und somit ein maximales Differenzsignal mit ∆q = 1 anliegt.
-
Mit zunehmender Phasenverschiebung nimmt die Ladung am ersten Akkumulationsgate Ga ab und am zweiten Akkumulationsgate Gb zu. Bei einer Phasenverschiebung von ∆φ(tL) = 90° sind die Ladungsträger qa, qb an beiden Gates Ga, Gb gleich verteilt und die Differenz somit Null und nach 180° Phasenverschiebung "–1". Mit weiter zunehmender Phasenverschiebung nimmt die Ladung am ersten Gate Ga wieder zu, so dass im Ergebnis die Ladungsdifferenz wieder ansteigt, um dann bei 360° bzw. 0° wieder ein Maximum zu erreichen.
-
Mathematisch handelt es sich hierbei um eine Korrelationsfunktion des empfangenen Signals S
p2 mit dem modulierenden Signal M
0.
-
Bei einer Modulation mit einem Rechtecksignal ergibt sich wie bereits dargestellt als Korrelationsfunktion eine Dreiecksfunktion. Bei einer Modulation mit beispielsweise einem Sinussignal wäre das Ergebnis eine Kosinusfunktion.
-
Wie 3a zeigt, ist eine Messung der Phase mit einer Phasenlage nur bis zu einer Phasenverschiebung ∆φ(tL) ≤ 180° eindeutig.
-
Zur maximalen Erfassung der Phasenverschiebung ist beispielsweise das IQ(Inphase-Quadratur) Verfahren bekannt, bei dem zwei Messungen mit um 90° verschobenen Phasenlagen durchgeführt werden, also beispielsweise mit der Phasenlage φvar = 0° und φvar = 90°. Das Ergebnis einer Messung mit der Phasenlage φvar = 90° ist in 3b dargestellt.
-
Die Beziehung dieser beiden Kurven lässt sich in bekannter Art und Weise beispielsweise für sinusförmige Kurvenverläufe in einem IQ-Diagramm gem. 4 darstellen. In erster Näherung ist diese Darstellung ohne weiteres auch für die dargestellten Dreiecksfunktionen anwendbar.
-
Der Phasenwinkel lässt sich dann in bekannter Weise über eine arctan-Funktion bestimmen: φ = arctan ∆q(90°) / ∆q(0°)
-
Um beispielsweise Asymmetrie des Sensors zu kompensieren, können zusätzliche um 180° verschobene Phasenmessungen durchgeführt werden, so dass sich im Ergebnis der Phasenwinkel wie folgt bestimmen lässt. φ = arctan ∆q(90°) – ∆q(270°) / ∆(0°) – ∆q(180°)
-
Aus der in 2 dargestellten laufzeitbedingten Phasenverschiebung ∆φ(tL) lassen sich für Objektabstände d, die kleiner sind als die halbe Wellenlänge λ der Modulationsfrequenz d ≤ λ/2 in bekannter Weise ein Abstand bestimmen. d = ∆φ(tL) λ / 2π· 1 / 2
-
Für Entfernungen d > λ/2 besteht in der Regel keine Möglichkeit die Phasenverschiebung absolut zu messen, so dass die ermittelte Phasenverschiebung nicht mehr eindeutig einem Entfernungswert zugeordnet werden kann.
-
5 zeigt ein Beispiel, bei dem das Objekt 40 einen Abstand d vom Sender 10 von d = 2λ + R / 2 aufweist, wobei selbstverständlich die bis zum Empfänger 20 zurückgelegt Wegstrecke doppelt so groß ist, nämlich D = 2d = 4λ + R
-
Zur Erhöhung des Eindeutigkeitsbereichs ist es, wie in
6 schematisch dargestellt, vorgesehen, mit mindestens zwei Modulationsfrequenzen respektive Modulationswellenlängen eine Objektabstand d zu bestimmen. Der Einfachheit halber ist in
6 die Gesamtstrecke D zwischen Sender
10 und Empfänger
20 dargestellt. Innerhalb des Eindeutigkeitsbereichs der beiden Wellenlängen λ
1, λ
2, der typischerweise durch das kleinste gemeinsame Vielfache der Wellenlängen λ
1, λ
2 aufgespannt wird, gilt folgende Distanzgleichung:
D = 2d = n1λ1 + R1 = n2λ2 + R2 mit
wobei für die von der Modulationsfrequenz und dem Objektabstand abhängige relative Phasenverschiebung φ
i(f
i, D) gilt:
-
Die relative Phasenverschiebung φi(fi, D) ist somit ein Maß für das in der Entfernungsmessung verbleibende Reststück Ri. Für die Entfernungsbestimmung kann nun mit zwei für unterschiedliche Modulationsfrequenzen f1, f2 erfassten Phasenverschiebungen φ1/2(f1/2, D) eine Lösung für die oben dargestellte Distanzgleichung gefunden werden.
-
Ein möglicher Lösungsweg ist in 7 schematisch dargestellt. Die 7 zeigt zwei relative Phasenverschiebung φ1/2(f1/2, D) in Abhängigkeit des doppelten Objektabstandes 2d = Gesamtweglänge D für zwei unterschiedliche Frequenzen f1, f2. Mit durchgezogener Linie ist die Phasenverschiebung φ1 für f1 = 7,5 MHz entsprechend einer Wellenlänge λ1 = 40 m und mit gestrichelter Line für f2 = 5 MHz entsprechend einer Wellenlänge λ2 = 60 m dargestellt. Der Eindeutigkeitsbereich EB12 für die beiden Frequenzen f1, f2 ergibt sich in bekannter Weise aus dem kleinsten gemeinsamen Vielfachen der beiden Wellenlänge λ1, λ2, also hier 120 m.
-
Für jeden Entfernungswert bzw. jeder Gesamtweglänge D innerhalb des gemeinsamen Eindeutigkeitsbereich EB12 gibt es genau ein Phasendifferenzpaar (φ1, φ2). Für den beispielhaften Entfernungswert D von 23 m, also einem Objektabstand d von 11,5 m, ergibt sich ein Phasendifferenzpaar von ca. (1,2 | 0,8).
-
In einem möglichen Anwendungsfall könnte es beispielsweise vorgesehen sein, eine geeignete Anzahl von Phasendifferenzpaaren mit dem ihnen zugeordneten Entfernungswert D oder Objektabstand d in einer Wertetabelle abzulegen. Bei einer Entfernungsmessung kann dann beispielsweise ermittelt werden, welches tabellierte Phasendifferenzpaar mit einem entsprechend zugeordnetem Entfernungswert dem ermittelten Phasendifferenzpaar am nächsten kommt. Alternativ kann der Objektabstand auch jedesmal berechnet werden.
-
8 entspricht der Darstellung gemäß
7 mit dem Unterschied, dass auf der y-Achse die Länge des jeweiligen Reststücks aufgetragen ist mit:
-
Im dargestellten Beispiel sind bis zu einer Gesamtweglänge D, die der kleinsten Wellenlänge entspricht, also hier 40 m, beide Reststücke gleich lang. Für eine Gesamtstrecke D von beispielsweise 70 m hingegen sind die Reststücke unterschiedlich groß.
-
Der in den 7 und 8 dargestellte Zusammenhang von Phase und Abstand lässt sich vorteilhaft in einem so genannten Modulodiagramm gemäß den 9 bis 11 darstellen. Auf der x- und y-Achse sind die Phasenwerte φ1 und φ2 für eine erste und zweite Modulationsfrequenz und auf der sekundären x- und y-Achse die den Phasenwerten entsprechenden Distanzwerte bzw. Reststückwerte d1, d2 dargestellt. Wie bereits erwähnt existiert für einen Entfernwert innerhalb des Eindeutigkeitsbereichs nur ein einziges Phasenwertepaar.
-
9 zeigt ein Modulodiagramm für die Frequenzen f1 = 7,5 MHz entsprechend einer Wellenlänge λ1 = 40 m und f2 = 5 MHz entsprechend einer Wellenlänge λ2 = 60 m wie bereits in 7 und 8 dargestellt. Die Kurve beginnt mit dem Phasendifferenzpaar (0 | 0) für D = 0. Erreicht die Gesamtweglänge des vom Objekt reflektierten Licht die Wellenlänge λ1 = 40 m der ersten Modulationsfrequenz so erreicht auch der Phasenwert seinen maximalen Wert, nämlich 2π mit dem Phasenwertepaar (2 | 1,33). Mit größer werdender Entfernung springt die Kurve immer an den Punkten, an denen eine der beiden Phasenwerte einen 2π -Wert durchläuft, bis ein Eindeutigkeitsbereich EB von 120 m erreicht ist.
-
Eine Entfernung kann beispielsweise dadurch bestimmt werden, indem ein ermitteltes Phasenwertepaar einem Entfernungspunkt der Distanzkurve zugeordnet wird. Phasenwertepaare liegen nur idealerweise auf der Distanzkurve und weichen typischerweise beispielsweise aufgrund von Rauschen davon ab. Im in 9 dargestellten Fall ist exemplarisch ein gemessenes Phasenwertepaar mit (1,05 | 0,85) eingezeichnet. Dieses Phasenwertepaar liegt nicht auf der Distanzkurve und ist nun einem Entfernungspunkt auf einer der beiden Kurvenabschnitte zuzuordnen. Der Abstand dAB zwischen den Kurvenabschnitten ist bekannt. Für die Zuordnung ist es daher ausreichend den Abstand dA, dB zu einer der beiden Kurvenabschnitte zu bestimmen. Der Objektabstand bestimmt sich alsdann aus dem am nächsten liegenden Entfernungspunkt. Im dargestellten Fall kann dem Phasenwertepaar ein Entfernungwert D von 23 m, also einem tatsächlichen Objektabstand d von 11,5 m zugeordnet werden.
-
Liegt hingegen ein erfasstes Phasenwertepaar beispielsweise in der Mitte der benachbarten Entfernungsgerade bzw. Kurvenabschnitte könnte statt der tatsächlichen Entfernung von 23 m dem Phasenwertepaar eine Entfernung von 93 m zugeordnet werden.
-
Inkorrekte Entfernungswerte entstehen jedoch nicht nur durch derartige Fehlzuordnungen, sondern auch durch Überreichweiten von Objekten außerhalb des Eindeutigkeitsbereichs. Im dargestellten Fall erstreckt sich der Eindeutigkeitsbereich EB bis 120 m Gesamtdistanz D, also einem maximalen Objektabstand d von 60 m. Typischerweise ist ein Lichtlaufzeitkamerasystem derart ausgelegt, dass Objekte außerhalb des Eindeutigkeitsbereichs nur noch ein geringes Signal liefern und in der Auswertung unberücksichtigt bleiben. Objekte mit einer hohen Reflektivität können jedoch eine ausreichend hohe Signalstärke am Sensor erzeugen und werden als Objekt erkannt.
-
Steht ein solches Objekt beispielsweise in einer tatsächlichen Entfernung von d = 71,5, also einer Gesamtlaufstrecke von 143 m, wird ein solches Objekt aufgrund des auf 120 m begrenzten Eindeutigkeitsbereich mit einer Gesamtdistanz D von 23 m erfasst. Bei einer Überreichweite mit der Gesamtstrecke von 213 m ergibt sich ein Distanzwert D von 93 m.
-
Um Überreichweiten und Fehlzuordnungen zu erkennen ist es erfindungsgemäße vorgesehen, die Entfernungsmessung mit weiteren unterschiedlichen Modulationsfrequenzen und entsprechend unterschiedlichen Eindeutigkeitsbereichen zu wiederholen und Entfernungswerte nur dann zuzulassen, wenn vorzugsweise alle oder eine vorbestimmte Anzahl von Entfernungsmessungen innerhalb tolerierter Grenzen zum selben Ergebnis führen.
-
In 10 ist ein Modulodiagramm für die Frequenzpaarung f1 = 7,5 MHz entsprechend einer Wellenlänge λ1 = 40 m und f2 = 6 MHz entsprechend einer Wellenlänge λ2 = 50 m dargestellt. Diese Frequenzpaarung spannt einen Eindeutigkeitsbereich EB bis 200 m auf. Das mit dieser Frequenzpaarung ermittelte Phasenwertepaar kann einer Entfernung von 23,3 m zugeordnet werden. Bei einem unklaren Phasenwertepaar könnte die Entfernung auf 178 m springen. Für die genannten Überreichweitenbeispiel von D = 143 m und D = 213 m würden sich Entfernungswerte D = 143 m und D = 13 m ergeben.
-
In
11 ist ein Modulodiagramm für die Frequenzpaarung f
1 = 6 MHz entsprechend einer Wellenlänge λ
1 = 50 m und f
2 = 5 MHz entsprechend einer Wellenlänge λ
2 = 60 m dargestellt mit einem Eindeutigkeitsbereich von 300 m. Das mit dieser Frequenzpaarung ermittelte Phasenwertepaar kann einer Entfernung von 22,9 m zugeordnet werden. Eine Fehlzuordnung durch ein unklares Phasenwertepaar führt ggf. zu einem Entfernungswert von 267,5 m. Für die genannten Überreichweitenbeispiele von D = 143 m und D = 213 m würden sich bei eindeutiger Zuordnung Entfernungswerte D = 143 m und D = 213 m ergeben. In folgender Tabelle sind einige Beispiele von Fehlzuordnungen und Messrauschen dargestellt:
Distanzmesszyklus | 1 | 2 | 3 | 4 | 5 | 6 | 7 | 8 | 9 |
EB | 120 | 200 | 300 | 120 | 200 | 300 | 120 | 200 | 300 |
Distanz | d12 | d23 | d31 | d12 | d23 | d31 | d12 | d23 | d31 |
Unklare Phasenwertepaare |
D = 23 m | 23 | 178 | 267,5 | 93 | 23 | 23 | 93 | 23 | 267,5 |
Überreichweite |
D = 143 m | 23 | 143 | 143 | 23 | 143 | 143 | 23 | 143 | 143 |
D = 213 m | 93 | 13 | 213 | 93 | 13 | 213 | 93 | 13 | 213 |
D = 340 m | 100 | 140 | 40 | 100 | 140 | 40 | 100 | 140 | 40 |
Signalrauschen |
D = 23 m | 23,2 | 22,5 | 23,0 | 23,4 | 23,4 | 22,8 | 22,7 | 23,1 | 22,9 |
-
Im dargestellten Beispiel ist zu erkennen, dass durch Signalrauschen verursachte Messschwankungen um Größenordnungen kleiner sind als die durch Überreichweiten oder durch unklare Messwerte generierten Fehlzuordnungen. Während durch Signalrauschen verursachte Schwankungen ohne weiteres durch Mittelung geglättet werden können, müssen fehlerhaft zugeordnete Entfernungswerte erkannt und ggf. verworfen werden.
-
Hinsichtlich der Überreichweiten könnte beispielsweise festgelegt werden, dass ein Distanzmesswert nur dann gültig ist, wenn in zwei aufeinanderfolgenden Distanzmesszyklen im Wesentlichen der gleiche Entfernungswert ermittelt wird. Gemäß einer solchen Vorschrift würde entsprechend der obigen Tabelle für eine Überreichweite von 143 m nach Durchlaufen des zweiten und dritten Distanzmesszyklus ein Entfernungswert von 143 m als gültig erkannt werden. Werden mindestens drei gleiche Entfernungswerte gefordert, so werden im dargestellten Beispiel alle Überreichweiten größer 120 m verworfen. 12 zeigt beispielhaft eine zeitliche Abfolge einer erfindungsgemäßen Entfernungsmessung für unterschiedliche Frequenzpaarungen, bei der die relative Phasenverschiebung φi(fi, D) für jede Modulationsfrequenz fi mit vier Phasenlagen φvar = 0°, 90°, 180°, 270° durchgeführt wird. Selbstverständlich sind auch Entfernungsmessungen mit weniger und ggf. auch mehr Phasenlagen denkbar.
-
In einem ersten Phasenmesszyklus PM1 wird für eine erste Modulationsfrequenz f1 eine erste Phasenverschiebung φ1 und für die nachfolgende Phasenmesszyklen PM2/3 für eine zweite und dritte Modulationsfrequenz f2, f3 eine zweite und dritte Phasenverschiebung φ2, φ3 ermittelt. Nach dem dritten Phasenmesszyklus PM3 beginnen die Phasenmessungen wieder mit der ersten Modulationsfrequenz f1 und so fort. Bei mehr als drei Modulationsfrequenzen können auch andere Frequenz-Reihenfolgen, insbesondere auch zufällige Reihenfolgen gewählt werden.
-
Jeweils zwei aufeinander folgende Phasenmesszyklen PMn,n+1 bilden einen Distanzmesszyklus Mn aus dem ein Phasenwertepaar (φn, φn+1) und ein diesem Paar zugeordneter Entfernungswert dn,n+1 ermittelt wird.
-
Erfindungsgemäß ist es hierbei vorgesehen, dass nur dann ein Entfernungswert d als gültig gewertet wird, wenn in drei aufeinander folgenden Distanzmesszyklen innerhalb tolerierter Grenzen im Wesentlichen derselbe Entfernungswert ermittelt wird.
-
Ein mögliches erfindungsgemäßes Vorgehen ist beispielhaft in folgender Tabelle veranschaulicht:
Distanzmesszyklus | 1 | 2 | 3 | 4 | 5 | 6 | 7 | 8 | 9 |
EB | 120 | 200 | 300 | 120 | 200 | 300 | 120 | 200 | 300 |
Distanz | d12 | d23 | d31 | d12 | d23 | d31 | d12 | d23 | d31 |
D = 23 m | 23,4 | 22,5 | 23,0 | 23,7 | 178 | 23,1 | 23,2 | 24 | 267 |
Differenz | 23,4 | 0,9 | 0,5 | 0,7 | 155,3 | 145,9 | 0,1 | 0,8 | 243 |
Toleranz 20 m | - | < | < | < | > | > | < | < | > |
Gültiger Wert | (–) | (–) | (+) | (+) | (–) | (–) | (–) | (+) | (–) |
Ausgabe | | | 23,0 | 23,7 | | | | 24 | |
-
Zur Erfassung von Fehlzuordnungen kann die Toleranzgrenze deutlich oberhalb eines üblichen Signalrauschens gelegt werden und selbstverständlich unterhalb eines minimal möglichen Entfernungssprungs durch Fehlzuordnung. Im dargestellten Beispiel könnte beispielsweise eine Toleranzgrenze ∆dtol auf ±20 m festgelegt werden. Ausgangspunkt für die Anwendung der Toleranzgrenze sind im dargestellten Beispiel die Differenzen der letzten drei Messungen.
-
Mit Beginn der Messung liegen im ersten und zweiten Distanzmesszyklus noch keine drei Distanzmessungen vor, so dass die an sich zutreffenden Entfernungswerte nicht ausgegeben werden. Ab dem dritten Messzyklus liegt dann eine ausreichende Anzahl von Entfernungswerten vor.
-
Die im dritten und vierten Messzyklus ermittelten Entfernungswerte liegen innerhalb der Toleranzgrenze, sind somit gültig und werden ausgegeben. Für bestimmte Auswerteverfahren könnte es ggf. auch vorgesehen sein, die beiden vorlaufenden Entfernungswerte rekursiv auszuwerten und auszugeben, wenn sie innerhalb der Toleranz liegen, wie dies im dargestellten ersten und zweiten Messzyklus der Fall ist.
-
Im fünften Messzyklus erfolgte eine Fehlzuordnung mit einem Distanzsprung auf 178 m, der die Toleranzgrenze überschreitet. Dieser Entfernungswert ist ungültig und wird nicht ausgegeben. Ein gültiger Entfernungswert liegt erst wieder im achten Distanzmesszyklus vor, nachdem die Entfernungswerte in Folge in der achten Messung innerhalb der Toleranzgrenze lagen. Ggf. könnten auch hier die vorlaufenden innerhalb der Toleranz liegenden Entfernungswerte rekursiv als gültig ausgegeben werden. Erfindungsgemäß ist es vorgesehen die Toleranzgrenze vornehmlich so festzulegen, dass sicher Fehlzuordnungen erkannt werden. Selbstverständlich kann die Toleranzgrenze je nach Genauigkeitsanforderung der Entfernungsmessungen enger gefasst werden.
-
Bei einer bewegten Kamera und/oder bewegten Objekten müssen zudem die Bewegungsgeschwindigkeiten berücksichtigt werden.
-
Wird die Kamera beispielsweise mit einer maximalen Geschwindigkeit von 10 m/s bewegt und wird für jede Phasenmessung eine Erfassungsrate von 1/50 s angenommen, so verschiebt sich jeder Entfernungspunkt zwischen zwei Messungen um 0,2 m. D.h. bei drei aufeinander folgenden Messungen verschiebt sich ein Entfernungspunkt allein aufgrund der Kamerabewegung um 0,6 m. Für die Festlegung der Toleranzgrenze wäre es somit von Vorteil vorzugsweise eine Kameraeigenbewegung ggf. auch eine zu erwartende Objektbewegung und mögliche Messfehler zu berücksichtigen. Im vorliegenden Beispiel könnte beispielsweise die Toleranzgrenze um +/–1,2 m erweitert werden.
-
Bezugszeichenliste
-
- 10
- Beleuchtungsmodul
- 12
- Beleuchtung
- 22
- Lichtlaufzeitsensor
- 27
- Auswerteeinheit
- 30
- Modulator
- 35
- Phasenschieber, Beleuchtungsphasenschieber
- 38
- Modulationssteuergerät
- ∆φ(tL)
- laufzeitbedingte Phasenverschiebung
- φvar
- Phasenlage
- φ0
- Basisphase
- M0
- Modulationssignal
- p1
- erste Phase
- p2
- zweite Phase
- Sp1
- Sendesignal mit erster Phase
- Sp2
- Empfangssignal mit zweiter Phase
- Ga, Gb
- Akkumulationsgates
- Ua, Ub
- Spannungen am Modulationsgate
- f1, f2, f3
- erste, zweite, dritte Modulationsfrequenz
- λ
- Wellenlänge
- PMi
- Phasenmesszyklus
- Mi
- Distanzmesszyklus
- D
- Gesamtweglänge
- d
- Objektdistanz
- dij
- ermittelte Objektdistanz
-
ZITATE ENTHALTEN IN DER BESCHREIBUNG
-
Diese Liste der vom Anmelder aufgeführten Dokumente wurde automatisiert erzeugt und ist ausschließlich zur besseren Information des Lesers aufgenommen. Die Liste ist nicht Bestandteil der deutschen Patent- bzw. Gebrauchsmusteranmeldung. Das DPMA übernimmt keinerlei Haftung für etwaige Fehler oder Auslassungen.
-
Zitierte Patentliteratur
-
- EP 1777747 [0002]
- US 6587186 [0002]
- DE 19704496 [0002, 0003, 0027]