DE3538908A1 - Autonomous on-board locating system for determining the position and protecting against collision of robot and industrial trucks - Google Patents
Autonomous on-board locating system for determining the position and protecting against collision of robot and industrial trucksInfo
- Publication number
- DE3538908A1 DE3538908A1 DE19853538908 DE3538908A DE3538908A1 DE 3538908 A1 DE3538908 A1 DE 3538908A1 DE 19853538908 DE19853538908 DE 19853538908 DE 3538908 A DE3538908 A DE 3538908A DE 3538908 A1 DE3538908 A1 DE 3538908A1
- Authority
- DE
- Germany
- Prior art keywords
- vehicle
- travel
- distance
- circuit
- measuring
- 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.)
- Withdrawn
Links
- 238000005259 measurement Methods 0.000 claims abstract description 21
- 238000000034 method Methods 0.000 claims abstract description 10
- 230000008878 coupling Effects 0.000 claims description 6
- 238000010168 coupling process Methods 0.000 claims description 6
- 238000005859 coupling reaction Methods 0.000 claims description 6
- 238000013459 approach Methods 0.000 abstract description 2
- 230000006698 induction Effects 0.000 abstract description 2
- 238000003860 storage Methods 0.000 abstract description 2
- 150000001875 compounds Chemical class 0.000 abstract 3
- 238000006073 displacement reaction Methods 0.000 description 4
- 238000011156 evaluation Methods 0.000 description 4
- 230000006870 function Effects 0.000 description 3
- 238000009434 installation Methods 0.000 description 3
- 238000004519 manufacturing process Methods 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 238000012545 processing Methods 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 230000002265 prevention Effects 0.000 description 2
- 230000015572 biosynthetic process Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000036039 immunity Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000008520 organization Effects 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 230000036962 time dependent Effects 0.000 description 1
- 230000001960 triggered effect Effects 0.000 description 1
- 238000002604 ultrasonography Methods 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0255—Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Acoustics & Sound (AREA)
- Aviation & Aerospace Engineering (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
Abstract
Description
Die vorliegende Erfindung betrifft ein bordautonomes Ortungssystem als Hilfsmittel zur teil- oder vollautomatischen Führung von Roboter- und Flurförderfahrzeugen. Ein derartiges Ortungssystem muß es dem einzelnen Fahrzeug prinzipiell ermöglichen, innerhalb eines bekannten, teilweise bebauten und abgegrenzten Operationsgebietes - z. B. eine Lagerhalle oder eine Fertigungsstraße - ohne weitere Hilfen von außen den eigenen Standort allein durch bordseitige Meß- und Signalverarbeitungsprozesse zu bestimmen. Dadurch wird es möglich, auf vorgegebenen Fahrwegen mit Hilfe eines zusätzlich vorhandenen, bordseitigen Lenkrechners Punktziele anzufahren. Voraussetzung ist hierfür eine Kollisionsvermeidung mit den Fahrbahnbegrenzungen oder mit anderen Fahrzeugen.The present invention relates to an on-board autonomous positioning system Tools for partially or fully automatic guidance of robots and Industrial trucks. Such a positioning system must be up to the individual In principle enable the vehicle within a known, partially built-up area and delimited area of operation - e.g. B. a warehouse or production line - your own location without any outside help to be determined by on-board measurement and signal processing processes. Thereby it will be possible to travel on predetermined routes with the help of an additional, to approach point targets on-board steering computer. Requirement is to avoid collisions with the lane boundaries or with others Vehicles.
Es ist allgemein bekannt, daß für den Betrieb von nichtschienengebundenenFlurförderfahrzeugen eine Führungshilfe entlang der Fahrwege erforderlich ist, die derzeit überwiegend mit im Boden verlegten Induktionsschleifen, ggf. auch mit anderen am Boden angebrachten Markierungen realisiert wird. Ohne diese Führung würde ein entsprechendes Fahrzeug schon nach einer kurzen Wegstrecke vom Weg abkommen und seine Aufgabe nicht mehr erfüllen können.It is generally known that for the operation of non-rail-bound industrial vehicles guidance along the routes is required currently mainly with induction loops installed in the floor, possibly also with other markings on the floor. Without this guidance a corresponding vehicle would be off after a short distance come off and can no longer fulfill his task.
Diese leitdrahtgestützen Führungshilfen erfordern einen z. T. erheblichen Aufwand an Material, Geräten, Installationen und Wartung. Nachteilig ist insbesondere, daß sowohl bei einer Erweiterung als auch bei einer Änderung der Streckenführung die neu erforderlichen Installationen umständlich und zeitraubend sind und hohe Kosten erfordern.These guide wire-based guide aids require a z. T. considerable effort of material, devices, installations and maintenance. A particular disadvantage is that both with an expansion and with a change in the route the newly required installations are cumbersome and time consuming and require high costs.
Es ist ferner allgemein bekannt (vgl. z. B. /1/), daß mit Hilfe von bordseitigen, weg- und winkelmessenden Sensoren nach dem Prinzip der Koppelnavigation die Position eines bewegten Fahrzeuges laufend berechnet werden kann. Vorteilhaft ist hier, daß diese Positionsmessungen bordautonom ohne äußere Hilfsmittel vorgenommen werden können und daß die Meßsignale ständig - z. B. auch bei Kurvenfahrten - zur Verfügung stehen. Als nachteilig erweist sich jedoch, daß der Positionsmeßfehler entsprechend der vom Fahrzeug zurückgelegten Wegstrecke ansteigt, weil die Weg- und Winkelmessung der Sensoren fehlerbehaftet ist. Deshalb ist dieses Verfahren für sich allein zur bordseitigen Messung der Position von Fahrzeugen über längere Fahrstrecken nicht geeignet. It is also generally known (see e.g. / 1 /) that with the help of onboard displacement and angle measuring sensors based on the principle of dead reckoning the position of a moving vehicle can be calculated continuously. Advantageous is here that these position measurements are autonomous on board without external aids can be made and that the measurement signals constantly - z. B. also at Cornering - are available. However, it proves disadvantageous that the position measurement error corresponding to the distance covered by the vehicle increases because the displacement and angle measurement of the sensors is faulty. That's why is this procedure in itself for measuring the position on board not suitable for vehicles over long journeys.
Der Erfindung liegt die Aufgabe zugrunde, ein bordseitiges Meßsystem für die laufende Positionsbestimmung eines fahrerlosen Flurförderfahrzeuges oder irgendeines anderen Roboterfahrzeuges zu schaffen, welches eine genaue teil- oder vollautomatische Fahrzeugbewegung entlang von beliebigen, vorgegebenen Fahrwegen in jedem abgegrenzten und bekannten Operationsgebiet, dessen Bebauungsmerkmale kartenmäßig erfaßt werden können, ermöglicht. Gleichzeitig soll durch das System eine Kollision mit den Fahrbahnbegrenzungen oder anderen automatisch geführten Fahrzeugen verhindert werden.The invention is based, an onboard measurement system for the task ongoing determination of the position of a driverless industrial truck or any other to create another robot vehicle, which is an exact partial or fully automatic vehicle movement along any given route in each defined and known area of operation, its development characteristics can be recorded on the map. At the same time through the system a collision with the lane boundaries or other automatically guided ones Vehicles can be prevented.
Die Aufgabe wird erfindungsmäßig dadurch gelöst, daß das Roboter- bzw. fahrerlose Flurförderfahrzeug mit einem bordautonomen Ortungssystem ausgerüstet wird, welches konstruktiv und schaltungsmäßig so gestaltet ist, daß einerseits die Vorzüge der Koppelnavigation genutzt werden können und andererseits aufgrund einer zusätzlichen, hochgenauen Stützschaltung im Ortungssystem ein bordseitig vorhandener Lenkrechner in der Lage ist, das Fahrzeug auch auf vergleichsweise engen Fahrbahnen über lange Fahrstrecken präzise zu führen. Dies geschieht erfindungsmäßig durch eine Anordnung des bordseitigen Ortungssystems, die es erlaubt, laufend die Fahrbahnbreite und die Fahrbahnlänge mit Hilfe von Abstandssensoren zu messen und mit Referenzwerten zu vergleichen. Die schaltungstechnische Aufbereitung der Signale der Abstandssensoren durch das Ortungssystem ermöglicht gleichzeitig auch die Kollisionsverhütung.The object is achieved according to the invention in that the robot or driverless Industrial truck is equipped with an on-board autonomous positioning system, which is designed constructively and in terms of circuitry so that on the one hand the Advantages of dead reckoning can be used and on the other hand due to a additional, high-precision support circuit in the location system an existing onboard Steering computer is able to drive the vehicle even on comparatively tight To guide lanes precisely over long distances. This happens according to the invention by an arrangement of the on-board location system that allows it to run continuously the width and length of the road with the help of distance sensors measure and compare with reference values. The circuit preparation the signals from the distance sensors through the location system enables simultaneously also collision prevention.
Gemäß der weiteren Ausgestaltung der Erfindung messen diese Abstandssensoren des Ortungssystems primär die Entfernung des Fahrzeuges zu den durch technische oder natürliche Merkmale gegebenen seitlichen Begrenzungen der Fahrbahnen fortwährend - sowohl beidseitg quer zur Fahrtrichtung als auch in bzw. entgegengesetzt zur Fahrtrichtung. Diese Folge der zeitabhängigen Abstandsmeßwerte dient nach Codierung zur laufenden Ermittlung der ortsabhängigen Fahrbahnbreite bzw. -länge mittels einer systeminternen Addierschaltung. Jede Position innerhalb des Operationsgebietes ist durch eine charakteristische Kombination dieser beiden Größen gekennzeichnet. Die zugehörigen Daten sind in einem systeminternen Digitalbaustein nach dem Organisationsschema einer elektronischen Landkarte gespeichert (Fig. 1). Aus der Folge der gemessenen Kombinationen ermittelt die weitere elektronische Schaltung des Ortungssystems die tatsächlich gefahrene Bahn und die momentane Position des Fahrzeuges, indem zur Positionsstützung die gemessenen Fahrbahnbreiten bzw. -längen laufend mit entsprechenden im Ortungssystem in Form einer elektronischen Landkarte gespeicherten Informationen elektronisch verglichen werden. Dieser Vergleich erfolgt mittels einer Korrelationsschaltung, wobei das maximale Signal am Ausgang dieser Schaltung detektiert wird und anschließend die zugehörigen Positionsdaten aus dem Landkartenbaustein ausgelesen werden. Eine nachfolgende Entscheidungsschaltung wählt auf Grundlage einer Plausibilitätsüberprüfung aus den zwei verfügbaren Positionsmeßwerten (Koppeldaten bzw. Stützdaten) die richtige Position für den Lenkrechner aus.According to a further embodiment of the invention, these distance sensors of the location system primarily measure the distance of the vehicle to the lateral boundaries of the roadways given by technical or natural features - both on both sides transverse to the direction of travel and in or opposite to the direction of travel. After coding, this sequence of time-dependent distance measured values is used to continuously determine the location-dependent roadway width or length by means of an internal system adding circuit. Each position within the operating area is characterized by a characteristic combination of these two quantities. The associated data are stored in a system-internal digital module according to the organization scheme of an electronic map ( Fig. 1). From the sequence of the measured combinations, the further electronic circuit of the locating system determines the actually driven path and the current position of the vehicle by continuously comparing the measured road widths or lengths electronically with corresponding information stored in the locating system in the form of an electronic map. This comparison is carried out by means of a correlation circuit, the maximum signal being detected at the output of this circuit and the associated position data subsequently being read out from the map module. A subsequent decision circuit selects the correct position for the steering computer based on a plausibility check from the two available position measurement values (coupling data or support data).
Die codierten seitlichen Abstandsmeßwerte werden gemäß der weiteren Ausgestaltung des Ortungssystems auf eine interne Differenzschaltung gegeben, so daß das Ausgangssignal für den Lenkrechner eine Proportionalinformation für die Ablage des Fahrzeuges von der Fahrbahnmitte darstellt. Auch die Abstandsmeßwerte in bzw. entgegengesetzt zur Fahrtrichtung werden dem Lenkrechner durch das Ortungssystem schaltungsmäßig zwecks Kollisionswarnung zur Verfügung gestellt.The coded lateral distance measured values are according to the further embodiment given the location system to an internal differential circuit, so that the output signal for the steering computer a proportional information for the storage of the vehicle from the center of the lane. The distance measurements in or opposite to the direction of travel, the steering computer is switched by the location system provided for the purpose of collision warning.
Die Messung der Abstände selbst erfolgt in bekannter Weise durch bordseitige Funk-, (Ultra-) Schall- oder Lasersender in Verbindung mit entsprechenden Detektoren für die Echosignale von den Fahrbahnbegrenzungen. Hierzu werden die Sender im Impuls- oder Dauerstrichbetrieb moduliert und ein Laufzeitverfahren angewendet. Auch winkelmessende Verfahren auf Grundlage einer bekannten Meßbasis sind möglich.The distances themselves are measured in a known manner by on-board radio, (Ultra) sound or laser transmitter in connection with appropriate detectors for the echo signals from the lane boundaries. For this purpose, the transmitters are or continuous wave operation modulated and a runtime procedure applied. Even angle measuring Methods based on a known measurement basis are possible.
Die Vorteile der Erfindung bestehen darin, daß keine zusätzlichen Installationen außerhalb des Fahrzeuges (Leitdrähte, Fahrbahnmarkierung, Baken o. ä.) erforderlich werden, des weiteren ist die Führung des Roboterfahrzeuges auch bei beliebig langen Fahrwegen mit der hohen Genauigkeit der Abstandssensoren möglich. Dies bedeutet Meßgenauigkeiten in der Größenordnung von Zentimetern oder besser, die durchaus für einen automatischen Fertigungs- oder Förderablauf notwendig werden können. Die schaltungsmäßige und konstruktiv bewirkte Kombination der Koppelnavigation mit dem Abstandsmeßverfahren ermöglicht ferner eine hohe Störsicherheit, weil auch bei Kruvenfahrten durch gezielte Ab- bzw. Aufschaltung des Stützsignals eine sichere Führung des Fahrzeuges möglich ist. Eine Umstellung im Förder- oder Fertigungsablauf kann zeitsparend durch einen einfachen Austausch des elektronischen Landkarten- Bausteines im Ortungssystem realisiert werden. The advantages of the invention are that no additional installations outside the vehicle (guidewires, road markings, beacons, etc.) required furthermore, the guidance of the robot vehicle is also possible with any length Driving paths possible with the high accuracy of the distance sensors. this means Measuring accuracies on the order of centimeters or better, which are quite may be necessary for an automatic production or conveying process. The circuitry and constructive combination of the dead reckoning with The distance measuring method also enables a high level of interference immunity, because also at Cruising through safe switching off or on of the support signal a safe Guidance of the vehicle is possible. A change in the conveyor or production process can be saved in time by simply exchanging the electronic map Building blocks can be realized in the location system.
Im folgenden wird ein Ausführungsbeispiel der Erfindung mit Hilfe der Fig. 2 näher erläutert.An exemplary embodiment of the invention is explained in more detail below with the aid of FIG. 2.
Das bordautonome Ortungssystem besteht aus zwei Hauptbaugruppen:
der Meßwerterfassungseinheit 10 und
der Auswerteeinheit 20 einschließlich des elektronischen Referenzspeichers
25.The on-board autonomous tracking system consists of two main components:
the measured value acquisition unit 10 and
the evaluation unit 20 including the electronic reference memory 25 .
Die vollständige Meßwerterfassungseinheit 10 besteht aus:
a) dem Wegsensor 11 mit Codierungseinheit 11 a zur Erfassung der vom
Fahrzeug zurückgelegten Wege; dies ist z. B. ein Hallsensor, der die
Anzahl der Umdrehungen eines Fahrzeugrades mißt,
b) dem Lenkwinkelsensor 12 mit Codierungseinheit 12 a zur Erfassung des
momentanen Lenkwinkeleinschlages, bezogen auf die Fahrzeuglängsachse;
z. B. einem Kurzschlußringsensor,
c) den Sensorsystemen 13 und 14 mit den Codierungseinheiten 13 a und
14 a, geeignet zur Messung des Abstandes von begrenzenden Objekten
rechts- und linksseitig der Fahrbahn, relativ zum Fahrzeug. Das Sensorsystem
besteht z. B. aus impulsmodulierten Ultraschallsendern und -empfängern
mit Auswerteteil für das Schallecho zwecks Ermittlung der Abstände
a l und a r vom Fahrzeug zu den nach rechts und links benachbarten Objekten
nach dem Laufzeitverfahren
d) und den Fahrtrichtungssensoren 15 und 16 mit den Codierungseinheiten
15 a und 16 a zur Bestimmung der Abstände a +, a - zwischen dem Fahrzeug und
Objekten in und entgegen Fahrtrichtung; realisiert z. B. ebenfalls
durch impulsmodulierte Ultraschallsender mit den zugehörigen Empfangseinrichtungen.The complete measured value acquisition unit 10 consists of:
a) the path sensor 11 with coding unit 11 a for detecting the distances traveled by the vehicle; this is e.g. B. a Hall sensor that measures the number of revolutions of a vehicle wheel,
b) the steering angle sensor 12 with coding unit 12 a for detecting the current steering angle, based on the longitudinal axis of the vehicle; e.g. B. a short-circuit ring sensor,
c) the sensor systems 13 and 14 with the coding units 13 a and 14 a , suitable for measuring the distance from limiting objects on the right and left sides of the road, relative to the vehicle. The sensor system consists, for. B. from pulse-modulated ultrasonic transmitters and receivers with an evaluation part for the sound echo in order to determine the distances a l and a r from the vehicle to the objects to the right and left adjacent according to the transit time method
d) and the direction of travel sensors 15 and 16 with the coding units 15 a and 16 a for determining the distances a + , a - between the vehicle and objects in and against the direction of travel; realized z. B. also by pulse-modulated ultrasound transmitter with the associated receiving devices.
Die vollständige Auswerteeinheit 20 umfaßt:
a) den Steuerungsteil 21,
welcher nach jeweils äquidistanten, vom Fahrzeug zurückgelegten Wegstücken
eine Messung des Lenkwinkelsensors 12 und der Abstandssensoren
13-16 auslöst,
b) den Positionsrechner 22,
der aus den codierten Meßwerten des Wegsensors 11, 11 a und des
Lenkwinkelsensors 12, 12 a die Position P* (x, y) nach dem Prinzip der
Koppelnavigation des Fahrzeuges errechnet,
c) die Addierer 23 und 23 a,
die aus den codierten Meßwerten der Abstandssensoren 13, 13 a 14, 14 a
und 15, 15 a, 16, 16 a durch Addition die Summen b = a l +a r (=Fahrbahnbreite)
bzw. l = a ++a - (=Fahrbahnlänge) der Abstände bilden,
d) den Pufferspeicher 24,
der die Ausgangswerte der Addierer 23 und 23 a speichert und hieraus eine
Meßwertfolge M = (b 1, l 1), (b 2, l 2), . . . (b n , l n ) mit n Elementenpaaren
sequentiell aus den letzten n Messungen bildet,
e) den Subtrahierer 29,
der aus den codierten Meßwerten der Abstandssensoren 13, 13 a und 14, 14 a
die Differenz der Abstände Δ b = a l -a r bildet und diese zur Kollisionsverhinderung
des Fahrzeugs mit den Fahrbahnbegrenzungen an den Lenkrechner
des Fahrzeuges ausgibt,
f) dem Referenzspeicher 25,
der als elektronische Landkarte funktioniert, indem jeder Position P′(x,y)
innerhalb des Operationsgebietes die Fahrbahnbreite B(x,y) und die Fahrbahnlänge
L(x,y) als Elemente der Referenzmatrix R(x,y) = R(B(x,y), L(x,y))
zugeordnet sind. Dieser Referenzspeicher kann z. B. ein Halbleiterspeicher
(ROM, PROM oder EPROM) sein,
g) den Vergleicher 26,
der die im Pufferspeicher 24 enthaltene Meßwertfolge M mit den im Referenzspeicher
25 enthaltenen Informationen R(B,L) mit Hilfe einer Korrelationsschaltung
vergleicht und die Positionskoordinaten P′(x,y) des letzten Elementes
derjenigen Referenzwertfolge R′(B′,L′) ausgibt, die die größte Übereinstimmung (Korrelationsmaximum) mit der aktuellen Meßwertfolge M hat,
h) den Positionsspeicher 27,
der die aktuelle Fahrzeugposition (P(x F , y F ) übernimmt,
i) die Entscheidungseinheit 28,
die die vom Positionrechner 22 berechnete Positionen P*(x,y) und die
vom Vergleicher zur Verfügung gestellte Position P′(x,y) übernimmt und
durch eine logische Schaltung den genaueren Positionswert als Position
des Fahrzeugs P(x F ,y F ) and den Lenkrechner ausgibt. Dies geschieht durch
die Schaltung in folgender Weise: Wenn der Abstand der Positionen P*(x,y)
und P′(x,y) unterhalb eines einstellbaren Grenzwertes G liegt, wird die
durch den Stützprozeß ermittelte Position P′(x,y) als Position des Fahrzeuges
(P(x F ,y F ) = P′(x,y)) ausgegeben. Andernfalls gilt für die Fahrzeugposition
P(x F ,y F ) = P*(x,y), d. h. die Koppelposition geht an den
Lenkrechner,
j) und dem Positionsspeicher 27,
der die von der Entscheidungseinheit 28 ausgegebene Fahrzeugposition
P(x F ,y F ) speichert, um diese dem Vergleicher 26 zur schnelleren Auffindung
der in Frage kommenden Referenzfolgen R′ zur Verfügung zu stellen.
Die codierten Abstandsmeßwerte der Sensoren 15, 15 a und 16, 16 a werden durch
die Auswerteeinheit 20 dem externen Lenkrechner direkt zur Kollisionsverhütung
zur Verfügung gestellt.The complete evaluation unit 20 comprises:
a) the control part 21 ,
which, after each equidistant by the vehicle spans a measurement of the steering angle sensor 12 and the distance sensors 13 to 16 triggers,
b) the position calculator 22 ,
which calculates the position P * ( x, y ) from the coded measured values of the displacement sensor 11 , 11 a and the steering angle sensor 12 , 12 a according to the principle of the coupling navigation of the vehicle,
c) adders 23 and 23 a ,
the sum of b = a l + a r (= roadway width) or l = a + + a - (from the coded measured values of the distance sensors 13 , 13 a 14 , 14 a and 15 , 15 a , 16 , 16 a by adding = Lane length) of the distances,
d) the buffer memory 24 ,
which stores the output values of the adders 23 and 23 a and from this a measured value sequence M = ( b 1 , l 1 ), ( b 2 , l 2 ),. . . ( b n , l n ) with n pairs of elements sequentially from the last n measurements,
e) the subtractor 29 ,
which forms the difference between the distances Δ b = a l - a r from the coded measured values of the distance sensors 13 , 13 a and 14 , 14 a and outputs them to the vehicle's steering computer to prevent the vehicle from colliding with the roadway limitations,
f) the reference memory 25 ,
which functions as an electronic map, in that each position P ′ ( x, y ) within the operating area has the lane width B ( x, y ) and the lane length L ( x, y ) as elements of the reference matrix R ( x, y ) = R ( B ( x, y ), L ( x, y )) are assigned. This reference memory can e.g. B. a semiconductor memory (ROM, PROM or EPROM),
g) the comparator 26 ,
which compares the measured value sequence M contained in the buffer memory 24 with the information R ( B, L ) contained in the reference memory 25 with the aid of a correlation circuit and the position coordinates P '( x, y ) of the last element of that reference value sequence R ' ( B ', L ') outputs that has the greatest correspondence (correlation maximum) with the current measured value sequence M ,
h) the position memory 27 ,
which takes over the current vehicle position ( P ( x F , y F ),
i) the decision unit 28 ,
which takes over the positions P * ( x, y ) calculated by the position computer 22 and the position P ′ ( x, y ) made available by the comparator and, by means of a logic circuit, the more precise position value as the position of the vehicle P ( x F , y F ) and outputs the steering computer. The circuit does this in the following way: If the distance between the positions P * ( x, y ) and P ′ ( x, y ) is below an adjustable limit value G , the position P ′ ( x, y ) determined by the support process is output as the position of the vehicle ( P ( x F , y F ) = P ′ ( x, y )). Otherwise, the following applies to the vehicle position P ( x F , y F ) = P * ( x, y ), ie the coupling position goes to the steering computer,
j) and the position memory 27 ,
which stores the vehicle position P ( x F , y F ) output by the decision unit 28 in order to make it available to the comparator 26 for faster finding of the reference sequences R ′ in question. The coded distance measured values of the sensors 15 , 15 a and 16 , 16 a are made available by the evaluation unit 20 to the external steering computer directly for collision prevention.
Der Funktionsablauf im bordautonomen Ortungssystem stellt sich folgendermaßen dar:The functional sequence in the on-board autonomous positioning system is as follows represents:
Die Meßdaten der Sensoren 11 bis 16 werden laufend in den Codierungseinheiten 11 a bis 16 a in vorgegebene Datenformen umgesetzt. Mit dem Taktsignal des Steuerungsteiles 21, das aus dem codierten Signal des Wegsensors 11 nach Zurücklegung von äquidistanten Wegstücken s erzeugt wird, werden die Messungen des Lenkwinkelsensors 12, 12 a und der Abstandssensoren 13-16 ausgelöst. Mit Kenntnis des Lenkwinkeleinschlages, geliefert vom Lenkwinkelsensor 12, 12 a und der jeweils zurückgelegten Wegstücke, gewonnen durch den Wegsensor 11, 11 a und dem Steuerungsteil 21, kann der Positionsrechner 22 bei bekannter Fahrzeuggeometrie den momentanen Fahrtwinkel und damit die Position p* (x,y) des Fahrzeuges berechnen.The measurement data from the sensors 11 to 16 are continuously converted into predetermined data forms in the coding units 11 a to 16 a . The measurements of the steering angle sensor 12 , 12 a and the distance sensors 13 - 16 are triggered with the clock signal of the control part 21 , which is generated from the coded signal of the travel sensor 11 after covering equidistant travel sections s . With knowledge of the steering angle, delivered by the steering angle sensor 12 , 12 a and the distance traveled in each case, obtained by the distance sensor 11 , 11 a and the control part 21 , the position computer 22 can know the current travel angle and thus the position p * ( x, y ) calculate the vehicle.
Mit den codierten Ausgangssignalen a l , a r bzw. a +, a - der Abstandssensoren 13, 14, 15 und 16 werden in den Addierern 23 und 23 a die Summensignale b bzw. l gebildet, die den Abständen der Objekte voneinander entsprechen, die die Fahrbahn rechtsseitig und linksseitig bzw. noch vorn und nach hinten begrenzen. Die Ausgangssignale der Addierer 23 und 23 a gelangen sequentiell in einen Pufferspeicher 24 zur Bildung der Meßwertfolge M.With the coded output signals a l , a r and a + , a - of the distance sensors 13 , 14 , 15 and 16 , the sum signals b and l are formed in the adders 23 and 23 a , which correspond to the distances of the objects from one another limit the lane on the right and left sides or still in front and back. The output signals of the adders 23 and 23 a pass sequentially into a buffer memory 24 to form the measurement sequence M.
Im Vergleicher 26 wird die Meßwertfolge M mit den im Referenzspeicher 25 gespeicherten Referenzinformation R(B,L) mit Hilfe der Korrelationsschaltung verglichen. Die Korrelation liefert diejenige Referenzwertfolge R′(B′,L′), die die größte Übereinstimmung (Korrelationsmaximum) mit der aktuellen Meßwertfolge M hat. Die Referenzwertfolge R′(B′,L′) der Korrelationsschaltung besteht wie die Meßwertfolge M aus n Elementpaaren, gebildet aus den Speicherwerten B′ bzw. L′ der Referenzwerte (Fahrbahnbreite bzw. Fahrbahnlänge). Das n-te Elementpaar dieser Referenzwertfolge R′(B′,L′) ist dem aktuellsten Meßwertpaar der Meßwertfolge M zugeordnet und liefert den Positionsstützwert P′(x,y). Da die Korrelationsschaltung unabhängig von der Reihenfolge der Elemente eines Paares diese Auswahl trifft, ermöglicht der Vergleicher 26 eine Bestimmung der Positionsstützwerte P′(x,y) unabhängig von der Fahrtrichtung. Der momentane Positionsstützwert P′(x,y) wird an die Entscheidungseinheit 28 ausgegeben. Hier wird überprüft, ob die vom Positionsrechner 22 berechnete Koppelposition P*(x,y) mit den Positionskoordinaten P′(x,y) des Vergleichers 26 übereinstimmt. Der Fahrzeugpositionswert P(x F ,y F-) wird an den Fahrzeuglenkrechner ausgegeben. Bei Unterschreitung des Abstandsgrenzwertes G gibt die Entscheidungseinheit 28 an den Kopplungsrechner 22 ein Signal zum Rücksetzen und übermittelt die Fahrzeugposition P(x F ,y F ) = P′(x,y) als neuen Anfangswert für die Koppelnavigation. Die von der Entscheidungseinheit 28 gefundene neue Position P(x F ,y F -) des Fahrzeugs wird sowohl an den Lenkrechner des Fahrzeuges zur Führung ausgegeben als auch dem Positionsspeicher 27 übermittelt, damit der Vergleicher 26 zum schnellen Auffinden der gesuchten Referenzwertfolge R′(B′,L′) auf die zuletzt bestimmte Position (P(x F ,y F ) zurückgreifen kann, um so eine gezielte Suche in den Referenzspeicherinformationen (R(B,L) zu ermöglichen.In the comparator 26 , the measured value sequence M is compared with the reference information R ( B, L ) stored in the reference memory 25 with the aid of the correlation circuit. The correlation provides that reference value sequence R ′ ( B ′, L ′) that has the greatest correspondence (correlation maximum) with the current measurement value sequence M. The reference value sequence R ′ ( B ′, L ′) of the correlation circuit, like the measurement value sequence M, consists of n element pairs, formed from the stored values B ′ and L ′ of the reference values (roadway width or roadway length). The nth pair of elements of this reference value sequence R ′ ( B ′, L ′) is assigned to the most recent measured value pair of the measured value sequence M and supplies the position reference value P ′ ( x, y ). Since the correlation circuit makes this selection irrespective of the order of the elements of a pair, the comparator 26 enables the position support values P ′ ( x, y ) to be determined independently of the direction of travel. The current position base value P ′ ( x, y ) is output to the decision unit 28 . It is checked here whether the coupling position P * ( x, y ) calculated by the position computer 22 matches the position coordinates P ′ ( x, y ) of the comparator 26 . The vehicle position value P ( x F , y F - ) is output to the vehicle steering computer. If the distance limit G is undershot, the decision unit 28 sends a signal to the coupling computer 22 to reset and transmits the vehicle position P ( x F , y F ) = P ′ ( x, y ) as the new initial value for the dead reckoning. The new position P ( x F , y F -) of the vehicle found by the decision unit 28 is both output to the steering computer of the vehicle for guidance and also transmitted to the position memory 27 so that the comparator 26 for quickly finding the desired reference value sequence R ′ ( B ', L ') can access the last determined position ( P ( x F , y F ), in order to enable a targeted search in the reference memory information ( R ( B, L ).
Zu Beginn der Fahrt kann gegebenenfalls die Anfangsposition des Fahrzeuges
in die Entscheidungseinheit 28 eingegeben werden, um so die Zeitdauer
für die erste Positionsermittlung zu verringern. Diese Eingabe
ist aber nicht zwingend notwendig, da das System nach der Bildung der
ersten Meßwertfolge M mit der Bestimmung der eigenen Position beginnt.
Die Erfindung ist nicht an das beschriebene Ausführbeispiel gebunden.
So können anstelle einzelner Komponenten und Schaltungen in der Funktion
äquivalente Funktionen und Schaltungen treten, z. B.
- die aktiven, laufzeitmessenden Abstandssensoren können durch passive
optische Entfernungsmesser oder bildverarbeitende Entfernungsmesser
ersetzt werden;
- für die Weg- und Winkelsensoren können auch Beschleunigungsmesser
mit nachgeschalteten Integratoren und Kreiselgeräte eingesetzt werden;
- die Signalverarbeitungsschaltungen 21-29 können analog, digital oder
hybrid ausgeführt werden;
- die Codiereinheiten 11 a-16 a können je nach Sensor- oder Schaltungsauslegung
teilweise oder ganz entfallen.At the start of the journey, the starting position of the vehicle can optionally be entered in the decision unit 28 , in order to reduce the time period for the first position determination. However, this entry is not absolutely necessary, since the system begins with the determination of its own position after the formation of the first measured value sequence M. The invention is not tied to the exemplary embodiment described. So instead of individual components and circuits in the function equivalent functions and circuits occur, for. B.
- The active, time-measuring distance sensors can be replaced by passive optical rangefinders or image-processing rangefinders;
- Accelerometers with downstream integrators and gyroscopes can also be used for the displacement and angle sensors;
- The signal processing circuits 21-29 can be designed analog, digital or hybrid;
- Depending on the sensor or circuit design, the coding units 11 a - 16 a can be partially or completely omitted.
Auch können die 4 Abstandssensoren 13/13 a bis 16/16 a durch einen oder zwei ggf. rotierende Abstandssensoren ersetzt werden, die die Messungen sequentiell durchführen. Die Grenzwerteinstellung G und die Anfangsposition können durch den Lenkrechner oder manuell erfolgen, ebenso ist eine visuelle Anzeige des Positionsmeßwertes P(x F ,y F ) möglich.Also, the distance sensors 4 13/13 a can be replaced by a one or two optionally rotating distance sensors 16, which perform the measurements sequentially to 16 /. The limit value setting G and the starting position can be carried out by the steering computer or manually, and a visual display of the position measurement value P ( x F , y F ) is also possible.
(1) TELDIX GmbH (Hrsg.)
Taschenbuch der Navigation
Eigenverlag Heidelberg (1979),
ISBN 3-9800294-0-9
S. 91(1) TELDIX GmbH (ed.)
Paperback of navigation
Self-published Heidelberg (1979),
ISBN 3-9800294-0-9
P. 91
Claims (2)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| DE19853538908 DE3538908A1 (en) | 1985-11-02 | 1985-11-02 | Autonomous on-board locating system for determining the position and protecting against collision of robot and industrial trucks |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| DE19853538908 DE3538908A1 (en) | 1985-11-02 | 1985-11-02 | Autonomous on-board locating system for determining the position and protecting against collision of robot and industrial trucks |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| DE3538908A1 true DE3538908A1 (en) | 1987-05-21 |
Family
ID=6285015
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| DE19853538908 Withdrawn DE3538908A1 (en) | 1985-11-02 | 1985-11-02 | Autonomous on-board locating system for determining the position and protecting against collision of robot and industrial trucks |
Country Status (1)
| Country | Link |
|---|---|
| DE (1) | DE3538908A1 (en) |
Cited By (20)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP0297811A2 (en) * | 1987-06-27 | 1989-01-04 | Shinko Electric Co. Ltd. | Control systems for self-contained unmanned vehicles |
| FR2646119A1 (en) * | 1989-04-25 | 1990-10-26 | Shinko Electric Co Ltd | Displacement control method, displacement control device, and movable robot for movable robot systems |
| DE3923458A1 (en) * | 1989-07-15 | 1991-01-24 | Bodenseewerk Geraetetech | Unmanned vehicle guidance system e.g. for assembly plant - determines vehicle position and course using way point markers to support autonomous navigation system |
| WO1991009275A2 (en) * | 1989-12-11 | 1991-06-27 | Caterpillar Inc. | Integrated vehicle positioning and navigation system, apparatus and method |
| DE4300123A1 (en) * | 1992-01-06 | 1993-07-08 | Samsung Electronics Co Ltd | |
| US5375059A (en) * | 1990-02-05 | 1994-12-20 | Caterpillar Inc. | Vehicle position determination system and method |
| DE4414192A1 (en) * | 1994-04-22 | 1995-11-02 | Siemens Ag | Self-controlled mobile unit safety clearance calculation method |
| US5488277A (en) * | 1989-04-25 | 1996-01-30 | Shinki Electric Co., Ltd. | Travel control method, travel control device, and mobile robot for mobile robot systems |
| US5548516A (en) * | 1989-12-11 | 1996-08-20 | Caterpillar Inc. | Multi-tasked navigation system and method for an autonomous land based vehicle |
| US5555503A (en) * | 1989-12-11 | 1996-09-10 | Caterpillar Inc. | System and method for providing accurate vehicle positioning using spatial bias techniques |
| US5612883A (en) * | 1990-02-05 | 1997-03-18 | Caterpillar Inc. | System and method for detecting obstacles in the path of a vehicle |
| US5835886A (en) * | 1994-10-26 | 1998-11-10 | Siemens Aktiengesellschaft | Method for analyzing a measurement value and measurement value analyzer for carrying out the method |
| DE19938345C1 (en) * | 1999-08-13 | 2001-02-15 | Isocom Automationssysteme Gmbh | Method and device for detecting the position of a vehicle in a predetermined area, in particular a storage facility, and warehouse management method and system |
| DE10234730A1 (en) * | 2002-07-30 | 2004-02-19 | Josef Schreiner | Position determination method for use with industrial trucks, e.g. forklift trucks, within a defined area, wherein the positions of transport and reference fixed objects are known and truck positions are determined from them |
| DE102007021693A1 (en) | 2007-05-09 | 2008-11-13 | Götting jun., Hans-Heinrich, Dipl.-Ing. (FH) | Auxiliary system for determining position of fork-lift truck in parking space, has unit for coupling and/or fixing position of vehicle, where determined position is corrected by relative positioning of vehicle relative to object |
| WO2009003876A1 (en) | 2007-07-02 | 2009-01-08 | Robert Bosch Gmbh | System and method for assisting longitudinal guidance of a vehicle |
| DE202007019542U1 (en) | 2007-05-09 | 2013-09-19 | Hans-Heinrich Götting jun. | Auxiliary system for determining the position of a vehicle |
| US9551582B2 (en) | 1998-01-27 | 2017-01-24 | Blanding Hovenweep, Llc | Mobile communication device |
| US9569962B2 (en) | 2012-10-30 | 2017-02-14 | Audi Ag | Method for identifying a vehicle detected by a sensor device |
| DE102015220495A1 (en) * | 2015-10-21 | 2017-04-27 | Kuka Roboter Gmbh | Protective field adaptation of a manipulator system |
-
1985
- 1985-11-02 DE DE19853538908 patent/DE3538908A1/en not_active Withdrawn
Cited By (29)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP0297811A3 (en) * | 1987-06-27 | 1990-08-16 | Shinko Electric Co. Ltd. | Control systems for self-contained unmanned vehicles |
| EP0297811A2 (en) * | 1987-06-27 | 1989-01-04 | Shinko Electric Co. Ltd. | Control systems for self-contained unmanned vehicles |
| US5488277A (en) * | 1989-04-25 | 1996-01-30 | Shinki Electric Co., Ltd. | Travel control method, travel control device, and mobile robot for mobile robot systems |
| FR2646119A1 (en) * | 1989-04-25 | 1990-10-26 | Shinko Electric Co Ltd | Displacement control method, displacement control device, and movable robot for movable robot systems |
| US5568030A (en) * | 1989-04-25 | 1996-10-22 | Shinko Electric Co., Ltd. | Travel control method, travel control device, and mobile robot for mobile robot systems |
| DE3923458A1 (en) * | 1989-07-15 | 1991-01-24 | Bodenseewerk Geraetetech | Unmanned vehicle guidance system e.g. for assembly plant - determines vehicle position and course using way point markers to support autonomous navigation system |
| WO1991009275A2 (en) * | 1989-12-11 | 1991-06-27 | Caterpillar Inc. | Integrated vehicle positioning and navigation system, apparatus and method |
| WO1991009275A3 (en) * | 1989-12-11 | 1992-03-05 | Caterpillar Inc | Integrated vehicle positioning and navigation system, apparatus and method |
| US5555503A (en) * | 1989-12-11 | 1996-09-10 | Caterpillar Inc. | System and method for providing accurate vehicle positioning using spatial bias techniques |
| US5548516A (en) * | 1989-12-11 | 1996-08-20 | Caterpillar Inc. | Multi-tasked navigation system and method for an autonomous land based vehicle |
| EP0679973A3 (en) * | 1989-12-11 | 1995-12-13 | Caterpillar Inc | |
| US5375059A (en) * | 1990-02-05 | 1994-12-20 | Caterpillar Inc. | Vehicle position determination system and method |
| US5390125A (en) * | 1990-02-05 | 1995-02-14 | Caterpillar Inc. | Vehicle position determination system and method |
| US5612883A (en) * | 1990-02-05 | 1997-03-18 | Caterpillar Inc. | System and method for detecting obstacles in the path of a vehicle |
| US5680313A (en) * | 1990-02-05 | 1997-10-21 | Caterpillar Inc. | System and method for detecting obstacles in a road |
| US5838562A (en) * | 1990-02-05 | 1998-11-17 | Caterpillar Inc. | System and a method for enabling a vehicle to track a preset path |
| DE4300123A1 (en) * | 1992-01-06 | 1993-07-08 | Samsung Electronics Co Ltd | |
| DE4414192A1 (en) * | 1994-04-22 | 1995-11-02 | Siemens Ag | Self-controlled mobile unit safety clearance calculation method |
| US5835886A (en) * | 1994-10-26 | 1998-11-10 | Siemens Aktiengesellschaft | Method for analyzing a measurement value and measurement value analyzer for carrying out the method |
| US9551582B2 (en) | 1998-01-27 | 2017-01-24 | Blanding Hovenweep, Llc | Mobile communication device |
| US10127816B2 (en) | 1998-01-27 | 2018-11-13 | Blanding Hovenweep, Llc | Detection and alert of automobile braking event |
| DE19938345C1 (en) * | 1999-08-13 | 2001-02-15 | Isocom Automationssysteme Gmbh | Method and device for detecting the position of a vehicle in a predetermined area, in particular a storage facility, and warehouse management method and system |
| US6732045B1 (en) | 1999-08-13 | 2004-05-04 | Locanis Technologies Gmbh | Method and device for detecting the position of a vehicle in a given area |
| DE10234730A1 (en) * | 2002-07-30 | 2004-02-19 | Josef Schreiner | Position determination method for use with industrial trucks, e.g. forklift trucks, within a defined area, wherein the positions of transport and reference fixed objects are known and truck positions are determined from them |
| DE202007019542U1 (en) | 2007-05-09 | 2013-09-19 | Hans-Heinrich Götting jun. | Auxiliary system for determining the position of a vehicle |
| DE102007021693A1 (en) | 2007-05-09 | 2008-11-13 | Götting jun., Hans-Heinrich, Dipl.-Ing. (FH) | Auxiliary system for determining position of fork-lift truck in parking space, has unit for coupling and/or fixing position of vehicle, where determined position is corrected by relative positioning of vehicle relative to object |
| WO2009003876A1 (en) | 2007-07-02 | 2009-01-08 | Robert Bosch Gmbh | System and method for assisting longitudinal guidance of a vehicle |
| US9569962B2 (en) | 2012-10-30 | 2017-02-14 | Audi Ag | Method for identifying a vehicle detected by a sensor device |
| DE102015220495A1 (en) * | 2015-10-21 | 2017-04-27 | Kuka Roboter Gmbh | Protective field adaptation of a manipulator system |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| DE3538908A1 (en) | Autonomous on-board locating system for determining the position and protecting against collision of robot and industrial trucks | |
| DE69509587T2 (en) | Method and device for determining vehicle azimuth | |
| EP0759151B2 (en) | Correction process and navigation system for the compound location of a motor vehicle | |
| EP1218809B1 (en) | Method and device for detecting the position of a vehicle in a given area | |
| DE69210930T2 (en) | Position determination procedure | |
| DE69210319T2 (en) | Device for calculating the position and azimuth of a vehicle | |
| EP3577420B1 (en) | Method and device for updating a digital map | |
| DE102017112865A1 (en) | Apparatus for automated driving control, system with the same, and method therefor | |
| DE3741259A1 (en) | Method and device for the autonomous steering of a vehicle | |
| DE102015001631B4 (en) | Method for operating a motor vehicle in a navigation environment and navigation environment | |
| DE68907403T2 (en) | Vehicle navigation system. | |
| DE102016221440A1 (en) | Method for diagnosing environmental sensor systems in vehicles | |
| DE19542370A1 (en) | Position detector system for guided vehicle such as train | |
| DE102018212219A1 (en) | Check a geographic map | |
| EP1665197B1 (en) | Method for determining a position of a motor vehicle on a road | |
| DE102018221864A1 (en) | Method and system for determining a trajectory of a vehicle | |
| DE19818473C2 (en) | Method for determining the position of a vehicle | |
| DE3512127A1 (en) | LOCATION AND NAVIGATION SYSTEM FOR AGRICULTURAL VEHICLES | |
| EP2995971A1 (en) | Method and system for positioning | |
| EP1380021B1 (en) | Method for operating a navigation system for a vehicle | |
| DE112020005630T5 (en) | DRIVING ASSISTANCE DEVICE | |
| DE4217555A1 (en) | Map-based location and navigation system for motor vehicle - corrects distance covered for tyre wear and pressure errors using known positions of detected bridges and tunnels | |
| EP3499271A1 (en) | Determination of a position of a vehicle | |
| WO1998013666A1 (en) | Navigation-assistance method and device for a vehicle driver | |
| DE69301174T2 (en) | Vehicle tracking device |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| 8139 | Disposal/non-payment of the annual fee | ||
| 8170 | Reinstatement of the former position | ||
| 8139 | Disposal/non-payment of the annual fee | ||
| 8170 | Reinstatement of the former position | ||
| 8139 | Disposal/non-payment of the annual fee |