DE102011011932A1 - Navigation system for e.g. position determination of security patrol robot, has ultrasound transmitting stations positioned in surface, where ultrasonic transmission range of station is partially overlapped with that of adjacent station - Google Patents

Navigation system for e.g. position determination of security patrol robot, has ultrasound transmitting stations positioned in surface, where ultrasonic transmission range of station is partially overlapped with that of adjacent station Download PDF

Info

Publication number
DE102011011932A1
DE102011011932A1 DE201110011932 DE102011011932A DE102011011932A1 DE 102011011932 A1 DE102011011932 A1 DE 102011011932A1 DE 201110011932 DE201110011932 DE 201110011932 DE 102011011932 A DE102011011932 A DE 102011011932A DE 102011011932 A1 DE102011011932 A1 DE 102011011932A1
Authority
DE
Germany
Prior art keywords
stations
station
ultrasound
robot
mobile objects
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
DE201110011932
Other languages
German (de)
Inventor
Anmelder Gleich
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.)
Individual
Original Assignee
Individual
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 Individual filed Critical Individual
Priority to DE201110011932 priority Critical patent/DE102011011932A1/en
Publication of DE102011011932A1 publication Critical patent/DE102011011932A1/en
Ceased legal-status Critical Current

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
    • G01S5/00Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/18Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using ultrasonic, sonic, or infrasonic waves
    • G01S5/30Determining absolute distances from a plurality of spaced points of known location
    • 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/04Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
    • 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
    • G01S11/00Systems for determining distance or velocity not using reflection or reradiation
    • G01S11/14Systems for determining distance or velocity not using reflection or reradiation using ultrasonic, sonic, or infrasonic waves

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The system has multiple ultrasound transmitting stations positioned in or near a surface, where a desired number of mobile objects simultaneously moves on the surface. Each of the transmitting stations and the mobile objects are equipped with respective timers, which are synchronized. The mobile objects receive ultrasound transmitted by the transmitting stations, where ultrasonic transmission range of the transmitting station is partially overlapped with the ultrasonic transmission range of the adjacent transmitting station.

Description

Stand der TechnikState of the art

  • 1) In den folgenden Patentschriften werden Vorrichtungen und Verfahren beschrieben um mit Hilfe von Ultraschall die genaue Position eines Roboters zu bestimmen: DE 102004018670 A1 , JP 000005341031 AA , JP 000008054926 AA , JP 000060107580 AA , US 000005440216 A , US 000005491670 A , US 000005646494 A , US 000005682313 A , EP 000001435555 A2 , US 000005652593 A , US 2003/0142587 A1 , US 2009/0073045 A1 1) The following patents describe devices and methods for determining the exact position of a robot by means of ultrasound: DE 102004018670 A1 . JP 000005341031 AA . JP 000008054926 AA . JP 000060107580 AA . US 000005440216 A . US 000005491670 A . US 000005646494 A . US 000005682313 A . EP 000001435555 A2 . US 000005652593 A . US 2003/0142587 A1 . US 2009/0073045 A1

Dabei sind eine oder mehrere feste Stationen, deren Positionen bekannt sind, beschrieben. Diese senden oder empfangen Ultraschall.One or more fixed stations whose positions are known are described. These send or receive ultrasound.

Außerdem wird jeweils ein mobiler Roboter beschrieben, der Ultraschall empfängt oder aussendet. Es werden anhand der Ausbreitungsgeschwindigkeit des Ultraschalls und der gemessenen Zeit zwischen dem Aussenden und dem Empfangen des Ultraschalls die Abstände zwischen der festen Station und dem Roboter berechnet.In addition, each describes a mobile robot that receives or transmits ultrasound. The distances between the fixed station and the robot are calculated on the basis of the propagation speed of the ultrasound and the measured time between the transmission and the reception of the ultrasound.

Aus den ermittelten Abständen des Roboters zu einer oder mehreren festen Stationen können im Roboter die genauen Koordinaten der aktuellen Position und die Fahrtrichtung berechnet werden.From the determined distances of the robot to one or more fixed stations, the exact coordinates of the current position and the direction of travel can be calculated in the robot.

Dabei erkennt der Ultraschall empfangende/sendende Teil den Zeitpunkt der Aussendung des Ultraschalls über ein Funksignal, Lichtsignal, Infrarotsignal oder über ein elektrisches Signal, das mittels Kabel übertragen wird. Im Patent US 2003/0142587 A1 erkennt der Ultraschall empfangende/sendende Teil den Zeitpunkt der Aussendung des Ultraschalls nicht über ein Funksignal sondern ebenfalls über ein Ultraschallsignal.

  • 2) Um eine Überlagerung der Signale bei den in 1) beschriebenen Methoden zu verhindern, muß die Aussendung und der Empfang eines Ultraschallsignals („Abfrage”) für jeden Roboter und jede feste Station nacheinander durchgeführt werden. Nach jeder einzelnen „Abfrage” muß zusätzlich eine Pause folgen, bis das Ultraschallsignal die von dem Roboter zu befahrende Fläche „verlassen” hat bzw. bis die maximale Reichweite der Ultraschallsender erreicht ist. Erst dann kann ein Roboter die nächste Station „abfragen”.
In this case, the ultrasonic receiving / transmitting part detects the time of transmission of the ultrasound via a radio signal, light signal, infrared signal or an electrical signal that is transmitted by cable. In the patent US 2003/0142587 A1 The ultrasound receiving / transmitting part does not recognize the time of transmission of the ultrasound via a radio signal but also via an ultrasound signal.
  • 2) In order to prevent interference of the signals in the methods described in 1), the transmission and reception of an ultrasonic signal ("interrogation") must be performed successively for each robot and each fixed station. After each "interrogation" an additional pause must follow until the ultrasonic signal has "left" the area to be traveled by the robot or until the maximum range of the ultrasound transmitters has been reached. Only then can a robot "poll" the next station.

Die Dauer der Pause nach einer „Abfrage” ist immer auf die maximal zu erwartenden Entfernung im Fahrbereich der Roboter (bzw. die maximale Reichweite der Ultraschallsender wenn die maximale Reichweite kleiner als die maximal zu erwartenden Entfernung im Fahrbereich ist) einzustellen. Wenn mehrere Roboter im Fahrbereich fahren, müssen alle Roboter nacheinander alle Stationen nacheinander „abfragen” und nach jeder „Abfrage” die Pause einhalten.The duration of the pause after a "query" must always be set to the maximum expected distance in the travel range of the robots (or the maximum range of the ultrasonic transmitters if the maximum range is less than the maximum expected distance in the driving range). If several robots travel in the driving range, all robots must consecutively "poll" all stations one after the other and pause after every "interrogation".

Die Anzahl der möglichen Positionsbestimmungen pro Roboter in einem Zeitabschnitt ist in 1) also abhängig von der Anzahl der Roboter, der Anzahl der festen Stationen und der Größe der zu befahrenden Fläche bzw. der Reichweite der Ultraschallsender.The number of possible position determinations per robot in a time period is therefore dependent on the number of robots, the number of fixed stations and the size of the area to be traveled or the range of the ultrasound transmitters in 1).

Der zeitliche Abstand zwischen zwei möglichen Positionsbestimmungen eines sich bewegenden Roboters muß so klein wie möglich sein um eine sichere Navigation zu ermöglichen. Die in 1) beschriebenen Methoden sind also nur sinnvoll, wenn ein Roboter oder wenige Roboter gleichzeitig die beschriebene Navigation nutzen. Wobei die Anzahl der Stationen und die Größe der zu befahrenden Fläche begrenzt sind.The time interval between two possible position determinations of a moving robot must be as small as possible to enable safe navigation. The methods described in 1) are therefore only meaningful if a robot or a few robots use the navigation described at the same time. The number of stations and the size of the area to be traveled are limited.

Die Nachteile der in 1) beschriebenen Methoden sind also:

  • a) Es können nicht beliebig viele Roboter gleichzeitig die Methoden nutzen.
  • b) Die Anzahl der festen Stationen ist begrenzt.
  • c) Die vom Roboter zu befahrende Fläche ist begrenzt.
  • 3) In den Patenten JP 2009139264 A und DE 10350746 A1 ist im Empfänger der Sendezeitpunkt des Ultraschallsignals unbekannt. Die Positionsbestimmung erfolgt durch Auswerten der zeitlichen Differenzen der Empfangszeitpunkte der Ultraschallsignale von mehreren räumlich getrennten Ultraschall-Sende/Empfangsstationen.
  • 4) In den in 3) beschriebene Methoden ist keine zeitliche Synchronisation zwischen den Ultraschall Sendern und Empfängern vorgesehen. Durch die fehlende zeitliche Synchronisation können die absoluten Entfernungen vom Roboter zu den festen Stationen nicht einzeln berechnet werden.
The disadvantages of the methods described in 1) are thus:
  • a) It is not possible for any number of robots to use the methods at the same time.
  • b) The number of fixed stations is limited.
  • c) The area to be traveled by the robot is limited.
  • 3) In the patents JP 2009139264 A and DE 10350746 A1 is unknown in the receiver, the transmission time of the ultrasonic signal. The position is determined by evaluating the time differences of the reception times of the ultrasonic signals of a plurality of spatially separated ultrasonic transmitting / receiving stations.
  • 4) In the methods described in 3) no temporal synchronization between the ultrasonic transmitters and receivers is provided. Due to the lack of time synchronization, the absolute distances from the robot to the fixed stations can not be calculated individually.

Für die Berechnung der Position sind die exakten zeitlichen Abstände aller am Roboter empfangenen Ultraschallsignale wichtig. Dadurch wird die vom Roboter zu befahrende Fläche begrenzt, weil an jedem Punkt an dem der Roboter eine Positionsbestimmung durchführt, die Ultraschallsignale aller festen Stationen für den Roboter empfangbar sein müssen. Somit begrenzt die Ultraschall-Reichweite der festen Stationen die maximal zu befahrende Fläche. Auch wenn die Anzahl der festen Stationen erhöht werden würde, vergrößert das die vom Roboter zu befahrende Fläche nicht wesentlich. Ein Roboter kann nur in der Schnittmenge der Reichweitenbereiche der Ultraschall sendenden Stationen navigieren. For calculating the position, the exact time intervals of all ultrasonic signals received at the robot are important. As a result, the surface to be traveled by the robot is limited, because at each point at which the robot performs a position determination, the ultrasonic signals of all fixed stations must be receivable for the robot. Thus, the ultrasonic range of the fixed stations limits the maximum area to be traveled. Even if the number of fixed stations were increased, this does not significantly increase the area to be traveled by the robot. A robot can only navigate in the intersection of the ranges of the ultrasound transmitting stations.

Die Nachteile der in 3) beschriebenen Methoden sind:The disadvantages of the methods described in 3) are:

  • a) Die vom Roboter zu befahrende Fläche ist begrenzt.a) The area to be traveled by the robot is limited.
  • b) Die Positionen der Ultraschall sendenden Stationen müssen bekannt sein.b) The positions of the ultrasonic transmitting stations must be known.
  • c) Es ist keine Redundanz möglich. Beim Ausfall von Ultraschall sendenden Stationen kann keine Positionsbestimmung mehr durchgeführt werden.c) No redundancy is possible. In the event of failure of stations transmitting ultrasound, position determination can no longer be carried out.
  • d) Die absoluten Entfernungen des Roboters zu den festen Stationen können nicht einzeln berechnet werden.d) The absolute distances of the robot to the fixed stations can not be calculated individually.
  • e) Die Methoden sind kompliziert.e) The methods are complicated.

Beschreibung dieser ErfindungDescription of this invention

Die Erfindung ermöglicht es, dass beliebig viele Roboter gleichzeitig eine Positionsbestimmung auf einer beliebig großen Fläche durchführen können. Wobei Roboter hier nur als ein Beispiel für mobile Objekte angeführt werden.The invention makes it possible for any number of robots to be able to carry out a position determination on an arbitrarily large area at the same time. Whereby robots are mentioned here only as an example for mobile objects.

Dazu werden beliebig viele (mindestens 2) Stationen in oder um eine beliebig große Fläche montiert.For this, any number of (at least 2) stations are mounted in or around an arbitrarily large area.

Die Roboter sind mit einem Microcontroler (oder anderer CPU) mit einem Speicher und timer und einem oder mehreren Ultraschallempfangsgeräten ausgerüstet.The robots are equipped with a microcontroller (or other CPU) with a memory and timer and one or more ultrasound receivers.

Die Stationen sind mit einem Microcontroler (oder anderer CPU) mit einem Speicher und timer und einem Ultraschallsendegerät ausgerüstet. Die Stationen werden durchnumeriert (1, 2, 3, ..., n).The stations are equipped with a microcontroller (or other CPU) with a memory and timer and an ultrasonic transmitter. The stations are numbered consecutively (1, 2, 3, ..., n).

Die Verteilung der Stationen ist beliebig. Die genauen Positionen der Stationen müssen nicht bekannt sein.The distribution of the stations is arbitrary. The exact positions of the stations need not be known.

Die Stationen werden nach den folgenden Bedingungen aufgestellt:

  • – Die Station 1 und 2 werden am Rand oder außerhalb der zu befahrenden Fläche aufgestellt.
  • – Der Abstand der Station 1 zur Station 2 muß bekannt sein.
  • – Der Ultraschall-Reichweitenbereich einer Stationen muß sich mit dem Ultraschall-Reichweitenbereich der angrenzenden Station bzw. den Ultraschall-Reichweitenbereichen der angrenzenden Stationen teilweise überlappen.
The stations are set up according to the following conditions:
  • - Stations 1 and 2 are set up at the edge or outside the area to be traveled.
  • - The distance of the station 1 to the station 2 must be known.
  • The range of ultrasound range of a station must partially overlap with the ultrasound range of the adjacent station or the range of ultrasonic ranges of the adjacent stations.

Der Startpunkt eines Roboters, an dem er die Navigation beginnt, muß sich innerhalb der Schnittmenge der Ultraschall-Reichweitenbereiche der Station 1 und 2 befinden. Außerdem muß sich der Startpunkt innerhalb der zu befahrenden Fläche befinden.The starting point of a robot on which it starts navigation must be within the intersection of the ultrasonic ranges of stations 1 and 2. In addition, the starting point must be within the area to be traveled.

Die timer der Stationen und der Roboter sind exakt synchronisiert. Dazu werden die timer der Roboter und der Stationen am Anfang der Navigation gleichzeitig auf Null gesetzt.The timers of the stations and the robots are exactly synchronized. For this purpose, the timers of the robots and the stations are set to zero at the beginning of the navigation at the same time.

Die Stationen können Ultraschall senden und die Roboter können Ultraschall empfangen (wobei Ultraschall nur als Beispiel für eine langsame Welle wie z. B. auch Schall angeführt wird).The stations can transmit ultrasound and the robots can receive ultrasound (ultrasound being only cited as an example of a slow wave such as sound).

Die Stationen 1 bis n senden der Reihe nach mit einem zeitlichen Abstand jeweils ein Ultraschallsignal. Hat die letzte Station n ein Ultraschallsignal gesendet, ist ein Durchgang beendet und es beginnt wieder Station 1 usw.. In 1 ist der Ablauf eines Durchgangs über der Zeit dargestellt.
td1, td2, td3, ..., tdn sind die Zeiten zwischen Absendung und Empfang eines Ultraschallsignals. tE1, tE2, tE3, ... tEn sind die Zeiten, die vom Start des, zum Ultraschallsignal gehörenden, Durchgangs bis zum Empfang des Ultraschallsignals vergangen ist.
t1 ist die zeitliche Länge eines gesendeten Ultraschallsignals
t2 ist die Pause nach dem Senden eines Ultraschallsignals
Um Überlagerungen der Ultraschallsignale zu verhindern, wird t2 anhand der maximal zu erwartenden Entfernung auf der zu befahrenden Fläche vorgegeben: t2 = maximale Entfernung/vus
Der Maximalwert für t2 ist jedoch begrenzt durch die Reichweite der Ultraschallsender also t2max = Reichweite/Vus
(Vus: Ultraschallgeschwindigkeit)
Z1, Z2, Z3, ..., Zn sind die Zeitintervalle, in denen das jeweilige Ultraschallsignal gesendet und empfangen wird.
Stations 1 to n sequentially transmit an ultrasonic signal at a time interval. If the last station has sent an ultrasonic signal, a passage is finished and it starts again station 1 and so on 1 the sequence of a passage over time is shown.
t d1 , t d2 , t d3 , ..., t dn are the times between transmission and reception of an ultrasonic signal. t E1 , t E2 , t E3 , ... t En are the times that elapsed from the start of the passage belonging to the ultrasonic signal to the reception of the ultrasonic signal.
t 1 is the time length of a transmitted ultrasonic signal
t 2 is the pause after transmitting an ultrasonic signal
In order to prevent superimposition of the ultrasonic signals, t 2 is given based on the maximum expected distance on the surface to be traveled: t 2 = maximum distance / v us
However, the maximum value for t 2 is limited by the range of the ultrasonic transmitter so t 2max = range / V us
(V us : ultrasonic speed)
Z 1 , Z 2 , Z 3 , ..., Z n are the time intervals in which the respective ultrasonic signal is transmitted and received.

Im Speicher jedes Roboters werden die folgenden Konstanten vorab eingespeichert: Die Anzahl der festen Stationen n, die Zeiten t1 und t2 und der Abstand As zwischen den Stationen 1 und 2.The following constants are stored in advance in the memory of each robot: the number of fixed stations n, the times t 1 and t 2 and the distance A s between the stations 1 and 2.

Im Speicher jeder Station werden die folgenden Konstanten vorab eingespeichert: Die Anzahl der festen Stationen n und die Zeiten t1 und t2 The following constants are stored in advance in the memory of each station: the number of fixed stations n and the times t 1 and t 2

Die Roboter empfangen die Ultraschallsignale. Wird vom Roboter ein Ultraschallsignal empfangen, wird die Empfangszeit mit Hilfe des timers registriert und abgespeichert. Die Empfangszeit ist die Zeit, die von der Synchronisation des timers bis zum Empfang des Ultraschallsignal vergangen ist.The robots receive the ultrasonic signals. If an ultrasonic signal is received by the robot, the reception time is registered and saved with the help of the timer. The reception time is the time that elapsed from the synchronization of the timer to the reception of the ultrasonic signal.

Anhand der Empfangszeit können die Roboter die Stationsnummer m der sendenden Station wie folgt berechnen: tEm = Empfangszeit – (L(Empfangszeit/(n·(t1 + t2)))⌋·(n·(t1 + t2))) m = L(tEm/(t1 + t2))⌋ + 1 (Hinweis: L ...⌋ ist eine Gaußklammer)Based on the reception time, the robots can calculate the station number m of the transmitting station as follows: t Em = reception time - (L (reception time / (n * (t 1 + t 2 ))) ⌋ * (n * (t 1 + t 2 ))) m = L (t Em / (t 1 + t 2 )) ⌋ + 1 (Note: L ... ⌋ is a Gaussian bracket)

Der Abstand Am des Roboters zur Station mit der Nummer m kann mit der Ultraschallgeschwindigkeit vus wie folgt berechnet werden: tdm = tEm – ((m – 1)·(t1 + t2)) Am = tdm·vus The distance Am of the robot to the station numbered m can be calculated with the ultrasonic velocity v us as follows: t dm = t Em - ((m-1) * (t 1 + t 2 )) A m = t dm · v us

Empfängt der Roboter im Zeitintervall Zm kein Ultraschallsignal, befindet er sich außerhalb der Reichweite der Station m und Am wird als ungültig markiert.If the robot does not receive an ultrasonic signal in the time interval Z m , it is out of range of the station m and A m is marked as invalid.

Die Abstände A1 bis An werden nach Ablauf eines Durchgangs im Speicher der Roboters gespeichert.The distances A 1 to A n are stored after a passage in the memory of the robot.

Da sich der Startpunkt eines Roboters, an dem er die Navigation beginnt, immer innerhalb der Schnittmenge der Ultraschall-Reichweitenbereiche der Station 1 und 2 befindet, kann die Navigation wie folgt starten:

  • – Für die Navigation wird ein angenommenes Koordinatenkreuz so gelegt, das Station 1 im Nullpunkt und Station 2 auf der y-Achse liegt.
  • – Der Abstand As zwischen Station 1 und 2 ist vorab als Konstante im Roboter abgespeichert worden.
  • – Nach dem ersten Durchlauf sind mindestens die Abstände A1 und A2 bekannt.
  • – Somit erhält man ein Dreieck wie in 3 gezeigt. (P: Position des Roboters, S1: Station 1, S2: Station 2, h: Höhe des gezeichneten Dreiecks)
  • – Die Höhe h kann vom Roboter mit einer Trigonometrischen Funktion berechnet werden:
    Figure 00060001
Since the starting point of a robot on which it starts the navigation is always within the intersection of the ultrasonic ranges of the stations 1 and 2, the navigation can start as follows:
  • - For navigation, an assumed coordinate system is placed so that station 1 is at zero and station 2 is on the y-axis.
  • - The distance A s between station 1 and 2 has been previously stored as a constant in the robot.
  • After the first pass, at least the distances A 1 and A 2 are known.
  • - Thus one gets a triangle like in 3 shown. (P: position of the robot, S1: station 1, S2: station 2, h: height of the drawn triangle)
  • - The height h can be calculated by the robot with a trigonometric function:
    Figure 00060001

Die xy-Koordinaten der Position des Roboters können wie folgt berechnet werden: x = h y = √A₁²-h² The xy coordinates of the position of the robot can be calculated as follows: x = h y = √ A₁²-h²

In der 2 sind als Beispiel 9 Stationen beliebig verteilt worden. S1 bis S9 stellen die Standorte der Stationen dar. Die Kreise begrenzen die Ultraschall-Reichweitenbereiche der einzelnen Stationen. Die Anzahl der Stationen kann beliebig erhöht werden. Somit kann die zu befahrende Fläche beliebig erhöht werden. Die einzige Bedingung für die Positionierung der Stationen 3 bis n ist die teilweise Überlappung der Reichweitenbereiche mit den benachbarten Stationen.In the 2 have been distributed as example 9 stations. S1 to S9 represent the locations of the stations. The circles limit the ultrasonic range of the individual stations. The number of stations can be increased as required. Thus, the area to be traveled can be increased as desired. The the only condition for the positioning of the stations 3 to n is the partial overlapping of the coverage areas with the neighboring stations.

Ein Roboter kann überall dort navigieren, wo er die Ultraschallsignale von mindestens 2 Stationen, deren xy-Position bekannt ist, empfangen kann. Mit mindestens zwei berechneten Abständen Am1, Am2 und den xy-Positionen der sendenden Stationen Sm1 und Sm2 kann die xy-Position des Roboters PRx, PRy nach der allgemein bekannten Formel für die Berechnung der Schnittpunkte zweier Kreise berechnet werden: Kreis 1: (x – Sm1x)2 + (y – Sm1y)2 = Am1 2 Kreis 2: (x – Sm2x)2 + (y – Sm2y)2 = Am2 2 A robot can navigate anywhere where it can receive the ultrasound signals from at least 2 stations whose xy position is known. With at least two calculated distances A m1 , A m2 and the xy positions of the transmitting stations S m1 and S m2 , the xy position of the robot P Rx , P Ry can be calculated according to the generally known formula for calculating the intersections of two circles: Circle 1: (x - S m1x ) 2 + (y - S m1y ) 2 = A m1 2 Circle 2: (x - S m2x ) 2 + (y - S m2y ) 2 = A m2 2

Die Schnittpunkte liegen auf der Geraden y = mx + n
wobei m = (Sm1x – Sm2x)/(Sm2y – Sm1y) n = (–Am2 2 + Am1 2 + Sm2y 2 – Sm1y 2 + Sm2x 2 – Sm1x 2)/(2(Sm2y – Sm1y))
The intersections lie on the line y = mx + n
in which m = (S m1x -S m2x ) / (S m2y -S m1y ) n = (-A m2 2 + A m1 2 + S m2y 2 - S m1y 2 + S m2x 2 - S m1x 2 ) / (2 (S m2y - S m1y ))

Mit der p-q-Formel werden die xy-Koordinaten berechnet: p = (2(–Sm1x + m(n – Sm1y)))/(1 + m2) q = (Sm1x 2 +(n – Sm1y)2 – Am1 2)/(1 + m2) The pq formula calculates xy coordinates: p = (2 (-S m1x + m (n - S m1y))) / (1 + m 2) q = (S m1x 2 + (n-S m1y ) 2 -A m1 2 ) / (1 + m 2 )

Zwei Positionen sind möglich: PRx1 = –(p/2) + (p/2)2 – q PRy1 = mPRx1 + n und PRx2 = –(p/2) – √(p/2)² – q PRy2 = mPRx2 + n Two positions are possible: P Rx1 = - (p / 2) + (p / 2) 2 - q P Ry1 = mP Rx1 + n and P Rx2 = - (p / 2) - √ (p / 2) ² - q P Ry2 = mP Rx2 + n

Die Position des Roboters wird dann anhand der im Roboter bekannten Fahrtgeschwindigkeit und der Zeit die der Roboter für den Weg von der letzten Position nach PR benötigt hat, ausgewählt.The position of the robot is then selected based on the travel speed known in the robot and the time it took the robot to travel from the last position to PR.

In 4 werden z. B. Station 1, 2 und 6 dargestellt. Die dünnen Kreise stellen die von P2 aus gemessenen Abstände A2 und A6 dar. Der Roboter ist zu diesem Zeitpunkt von P1 nach P2 gefahren. Der Ort P2 soll außerhalb der Ultraschall-Reichweite der Station 1 (also A1 ist unbekannt) liegen. Anhand der im Roboter bekannten Fahrtgeschwindigkeit und der Zeit die der Roboter für den Weg von P1 nach P2 benötigt hat, kann der Roboter die maximal mögliche Entfernung von P1 berechnen (breiter Kreis). Somit ist die Positionsbestimmung mit nur zwei gemessenen Abständen A1 und A6 eindeutig. (Wenn die Fahrgeschwindigkeit so hoch ist, dass die Positionsbestimmung nicht mehr eindeutig ist, ist die Genauigkeit durch andere Faktoren bereits so gering, dass die nicht eindeutige Bestimmung unerheblich ist)In 4 be z. B. Station 1, 2 and 6 shown. The thin circles represent the distances A 2 and A 6 measured from P 2. The robot has moved from P 1 to P 2 at this time. The location P 2 should be outside the ultrasonic range of station 1 (ie A 1 is unknown). Based on the speed of travel known in the robot and the time it took the robot to travel from P 1 to P 2 , the robot can calculate the maximum possible distance from P 1 (wide circle). Thus, the position determination with only two measured distances A 1 and A 6 is unique. (If the driving speed is so high that the position determination is no longer clear, the accuracy is already so low by other factors that the ambiguous determination is irrelevant)

Wenn die xy-Positionen der Stationen 3 bis n vorab bekannt sind, können sie vorab in den Robotern abgespeichert werden und die Roboter können sofort in den Bereichen, in denen er die Ultraschallsignale von mindestens 2 Stationen empfängt navigieren.If the xy positions of the stations 3 to n are known in advance, they can be stored in advance in the robots and the robots can immediately navigate in the areas where he receives the ultrasound signals from at least 2 stations.

Wenn die xy-Positionen der Stationen 3 bis n vorab nicht bekannt sind, kann jeder Roboter die xy-Positionen der Stationen 3 bis n selbst wie folgt ausmessen und dann abspeichern:
Da sich die Ultraschallreichweiten-Bereiche der Stationen immer teilweise überlappen, kann ein Roboter die xy-Position einer Station deren xy-Position unbekannt ist berechnen. Dazu muß er in einem Bereich fahren in dem er die Ultraschallsignale empfangen kann von:

  • a) Mindestens 2 Stationen mit bekannter xy-Position
  • b) Mindestens 1 Station mit unbekannter xy-Position
If the xy positions of the stations 3 to n are not known in advance, each robot can measure the xy positions of the stations 3 to n themselves as follows and then store:
Since the ultrasonic ranges of the stations always partially overlap, a robot can calculate the xy position of a station whose xy position is unknown. For this he must drive in an area where he can receive the ultrasonic signals from:
  • a) At least 2 stations with known xy position
  • b) At least 1 station with unknown xy position

5 zeit als Beispiel eine Fläche mit den Stationen S1, S2, S3, S4 und S5. Die Kreise zeigen die jeweiligen Ultraschallreichweiten-Bereiche der Stationen an. Ein Roboter startet die Fahrt am Punkt Pstart und fährt auf der eingetragenen Strecke. Die xy-Positionen der Stationen S3, S4 und S5 sind beim Start unbekannt. An den Punkten P1, P2 und P3 kann der Roboter die xy-Positionen der Punkte P1, P2 und P3 mit S1 und S2 berechnen und gleichzeitig jeweils die Abstände A3P1, A3P2 und A3P3 der Punkte zur Station 3. 5 time as an example an area with the stations S 1 , S 2 , S 3 , S 4 and S 5 . The circles indicate the respective ultrasonic range of the stations. A robot starts the journey at point P start and travels on the entered route. The xy positions of stations S 3 , S 4 and S 5 are unknown at startup. At the points P 1 , P 2 and P 3 , the robot can calculate the xy positions of the points P 1 , P 2 and P 3 with S 1 and S 2 and at the same time the distances A 3P1 , A 3P2 and A 3P3 of the points to the station 3.

Mit den beiden Kreisgleichungen Kreis 1: (x – P1x)2 + (y – P1y)2 = A3P1 2 Kreis 2: (x – P2x)2 + (y – P2y) – A3P 2 können mit der oben bereits gezeigten allgemein bekannten Formel für die Berechnung der Schnittpunkte zweier Kreise die Koordinaten der Schnittpunkte der beiden Kreise berechnet werden. Mit A3P3 wird dann der gültige Schnittpunkt durch Vergleich mit der Entfernung der Schnittpunkte zum Roboter bestimmt. Die Koordinaten dieses Schnittpunktes werden dann als Positionskoordinaten der Station S3 im Speicher des Roboters abgespeichert.With the two circle equations Circle 1: (x - P 1x ) 2 + (y - P 1y ) 2 = A 3P1 2 Circle 2: (x - P 2x ) 2 + (y - P 2y ) - A 3P 2 For example, with the well-known formula shown above for calculating the intersections of two circles, the coordinates of the intersections of the two circles can be calculated. With A 3P3 the valid intersection is then determined by comparison with the distance of the intersections to the robot. The coordinates of this intersection are then stored as position coordinates of the station S 3 in the memory of the robot.

An den Punkten P4, P5 und P6 kann der Roboter die xy-Positionen der Punkte P4, P5 und P6 mit S2 und S3 berechnen und gleichzeitig jeweils die Abstände A4P4, A4P5 und A4P6 der Punkte zur Station 4.At the points P 4 , P 5 and P 6 , the robot can calculate the xy positions of the points P 4 , P 5 and P 6 with S 2 and S 3 and at the same time the distances A 4P4 , A 4P5 and A 4P6 of the points to station 4.

Mit den beiden Kreisgleichungen Kreis 1: (x – P4x)2 + (y – P4y)2 = A4P4 2 Kreis 2: (x – P5x)2 + (y – P5y)2 = A4P5 2 können mit der oben bereits gezeigten allgemein bekannten Formel für die Berechnung der Schnittpunkte zweier Kreise die Koordinaten der Schnittpunkte der beiden Kreise berechnet werden. Mit A4P6 wird dann der gültige Schnittpunkt durch Vergleich mit der Entfernung der Schnittpunkte zum Roboter bestimmt. Die Koordinaten dieses Schnittpunktes werden dann als Positionskoordinaten der Station S4 im Speicher des Roboters abgespeichert.
u. s. w.
With the two circle equations Circle 1: (x - P 4x) 2 + (y - P 4y) 2 = A 2 4P4 Circle 2: (x - P 5x ) 2 + (y - P 5y ) 2 = A 4P5 2 For example, with the well-known formula shown above for calculating the intersections of two circles, the coordinates of the intersections of the two circles can be calculated. With A 4P6 the valid intersection is then determined by comparison with the distance of the intersections to the robot. The coordinates of this intersection are then stored as position coordinates of the station S 4 in the memory of the robot.
etc

Also jedesmal wenn der Roboter in den Ultraschallreichweiten-Bereich einer Station deren xy-Position unbekannt ist einfährt, kann er in dem Bereich in dem noch Ultraschallsignale von mindestens 2 Stationen zu empfangen sind, deren xy-Positionen schon bekannt sind die xy-Position der neuen Station berechnen und dann abspeichern.Thus, each time the robot enters the ultrasound range of a station whose xy position is unknown, it can be received in the area where ultrasound signals from at least 2 stations whose xy positions are already known are the xy position of the new one Calculate station and then save.

Wenn ein Roboter mehr als 2 Ultraschallsignale von Stationen deren xy-Positionen bekannt sind empfangen kann, können durch redundante Berechnungen der xy-Position des Roboters Plausibilitätsprüfungen durchgeführt werden um z. B. defekte Stationen oder gestörte Ultraschallsignale zu erkennen.If a robot can receive more than 2 ultrasonic signals from stations whose xy positions are known, plausibility checks can be carried out by redundant calculations of the xy position of the robot. B. detect defective stations or disturbed ultrasonic signals.

Da beliebig viele Roboter gleichzeitig eine Positionsbestimmung durchführen können, ist es problemlos möglich, mehrere Positionsbestimmungen an verschiedenen Stellen eines Roboters durchzuführen. Wird z. B. am Bug und am Heck des Roboters jeweils gleichzeitig eine Positionsbestimmung durchgeführt, kann der Roboter anhand der Positionsdifferenzen die aktuelle Fahrtrichtung des Roboters im Koordinatenkreuz berechnen.Since any number of robots can perform a position determination at the same time, it is easily possible to carry out several position determinations at different points of a robot. If z. B. at the bow and at the rear of the robot at the same time carried out a position determination, the robot can calculate the current direction of travel of the robot in the coordinate system based on the position differences.

Das anfängliche Synchronisieren der timer in den Stationen und den Robotern kann durch eine temporäre Kabelverbindung mit einer externen Uhr erfolgen oder durch eine temporäre Kabelverbindung untereinander wobei dann alle timer, durch ein elektrisches Signal in der Kabelverbindung, auf Null gestellt werden. Nach der Synchronisierung wird die Kabelverbindung wieder entfernt. Möglich wäre auch eine Synchronisierung durch ein externes Funk-, IR- oder Lichtsignal o. Ä. (wobei die Stationen und die Roboter mit einem zusätzlichen Empfangsgerät für Funk, IR oder Licht ausgerüstet werden müssen) oder durch das DCF77(PZF) Signal (wobei die Stationen und die Roboter mit einem zusätzlichen Empfangsgerät für das DCF77(PZF) Signal ausgerüstet werden müssen).The initial synchronization of the timers in the stations and the robots can be done by a temporary cable connection to an external clock or by a temporary cable connection with each other then all the timers are reset by an electrical signal in the cable connection. After synchronization, the cable connection is removed. It would also be possible sync by an external radio, IR or light signal o. Ä. (where the stations and the robots must be equipped with an additional receiver for radio, IR or light) or by the DCF77 (PZF) signal (where the stations and the robots must be equipped with an additional receiver for the DCF77 (PZF) signal ).

Die Erfindung kann durch Einführung einer z-Achse in das xy-Koordinatensystem analog im dreidimensionalen Raum angewendet werden. Die Stationen werden dann in oder um den dreidimensionalen Raum montiert. Die Roboter können sich im Raum bewegen. The invention can be applied analogously in three-dimensional space by introducing a z-axis into the xy-coordinate system. The stations are then mounted in or around the three-dimensional space. The robots can move in space.

Die besonderen Vorteile dieser Erfindung

  • – Beliebig viele Roboter können gleichzeitig eine Positionsbestimmung auf einer Fläche durchführen. (wobei Roboter hier nur als ein Beispiel für mobile Objekte angeführt werden)
  • – Der zeitliche Abstand zwischen den Positionsbestimmungen der Roboter kann optimal minimiert werden und ist unabhängig von der Anzahl der Roboter.
  • – Die Anzahl der Stationen kann beliebig erhöht werden.
  • – Die Größe der zu befahrenden Fläche kann beliebig erhöht werden.
  • – Eine Positionsbestimmung ist auch noch möglich wenn eine oder mehrere Stationen ausgefallen sind. (hohe Ausfallsicherheit)
  • – Jeder Roboter kann zusätzlich zur aktuellen xy-Position auch die aktuelle Fahrtrichtung des Roboters im Koordinatenkreuz berechnen.
  • – Geringe Hardwarekosten
  • – Die Navigation ist indoor und outdoor einsetzbar
  • – Die Navigation ist in der zu befahrenden Fläche wesentlich genauer als z. B. die Navigation mit GPS.
  • – Da beliebig viele Roboter auf der Fläche gleichzeitig fahren können, können Aufgaben auf mehrere Roboter verteilt werden.
  • – Da die Roboter die xy-Positionen von Stationen deren Positionen unbekannt sind, selbst berechnen können, sind die Roboter in der Lage bei Bedarf die Fläche in der sie navigieren können, selbständig zu vergrößern indem Sie mit geführte neue Stationen ablegen oder über die Grenze der Fläche katapultieren.
The particular advantages of this invention
  • - Any number of robots can simultaneously perform a position determination on a surface. (where robots are cited here only as an example of mobile objects)
  • - The time interval between the position determinations of the robots can be optimally minimized and is independent of the number of robots.
  • - The number of stations can be increased as required.
  • - The size of the surface to be traveled can be increased as desired.
  • - A position determination is still possible if one or more stations have failed. (high reliability)
  • - In addition to the current xy position, each robot can also calculate the current direction of travel of the robot in the coordinate system.
  • - Low hardware costs
  • - The navigation can be used indoor and outdoor
  • - The navigation is much more accurate in the area to be traveled than z. B. the navigation with GPS.
  • - Since as many robots as possible can drive on the surface at the same time, tasks can be distributed to several robots.
  • Since the robots are able to calculate the xy positions of stations whose positions are unknown, the robots are able to independently enlarge the area in which they can navigate by dropping them with guided new stations or crossing the border of the Catapult the surface.

Anwendungen dieser ErfindungApplications of this invention

Es können von den Robotern „angelernte” Strecken in der zu befahrenden Fläche im Speicher abgespeichert werden. Dabei werden die xy-Positionsdaten während einer z. B. vom Menschen gesteuerten Fahrt gespeichert. Die abgespeicherten Strecken können dann vom Roboter automatisch wieder abgefahren werden. So können die Roboter z. B. als „Security”-Roboter Patrouillen selbständig abfahren.It can be stored by the robots "trained" routes in the area to be traveled in the memory. The xy position data during a z. B. man-driven ride stored. The saved routes can then be automatically re-started by the robot. So the robot z. B. leave as a "security" robots patrols independently.

Um ein exaktes Abfahren der gespeicherten Strecken zu gewährleisten ist es wichtig, dass die Positionen der Stationen 1 und 2 nicht verändert werden bzw. genau wiederhergestellt werden.In order to guarantee a precise departure of the stored routes, it is important that the positions of stations 1 and 2 are not changed or exactly restored.

Die Positionen der Stationen 1 und 2 sollten auf der Fläche markiert werden (z. B. mit Farbpunkten) um eine Wiederholbarkeit von gespeicherten Fahrwegen zu gewährleisten.The positions of stations 1 and 2 should be marked on the surface (eg with colored dots) to ensure repeatability of stored driveways.

Andererseits kann dem Roboter die abzufahrende Strecke vorab eingespeichert werden. So kann ein Roboter z. B. als Präzisionsrasenmäher filigrane Muster in große Rasenflächen mähen.On the other hand, the route to be traveled to the robot can be stored in advance. So a robot z. For example, as a precision lawnmower mowing filigree patterns in large lawns.

Das Abfahren von xy-Positionsdaten einer gespeicherten Strecke könnte wie folgt ablaufen:

  • – Am Startpunkt stellt der Roboter seine xy-Position und die Fahrtrichtung im Koordinatenkreuz fest.
  • – Anhand der festgestellten xy-Position und momentanen Fahrtrichtung des Roboters und der xy-Koordinaten des ersten Wegpunktes, wird der einzustellende Winkel der Lenkung des Roboters bestimmt. Der Roboter fährt los.
  • – Während der Fahrt werden laufend die xy-Position und die Fahrtrichtung des Roboters berechnet und die Lenkung entsprechend neu eingestellt, bis die xy-Position des ersten Punktes erreicht ist.
  • – Nach dem Erreichen des Punktes wird anhand der aktuellen xy-Position und momentanen Fahrtrichtung des Roboters und der xy-Koordinaten des nächsten Wegpunktes wieder der einzustellende Winkel der Lenkung des Roboters bestimmt. Der Roboter fährt weiter.
  • – Während der Fahrt werden laufend die xy-Position und die Fahrtrichtung des Roboters berechnet und die Lenkung entsprechend neu eingestellt, bis die xy-Position des nächsten Punktes erreicht ist.
u. s. w.The departure of xy position data of a stored route could proceed as follows:
  • - At the starting point, the robot determines its xy position and the direction of travel in the coordinate system.
  • - Based on the determined xy position and current direction of travel of the robot and the xy coordinates of the first waypoint, the set angle of the steering of the robot is determined. The robot starts.
  • - While driving, the xy position and the direction of travel of the robot are continuously calculated and the steering adjusted accordingly until the xy position of the first point is reached.
  • - After reaching the point, the robot's steering angle to be set is determined based on the current xy position and current direction of travel of the robot and the xy coordinates of the next waypoint. The robot continues.
  • - While driving, the xy position and the direction of travel of the robot are continuously calculated and the steering adjusted accordingly until the xy position of the next point is reached.
etc

ZITATE ENTHALTEN IN DER BESCHREIBUNG QUOTES INCLUDE IN THE DESCRIPTION

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.This list of the documents listed by the applicant has been generated automatically and is included solely for the better information of the reader. The list is not part of the German patent or utility model application. The DPMA assumes no liability for any errors or omissions.

Zitierte PatentliteraturCited patent literature

  • DE 102004018670 A1 [0001] DE 102004018670 A1 [0001]
  • JP 000005341031 AA [0001] JP 000005341031 AA [0001]
  • JP 000008054926 [0001] JP000008054926 [0001]
  • JP 000060107582 AA [0001] JP 000060107582 AA [0001]
  • US 000005440216 A [0001] US 000005440216 A [0001]
  • US 000005491670 A [0001] US 000005491670 A [0001]
  • US 000005646494 A [0001] US 000005646494 A [0001]
  • US 000005682313 A [0001] US 000005682313 A [0001]
  • EP 000001435555 A2 [0001] EP 000001435555 A2 [0001]
  • US 000005652593 A [0001] US 000005652593 A [0001]
  • US 2003/0142587 A1 [0001, 0005] US 2003/0142587 A1 [0001, 0005]
  • US 2009/0073045 A1 [0001] US 2009/0073045 A1 [0001]
  • JP 2009139264 A [0009] JP 2009139264A [0009]
  • DE 10350746 A1 [0009] DE 10350746 A1 [0009]

Claims (10)

Navigationssystem zur Positions- und Richtungsbestimmung von mobilen Objekten insbesondere von mobilen Robotern die sich auf einer Fläche bewegen gekennzeichnet durch folgende Merkmale: – Beliebig viele mindestens jedoch zwei durchnumerierte Stationen sind in oder um die Fläche positioniert – Die Stationen sind jeweils mit einer CPU, einem Speicher, einem timer und einem Sendegerät für Ultraschall ausgerüstet – Beliebig viele mobile Objekte bewegen sich gleichzeitig auf der Fläche – Die mobilen Objekte sind jeweils mit einer CPU, einem Speicher, einem timer und mindestens einem Empfangsgerät für Ultraschall ausgerüstet – Die timer der Stationen und der mobilen Objekte sind synchronisiert – Die Stationen können Ultraschall senden – Die mobilen Objekte können Ultraschall empfangen – Die Größe der Fläche ist beliebig – Die Stationen 1 und 2 sind am Rand oder außerhalb der Fläche mit einem bekannten Abstand positioniert – Die Verteilung der Stationen 3 bis n in der Fläche ist beliebig – Die Ultraschallsendereichweiten-Bereiche der Stationen überlappen die Ultraschallsendereichweiten-Bereiche der jeweils benachbarten Stationen teilweiseNavigation system for determining the position and direction of mobile objects, in particular of mobile robots moving on a surface, characterized by the following features: Any number but at least two numbered stations are positioned in or around the surface - The stations are each equipped with a CPU, a memory, a timer and a transmitter for ultrasound - Any number of mobile objects move simultaneously on the surface - The mobile objects are each equipped with a CPU, a memory, a timer and at least one receiver for ultrasound - The timers of the stations and the mobile objects are synchronized - The stations can send ultrasound - The mobile objects can receive ultrasound - The size of the area is arbitrary Stations 1 and 2 are positioned at the edge or outside the surface at a known distance - The distribution of stations 3 to n in the area is arbitrary The ultrasound transmission range of the stations partially overlaps the ultrasound transmission range of the adjacent stations System nach Anspruch 1 dadurch gekennzeichnet, dass die Positionen der Stationen 3 bis n in der Fläche nicht bekannt sein müssenSystem according to claim 1, characterized in that the positions of the stations 3 to n in the area need not be known System nach Anspruch 1 dadurch gekennzeichnet, dass – die Stationen 1 bis n der Reihe nach mit einem definierten zeitlichen Abstand jeweils ein Ultraschallsignal mit einer definierten zeitlichen Länge senden – sobald die letzte Station n ein Ultraschallsignal gesendet hat, die Station 1 wieder anfängtSystem according to claim 1, characterized in that - The stations 1 to n in turn with a defined time interval in each case send an ultrasonic signal with a defined time length - as soon as the last station n has sent an ultrasonic signal, the station 1 starts again System nach Anspruch 1 dadurch gekennzeichnet, dass – alle mobilen Objekte das von einer Station gesendete Ultraschallsignal empfangen wenn sie sich in dem Ultraschallsendereichweiten-Bereiche der Station befinden. – die mobilen Objekte den Empfangszeitpunkt des Ultraschallsignals mit Hilfe des timers registrieren und speichern – die das Ultraschallsignal absendende Station von den mobilen Objekten anhand des Empfangszeitpunktes identifiziert wird. – der Zeitpunkt der Absendung des Ultraschallsignals anhand der Nummer der identifizierten Station ermittelt wird. – der Abstand des mobilen Objektes zur absendenden Station mit der zeitlichen Differenz von Absendezeitpunkt und Empfangszeitpunkt, und der Ausbreitungsgeschwindigkeit des Ultraschalls berechnet wird.System according to claim 1, characterized in that All mobile objects receive the ultrasound signal transmitted by a station when they are in the ultrasound range areas of the station. - The mobile objects register and store the time of reception of the ultrasound signal using the timer - The ultrasound signal sending station is identified by the mobile objects based on the time of reception. - The time of transmission of the ultrasonic signal is determined by the number of the identified station. - The distance of the mobile object to the transmitting station with the time difference between the sending time and the receiving time, and the propagation speed of the ultrasound is calculated. System nach Anspruch 1 dadurch gekennzeichnet, dass – die Positionen der Stationen 3 bis n, falls bekannt, vor dem Start der Navigation in den Speichern der mobilen Objekte gespeichert werden. – die Positionen von Stationen deren Positionen vor dem Start der Navigation nicht bekannt waren, von den mobilen Objekten während der Fahrt gemessen, berechnet und im Speicher gespeichert werden.System according to claim 1, characterized in that The positions of the stations 3 to n, if known, are stored in the memories of the mobile objects prior to the start of the navigation. - The positions of stations whose positions were not known before the start of the navigation, measured by the mobile objects while driving, calculated and stored in memory. System nach Anspruch 1 dadurch gekennzeichnet, dass – auf dem mobilen Objekt zwei oder mehrere Ultraschallempfangsgeräte montiert werden können, wobei die Geräte in möglichst großem Abstand zueinander montiert werden sollten. – mit den Unterschieden der, mit den Ultraschallempfangsgeräten, gemessenen Positionen die aktuelle Fahrtrichtung ermittelt werden kann.System according to claim 1, characterized in that - Two or more ultrasound receiving devices can be mounted on the mobile object, whereby the devices should be mounted as far apart as possible. - With the differences of, with the ultrasonic receiving devices, measured positions, the current direction of travel can be determined. System nach Anspruch 1 dadurch gekennzeichnet, dass jedes mobile Objekt in der Fläche überall dort die eigene aktuelle Position und Fahrtrichtung berechnen kann, wo es die Abstände zu mindestens 2 Stationen, deren Positionen im Speicher des mobilen Objektes abgespeichert sind, ermitteln kann.System according to claim 1, characterized in that each mobile object in the area anywhere there can calculate its own current position and direction, where it can determine the distances to at least two stations whose positions are stored in the memory of the mobile object. System nach Anspruch 1 dadurch gekennzeichnet, dass durch Plausibilitätsrechnungen fehlerhafte Stationen erkannt werden können wenn die Abstände zu mehr als 2 Stationen, deren Positionen im Speicher des mobilen Objektes abgespeichert sind, ermittelt wurden. System according to claim 1, characterized in that faulty stations can be detected by plausibility calculations when the distances to more than two stations whose positions are stored in the memory of the mobile object, were determined. System nach Anspruch 1 dadurch gekennzeichnet, dass die mobilen Objekte bei Bedarf die Fläche auf der eine Navigation möglich ist, selbständig erweitern können.System according to claim 1, characterized in that the mobile objects, if necessary, the area on which a navigation is possible to expand independently. System nach Anspruch 1 dadurch gekennzeichnet, dass auch beim Ausfall einer oder mehrerer Stationen eine Navigation noch möglich ist.System according to claim 1, characterized in that even if one or more stations a navigation is still possible.
DE201110011932 2010-02-18 2011-02-18 Navigation system for e.g. position determination of security patrol robot, has ultrasound transmitting stations positioned in surface, where ultrasonic transmission range of station is partially overlapped with that of adjacent station Ceased DE102011011932A1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
DE201110011932 DE102011011932A1 (en) 2010-02-18 2011-02-18 Navigation system for e.g. position determination of security patrol robot, has ultrasound transmitting stations positioned in surface, where ultrasonic transmission range of station is partially overlapped with that of adjacent station

Applications Claiming Priority (7)

Application Number Priority Date Filing Date Title
DE102010008637.1 2010-02-18
DE102010008637 2010-02-18
DE102010014626.9 2010-04-12
DE102010014626 2010-04-12
DE102010025299.9 2010-06-28
DE102010025299 2010-06-28
DE201110011932 DE102011011932A1 (en) 2010-02-18 2011-02-18 Navigation system for e.g. position determination of security patrol robot, has ultrasound transmitting stations positioned in surface, where ultrasonic transmission range of station is partially overlapped with that of adjacent station

Publications (1)

Publication Number Publication Date
DE102011011932A1 true DE102011011932A1 (en) 2012-03-15

Family

ID=45756201

Family Applications (1)

Application Number Title Priority Date Filing Date
DE201110011932 Ceased DE102011011932A1 (en) 2010-02-18 2011-02-18 Navigation system for e.g. position determination of security patrol robot, has ultrasound transmitting stations positioned in surface, where ultrasonic transmission range of station is partially overlapped with that of adjacent station

Country Status (1)

Country Link
DE (1) DE102011011932A1 (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE202016008129U1 (en) 2016-02-09 2017-04-26 Universität Stuttgart Körperschaft des öffentlichen Rechts Device for determining the three-dimensional pose of rigid bodies using opto-acoustic code division multiplexing and carrier phase distance measurements
CN110573899A (en) * 2017-03-07 2019-12-13 索尼特技术公司 ultrasound position determination system
CN113473357A (en) * 2021-06-15 2021-10-01 深圳优地科技有限公司 Auxiliary positioning method, device, equipment and storage medium

Citations (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS60107582A (en) 1983-11-16 1985-06-13 Nec Corp Dynamic range compressing circuit
JPH05341031A (en) 1992-06-08 1993-12-24 Isao Murakami Position sensing device
US5440216A (en) 1993-06-08 1995-08-08 Samsung Electronics Co., Ltd. Robot cleaner
US5491670A (en) 1993-01-21 1996-02-13 Weber; T. Jerome System and method for sonic positioning
JPH0854926A (en) 1994-08-08 1996-02-27 Toshiba Corp Guidance device for autonomous mobile robot
US5646494A (en) 1994-03-29 1997-07-08 Samsung Electronics Co., Ltd. Charge induction apparatus of robot cleaner and method thereof
US5652593A (en) 1994-09-29 1997-07-29 Von Schrader Company Method and apparatus for guiding a machine
US5682313A (en) 1994-06-06 1997-10-28 Aktiebolaget Electrolux Method for localization of beacons for an autonomous device
US20030142587A1 (en) 2002-01-25 2003-07-31 Zeitzew Michael A. System and method for navigation using two-way ultrasonic positioning
EP1435555A2 (en) 2002-12-30 2004-07-07 Samsung Electronics Co., Ltd. Robot localization system
DE10350746A1 (en) 2003-10-30 2005-06-16 Infineon Technologies Ag Method for localizing position of object e.g. for domestic robots, uses signal propagation time differences to determine position of object
DE102004018670A1 (en) 2003-12-22 2005-08-04 Lg Electronics Inc. Apparatus and method for detecting a position of a mobile robot
US20090073045A1 (en) 2007-09-18 2009-03-19 Honeywell International Inc. Ultrasonic multilateration system for stride vectoring
JP2009139264A (en) 2007-12-07 2009-06-25 Synthesize Ltd Three-dimensional position determination system, and three-dimensional position determination method

Patent Citations (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS60107582A (en) 1983-11-16 1985-06-13 Nec Corp Dynamic range compressing circuit
JPH05341031A (en) 1992-06-08 1993-12-24 Isao Murakami Position sensing device
US5491670A (en) 1993-01-21 1996-02-13 Weber; T. Jerome System and method for sonic positioning
US5440216A (en) 1993-06-08 1995-08-08 Samsung Electronics Co., Ltd. Robot cleaner
US5646494A (en) 1994-03-29 1997-07-08 Samsung Electronics Co., Ltd. Charge induction apparatus of robot cleaner and method thereof
US5682313A (en) 1994-06-06 1997-10-28 Aktiebolaget Electrolux Method for localization of beacons for an autonomous device
JPH0854926A (en) 1994-08-08 1996-02-27 Toshiba Corp Guidance device for autonomous mobile robot
US5652593A (en) 1994-09-29 1997-07-29 Von Schrader Company Method and apparatus for guiding a machine
US20030142587A1 (en) 2002-01-25 2003-07-31 Zeitzew Michael A. System and method for navigation using two-way ultrasonic positioning
EP1435555A2 (en) 2002-12-30 2004-07-07 Samsung Electronics Co., Ltd. Robot localization system
DE10350746A1 (en) 2003-10-30 2005-06-16 Infineon Technologies Ag Method for localizing position of object e.g. for domestic robots, uses signal propagation time differences to determine position of object
DE102004018670A1 (en) 2003-12-22 2005-08-04 Lg Electronics Inc. Apparatus and method for detecting a position of a mobile robot
US20090073045A1 (en) 2007-09-18 2009-03-19 Honeywell International Inc. Ultrasonic multilateration system for stride vectoring
JP2009139264A (en) 2007-12-07 2009-06-25 Synthesize Ltd Three-dimensional position determination system, and three-dimensional position determination method

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE202016008129U1 (en) 2016-02-09 2017-04-26 Universität Stuttgart Körperschaft des öffentlichen Rechts Device for determining the three-dimensional pose of rigid bodies using opto-acoustic code division multiplexing and carrier phase distance measurements
CN110573899A (en) * 2017-03-07 2019-12-13 索尼特技术公司 ultrasound position determination system
CN110573899B (en) * 2017-03-07 2024-03-08 索尼特技术公司 Ultrasonic position determination system
CN113473357A (en) * 2021-06-15 2021-10-01 深圳优地科技有限公司 Auxiliary positioning method, device, equipment and storage medium

Similar Documents

Publication Publication Date Title
EP3250443B1 (en) Valet parking method and valet parking system
DE102017217961B4 (en) DEVICE FOR CONTROLLING A VEHICLE AT AN INTERSECTION
EP3213260B1 (en) Method and device for localizing a vehicle in the environment thereof
DE19520532C2 (en) Method for quickly measuring the direction from an autonomous device to a transponder and self-driving autonomous device ####
DE102014211557A1 (en) Valet parking procedure and system
DE102015201204A1 (en) Valet parking system
DE102015001631B4 (en) Method for operating a motor vehicle in a navigation environment and navigation environment
DE112017003867T5 (en) Roadside device, on-board device and vehicle
DE69822187T2 (en) METHOD AND DEVICE FOR LOCATING AND GUIDING A VEHICLE PROVIDED WITH A LINEAR CAMERA
DE102015217036A1 (en) Method for planning a supported parking operation
EP3380810A1 (en) Method, device, map management apparatus, and system for precision-locating a motor vehicle in an environment
DE202012006267U1 (en) Route determination of a mobile multipurpose device with drive system
DE102011011932A1 (en) Navigation system for e.g. position determination of security patrol robot, has ultrasound transmitting stations positioned in surface, where ultrasonic transmission range of station is partially overlapped with that of adjacent station
DE2813189C2 (en) Procedure for precise flight guidance and navigation
DE102008064440A1 (en) Navigation for especially unmanned vehicles
AT516553A1 (en) Method for determining the position of a vehicle
DE102018221864A1 (en) Method and system for determining a trajectory of a vehicle
WO2016202771A1 (en) Apparatus and method for determining a vehicle position in a fixed-traffic-node coordinate system
DE102018212219A1 (en) Check a geographic map
DE102010052474B4 (en) Flight Guidance System
DE102017223607B4 (en) Procedure for mobile parking aid
DE102014221768A1 (en) A method of operating a vehicle and method of operating a parking lot
EP3326891B1 (en) Method for location of a vehicle along a route in a parking space environment
DE102010052475B4 (en) tracking system
DE102018105258A1 (en) SYSTEM FOR INDUCTIVE CHARGING OF AN ENERGY STORAGE OF AN ELECTRIC VEHICLE

Legal Events

Date Code Title Description
R012 Request for examination validly filed
R016 Response to examination communication
R016 Response to examination communication
R016 Response to examination communication
R084 Declaration of willingness to licence
R016 Response to examination communication
R002 Refusal decision in examination/registration proceedings
R003 Refusal decision now final