DE102011012689B4 - Verfahren zur Bestimmung der Position eines Objekts in einem Bezugssystem - Google Patents

Verfahren zur Bestimmung der Position eines Objekts in einem Bezugssystem Download PDF

Info

Publication number
DE102011012689B4
DE102011012689B4 DE102011012689.9A DE102011012689A DE102011012689B4 DE 102011012689 B4 DE102011012689 B4 DE 102011012689B4 DE 102011012689 A DE102011012689 A DE 102011012689A DE 102011012689 B4 DE102011012689 B4 DE 102011012689B4
Authority
DE
Germany
Prior art keywords
landmark
detected
field
landmarks
determined
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.)
Active
Application number
DE102011012689.9A
Other languages
English (en)
Other versions
DE102011012689A1 (de
Inventor
Gerhard Sommer
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.)
E & K Automation GmbH
E&K Automation GmbH
Original Assignee
E & K Automation GmbH
E&K Automation 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 E & K Automation GmbH, E&K Automation GmbH filed Critical E & K Automation GmbH
Priority to DE102011012689.9A priority Critical patent/DE102011012689B4/de
Publication of DE102011012689A1 publication Critical patent/DE102011012689A1/de
Application granted granted Critical
Publication of DE102011012689B4 publication Critical patent/DE102011012689B4/de
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/02Systems using the reflection of electromagnetic waves other than radio waves
    • G01S17/06Systems determining position data of a target
    • G01S17/42Simultaneous measurement of distance and other co-ordinates
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/48Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
    • G01S7/4808Evaluating distance, position or velocity data
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/74Systems using reradiation of electromagnetic waves other than radio waves, e.g. IFF, i.e. identification of friend or foe
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/87Combinations of systems using electromagnetic waves other than radio waves
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S17/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/88Lidar systems specially adapted for specific applications
    • G01S17/93Lidar systems specially adapted for specific applications for anti-collision purposes
    • G01S17/931Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/48Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
    • G01S7/481Constructional features, e.g. arrangements of optical elements
    • G01S7/4817Constructional features, e.g. arrangements of optical elements relating to scanning

Abstract

Verfahren zur Bestimmung der Position eines Objekts (1) in einem Bezugssystem, umfassend die Verfahrensschritte: a) Erfassen der Relativposition von Landmarken (4, 5, 15) zu einer Objektreferenz (3) mittels eines am Objekt (1) angeordneten rotierenden Sensors (2), der den Winkel zu einer Bezugsachse als Objektreferenz erfasst, unter dem eine Landmarke detektiert wird; b) Erfassen einer Eigenschaft einer Markierung (10, 11) jeder erfassten Landmarke (4, 5, 15); c) Bestimmung der Position des Objekts (1) unter Berücksichtigung der erfassten Relativpositionen und der erfassten Eigenschaften, wobei eine Breiteninformation einer Markierung (10, 11) jeder erfassten Landmarke (4, 5, 15) erfasst wird und unter Berücksichtigung der erfassten Breiteninformation Position und/oder Orientierung des Objekts (1) ermittelt werden.

Description

  • Die Erfindung betrifft ein Verfahren zur Bestimmung der Position eines Objekts in einem Bezugssystem.
  • Es ist bekannt, in größeren Produktions- oder Lagerhallen, Fahrzeuge selbstständig fahren zu lassen. Dabei orientieren sich die Fahrzeuge an Landmarken, wobei eine Karte der Landmarken in den Fahrzeugen und/oder in einem zentralen Rechner abgelegt ist. Dabei ist auf den Objekten, insbesondere den Fahrzeugen, ein Sensor montiert, der die Umgebung nach Landmarken abtastet. Beispielsweise kann auf einem Fahrzeug ein Lasersensor angebracht sein, der rotiert. Der rotierende Lasersensor liefert die Winkel zu einer Bezugsachse im Fahrzeug, unter denen Landmarken detektiert werden. Außerdem kann der Typ der Landmarken, wenn unterschiedliche Landmarkentypen vorhanden sind, erfasst werden. Bei unbekannter Fahrzeugposition kann keine Zuordnung der gesichteten Landmarken zu den Landmarken der Landmarkenkarte hergestellt werden. Mit identifizierten Landmarken kann über bekannte Verfahren, zum Beispiel Triangulation, die Position des Fahrzeugs ermittelt werden. Bei drei Freiheitsgraden des Fahrzeugs werden mindestens drei Landmarken für eine Positionsbestimmung benötigt.
  • Ist die Position eines Fahrzeugs beziehungsweise Objekts bekannt, so können weitere erfasste Landmarken mit Landmarken der Landmarkenkarte in Deckung gebracht werden und bei einem Positionswechsel kann erneut die Position bestimmt werden.
  • Eine weitere Möglichkeit besteht darin, während der Fahrzeugbewegung die Landmarken zu verfolgen. Aus den Winkeländerungen kann auf die Entfernung der Landmarken geschlossen werden. Aus diesen Entfernungen können die Abstände zwischen den Landmarken in einer Abstandsmatrix ermittelt werden. Diese Abstandsmatrix kann gegen eine Abstandsmatrix aller Landmarken verglichen werden, um die Landmarken zu identifizieren.
  • Aus der US 5,911,767 A ist ein Verfahren zur Lokalisierung eines Roboters bekannt. Der Roboter weist eine Kamera auf, über den eine eindeutig identifizierbare Landmarke erfasst wird. Wenn die Landmarke erfasst wurde, wird die Position und Orientierung des Roboters relativ zur Landmarke geschätzt. Basierend auf dieser Information wird die Position des Roboters in einem Bezugssystem bestimmt.
  • Problematisch für alle diese Verfahren ist es, eine Startposition des Objekts, beziehungsweise Fahrzeugs, zu bestimmen. Bekannt ist es dabei, eine Markierung auf dem Boden einer Halle anzubringen. Dabei muss sowohl dem Objekt mitgeteilt werden, wo die Startposition im Bezugssystem liegt und zum anderen muss einem Benutzer mitgeteilt werden, wo die Startposition markiert werden muss. Diese Vorgehensweise ist relativ umständlich.
  • Eine andere Möglichkeit besteht darin, aufgrund der von einer Position aus erfassten Landmarken, sämtliche Kombinationen zu berechnen und zu prüfen, bis eine passende Kombination gefunden ist. Hierbei ist der Rechenaufwand sehr groß, sodass es mitunter sehr lange dauern kann, bis eine Startposition gefunden ist.
  • Aufgabe der vorliegenden Erfindung ist es deshalb, ein alternatives Verfahren bereitzustellen, mit dem unter Einsatz von wenig Rechenleistung eine Startposition bestimmt werden kann.
  • Gelöst wird diese Aufgabe durch ein Verfahren zur Bestimmung der Position eines Objekts in einem Bezugssystem mit den Merkmalen des Anspruchs 1.
  • Durch das Erfassen einer Eigenschaft einer Markierung einer Landmarke ist es möglich, die möglichen Positionen des Objekts im Bereich einer Landmarke zu reduzieren. Dies führt dazu, dass mit geringerem Rechenaufwand als mit dem Verfahren des Standes der Technik eine Startpositionsbestimmung erfolgen kann.
  • Vorzugsweise handelt es sich bei dem Objekt, dessen Startposition bestimmt werden soll, um ein Fahrzeug, insbesondere ein Flurförderfahrzeug. Die Landmarken sind vorzugsweise an Wänden oder Säulen eines Arbeitsraums angebracht. Dabei besteht vorzugsweise eine Karte von Landmarken, die Informationen über die Koordinaten der Landmarken in einem Bezugssystem, deren Montagerichtung und deren Landmarkennummer im Bezugssystem enthalten.
  • Die Landmarken bestehen vorzugsweise aus einem oder mehreren Streifen retroreflektierenden Materials. Derartige Reflektortypen sind grundsätzlich bekannt.
  • Als Sensor des Objekts wird vorzugsweise ein rotierender Sensor verwendet, der den Winkel zu einer Bezugsachse als Objektreferenz erfasst, unter dem eine Landmarke detektiert wird. Vorzugsweise weist der Sensor einen Inkrementalgeber mit 40.000 Strichen auf.
  • Besondere Vorteile ergeben sich, wenn zusätzlich zu der Position des Objekts auch die Orientierung des Objekts im Bezugssystem bestimmt wird. Wenn sowohl die Position als auch die Orientierung des Objekts im Bezugssystem bekannt sind, können die bekannten Algorithmen für die Korrektur dieser Position verwendet werden. Wenn dem Objekt demnach seine Position und Orientierung bekannt sind, kann es seinen Weg im Bezugssystem anhand der Landmarken finden.
  • Eine Breiteninformation einer Markierung jeder erfassten Landmarke wird erfasst und unter Berücksichtigung der erfassten Breiteninformation werden Position und/oder Orientierung des Objekts ermittelt. Beispielsweise kann die Breite eines Reflektors einer Landmarke erfasst werden. Wenn demnach der rotierende Lasersensor einmal um 360° umläuft, so erfasst er zum einen, unter welchem Winkel bezogen auf die Objektreferenz eine Landmarke erfasst wird. Weiterhin wird für jede erfasste Landmarke eine Breiteninformation erfasst, insbesondere ein Winkelbereich vom erfassten Anfang bis zum erfassten Ende einer Markierung der Landmarke, insbesondere eines Reflektors. Je nachdem, wie der Reflektor orientiert ist und wo sich das Objekt befindet, wird eine Markierung unterschiedlich breit wahrgenommen.
  • Gemäß einer weiteren Verfahrensvariante kann vorgesehen sein, dass unter Berücksichtigung einer Landmarkenkarte, die Informationen über die Position einer Landmarke und deren Orientierung im Bezugssystem enthält, alle aufgrund der erfassten Eigenschaft einer Markierung möglichen Positionen des Objekts ermittelt werden. Die Landmarken und die Orientierung der Landmarken im Bezugssystem sind bekannt. Wenn demnach durch den Sensor ein Winkel erfasst wird, unter dem der Sensor eine Landmarke erfasst und weiterhin ein Winkel erfasst wird, der die Breite einer Markierung der Landmarke beschreibt, so kann für jede Landmarke der Landmarkenkarte ein insbesondere sichelförmiger Abschnitt um die Landmarke ermittelt werden, auf dem sich das Objekt befinden könnte. Dies wird für jede in Frage kommende Landmarke ermittelt. Dabei repräsentiert die Dicke des sichelförmigen Abschnitts die Messungenauigkeit der Winkelmessung, die „Öffnung” der Sichel resultiert aus den Reflexionseigenschaften der Reflektoren der Landmarken.
  • Eine genauere Information erhält man, wenn die Landmarken unterschiedliche Landmarkentypen aufweisen, die vom Sensor erfasst werden. Dann können nämlich für jede Landmarke eines Typs alle aufgrund der erfassten Eigenschaften einer Markierung möglichen Positionen des Objekts im Umfeld der entsprechenden Landmarke ermittelt werden. Beispielsweise können drei unterschiedliche Landmarkentypen vorgesehen sein. Wenn demnach ein Sensor beispielsweise eine Landmarke des Typs 2 erfasst, so können die möglichen Positionen im Verhältnis zu sämtlichen Landmarken des Typs 2 ermittelt werden. Für die anderen Landmarken eines anderen Typs müssen die Positionen in diesem Fall nicht ermittelt werden. Die Verwendung von Landmarken unterschiedlichen Typs kann zur Beschleunigung der Bestimmung der Position eines Objekts beitragen.
  • Besonders vorteilhaft ist es, wenn das Bezugssystem beziehungsweise der Arbeitsraum, in dem die Position des Objekts zu bestimmen ist, in ein Belegungsfeld mit Feldelementen unterteilt wird und ein Feldelement als „belegt” erfasst oder markiert wird, wenn eine mögliche Position des Objekts in das Feldelement fällt. Feldelemente, die nicht als belegt erfasst oder markiert werden, scheiden demnach bereits für die Position des Objekts aus.
  • Auch in diesem Zusammenhang ist es vorteilhaft, wenn Landmarken unterschiedlichen Typs vorgesehen sind und der Landmarkentyp durch den Sensor erfasst wird. Dann ist es möglich, dass für jeden Landmarkentyp in einem Belegungsfeld ein Feldelement als „belegt” erfasst oder markiert wird, wenn eine mögliche Position des Objekts in das Feldelement fällt. Vorzugsweise wird für jede erfasste Landmarke, d. h. für jedes Wertepaar, bestehend aus erfasster Relativposition und Breiteninformation, getrennt analysiert, ob ein Feldelement des Bewegungsfelds belegt ist oder nicht.
  • Gemäß einer besonders bevorzugten Ausführungsform des erfindungsgemäßen Verfahrens kann vorgesehen sein, dass das Belegungsfeld durch ein Gitter in Feldelemente unterteilt wird, wobei die Gitterkonstante eingestellt wird. Durch das Einstellen der Gitterkonstante kann die Größe der Feldelemente eingestellt werden. Durch Wählen einer kleinen Gitterkonstante kann die Genauigkeit erhöht werden, andererseits erhöht sich dann die erforderliche Rechenleistung.
  • Für die Positionsbestimmung ist es vorteilhaft, wenn für jedes Feldelement erfasst wird, welche Landmarke beziehungsweise welches Wertepaar, zu einer Erfassung oder Markierung des Feldelements als „belegt” geführt hat.
  • Wie oben bereits erwähnt, ist es vorteilhaft, wenn für jede erfasste Landmarke ein Belegungsfeld ausgefüllt wird, d. h. in ein Belegungsfeld eingetragen wird, ob ein Feldelement belegt ist oder nicht. Liegen für n Landmarken Messungen vor, können n Belegungsfelder gebildet werden.
  • Weiterhin kann ermittelt werden, wie oft ein Feldelement als „belegt” markiert oder erfasst wurde. Wird jedoch ein Feldelement bei der Bewertung für dieselbe Landmarke mehrmals als „belegt” gekennzeichnet, so wird dieses Feldelement beziehungsweise die Belegung dieses Feldelements vorteilhafterweise nur einmal gezählt.
  • Um die möglichen Lösungen für die Position des Objekts einzuschränken, kann vorgesehen sein, dass Feldelemente mit einer vorgegebenen Belegungszahl ausgewählt werden und für jedes ausgewählte Feldelement und jede Landmarke, die zu einer Erfassung oder Markierung des Feldelements als „belegt” geführt hat, die Objektorientierung ermittelt wird und durch Vergleich mit der Landmarkenkarte überprüft wird, ob die ermittelte Objektorientierung plausibel ist. Die maximale Belegungszahl eines Feldelements entspricht dabei der Anzahl der erfassten Landmarken. Es kann nun vorgegeben werden, dass nur die Feldelemente berücksichtigt werden, die die maximale Belegungszahl aufweisen oder diejenigen Feldelemente ausgewählt werden, die die maximale Belegungszahl minus einen vorgegebenen Wert aufweisen. Wenn beispielsweise 10 Landmarken detektiert werden, und vorgegeben wird, dass nur Feldelemente mit einer Belegungszahl ≥ die maximale Belegungszahl minus zwei für die weitere Verarbeitung verwendet werden sollen, so werden nur diejenigen Feldelemente für die weitere Verarbeitung ausgewählt, deren Belegungszahl 8, 9 oder 10 ist. Alternativ kann eine minimale Belegungszahl vorgegeben werden. Für diese so identifizierten Feldelemente wird überprüft, ob die ermittelte Objektorientierung plausibel ist. Insbesondere wird überprüft, ob in diesem Feldelement die zugehörigen Landmarken (Reflektoren) aufsteigende Sichtwinkel aufweisen. Dadurch werden fast alle „falschen” Positionen erkannt.
  • Wenn eine vorgegebene Anzahl von Landmarken als passend identifiziert wurde, so wird davon ausgegangen, dass die richtige Startposition des Objekts gefunden wurde und werden diese Positionsdaten an einen bekannten Algorithmus zur Positionsbestimmung übergeben, um ausgehend von dieser Startposition das Objekt zu steuern. Das erfindungsgemäße Verfahren wird vorzugsweise in einem Computersystem implementiert. Dabei hat sich gezeigt, dass die Positionsermittlung unter Verwendung eines PowerPCs in etwa 50 Millisekunden erfolgen kann. Der Rechenaufwand des erfindungsgemäßen Verfahrens steigt lediglich quadratisch mit der Fläche des Arbeitsraums. Der Rechenaufwand bei herkömmlichen Verfahren zur Bestimmung der Startposition liegt deutlich darüber.
  • Weitere Merkmale und Vorteile der Erfindung ergeben sich aus der nachfolgenden Beschreibung eines Ausführungsbeispiels der Erfindung, anhand der Figuren der Zeichnung, die erfindungswesentliche Einzelheiten zeigt, sowie aus den Ansprüchen. Die verschiedenen Merkmale können je einzeln für sich oder zu mehreren in beliebigen Kombinationen bei Varianten der Erfindung verwirklicht sein.
  • Es zeigen:
  • 1 eine schematische Darstellung zur Verdeutlichung der Erfassung von Landmarken;
  • 2a eine schematische Darstellung einer Landmarke eines ersten Typs;
  • 2b eine schematische Darstellung einer Landmarke eines zweiten Typs;
  • 3 eine schematische Darstellung zur Verdeutlichung der Bestimmung eines möglichen Abstands des Objekts von einer Landmarke für eine erste erfasste Landmarke;
  • 4 eine Darstellung zur Verdeutlichung des Einzeichnens der möglichen Abstände um Landmarken eines ersten Typs;
  • 5 eine der 4 entsprechende Darstellung für eine Landmarke eines zweiten Typs;
  • 6 eine schematische Darstellung zur Verdeutlichung der Belegung von Feldelementen mit dem Zustand „belegt”; und
  • 7 eine graphische Darstellung der Anzahl der Belegung eines Feldelements.
  • Die 1 zeigt stark schematisiert ein Objekt 1, dessen Position in einem Arbeitsraum, über den ein Bezugssystem gelegt ist, zu bestimmen ist. Das Objekt 1 weist einen Sensor 2 auf, im Ausführungsbeispiel einen rotierenden Lasersensor. Dem Sensor 2 ist eine Objektreferenz 3 zugeordnet. In einem Arbeitsraum sind mehrere Landmarken 4, 5 vorgesehen. Im Ausführungsbeispiel tragen die Landmarken 4, 5 Reflektorstreifen 69. Die Reflektorstreifen 69 sind als retroreflektierende Reflektoren ausgebildet. Die reflektierenden Streifen 6, 7 bilden eine Markierung 10 und die Reflektoren 8, 9 bilden eine Markierung 11. Die Breite der Markierung 10 entspricht b1 und die Breite der Markierung 11 entspricht b2. Der Sensor 2 erkennt bei seinem Umlauf den Beginn einer Markierung 10 und das Ende einer Markierung 10. Zum Mittelpunkt zwischen dem Beginn und dem Ende der Markierung 10 wird der Winkel α1 bestimmt. Der Winkel α1 entspricht der Relativposition der Landmarke 4 zum Objekt 1. Außerdem wird eine Breiteninformation ermittelt. Hierfür wird der Winkel β1 bestimmt, der ein Maß für die Breite der Markierung 10 ist. Die Landmarke 5 ist zum Objekt 1 anders orientiert als die Landmarke 4. Auch für die Landmarke 5 wird eine Relativposition, nämlich der Winkel α2 und eine Breiteninformation, nämlich der Winkel β2 bestimmt. Wie sich aus dem vorliegenden Beispiel ohne Weiteres erkennen lässt, hängt die Breiteninformation davon ab, in welcher Orientierung sich die Landmarke 4, 5 zum Objekt 1 befindet. Ändert sich die Orientierung der Landmarke 4, 5 zum Objekt 1, ändert sich auch die Breiteninformation. Die Winkel α1, β1 beziehungsweise α2, β2 liefern daher keine eindeutige Information bezüglich der Position des Objekts 1 relativ zu den Landmarken 4, 5. Diese Daten sind jedoch hilfreich für die Bestimmung der Position des Objekts 1, wie später noch deutlich werden wird.
  • In der 2a ist eine Landmarke 4 eines ersten Typs dargestellt. Die Landmarke weist die zwei Reflektorstreifen 6, 7 auf, wobei jeder Reflektorstreifen 6, 7 die Breite d1 aufweist. Der Abstand zwischen den Reflektorstreifen 6, 7 beträgt d2.
  • In der 2b ist eine Landmarke 15 eines zweiten Typs exemplarisch dargestellt. Diese weist Reflektorstreifen 16, 17 auf, die wiederum den Abstand d2 zueinander aufweisen. Allerdings weisen die Streifen 16, 17 jeweils die Breite d3 auf, die von d1 verschieden ist. Somit ist auch die Breite b3 der Markierung anders als die Breite b1 der Markierung der Landmarke 4 der 2a. Der Sensor 2 kann aufgrund dieser unterschiedlichen Gestaltung der Landmarken 4, 15 erkennen, ob es sich um eine Landmarke des Typs 1 oder eine Landmarke des Typs 2 handelt. Auch weitere Landmarkentypen sind denkbar.
  • Das erfindungsgemäße Verfahren sei anhand des folgenden Beispiels erläutert:
    Der Sensor 2 erfasst bei einem Umlauf von 360° bei der gegebenen Position des Objekts 1 neun Landmarken 4, 5. Für jede Landmarke 4, 5 wird der Sichtwinkel α, also die Relativposition zur Objektreferenz 3, bestimmt und die Breiteninformation β, ebenfalls in Grad. Dabei ergibt sich beispielsweise folgendes Ergebnis:
    Landmarkentyp Sichtwinkel in Grad Breiteninformation in Grad
    1 9,202 0,37
    1 64,31 0,23
    2 75,27 0,21
    1 158,897 0,9
    1 184,939 0,33
    2 197,227 1,05
    2 292,843 0,16
    2 349,137 0,64
    3 355,957 0,28
  • Bei einem Umlauf beziehungsweise Scan hat der Sensor 2 demnach vier Landmarken des Typs 1, vier Landmarken des Typs 2 und eine Landmarke des Typs 3 erfasst. Als erste Landmarke wurde eine Landmarke des Typs 1 unter einem Winkel α von 9,202° und mit einer Breite von 0,37° erfasst.
  • Für alle in einer Landmarkenkarten vermerkten Landmarken des Typs 1 werden daher die potenziellen Positionen des Objekts 1 ermittelt, von denen aus die entsprechende Landmarke durch den Sensor 2 mit der Breiteninformation von 0,37° erfasst werden könnte. In der 3 ist ein Ausschnitt des Arbeitsraums gezeigt und sind die entsprechenden möglichen Positionen des Sensors 2 beziehungsweise des Objekts 1 für zwei Landmarken 20, 21 eingezeichnet. Wie sich unschwer erkennen lässt, liegen die möglichen Positionen auf Positionskurven 22, 23, die sichel- bzw. kreisbogenförmig sind.
  • In der 4 ist der gesamte Arbeitsraum dargestellt, wobei für jede Landmarke des Typs 1 die möglichen Positionen des Objekts eingezeichnet sind, unter denen die entsprechende Landmarke mit der Breiteninformation von 0,37° erfasst werden könnte. Entsprechend sind mehrere Positionskurven 22, 23 eingezeichnet.
  • In der 5 sind die entsprechenden möglichen Positionen des Objekts im Umfeld von Landmarken des Typs 2 eingezeichnet, von denen aus die entsprechende Landmarke mit der Breiteninformation 0,21° (entsprechend der dritten erfassten Landmarke, Zeile 4 der Tabelle) erfasst werden kann. Exemplarisch sind die Positionskurven 26, 27 eingezeichnet. Aus dem Vorstehenden ergibt sich, dass für jede erfasste Landmarke gemäß der Tabelle entsprechende mögliche Positionen um die Landmarke eines entsprechenden Typs ermittelt werden. Eine graphische Darstellung wie in den 4, 5 ist nicht zwingend notwendig.
  • Weiterhin wird der Arbeitsraum in Feldelemente 30, 31 eines Belegungsfelds 32 unterteilt. Im gezeigten Ausführungsbeispiel weist das Belegungsfeld 32 eine Gitterstruktur auf. Die Gitterkonstante α ist dabei einstellbar.
  • Es wird für jede erfasste Landmarke überprüft, ob eine ermittelte mögliche Position – anschaulich Positionskurve 22, 23, 26, 27 – in ein entsprechendes Feldelement 30, 31 fällt. In der 6 ist dies anhand der Positionskurve 22 veranschaulicht. Beispielsweise fällt die Positionskurve 22 in das Feldelement 31. Das Feldelement 31 wird daher mit „belegt” markiert beziehungsweise erfasst. Dies wird für alle möglichen Positionen beziehungsweise Positionskurven 22, 23, 26, 27 durchgeführt und zwar getrennt für jede erfasste Landmarke der obigen Tabelle. Anschließend wird gezählt, wie oft ein Feldelement 30, 31 mit „belegt” markiert wurde, wobei für jede erfasste Landmarke ein Belegungsfeld nur einmal gezählt wird, auch wenn mehrere Landmarken desselben Typs eine Positionskurve aufweisen, die durch dasselbe Feldelement verläuft. Für das vorliegende Ausführungsbeispiel bedeutet dies, dass ein Feldelement maximal neunmal mit „belegt” markiert werden kann, da bei einem Umlauf neun Landmarken erfasst wurden. Dies kann graphisch in einem „Belegungsgebirge”, wie in der 7 dargestellt, visualisiert werden. Die Spitzen 41, des Gebirges 40 verdeutlichen, dass in den zugeordneten Feldelementen 30, 31 eine hohe Anzahl von Belegungen festgestellt wurde. Anschließend können Feldelemente ausgewählt werden, die eine bestimmte Mindestanzahl von Belegungen aufweisen. Beispielsweise kann festgelegt werden, dass nur diejenigen Feldelemente 30, 31 ausgewählt werden, die sechsmal oder öfters mit „belegt” markiert wurden. Da sich normalerweise kein eindeutiger Gipfel/Spitze 41 ergibt, wird für die Feldelemente 30, 31, die eine bestimmte Mindestbelegung aufweisen, versucht, Mehrdeutigkeiten auszuschließen. Dies geschieht durch Verwendung der Relativposition beziehungsweise des Sichtwinkels. Für jede Landmarke, die zu einer Belegung eines ausgewählten Feldelements geführt hat, wird die sich ergebende Objektorientierung errechnet. Dieser die Objektorientierung des Fahrzeugs im Bezugssystem angebende Winkel erhöht in einem Winkelverteilungsfeld einen Winkelwahrscheinlichkeitszähler. Der Winkel mit dem höchsten Winkelwahrscheinlichkeitszähler wird ausgewählt. Alle Landmarken, die zur wahrscheinlichsten Objektorientierung beitragen, werden verwendet.
  • Jede Messung bildet eine Ebene des Belegungsgebirges (= Belegungsvolumen). Eine Landmarke kann darin nicht mehrfach erscheinen.
  • Eine Landmarke, die in mehreren Ebenen gewählt wurde, wird entfernt. Dieser Verarbeitungsschritt reduziert die Anzahl der Lösungen drastisch. Bleiben mindestens drei eindeutige Landmarken übrig, wird damit der normale Ortungsalgorithmus gestartet. Aus der Liste möglicher Lösungen wird die beste selektiert. Dabei wird nach der Güte der ermittelten Position und der Anzahl der beteiligten Landmarken selektiert. Das erfindungsgemäße Verfahren ist sehr schnell (50 Millisekunden Rechenzeit auf PowerPC mit 300 Landmarken), da die Rechenzeit nur linear mit der Anzahl der vorhandenen Landmarken anwächst. Dadurch ergeben sich Möglichkeiten zum selbsttätigen Vermessen der Landmarkenumgebung, aufbauend auf vorher schon bekannten Landmarken, da das Verfahren keine odometrischen Informationen benötigt.

Claims (13)

  1. Verfahren zur Bestimmung der Position eines Objekts (1) in einem Bezugssystem, umfassend die Verfahrensschritte: a) Erfassen der Relativposition von Landmarken (4, 5, 15) zu einer Objektreferenz (3) mittels eines am Objekt (1) angeordneten rotierenden Sensors (2), der den Winkel zu einer Bezugsachse als Objektreferenz erfasst, unter dem eine Landmarke detektiert wird; b) Erfassen einer Eigenschaft einer Markierung (10, 11) jeder erfassten Landmarke (4, 5, 15); c) Bestimmung der Position des Objekts (1) unter Berücksichtigung der erfassten Relativpositionen und der erfassten Eigenschaften, wobei eine Breiteninformation einer Markierung (10, 11) jeder erfassten Landmarke (4, 5, 15) erfasst wird und unter Berücksichtigung der erfassten Breiteninformation Position und/oder Orientierung des Objekts (1) ermittelt werden.
  2. Verfahren nach Anspruch 1, dadurch gekennzeichnet, dass zusätzlich zur Position auch die Orientierung des Objekts (1) im Bezugssystem bestimmt wird.
  3. Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass als Breiteninformation ein Winkelbereich vom erfassten Anfang bis zum erfassten Ende der Landmarke erfasst wird.
  4. Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass unter Berücksichtigung einer Landmarkenkarte, die Informationen über die Position einer Landmarke (4, 5, 15) und deren Orientierung im Bezugssystem enthält, alle aufgrund der erfassten Eigenschaft einer Markierung (10, 11) möglichen Positionen des Objekts (1) ermittelt werden.
  5. Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass ein Landmarkentyp erfasst wird und für jede Landmarke (4, 5, 15) eines Typs alle aufgrund der erfassten Eigenschaft einer Markierung (10, 11) möglichen Positionen des Objekts (1) ermittelt werden.
  6. Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass das Bezugssystem in ein Belegungsfeld (32) mit Feldelementen (30, 31) unterteilt wird und ein Feldelement als „belegt” erfasst oder markiert wird, wenn eine mögliche Position des Objekts (1) in das Feldelement (30, 31) fällt.
  7. Verfahren nach Anspruch 6, dadurch gekennzeichnet, dass für jeden Landmarkentyp in einem Belegungsfeld (32) ein Feldelement (30, 31) als „belegt” erfasst oder markiert wird, wenn eine mögliche Position des Objekts (1) in das Feldelement (30, 31) fällt.
  8. Verfahren nach Anspruch 6 oder 7, dadurch gekennzeichnet, dass das Belegungsfeld (32) durch ein Gitter in Feldelemente (30, 31) unterteilt wird, wobei die Gitterkonstante (a) eingestellt wird.
  9. Verfahren nach einem der vorhergehenden Ansprüche 6 bis 8, dadurch gekennzeichnet, dass für jedes Feldelement (30, 31) erfasst wird, welche Landmarke (4, 5, 15) zu einer Erfassung oder Markierung des Feldelements (30, 31) als „belegt” geführt hat.
  10. Verfahren nach einem der vorhergehenden Ansprüche 6 bis 9, dadurch gekennzeichnet, dass für jede erfasste Landmarke (4, 5, 15) ein Belegungsfeld (32) ausgefüllt wird.
  11. Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass ermittelt wird, wie oft ein Feldelement (30, 31) als „belegt” markiert oder erfasst wurde.
  12. Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass Feldelemente (30, 31) mit einer vorgegebenen Belegungszahl ausgewählt werden und für jedes ausgewählte Feldelement (30, 31) und jede Landmarke (4, 5, 15), die zu einer Erfassung oder Markierung des Feldelements (30, 31) als „belegt” geführt hat, die Objektorientierung ermittelt wird und durch Vergleich mit der Landmarkenkarte überprüft wird, ob die ermittelte Objektorientierung plausibel ist.
  13. Verfahren nach einem der vorhergehenden Ansprüche, dadurch gekennzeichnet, dass das Verfahren in einem Computersystem implementiert wird.
DE102011012689.9A 2011-03-01 2011-03-01 Verfahren zur Bestimmung der Position eines Objekts in einem Bezugssystem Active DE102011012689B4 (de)

Priority Applications (1)

Application Number Priority Date Filing Date Title
DE102011012689.9A DE102011012689B4 (de) 2011-03-01 2011-03-01 Verfahren zur Bestimmung der Position eines Objekts in einem Bezugssystem

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
DE102011012689.9A DE102011012689B4 (de) 2011-03-01 2011-03-01 Verfahren zur Bestimmung der Position eines Objekts in einem Bezugssystem

Publications (2)

Publication Number Publication Date
DE102011012689A1 DE102011012689A1 (de) 2012-09-06
DE102011012689B4 true DE102011012689B4 (de) 2014-09-04

Family

ID=46671298

Family Applications (1)

Application Number Title Priority Date Filing Date
DE102011012689.9A Active DE102011012689B4 (de) 2011-03-01 2011-03-01 Verfahren zur Bestimmung der Position eines Objekts in einem Bezugssystem

Country Status (1)

Country Link
DE (1) DE102011012689B4 (de)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102014219389A1 (de) * 2014-09-25 2016-03-31 Continental Teves Ag & Co. Ohg Koppelnavigation basierend auf Landmarken
DE102022201427A1 (de) 2022-02-11 2023-08-17 Robert Bosch Gesellschaft mit beschränkter Haftung Verfahren zum Bestimmen einer Position und/oder Orientierung eines mobilen Geräts in einer Umgebung
DE102022201421A1 (de) 2022-02-11 2023-08-17 Robert Bosch Gesellschaft mit beschränkter Haftung Verfahren zum Bestimmen einer Position und/oder Orientierung eines mobilen Geräts in einer Umgebung
DE102022118151A1 (de) 2022-07-20 2024-01-25 Bayerische Motoren Werke Aktiengesellschaft Fahrerloses Transportsystem

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5911767A (en) * 1994-10-04 1999-06-15 Garibotto; Giovanni Navigation system for an autonomous mobile robot

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5911767A (en) * 1994-10-04 1999-06-15 Garibotto; Giovanni Navigation system for an autonomous mobile robot

Also Published As

Publication number Publication date
DE102011012689A1 (de) 2012-09-06

Similar Documents

Publication Publication Date Title
EP2002203B1 (de) Verfahren und system zur formmessung einer spiegelnden oberfläche
DE102011000304B4 (de) Kalibrierung von Laser-Lichtschnittsensoren bei gleichzeitiger Messung
DE102004015785B4 (de) Verfahren zur Bestimmung der Abmessung eines Querschnitts eines Flachkabels oder eines Sektorleiters
EP3022145A1 (de) Codierungsvorrichtung sowie positionsbestimmungsvorrichtung und -verfahren
EP2457217B1 (de) Verfahren und vorrichtung zum überwachen eines raumbereichs
DE102016120386A1 (de) Verfahren zum Erkennen von Objekten in einem Lager und Flurförderzeug mit einer Einrichtung zum Erkennen von Objekten in einem Lager
DE102014220313A1 (de) Erfassung von geometrischen Abweichungen einer Bewegungsführung bei einemKoordinatenmessgerät oder einer Werkzeugmaschine
DE102011012689B4 (de) Verfahren zur Bestimmung der Position eines Objekts in einem Bezugssystem
DE10040981A1 (de) Verfahren und Vorrichtung zur Ermittlung der Lage eines Flächen und Kanten aufweisenden Gegenstandes sowie Positioniereinrichtung
DE102016102579A1 (de) Verfahren und Vorrichtung zum Bestimmen einer Vielzahl von Raumkoordinaten an einem Gegenstand
DE10312535B4 (de) Verfahren und Vorrichtung zum geometrischen Vermessen eines Materialbandes
DE102008035480A1 (de) Verfahren zur Vermessung von Körperoberflächen
EP2693403B1 (de) Verfahren zur Prüfung eines zusammenhängenden Bildbereichs auf Fehler im Oberflächenbereich eines Gegenstands
DE102012016106A1 (de) Anordnung und Verfahren zur modellbasierten Kalibration eines Roboters in einem Arbeitsraum
DE19953063A1 (de) Verfahren zur dreidimensionalen optischen Vermessung von Objektoberflächen
DE3100131A1 (de) Verfahren zur bestimmung der form eines risses
EP0479978A1 (de) Verfahren zum ausschneiden eines zuschnitteils
EP1291614A1 (de) Koordinatenmessung mit Geradheits- und Winkelkalibrierung sowie anschliessender Messwertkorrektur
DE102018007643A1 (de) Numerische steuerung
DE102014113977A1 (de) Verfahren zur Bestimmung zumindest eines Parameters bei der dimensionellen Messung mit einer Computertomografiesensorik
DE4225270C2 (de) Verfahren zur Lagebestimmung eines Positionierkörpers relativ zu einem Bezugskörper und Vorrichtung zur Durchführung des Verfahrens
EP3561772B1 (de) Verfahren zur kalibrierung einer zeilenbildaufnahmeeinheit
DE102021201172A1 (de) Kalibrierkörpervorrichtung, Kalibrierkörpersystem und Verfahren zu einer Kalibrierung eines Kamerasystems, eines Tiefensensors und/oder eines Radar-Systems mittels der Kalibrierkörpervorrichtung oder des Kalibrierkörpersystems
DE102020208567A1 (de) Kalibrieren eines Referenzkörpers für die Führungsfehlerermittlung einer Maschinenachse
DE102008024806A1 (de) Verfahren zum Justieren einer Profilbearbeitungsmaschine für die Bearbeitung von Holz oder Holzersatzwerkstoffen im Durchlaufverfahren und Justiersystem

Legal Events

Date Code Title Description
R012 Request for examination validly filed
R016 Response to examination communication
R016 Response to examination communication
R018 Grant decision by examination section/examining division
R020 Patent grant now final