DE102017203653A1 - Method and device for determining the position of kinematics, in particular mobile machines - Google Patents
Method and device for determining the position of kinematics, in particular mobile machines Download PDFInfo
- Publication number
- DE102017203653A1 DE102017203653A1 DE102017203653.2A DE102017203653A DE102017203653A1 DE 102017203653 A1 DE102017203653 A1 DE 102017203653A1 DE 102017203653 A DE102017203653 A DE 102017203653A DE 102017203653 A1 DE102017203653 A1 DE 102017203653A1
- Authority
- DE
- Germany
- Prior art keywords
- kinematics
- machine
- tcp
- determining
- basis
- 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
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66C—CRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
- B66C13/00—Other constructional features or details
- B66C13/18—Control systems or devices
- B66C13/46—Position indicators for suspended loads or for crane elements
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/30—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets with a dipper-arm pivoted on a cantilever beam, i.e. boom
- E02F3/301—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets with a dipper-arm pivoted on a cantilever beam, i.e. boom with more than two arms (boom included), e.g. two-part boom with additional dipper-arm
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/76—Graders, bulldozers, or the like with scraper plates or ploughshare-like elements; Levelling scarifying devices
- E02F3/80—Component parts
- E02F3/84—Drives or control devices therefor, e.g. hydraulic drive systems
- E02F3/844—Drives or control devices therefor, e.g. hydraulic drive systems for positioning the blade, e.g. hydraulically
- E02F3/845—Drives or control devices therefor, e.g. hydraulic drive systems for positioning the blade, e.g. hydraulically using mechanical sensors to determine the blade position, e.g. inclinometers, gyroscopes, pendulums
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/76—Graders, bulldozers, or the like with scraper plates or ploughshare-like elements; Levelling scarifying devices
- E02F3/80—Component parts
- E02F3/84—Drives or control devices therefor, e.g. hydraulic drive systems
- E02F3/844—Drives or control devices therefor, e.g. hydraulic drive systems for positioning the blade, e.g. hydraulically
- E02F3/847—Drives or control devices therefor, e.g. hydraulic drive systems for positioning the blade, e.g. hydraulically using electromagnetic, optical or acoustic beams to determine the blade position, e.g. laser beams
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/26—Indicating devices
- E02F9/264—Sensors and their calibration for indicating the position of the work tool
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/37—Measurements
- G05B2219/37304—Combined position measurement, encoder and separate laser, two different sensors
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/37—Measurements
- G05B2219/37325—Multisensor integration, fusion, redundant
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40611—Camera to monitor endpoint, end effector position
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40623—Track position of end effector by laser beam
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/45—Nc applications
- G05B2219/45012—Excavator
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Mining & Mineral Resources (AREA)
- Civil Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Structural Engineering (AREA)
- Physics & Mathematics (AREA)
- Acoustics & Sound (AREA)
- Electromagnetism (AREA)
- Optics & Photonics (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Operation Control Of Excavators (AREA)
Abstract
Die vorliegende Erfindung betrifft ein Verfahren und eine Vorrichtung zur Positionsbestimmung einer Kinematik (110, 115, 120) einer bevorzugt hydraulischen Maschine, wobei die Kinematik (110, 115, 120) gegenüber einem die Positionsbestimmung durchführenden Maschinenbereich (105) peripher angeordnet ist, und wobei es zu Betriebssituationen der Maschine kommt, in denen zwischen der Kinematik (110, 115, 120) und dem die Positionsbestimmung durchführenden Maschinenbereich (105) keine signaltechnische Verbindung möglich ist, und wobei insbesondere vorgesehen ist, dass die Position der Kinematik (110, 115, 120) anhand eines von dem die Positionsbestimmung durchführenden Maschinenbereich (105) durchgeführten direkten signaltechnischen Messverfahrens (230, 235, 240, 245) ermittelt wird, dass die Position der Kinematik (110, 115, 120) in Betriebssituationen der Maschine, in denen keine signaltechnische Verbindung möglich ist, anhand eines indirekten Messverfahrens (210, 215, 220, 225) ermittelt wird, wobei anhand des direkten Messverfahrens (230, 235, 240, 245) und anhand des indirekten Messverfahrens (210, 215, 220, 225) ermittelte Positionsdaten zur Positionsbestimmung der Kinematik (110, 115, 120) gemeinsam ausgewertet werden.The present invention relates to a method and a device for determining the position of a kinematics (110, 115, 120) of a preferably hydraulic machine, wherein the kinematics (110, 115, 120) is peripherally arranged relative to a position determining machine section (105), and wherein it comes to operating situations of the machine, in which between the kinematics (110, 115, 120) and the position determining machine area (105) no signal connection is possible, and wherein it is provided in particular that the position of the kinematics (110, 115, 120) is determined on the basis of one of the position determining by performing machine area (105) carried out direct signal measuring method (230, 235, 240, 245) that the position of the kinematics (110, 115, 120) in operating situations of the machine, in which no signal Connection is possible, using an indirect measurement method (210, 215, 220, 225) he is averaged, wherein on the basis of the direct measuring method (230, 235, 240, 245) and based on the indirect measuring method (210, 215, 220, 225) determined position data for determining the position of the kinematics (110, 115, 120) are evaluated together.
Description
Die Erfindung betrifft ein Verfahren und eine Vorrichtung zur Positionsbestimmung von Kinematiken von Arbeitsmaschinen, insbesondere von Kinematiken mobiler Arbeitsmaschinen, gemäß den Oberbegriffen der jeweiligen unabhängigen Ansprüche. Gegenstand der vorliegenden Erfindung sind auch ein Computerprogramm, ein maschinenlesbarer Datenträger zur Speicherung des Computerprogramms und ein elektronisches Steuergerät, mittels derer das Verfahren durchführbar ist.The invention relates to a method and a device for determining the position of kinematics of working machines, in particular of kinematics of mobile machines, according to the preambles of the respective independent claims. The present invention also relates to a computer program, a machine-readable data carrier for storing the computer program and an electronic control unit, by means of which the method can be carried out.
Stand der TechnikState of the art
Hier betroffene Kinematiken mobiler Maschinen, z.B. Arbeitsarme von Baumaschinen wie Baggern, werden meist rein hydraulisch angesteuert. Allerdings wird die Hydraulik bei Baumaschinen und speziell bei Baggern zunehmend elekronifiziert, z.B. um Assistenzsysteme bereitzustellen, mittels derer ein Maschinen- bzw. Fahrzeugführer z.B. auf einem Monitor angezeigt bekommt, wie er präzise zu baggern hat. Dabei werden Linien oder Konturen vorgegeben, welche nicht überschritten werden dürfen. Fortgeschrittene Assistenzsysteme können auch in die Steuerung der Hydraulik eingreifen, falls z.B. eine Grenzlinie überschritten wird. Neben entsprechend teilautomatisierten Baggern gibt es bereits Prototypen von vollautomatisch arbeitenden Baggern.Affected kinematics of mobile machines, e.g. Working arms of construction machinery such as excavators are usually controlled purely hydraulically. However, the hydraulics of construction machinery and especially of excavators are increasingly becoming more complicated, e.g. to provide assistance systems by which a machine operator, e.g. gets displayed on a monitor as he has to excavate precisely. Here, lines or contours are specified, which must not be exceeded. Advanced assistance systems can also intervene in the control of the hydraulics if e.g. a borderline is exceeded. In addition to correspondingly semi-automatic excavators, there are already prototypes of fully automatic excavators.
Eine Grundlage bei der Implementierung genannter Funktionen ist die Möglichkeit, den Zustand einer genannten Kinematik, im speziellen eines sogenannten „Tool Center Point“ (TCP), welcher einen Referenzpunkt für ein z.B. an einem Baggerarm angeordnetes Werkzeug dient, möglichst präzise bestimmen zu können. Die Bestimmung des TCP erfolgt dabei relativ zur Position der Maschine, z.B. in Bezug auf einen Oberwagen eines Baggers, sowie absolut in Bezug auf den räumlichen Arbeitsbereich der Maschine.A basis in the implementation of said functions is the possibility of the state of a said kinematics, in particular a so-called "Tool Center Point" (TCP), which is a reference point for a e.g. Tool arranged on an excavator arm serves to be able to determine as precisely as possible. The determination of the TCP is relative to the position of the machine, e.g. in relation to a superstructure of an excavator, as well as absolutely in relation to the spatial working range of the machine.
Die Position eines genannten Oberwagens der Maschine in Bezug auf den Arbeitsbereich wird meist über ein GPS-basiertes Messsystem ermittelt. Zur Bestimmung des TCP ist daher noch die Position des TCP relativ zu einem an dem Oberwagen angeordneten GPS-Referenzpunkt zu ermitteln. Hierzu gibt es bekanntermaßen verschiedene Ansätze, wie die Berechnung des TCP anhand der Kinematik eines genannten Arbeitsarms und/oder anhand von an hydraulischen Zylindern des Arbeitsarms verbauten Wegsensoren, an Armgelenken angeordneten Winkelsensoren oder an Teilen des Arbeitsarms angeordneten Inertialsensoren erfolgen kann.The position of a given superstructure of the machine in relation to the working area is usually determined by a GPS-based measuring system. To determine the TCP, therefore, the position of the TCP is still to be determined relative to a GPS reference point arranged on the superstructure. For this purpose, there are known to be various approaches, such as the calculation of the TCP based on the kinematics of a working arm and / or based on built-in hydraulic cylinders working arm displacement sensors, arranged on arm joints angle sensors or parts of the working arm arranged inertial sensors can be done.
Zur Bestimmung des TCP selbst werden im Stand der Technik insbesondere genannte Inertialsensoren und Drehwinkelgeber eingesetzt. Allerdings ist die Positionsbestimmung mittels Inertialsensoren insbesondere bei Drehungen des Oberwagens meist noch relativ ungenau. Aufgrund von Sensorfehlern, Messrauschen, losabhängigem Gelenkspiel in den Armgelenken und möglichen Verwindungen von Armteilen bei sich ändernden Lasten erreicht dieses System nur eine begrenzte Genauigkeit. Dabei werden mögliche Verwindungen des Oberwagens meist nicht berücksichtigt, da diese in Relation zur Armverwindung als zu gering angesehen werden. Zudem steigt diese Ungenauigkeit mit der Zeit aufgrund von Verschleiß, z.B. über das Einlaufen von Lagerbolzen.To determine the TCP itself, in particular the inertial sensors and rotary encoders mentioned in the prior art are used. However, the position determination by means of inertial sensors, in particular during rotations of the superstructure, is usually still relatively inaccurate. Due to sensor errors, measurement noise, loose joint play in the arm joints and possible twisting of arm parts with changing loads, this system achieves only a limited accuracy. Possible twisting of the superstructure is usually not considered, as these are considered to be too small in relation to arm twisting. In addition, this inaccuracy increases with time due to wear, e.g. about the entry of bearing bolts.
Ein genannter GPS-Sensor an dem TCP ist aufgrund von auftretender Abschattung des Sensors, z.B. beim Betrieb der Maschine in einem tiefen Graben, nicht zuverlässig einsetzbar. Andere Ansätze wie die Abstandsbestimmung des TCP zum Oberwagen mittels Ultraschall, Laser oder kamerabasierten Abstandsmessungen scheiden ebenfalls aus, da auch diese z.B. beim Baggern unter Wasser, in tiefen Löchern oder hinter Spundwänden nicht funktionieren, da kein Sichtkontakt mehr zwischen Oberwagen und TCP besteht. Auch optische Messsysteme sind bei Regen, Staub und Nebel meist ebenfalls problematisch. So gibt es derzeit keine hochgenauen TCP-Erfassungsmethoden mit Inertialsensoren, welche in allen möglichen Einsatzbereichen einer hier betroffenen Maschine präzise und zuverlässig funktionieren.A named GPS sensor on the TCP is due to shadowing of the sensor, e.g. when operating the machine in a deep trench, not reliable use. Other approaches such as the determination of the distance of the TCP to the superstructure by means of ultrasound, laser or camera-based distance measurements are also eliminated, as these, too, e.g. when digging underwater, in deep holes or behind sheet pile walls do not work because there is no visual contact between the superstructure and TCP. Optical measuring systems are usually also problematic in rain, dust and fog. For example, there are currently no high-precision TCP acquisition methods with inertial sensors that work precisely and reliably in all possible areas of application of a machine affected here.
Offenbarung der ErfindungDisclosure of the invention
Der Erfindung liegt die Idee zugrunde, mittels einer Anordnung von Sensoren sowie einer geeigneten Zusammenführung entsprechend erfasster Sensorsignale die Position einer hier betroffenen Kinematik einer Maschine, insbesondere einen genannten TCP, möglichst genau zu bestimmen. Dadurch werden vorteilhaft genannte Assistenz- und/oder Automatisierungsfunktionen ermöglicht. Falls es hierbei aufgrund von nicht änderbaren Randbedingungen zu einer Verringerung der Genauigkeit der TCP-Position in bestimmten Arbeitssituationen kommt, so ist dies zum einen einem Maschinenführer mitzuteilen. Andererseits muss die Maschine weiterhin benutzbar sein, wobei insbesondere auch erforderliche Sicherheitsfunktionen, welche z.B. den Arbeitsbereich der Maschine begrenzen können, bereitgestellt werden müssen.The invention is based on the idea of determining the position of a kinematics of a machine, in particular a TCP mentioned, as accurately as possible by means of an arrangement of sensors and a suitable combination of correspondingly detected sensor signals. As a result, said assistance and / or automation functions are advantageously made possible. If this leads to a reduction in the accuracy of the TCP position in certain work situations due to unchangeable boundary conditions, this must be reported to a machine operator. On the other hand, the machine must continue to be usable, and in particular also required safety functions, which e.g. be able to limit the work area of the machine must be provided.
Die an sich bekannten Ansätze, bei welchen der TCP anhand der Lage von Kinematik-Elementen über z.B. Inertialsensoren bestimmt werden, sind oftmals ungenau und es besteht keine Möglichkeit, die Genauigkeit mit angemessenem Aufwand zu erhöhen. So kann die Genauigkeit nur anhand von aufwändigen Modellberechnungen, die zudem vor ihrer Anwendung mit tatsächlich vorliegenden Positionsdaten abgeglichen werden müssen, erhöht werden. Dabei sind zusätzliche Signale, z.B. Druckwerte einzelner Hydraulikzylinder und/oder Fahrgeschwindigkeiten der Maschine und/oder Drehzahlen eines genannten Oberwagens, zu erfassen und auszuwerten. Ein solcher Ansatz ist daher mit erheblichen Kosten verbunden und bedarf zudem einer genauen Anpassung eines zugrunde liegenden Modells bzw. entsprechender Modellparameter an die jeweilige Maschine.The approaches known per se, in which the TCP is determined on the basis of the position of kinematics elements via eg inertial sensors, are often inaccurate and there is no possibility to increase the accuracy with reasonable effort. Thus, the accuracy can be increased only on the basis of complex model calculations, which also need to be compared with their actual position data prior to their application. There are additional signals, eg pressure values individual hydraulic cylinders and / or travel speeds of the machine and / or speeds of a said superstructure to detect and evaluate. Such an approach is therefore associated with considerable costs and also requires a precise adaptation of an underlying model or corresponding model parameters to the respective machine.
Die Erfindung schlägt ein Verfahren sowie eine Vorrichtung bzw. Sensoranordnung zur direkten Messung des TCP in Bezug auf einen Oberwagen oder dergleichen einer hier betroffenen Maschine vor, wobei insbesondere Zusammenführung von mit einer indirekten, zuverlässigen Messmethode sowie mit einer direkten Messmethode erfassten Positionsdaten vorgesehen ist. The invention proposes a method and a device or sensor arrangement for the direct measurement of the TCP with respect to an uppercarriage or the like of a machine involved here, wherein in particular merging of position data acquired with an indirect, reliable measuring method and with a direct measuring method is provided.
Dadurch wird eine erhebliche Verbesserung der Genauigkeit bei der TCP-Ermittlung ermöglicht. Das Verfahren umfasst zudem insbesondere eine gegenüber der genannten, zuverlässigen Messmethode weniger genaue Rückfallebene, welche z.B. mittels Inertialsensoren bereitgestellt wird. Diese Rückfallebene wird in Arbeits- bzw. Betriebssituationen der Maschine bereitgestellt, in denen genannte Sensoren zur direkten Messung des TCP anhand von Abstands- und/oder Winkelmessungen in Bezug auf den Oberwagen oder dergleichen nicht funktionieren.This provides a significant improvement in TCP discovery accuracy. In particular, the method comprises a less accurate fallback level than the said reliable measuring method, which e.g. provided by inertial sensors. This fallback level is provided in operating or operating situations of the machine in which said sensors for direct measurement of the TCP do not function on the basis of distance and / or angle measurements with respect to the superstructure or the like.
Bei dem vorgeschlagenen Verfahren zur Positionsbestimmung einer hier betroffenen Kinematik einer Maschine, insbesondere einer hydraulischen Maschine oder einer mobilen hydraulischen Arbeitsmaschine, wobei die Kinematik gegenüber einem die Positionsbestimmung durchführenden Maschinenbereich peripher angeordnet ist, und wobei es zu Betriebssituationen der Maschine kommt, in denen zwischen der Kinematik und dem die Positionsbestimmung durchführenden Maschinenbereich keine signaltechnische Verbindung möglich ist, ist insbesondere vorgesehen, dass die Position der Kinematik anhand eines von dem die Positionsbestimmung durchführenden Maschinenbereich durchgeführten direkten signaltechnischen Messverfahrens ermittelt wird, dass die Position der Kinematik in Betriebssituationen der Maschine, in denen keine signaltechnische Verbindung möglich ist, anhand eines indirekten Messverfahrens ermittelt wird, wobei anhand des direkten Messverfahrens und anhand des indirekten Messverfahrens ermittelte Positionsdaten zur Positionsbestimmung der Kinematik gemeinsam ausgewertet werden.In the proposed method for determining the position of a kinematics of a machine, in particular a hydraulic machine or a mobile hydraulic working machine, wherein the kinematics is arranged peripherally relative to a position determining machine area, and it comes to operating situations of the machine, in which between the kinematics In particular, it is provided that the position of the kinematics is determined on the basis of a direct signal engineering measuring method carried out by the machine area performing the position determination that the position of the kinematics in operating situations of the machine in which no signal technical Connection is possible, is determined by an indirect measurement method, using the direct measurement method and the indirect measurement method ermit telte position data for determining the position of the kinematics are evaluated together.
Als genannte Rückfallebene kann die TCP-Bestimmung mittels an Armteilen einer hier betroffenen Maschine oder die Zylinderlage erfassenden Inertialsensoren erfolgen. Die entsprechende Genauigkeit kann über einen Abgleich zwischen einem mit einer inversen Kinematik berechneten TCP und einem direkt von z.B. einem Baggeroberwagen aus gemessenen TCP erhöht werden. Da diese Messverfahren eine direkte Sichtlinie zwischen dem jeweiligen Sensor auf dem Oberwagen und dem TCP erfordern, sind sie nicht permanent einsetzbar. In Zeiträumen, in denen eine direkte Messung nicht verfügbar ist, wird der TCP daher anhand eines Modells der Kinematik und den von den Initialsensoren gelieferten Daten berechnet.As a named fallback level, the TCP determination can take place by means of inertial sensors which detect at arm parts of a machine concerned here or the cylinder position. The corresponding accuracy can be obtained by matching between a TCP calculated with inverse kinematics and a signal directly from e.g. An excavator superstructure can be increased from measured TCP. Since these measurement methods require a direct line of sight between the respective sensor on the superstructure and the TCP, they are not permanently usable. In periods where a direct measurement is not available, the TCP is therefore calculated based on a model of the kinematic and the data provided by the initial sensors.
Auch kann vorgesehen sein, dass anhand von mit Drucksensoren und/oder mit genannten Inertial- oder Zylinderpositionssensoren erfassten „groben“ Positionsdaten von Armelementen die momentane mechanische Belastung auf den Arm bzw. auf die Armelemente berechnet wird. Wird nun während eines vorliegenden Sichtkontakts zwischen dem jeweiligen Sensor auf dem Oberwagen und dem TCP ein Abgleich zwischen der z.B. über Peilsender erfassten tatsächlichen Position und den über genannte Inertialsensoren und/oder über an hydraulischen Zylindern angeordnete Drucksensoren modellierten Position durchgeführt, kann dadurch die Güte der Modellierung erheblich verbessert werden. Dadurch sind höhere Positionsgenauigkeiten möglich, auch wenn kein Sichtkontakt besteht. Es ist anzumerken, dass genannte Zylinderdruckdaten bei elektronifizierten, hydraulischen Systemen meist bereits als Messwerte zur Verfügung stehen.It can also be provided that the instantaneous mechanical load on the arm or on the arm elements is calculated on the basis of "coarse" position data of arm elements detected with pressure sensors and / or with specified inertial or cylinder position sensors. If, during an instant visual contact between the respective sensor on the superstructure and the TCP, an alignment between the e.g. This is done by means of tracked actual position and the above-mentioned inertial sensors and / or modeled on arranged on hydraulic cylinders pressure sensors position, thereby the quality of the modeling can be significantly improved. As a result, higher position accuracies are possible, even if there is no visual contact. It should be noted that said cylinder pressure data are usually already available as measured values in the case of electronized, hydraulic systems.
Das indirekte Messverfahren kann anhand von an der Kinematik angeordneten Sensoren durchgeführt werden, welche durch wenigstens einen an der Kinematik angeordneten Inertialsensor, Linearpositionsgeber an einer Linearachse und/oder einem Winkelpositionsgeber realisiert werden können. Die bei dem indirekten Messverfahren gewonnenen Daten können auf der Grundlage einer Modellrechnung ausgewertet werden, wobei ein anhand der Modellrechnung ermittelter Schätzwert der Position der Kinematik mit einem direkt gemessenen Positionswert verglichen wird und ein bei der Modellrechnung zugrunde gelegtes kinematisches Modell anhand eines sich bei dem Vergleich ergebenden Differenzwertes der Position der Kinematik angepasst bzw. optimiert werden kann. Bei der Modellrechnung können zudem im Betrieb der Maschine auftretende, mechanische Belastungen der Kinematik bzw. von Teilen der Kinematik berücksichtigt werden.The indirect measuring method can be carried out by means of sensors arranged on the kinematics, which can be realized by at least one inertial sensor arranged on the kinematics, linear position sensors on a linear axis and / or an angular position sensor. The data obtained in the indirect measurement method can be evaluated on the basis of a model calculation, whereby an estimated value of the position of the kinematics determined using the model calculation is compared with a directly measured position value and a kinematic model used in the model calculation on the basis of a comparison Differential value of the position of the kinematics can be adjusted or optimized. In the model calculation, mechanical loads of the kinematics or parts of the kinematics occurring during operation of the machine can also be taken into account.
Das direkte Messverfahren kann mittels wenigstens eines hochfrequenten Signalgebers bzw. Signalempfängers und/oder mittels wenigstens einer optischen Kamera und/oder mittels wenigstens eines Laserentfernungsmessers und/oder mittels wenigstens eines Ultraschallsensors durchgeführt werden.The direct measuring method can be performed by means of at least one high-frequency signal transmitter or signal receiver and / or by means of at least one optical camera and / or by means of at least one laser rangefinder and / or by means of at least one ultrasonic sensor.
Die Vorrichtung umfasst eine Signaltechnik zur direkten Erfassung der Position der Kinematik, eine Sensortechnik zur indirekten Ermittlung der Position der Kinematik sowie Rechenmittel zur gemeinsamen Auswertung der direkt erfassten und indirekt ermittelten Positionsdaten. Die direkte Erfassung der Position der Kinematik kann mittels wenigstens eines hochfrequenten Signalgebers bzw. Signalempfängers und/oder mittels wenigstens einer optischen Kamera und/oder mittels wenigstens eines Laserentfernungsmessers und/oder mittels wenigstens eines Ultraschallsensors erfolgen. Die indirekte Ermittlung der Position der Kinematik kann mittels wenigstens eines an der Kinematik angeordneten hydraulischen Druckgebers und/oder wenigstens eines hydraulischen Linearpositionsgebers und/oder wenigstens eines hydraulischen Winkelpositionsgebers und/oder wenigstens eines Inertialsensors (Beschleunigungssensor und/oder Gyrometer) erfolgen.The device comprises a signal technology for the direct detection of the position of the kinematics, a sensor technology for the indirect determination of the Position of the kinematics as well as calculation means for the joint evaluation of the directly detected and indirectly determined position data. The direct detection of the position of the kinematics can take place by means of at least one high-frequency signal transmitter or signal receiver and / or by means of at least one optical camera and / or by means of at least one laser rangefinder and / or by means of at least one ultrasound sensor. The indirect determination of the position of the kinematics can take place by means of at least one hydraulic pressure transmitter arranged on the kinematics and / or at least one hydraulic linear position sensor and / or at least one hydraulic angular position sensor and / or at least one inertial sensor (acceleration sensor and / or gyrometer).
Die Erfindung ermöglicht vorteilhaft die Erhöhung der Genauigkeit und Zuverlässigkeit bei der Positionsbestimmung von Kinematiken bevorzugt mobiler Arbeitsmaschinen, insbesondere bei der TCP-Bestimmung dort angeordneter Werkzeuge. Die genannte Rückfallebene ermöglicht eine ebenfalls verbesserte Messgenauigkeit auch bei Nichtvorliegen eines direkten Sichtkontakts zwischen einem genannten Oberwagen und dem TCP.[PN1] The invention advantageously makes it possible to increase the accuracy and reliability in determining the position of kinematics, preferably mobile working machines, in particular in the case of the TCP determination of tools arranged there. The said fallback level also allows an improved measurement accuracy even in the absence of direct visual contact between a named superstructure and the TCP. [PN1]
Die Erfindung kann insbesondere bei bzw. in einer mobilen Baumaschine, z.B. einem Schaufelbagger oder Bau-/Ladekran zum Einsatz kommen. Es ist anzumerken, dass die Bestimmung des TCP die Grundlage nahezu jedes Assistenzsystems für Maschinen mit Manipulator-Kinematik, z.B. für Bagger, Telehandler, Forstmaschinen, Baukräne oder LKW-Ladekrane, darstellt. Zudem ermöglicht die genaue Kenntnis des TCP eine präzise Begrenzung des Arbeitsbereichs der Maschine sowie ein genaues Protokollieren des Baufortschritts insbesondere bei einem automatischen bzw. teilautomatischen Betrieb der Maschine.In particular, the invention may be applied to a mobile construction machine, e.g. a shovel or construction / loading crane are used. It should be noted that the determination of TCP is the basis of almost any assistance system for machines with manipulator kinematics, e.g. for excavators, telehandlers, forestry machines, construction cranes or truck loading cranes. In addition, the exact knowledge of the TCP allows a precise limitation of the working range of the machine as well as an accurate logging of the construction progress, in particular during an automatic or semi-automatic operation of the machine.
Das Computerprogramm ist eingerichtet, jeden Schritt des Verfahrens durchzuführen, insbesondere wenn es auf einem Rechengerät oder einem Steuergerät abläuft. Es ermöglicht die Implementierung des Verfahrens auf einem elektronischen Steuergerät, ohne an diesem bauliche Veränderungen vornehmen zu müssen. Hierzu ist der maschinenlesbare Datenträger vorgesehen, auf welchem das Computerprogramm gespeichert ist. Durch Aufspielen des Computerprogramms auf ein elektronisches Steuergerät wird das elektronische Steuergerät erhalten, welches eingerichtet ist, um eine hier betroffene Maschine mittels des Verfahrens zu steuern.The computer program is set up to perform each step of the method, in particular if it runs on a computing device or a control unit. It enables the implementation of the method on an electronic control unit, without having to make structural changes. For this purpose, the machine-readable data carrier is provided, on which the computer program is stored. By loading the computer program onto an electronic control unit, the electronic control unit is obtained, which is set up to control a machine affected here by means of the method.
Weitere Vorteile und Ausgestaltungen der Erfindung ergeben sich aus der Beschreibung und den beiliegenden Zeichnungen.Further advantages and embodiments of the invention will become apparent from the description and the accompanying drawings.
Es versteht sich, dass die voranstehend genannten und die nachstehend noch zu erläuternden Merkmale nicht nur in der jeweiligen angegebenen Kombination, sondern auch in anderen Kombinationen oder in Alleinstellung verwendbar sind, ohne den Rahmen der vorliegenden Erfindung zu verlassen.It is understood that the features mentioned above and those yet to be explained below can be used not only in the particular combination indicated, but also in other combinations or in isolation, without departing from the scope of the present invention.
Figurenlistelist of figures
-
1 zeigt am Beispiel eines schematisch dargestellten Schaufelbaggers mögliche Ursachen für Ungenauigkeiten bei einer gemäß dem Stand der Technik erfolgenden Bestimmung eines genannten TCP.1 shows the example of a shovel schematically illustrated possible causes of inaccuracies in a taking place according to the prior art determination of a said TCP. -
2a zeigt eine der1 entsprechende Darstellung eines zur Bestimmung des TCP erfindungsgemäß an einem Oberwagen mit drei ortsfest angeordneten Peilsendern ausgestatteten Baggers.2a shows one of the1 corresponding representation of an invention for determining the TCP according to the invention on a superstructure with three stationary Peilsendern equipped excavator. -
2b zeigt schematisch eine erfindungsgemäße Auswertung von in2a gezeigten Peilsendern ausgesendeten Signalen.2 B shows schematically an inventive evaluation of in2a shown Peilsendern emitted signals. -
3 zeigt eine den vorherigen Figuren entsprechende Darstellung eines Baggers mit einer zur Bestimmung des TCP erfindungsgemäß an dem Oberwagen ortsfest angeordneten Kamera.3 shows a representation corresponding to the previous figures of an excavator with a for the determination of the TCP according to the invention on the upper carriage stationarily arranged camera. -
4 zeigt eine den vorherigen Figuren entsprechende Darstellung eines Baggers mit einer zur Bestimmung des TCP erfindungsgemäß vorgesehenen, laserbasierten Abstandsmessung.4 shows a representation corresponding to the previous figures of an excavator with an inventively provided for the determination of the TCP, laser-based distance measurement. -
5 zeigt ein Ausführungsbeispiel des erfindungsgemäßen Verfahrens bzw. einer entsprechenden Logik bzw. Schaltungsanordnung zur Bestimmung des TCP, und zwar anhand eines Flussdiagramms.5 shows an embodiment of the method according to the invention or a corresponding logic or circuit arrangement for determining the TCP, namely with reference to a flowchart.
Beschreibung von AusführungsbeispielenDescription of exemplary embodiments
Der Schaufelbagger umfasst einen Unterwagen
Im Betrieb des Schaufelbaggers sind die Gelenkarme
Im Folgenden werden zunächst einige Ausführungsbeispiele einer erfindungsgemäßen Vorrichtung beschrieben, mit denen die relative Position des TCP 127 in Bezug auf einen Oberwagen
Bei dem in
Die Peilsender
Anhand der Empfangszeitpunkte der eintreffenden drei Peilsendersignale und anhand des an sich bekannten ortsfesten Abstandes zwischen den drei Peilsendern kann eine z.B. an dem TCP
Gemäß dem in
Unter der Annahme, dass das erste am Empfänger
Die genaue Position kann in an sich bekannter Weise mittels trigonometrischer Funktionen, und zwar anhand der erfassten Zeitunterschiede zwischen den einzelnen Peilsignalen, ermittelt werden. Falls nur zwei Peilsignale empfangen werden, so ist ein Sender abgeschattet oder defekt und es kann keine exakte Positionsbestimmung des TCP
Ein weiterer Vorteil des beschriebenen, funktechnischen Ansatzes liegt darin, dass keine hochgenau synchronisierten Uhren zwischen dem TCP
In einer gegenüber
Gemäß einem in
Ein Vorteil dieses Ausführungsbeispiels liegt darin, dass die Kamera
Bei einem in
Einen besonderen Aspekt des erfindungsgemäßen Verfahrens stellt die genannte Zusammenführung bzw. Fusion von Sensorsignalen der Inertialsensoren 210, 215, 220, 225 und der durch direkte Messung des TCP
Die Position einzelner Armelemente bzw. deren Winkel wird, basierend auf Daten
Der Fokus bei der Zusammenführung
Das bei der TCP-Bestimmung zugrunde gelegte Modell kann, basierend auf den Messwerten der Inertialsensoren
Die genannten Abweichungen können mittels selbstlernender Algorithmen, Kennfelder oder Berechnungsvorschriften deshalb bei hier betroffenen Maschinen vorteilhaft ermittelt werden, da z.B. ein Bagger ähnliche Bewegungen sehr häufig wiederholend ausführt und die Einflussgrößen daher bekannt sind. Dadurch ist bei einer möglichen bzw. durchführbaren direkten TCP-Bestimmung ein zügiges Einlernen möglich. Falls dann beim späteren Arbeiten unter Wasser oder hinter Spundwänden die direkte TCP-Messung bzw. Regelung auf den TCP
Das beschriebene Verfahren kann in Form eines Steuerprogramms für ein elektronisches Steuergerät zur Steuerung einer hier betroffenen Maschine oder in Form einer oder mehrerer entsprechender elektronischer Steuereinheiten (ECUs) realisiert werden.The method described can be implemented in the form of a control program for an electronic control unit for controlling a machine affected here or in the form of one or more corresponding electronic control units (ECUs).
Claims (13)
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE102017203653.2A DE102017203653A1 (en) | 2017-03-07 | 2017-03-07 | Method and device for determining the position of kinematics, in particular mobile machines |
PCT/EP2018/055442 WO2018162461A1 (en) | 2017-03-07 | 2018-03-06 | Method and device for determining the position of kinematic systems, in particular of mobile working machines |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE102017203653.2A DE102017203653A1 (en) | 2017-03-07 | 2017-03-07 | Method and device for determining the position of kinematics, in particular mobile machines |
Publications (1)
Publication Number | Publication Date |
---|---|
DE102017203653A1 true DE102017203653A1 (en) | 2018-09-13 |
Family
ID=61616997
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
DE102017203653.2A Withdrawn DE102017203653A1 (en) | 2017-03-07 | 2017-03-07 | Method and device for determining the position of kinematics, in particular mobile machines |
Country Status (2)
Country | Link |
---|---|
DE (1) | DE102017203653A1 (en) |
WO (1) | WO2018162461A1 (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102019201091A1 (en) * | 2019-01-29 | 2020-07-30 | Robert Bosch Gmbh | Method for estimating the position and orientation of several moving modules in a common system |
DE102019132024A1 (en) * | 2019-11-26 | 2021-05-27 | Sick Ag | security system |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130275035A1 (en) | 1998-11-27 | 2013-10-17 | Trimble Navigation Limited | Performing non-contact based determination of the position of an implement |
US20160114198A1 (en) | 2014-10-23 | 2016-04-28 | Michael P. Ziaylek | Mounting bracket with inertia dampening mechanism for holding a cylindrical tank |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9746329B2 (en) * | 2006-11-08 | 2017-08-29 | Caterpillar Trimble Control Technologies Llc | Systems and methods for augmenting an inertial navigation system |
JP2012233353A (en) * | 2011-05-02 | 2012-11-29 | Komatsu Ltd | Calibration system for hydraulic shovel and calibration method for the hydraulic shovel |
WO2015162710A1 (en) * | 2014-04-23 | 2015-10-29 | 株式会社日立製作所 | Excavation device |
US9428885B2 (en) * | 2014-09-15 | 2016-08-30 | Trimble Navigation Limited | Guidance system for earthmoving machinery |
-
2017
- 2017-03-07 DE DE102017203653.2A patent/DE102017203653A1/en not_active Withdrawn
-
2018
- 2018-03-06 WO PCT/EP2018/055442 patent/WO2018162461A1/en active Application Filing
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130275035A1 (en) | 1998-11-27 | 2013-10-17 | Trimble Navigation Limited | Performing non-contact based determination of the position of an implement |
US20160114198A1 (en) | 2014-10-23 | 2016-04-28 | Michael P. Ziaylek | Mounting bracket with inertia dampening mechanism for holding a cylindrical tank |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102019201091A1 (en) * | 2019-01-29 | 2020-07-30 | Robert Bosch Gmbh | Method for estimating the position and orientation of several moving modules in a common system |
DE102019132024A1 (en) * | 2019-11-26 | 2021-05-27 | Sick Ag | security system |
EP3828584A1 (en) * | 2019-11-26 | 2021-06-02 | Sick Ag | Safety system |
US11892551B2 (en) | 2019-11-26 | 2024-02-06 | Sick Ag | Safety system |
Also Published As
Publication number | Publication date |
---|---|
WO2018162461A1 (en) | 2018-09-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
DE102007051198B4 (en) | System and method for automatic adjustment of a working device | |
EP2193333B1 (en) | Positioning method | |
DE112009001466B4 (en) | Inclinometer measuring system and method for correcting motion-induced acceleration errors | |
EP1842077B1 (en) | Method for determining a positional information of at least one object | |
DE102009018070A1 (en) | Mobile work machine with a position control device of a working arm and method for position control of a working arm of a mobile machine | |
DE112016000014B4 (en) | Control system for a work vehicle, control method and work vehicle | |
WO2011020561A1 (en) | Mobile working machine with a control device, comprising a working arm, and methods for controlling the operating point of a working arm of a mobile working machine | |
DE102018209336A1 (en) | Method and device for operating autonomously operated working machines | |
DE102018207706A1 (en) | Environmental scan using a work machine with a camera | |
WO2020182592A1 (en) | Crane and device for controlling same | |
CN103900497B (en) | Based on the contactless digger operating device attitude measurement method of vision measurement | |
DE102013014626A1 (en) | Determining the position of a displaceable measuring point on a machine | |
DE112020000310T5 (en) | Image processing system, image processing method, method for generating a learned model and data set for learning | |
DE112017004096T5 (en) | COLLECTION PROCESSING DEVICE FOR WORKING MACHINE AND A RECORDING PROCESSING METHOD OF WORKING MACHINE | |
DE102010060137A1 (en) | Excavator control using radio range finders | |
WO2006066853A1 (en) | Position determination system | |
DE112017002276T5 (en) | Construction system and construction method | |
WO2014146809A1 (en) | Mobile construction site surveying device, and device for providing information, particularly for generating handling instructions, for a construction machine operator | |
WO2020021059A1 (en) | Method for determining an angle of a tool of a machine | |
DE102018200060B4 (en) | Method for operating a mobile work machine and mobile work machine | |
DE102017203653A1 (en) | Method and device for determining the position of kinematics, in particular mobile machines | |
DE112018004270T5 (en) | CONTROL DEVICE AND CONTROL METHOD FOR LOADING MACHINE | |
EP4108837A1 (en) | System and method for locating an attached tool | |
WO1982001420A1 (en) | Method and installation for determining the move coordinates for the remote controlled path of a moving body | |
DE102022207943A1 (en) | Laser reference tracking and target corrections for work machines |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
R163 | Identified publications notified | ||
R119 | Application deemed withdrawn, or ip right lapsed, due to non-payment of renewal fee |