EP4314419A1 - Method for determining the position and spatial orientation of a tool of an agricultural vehicle - Google Patents

Method for determining the position and spatial orientation of a tool of an agricultural vehicle

Info

Publication number
EP4314419A1
EP4314419A1 EP22716901.8A EP22716901A EP4314419A1 EP 4314419 A1 EP4314419 A1 EP 4314419A1 EP 22716901 A EP22716901 A EP 22716901A EP 4314419 A1 EP4314419 A1 EP 4314419A1
Authority
EP
European Patent Office
Prior art keywords
determination unit
tool
position determination
location
data set
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.)
Pending
Application number
EP22716901.8A
Other languages
German (de)
French (fr)
Inventor
Emanuel SIZMANN
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Individual
Original Assignee
Individual
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Individual filed Critical Individual
Publication of EP4314419A1 publication Critical patent/EP4314419A1/en
Pending legal-status Critical Current

Links

Classifications

    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • E02F9/264Sensors and their calibration for indicating the position of the work tool
    • E02F9/265Sensors and their calibration for indicating the position of the work tool with follow-up actions (e.g. control signals sent to actuate the work tool)
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; 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/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/01Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/13Receivers
    • G01S19/14Receivers specially adapted for specific applications
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/01Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/13Receivers
    • G01S19/35Constructional details or hardware or software details of the signal processing chain
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/40Correcting position, velocity or attitude
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position
    • G01S19/48Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
    • G01S19/49Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an inertial position system, e.g. loosely-coupled

Definitions

  • the invention relates to a method for determining the position and spatial location of a tool for tilling the soil on an adjustable boom of a land vehicle.
  • the invention also relates to a computer program product, a system for determining the position and position in space of a tool for tillage on an adjustable boom of a land vehicle and a position and position determination assembly for such a system.
  • a position determination is understood to be the determination of a position of the tool or a section of the tool in relation to a defined fixed point, while the spatial position determination is understood as the determination of the alignment of the tool to the surrounding space, especially with regard to the horizontal or the perpendicular direction.
  • plan specifications which are typically either relative to a reference point or as absolute geostationary three-dimensional position data. This may include, for example, leveling an area to an absolute elevation or an elevation relative to a reference point, or excavating three-dimensional soil profiles.
  • an excavator is understood to be a construction machine for loosening and moving soil and rock, in particular for digging and backfilling of earth depressions, such as building pits and shafts.
  • Such excavators are designed as self-propelled land vehicles and have a structure which can be rotated about its vertical axis on a chassis of the excavator and has a boom, at the distal end of which a tool, such as an excavator shovel, is attached.
  • the boom itself has a plurality of joints and can thus be displaced radially inwards and outwards with them will.
  • the displacement of the boom and the tool is usually effected by hydraulics or electric motors.
  • floor profiles often have to be executed with an accuracy of a few centimetres. For example, a flat surface with a maximum deviation of +/-1.5 cm in relation to the geostationary position and height is required for a floor slab of a house.
  • the creation of soil profiles with the above accuracy and absolute positioning requires a specially equipped excavator or complex measurement methods.
  • an excavator that is not specially equipped for this purpose is used, particularly on small construction sites, with another person determining the height to be removed with measuring equipment between each earth-working operation.
  • the machine operator of the excavator and the other person can provide such a soil profile in cooperation.
  • a construction site measuring device to support such work is known, for example, from WO 2014/146809 A1.
  • this procedure is time-consuming and personnel-intensive.
  • a specially equipped excavator can also be used, mostly based on GNSS (Global Satellite Navigation Systems such as GPS, Galileo, GLONASS and Beidu) and/or laser reference plane, with a technically complex solution that is fully integrated in the excavator.
  • GNSS Global Satellite Navigation Systems
  • Such systems are factory installed.
  • These excavators are equipped with sensors on all moving parts of the boom that carry the tool and must be calibrated and measured accordingly.
  • These specially equipped excavators often use systems that intervene in the machine controls and partially automate the excavation process.
  • Such a system is known, for example, from WO 2008/091395 A2.
  • the system is designed for three-dimensional guidance of an excavator, based on GPS and laser reference, and includes a mobile GPS receiver, a system for positioning a tool in relation to the excavator, a Laser detector as well as a built-in control system.
  • a mobile GPS receiver a system for positioning a tool in relation to the excavator
  • a Laser detector as well as a built-in control system.
  • an external laser source can easily be shadowed and must be readjusted if the depth changes significantly.
  • the attachment and Ka calibration are expensive.
  • Excavators that are not specially equipped for this purpose can also be used, which are retrofitted accordingly. Retrofitting options are known, but they are technically complex. When installing such systems, manual measurement and calibration of at least part of the excavator geometry, such as the boom, is necessary so that a control unit can determine the position of the tool.
  • An integrated sensor unit for machine control is known from US 2019/0003825 A1, which supports a machine operator in finding the correct excavation depth.
  • the integrated sensor unit includes an acceleration sensor, a laser distance sensor (LDM) and a laser receiver for detecting a laser reference plane and optionally a GPS receiver.
  • LDM laser distance sensor
  • This unit is attached to the boom of the excavator and can detect the position of a tool via the LDM. Manual measurement is required for calibration. A suitable LDM reference must be attached for use.
  • Transport status information can also include distances between the transport device and the transponder. This provides a system that makes it possible to determine the distance between an RFID transponder, which can be attached to a tool, for example, and a transport device such as an excavator.
  • RFID Radio-Frequency Identification
  • RFID can achieve good distance resolution with a clear line of sight to the transponder, measuring the angle between the excavator body and the tool is technically complex and imprecise.
  • EP 1 029 306 B1 discloses a method for optically detecting the position and spatial location of a tool in relation to a machine.
  • This method uses markers on the tool to be followed, which one have predetermined relative position to each other. The detection is based on image processing algorithms. For example, the position and spatial position of an excavator shovel in relation to the excavator can be determined.
  • One sensor unit is sufficient for tracking the tool, but depending on the technology, possibilities of use and/or resolution are limited. For example, optical processes depend on always having a sufficient view of the tool. Furthermore, this method is sensitive to contamination of the markers or a camera.
  • US Pat. No. 6,665,465 B2 discloses a clearing blade control system for a construction machine designed as a grader, in which the position and inclination of a clearing blade is recorded and adjusted using an ultrasonic sensor, starting from the reference point.
  • a guidance system for an excavator is known from US 2016/0076228 A1, on the boom of which a laser sensor is arranged.
  • a method for calibrating a detection device and a detection device is known from EP 2 806 248 A1.
  • the object of the invention is achieved by a method for determining the position and spatial orientation of a tool for soil cultivation on an adjustable boom of a land vehicle, with the steps:
  • Position data originating from a GNSS system and position data originating from a position sensor assembly of the attitude and position determination unit of the attitude and position determination assembly are combined in order to determine the position in space and position of the tool.
  • the position sensor assembly can be designed as an acceleration sensor assembly with at least two measurement axes and is designed, for example, to determine the current spatial position by comparing at least two acceleration values that are detected in the direction of the at least two measurement axes.
  • the attitude and position determination assembly or a component of the attitude and position determination assembly, such as the attitude and position determination unit, with a GNSS module, can be attached to the tool at an essentially freely selectable position.
  • An essentially freely selectable position is understood to mean a position that ensures a sufficient connection quality to satellites of the GNSS system.
  • the calibration data record allows the position data and position data that are indicative of the position in space and position of the attitude and position determination unit or a component of the attitude and position determination unit are to be evaluated in order to be able to determine the location and position of a reference mark of the tool.
  • a coordinate transformation or a base change is carried out with the calibration data record, so that the spatial position and location of the position and position determination unit of the position and position determination assembly can be used to determine the spatial position and position of the reference mark.
  • the reference mark can be a defined point on the tool, a line corresponding to an edge on the tool, or a tool tip.
  • the reference mark is a point or edge on the tool where the tool comes into contact with the media to be processed.
  • the following steps are carried out to determine the calibration data set: Attaching the location and position determination unit to the tool,
  • the vertical deviation is determined automatically, i.e. without intervention by the machine operator.
  • a calibration data set can also be determined if no data from a GNSS system is available, e.g. if there is no reception.
  • the following additional steps are carried out: Aligning the tool in such a way that the tool assumes a predetermined position with a predetermined inclination, in particular with a maximum inclination, and the reference mark remains at the same predetermined position during the alignment, with position data being compared with the GNSS system during the alignment module of the situation and position determination unit are recorded,
  • the control data record can be a predetermined sequence of control commands, with which the tool is brought into the specified, predetermined position without further intervention by a machine operator.
  • the predetermined position can be a position of maximum inclination, in which one or more joints of the cantilever are at their stop and further pivoting is no longer possible.
  • the control data record can be activated automatically during the course of the process.
  • the location and position determination unit of the position and position determination assembly describes a displacement along a circular or circular segment-shaped trajectory.
  • a comparison then takes place of data based on the GNSS data with data obtained on the basis of the calibration data set obtained using the manual method. In other words, both methods are compared with one another and an error or a deviation is determined, which then leads to an improved, supplemented calibration data set.
  • This procedure can also be carried out if a GNSS system is available again after an interim failure.
  • the following steps are carried out to determine the calibration data set: Attaching the location and position determination unit to the tool,
  • a target curve is approximated by a circle or a section of a circle, taking into account measurement points according to the position data, e.g. by Least SquareFit or Taubinfit, in order to determine the radius of the approximated circle or section of a circle that is representative of the distance is.
  • a total of at least three measuring points are controlled by moving the tool and then measured values are recorded and evaluated.
  • the accuracy can be increased if the number of controlled measuring points is increased.
  • the following steps are carried out to determine the calibration data set:
  • Data from a GNSS system is also a prerequisite for this procedure.
  • the position data are recorded here when the first measured value is recorded at the first measuring point and the second measured value is recorded at the second measuring point.
  • a target curve is approximated by a circle or a circle section, taking into account measuring points according to the position data, e.g. by Least SquareFit or Taubinfit, in order to determine the radius of the approximated circle or circle section that is representative of the distance is.
  • the following steps are carried out to determine the calibration data set:
  • the tool with the reference mark is shifted in such a way that the distance between the land vehicle and the tool is changed. This is done with the boom in such a way that the tool is moved essentially parallel to the reference mark over the ground.
  • “substantially” is understood to mean within technically caused deviations in the control of the boom. There is no tilting of the tool. For example, if the tool is designed as an excavator shovel, there is no rotational movement to change the inclination of the shovel. Furthermore, the boom does not rotate about the vertical axis of the land vehicle.
  • the tool does not rotate about the vertical axis of the land vehicle.
  • the land vehicle is designed as an excavator with a structure that can be rotated about its vertical axis and has a boom, there is no rotation about the vertical axis of the rotatable structure.
  • the displacement takes place in a straight line and without any rotational components.
  • the displacement can also take place in a non-linear manner, for example in an S-shape.
  • it is essential here that the first measuring point and the second measuring point are connected by a linear equation to be parameterized.
  • the first and second alignment data sets each contain data indicative of the positions of the reference mark at the first measurement point and the second measurement point. With the help of the data indicative of the positions, parameters of the straight line equation parameterizing a straight line equation connecting the positions can be determined.
  • a calibration data set can be determined, which is a calibration in relation to the North Pole or the Position of lines of longitude and latitude of a Cartesian coordinate system team allowed.
  • the absolute orientation of the tool in relation to the North Pole or the absolute direction of the compass can be determined. This improves compliance with absolute plan specifications for tillage.
  • the functionality of a compass can be provided with just a single GNSS module.
  • a land vehicle's own coordinate system can be aligned with the position of the north pole or the position of longitude and latitude lines of a Cartesian coordinate system.
  • an inertial navigation system of the position and position determination unit is used, which additionally provides data for the position data set.
  • the briefly accurate but drifting inertial system can be merged with the long-term stable but briefly variable fluctuating data of the GNSS system. This enables a more precise determination of the position as well as a position determination that is sufficiently precise for a short time in the event of a short-term interruption of a connection to the GNSS system.
  • a brief interruption of a connection to the GNSS system can occur during an excavation process, for example, if the excavated earth is moved in a tool designed as an excavator shovel and the GNSS antenna does not have a clear field of view to the satellites of the GNSS system.
  • the invention also includes a computer program product, a system for determining the position and position in space of a tool for soil processing on an adjustable boom of a land vehicle and a position and position determination assembly for such a system.
  • the situation and position determination assembly can have a display device and/or a terminal and/or control output device, the display device and/or the terminal and/or control output device being designed as a mobile device.
  • FIG. 1 shows a schematic representation of a land vehicle with a system for determining the position and spatial orientation of a tool on the land vehicle.
  • FIG. 2 shows, in a schematic representation, further details of the boom with the tool shown in FIG.
  • FIG. 3 shows further details of the tool shown in FIG. 1 in a schematic representation.
  • FIG. 4 shows a schematic representation of components of the system shown in FIG.
  • FIG. 5 shows further details of the reference station shown in FIG. 4 in a schematic representation.
  • FIG. 6 shows further details of one of the components of the system shown in FIG. 1 in a schematic representation.
  • FIG. 7 shows a schematic representation of a tool during a calibration process.
  • FIG. 8 shows a tool during a further calibration process in a schematic representation.
  • FIG. 9 shows a further calibration process in a schematic representation.
  • FIG. 10 shows a further calibration process in a schematic representation.
  • FIG. 11 shows a schematic representation of a process sequence according to a first exemplary embodiment for calibrating the system shown in FIG.
  • FIG. 12 shows a schematic representation of a process sequence according to a second exemplary embodiment for calibrating the system shown in FIG.
  • FIG. 13 shows a schematic representation of a process sequence according to a third exemplary embodiment for calibrating the system shown in FIG.
  • FIG. 14 shows a schematic representation of a method sequence according to a fourth exemplary embodiment for calibrating the system shown in FIG.
  • FIG. 15 shows a schematic representation of a tool during a calibration process according to a fifth exemplary embodiment for calibrating the system shown in FIG.
  • FIG. 16 shows, in a schematic representation, further details of the calibration process according to the fifth exemplary embodiment.
  • FIG. 17 shows a schematic representation of a process sequence according to the fifth exemplary embodiment for calibrating the system shown in FIG.
  • FIG. 18 shows a schematic representation of a process sequence for operating the system shown in FIG.
  • FIG. 1 A land vehicle 1 is shown with a system 21 for determining the position and spatial orientation of a tool 2 of the land vehicle 1 .
  • the land vehicle 1 is designed as an excavator with an adjustable boom 3, at the end of which the tool 2 is attached, which is designed as an excavator shovel in the present embodiment.
  • soil processing can be carried out according to plan specifications, in which case the surface of the earth is processed only with a reference mark 11 of the tool 2.
  • the reference mark 11 can be a defined point on the tool 2 or a line corresponding to an edge on the tool 2.
  • the agricultural vehicle 1 can also be designed as another construction machine with a different tool or as an agricultural machine with a corresponding tool.
  • a position and position determination module 4 and a terminal and/or control output device 6 are shown in FIG.
  • the location and position determination module 4 has a location and position determination unit 8 and a display device 5 .
  • the attitude and position determination subassembly 4 can also only have the attitude and position determination unit 8 .
  • the terminal device and/or the control output device 6 is arranged in the driver's cab of the land vehicle 1 .
  • the terminal and/or control output device 6 can also be designed as a mobile device.
  • a mobile device is understood to mean an end device which, due to its size and weight, can be carried without any major physical exertion and can therefore be used on the move. Examples of mobile devices are smartphones or tablet computers and notebooks.
  • the orientation and position determination unit 8 and the display device 5 are each fastened to the tool 2 or the boom 3 without tools and can also be detached from the tool 2 or the boom 3 without tools in the present exemplary embodiment.
  • magnets 9 are seen between the location and position determination unit 8 and the tool 2 and between the display device 5 and the boom 3 tween. It can be strong permanent magnets such as NdFeB magnets.
  • a frame-shaped holder 10 can also be used in order to attach the location and position determination unit 8 to the tool 2 and/or the display device 5 to the extension ger 3 .
  • the use of the frame-shaped bracket 10, which is firmly connected to the tool 2 or the boom 3, ensures that the location and position determination unit 8 and/or the display device 5 each have defined positions and spatial positions, which also after a separation or disassembly and re-assembly of the location and position determination unit 8 and/or the display device 5 are preserved. This also reduces the effort for calibrations.
  • Location and position determination unit 8 is placed on tool 2 in such a way that at least in certain positions of tool 2 there is a clear field of view of satellites 701 (see FIG. 4) of a GNSS system.
  • the attitude and position determination unit 8 is arranged on an upper side of the tool 2 designed as an excavator shovel.
  • a GNSS system Global Navigation Satellite System
  • the GNSS system can be a system such as GPS, Galileo, GLONASS or Beidu.
  • GNSS correction data such as RTCM (Radio Technical Commission for Maritime Services) data for RTK (Real Time Kinematic)
  • RTCM Radio Technical Commission for Maritime Services
  • RTK Real Time Kinematic
  • time-of-flight errors through the atmosphere and ionosphere can be corrected and thus precise values for the position can be determined.
  • the GNSS system can also be designed as a DGPS system (Differential Global Positioning System), in which the accuracy of the GNSS navigation is increased by broadcasting correction data (orbit and time system).
  • the system 21 and its components are designed for wireless, bidirectional data exchange and each have their own operating power supply.
  • the system 21 and its components can each have hardware and/or software components for the tasks and functions described below.
  • the display device 5 and/or the end device and/or control output device 6 and/or the location and position determination unit 8 can have software components of a computer program product for operating the system 21, the software components being designed in particular as modules.
  • location and position determination unit 8 has the following subcomponents:
  • IMU - Inertial Measuring Unit an acceleration sensor assembly
  • a transmitter and receiving module 706a for wireless data exchange with the other components of the system 21 for determining position and position in space
  • a display unit 704a an input device 705, a microcontroller as a computing unit for position and position calculation and an accumulator 707a for operating power supply.
  • the position sensor assembly 703 is designed to, by comparing at least two acceleration values that are detected in the direction of at least two measurement axes, the current spatial position of the attitude and position determination assembly 4 in relation to gravity or to the perpendicular L (see, e.g., Figure 7) to determine.
  • the at least two measurement axes of the respective acceleration sensors of the position sensor assembly 703 are arranged orthogonal to one another in order to determine the spatial position or an inclination of the tool 2 .
  • the position and position as well as the alignment of the reference mark 11 are determined from the position data PD and the position data LD of the position sensor assembly 703 and, in the present exemplary embodiment, a first calibration data set KDS and a second calibration data set KDS', as will be done later will be explained in detail later.
  • the attitude sensor assembly 703 may also include an inertial navigation system. It can combine the short-term accurate but drifting inertial system with the long-term stable but short-term variable fluctuating data of the GNSS systems are merged. This enables a more precise determination of the position as well as a position determination that is sufficiently precise for a short time in the event of a short-term interruption of a connection to the GNSS system.
  • a brief interruption of a connection to the GNSS system can occur during an excavation process, for example, if the excavated earth is moved in a tool 2 designed as an excavator shovel and the GNSS antenna 13 (see Figure 6) has no clear field of view to the satellites 701 .
  • the microcontroller calculates the difference between an actual position and a target position of the tool 2 during operation and displays it, for example, on the display unit 704a or transmits it to an external device.
  • the display device 5 has a display unit 704b, a transmission and reception module 706b and an accumulator 707b.
  • the terminal device and/or control output device 6 has a display unit 704c and a transmission and reception module 706c.
  • a connection to an on-board network of the land vehicle 1 is provided for operating energy supply.
  • an accumulator can also be provided for supplying operating energy.
  • the terminal and/or control output device 6 can be designed to read in a three-dimensional position data map. An absolute height and/or an absolute position of the tool 2 or the reference mark 11 is then displayed, for example, via the display unit 5 . An error or a deviation from a target height of the tool 2 or the reference mark 11 can also be displayed. Furthermore, a two- or three-dimensional view of the position data map with the current position of the tool 2 can be displayed, for example, via the terminal and/or control output device 6 .
  • the reference station 7 has a display unit 704d, a transmission and reception module 706d and an accumulator 707d.
  • GNSS reference station 7 Shown is the GNSS reference station 7, which is arranged on a tripod 12 in the present exemplary embodiment.
  • the reference station 7 should be positioned at a point with a known geostationary position and a clear field of view to the satellites 701 . If only relative position data is required, any location that offers a clear field of view of satellites 701 of the GNSS system is suitable.
  • the situation and position determination assembly 4 automatically connects to the reference station 7, for example via a mobile network (LTE, 3G, 5G, EDGE, ...) or using the display device 5 as a relay station, e.g. via long-distance radio.
  • WLAN, Bluetooth, 868MHz, LoRa, UWB radio or mobile radio standards can be used as transmission standards.
  • attitude and position determination unit 8 Reference is now also made to FIG. 6 in order to explain further details of attitude and position determination unit 8 .
  • the location and position determination unit 8 has an optional display 16 with, for example, LEDs as illuminants 15, which are connected to the other components of the location and position determination assembly 4 via a line connection (display connector 17) in order to transmit data and operating energy is. Furthermore, the location and position determination unit 8 in the present exemplary embodiment has keys 18, 19, 20 or other switching elements for configuration of the location and position determination assembly 4.
  • location and position determination unit 8 has a GNSS antenna 13 with a GNSS antenna center 14 .
  • the location and position determination subassembly 4 can be started up automatically, for example, without actuating a switch or button, simply by removing it from a transport container or using the button 18, for example. After removal, e.g. the attitude and position determination unit 8 wirelessly connects itself to the appropriate GNSS reference station 7 or to a GNSS correction data network service.
  • the location and position determination unit 8 is designed to determine a position data set PDS indicative of the position of the location and position determination assembly 4 with the GNSS module 702 after it has been attached to the tool 2 .
  • the location and position determination unit 8 is designed to determine a location data set LDS indicative of the spatial position of the location and position determination assembly 4 with the position sensor assembly 703 .
  • the location and position determination unit 8 is designed to evaluate the position data set PDS and the position data set LDS in the present exemplary embodiment using the first calibration data set KDS and the second calibration data set KDS' in order to generate an output data set To determine ADS indicative of the spatial location and position of the tool 2, and to output the output data record ADS.
  • a point at a desired height can be approached with reference mark 11 of tool 2 and by pressing button 19 be transferred to a configuration. Since the position and the height h between the reference mark 11 and, for example, the GNSS receiving antenna 13 are known from the calibration data set KDS, the position and spatial position of the reference mark 11 can now be determined based on the position and spatial position of the position and position determination unit 8 will.
  • the first calibration data record KDS and the second calibration data record KDS′ are determined at least once after the attitude and position determination unit 8 has been attached to the tool 2, as will be explained in detail later.
  • FIG. 7 Reference is now additionally made to FIGS. 7 and 8.
  • FIG. 7 A scenario is shown in FIG. 7 in which the tool 2 is aligned in the perpendicular L. It can also be seen that the location and position determination unit 8 in this position and spatial position has an angular offset with an angle value a relative to the spatial position B of the position and position determination unit 8 .
  • the angular value measured by the position sensor assembly 703 is that of the angle d with respect to the perpendicular L. In this position, the respective angular values of the angles a and d are equal. By taking angle a into account, the angular offset can be compensated.
  • the angle d can also be interpreted as a rod axis error or rod axis error, i.e. as a deviation from the perpendicular L, while the angle a can be interpreted as a tilting axis error in relation to the spatial position B of the location and position determination unit 8 .
  • FIG. 8 shows a scenario in which the tool 2 has a further angular offset with the angular value d as a result of a rotation.
  • the tool 2 was thus brought out of line L by rotating it around the y-axis.
  • the angle a of the angular offset has not changed and the angular offset can be calculated with it.
  • the angle a of the angular offset and a value for the distance R from the attitude and position determination unit 8 to the reference mark 11 are required.
  • the first calibration data record KDS can contain at least one angle value a, indicative of the angular offset, and a distance R, indicative of a distance from the attitude and position determination unit 8 to the reference mark 11, both of which can be interpreted as offset variables. in order to be able to infer the spatial location and position of the reference mark 11 from the location and position of the location and position determination unit 8 .
  • a coordinate transformation or a base change is carried out with the first calibration data set KDS, so that the spatial location and position of the location and position determination unit 8 can be used to determine the spatial location and position of the reference mark 11 .
  • the angle value d designates the current spatial position of the location and position determination unit 8, based on the perpendicular L and a perpendicular S through the position sensor assembly 703 of the location and position determination unit 8.
  • the angle value ß designates the spatial position of the position corrected by the offset angle a Orientation and position determination unit 8, based on the perpendicular L and a perpendicular S through the position sensor assembly 703 of the position and Position determination unit 8.
  • the fleas h or a deviation therefrom can then be displayed based on the output data set ADS.
  • the advantage here is that the display device 5 is in the field of view of the machine operator at the same time as the tool 2 due to its arrangement on the boom 3 .
  • the distance R between the location and position determination unit 8 and the reference mark 11 is determined manually.
  • the attitude and position determination unit 8 is designed to read in this value after it has been entered manually via, for example, an HMI of the attitude and position determination assembly 4 .
  • the location and position determination unit 8 is designed to determine a vertical deviation LAB of the location and position determination unit 8 with the position sensor assembly 703, i.e., for example, the angular value a for the angular offset.
  • the location and position determination unit 8 of the location and position determination assembly 4 then generates the calibration data set KDS from the distance R and the angle value a.
  • the first calibration data set KDS can be determined in the display device 5 of the location and position determination assembly 4 .
  • a second exemplary embodiment of a combined manual/automatic or also semi-automatic calibration method for determining the first calibration data record KDS will now be explained with reference to FIG.
  • the calibration method according to the present second exemplary embodiment is based on the calibration method described with reference to FIG. 7 and allows the accuracy to be increased.
  • the attitude and position determination unit 8 is designed to bring about an alignment of the tool 2 such that the tool 2 assumes a predetermined position, in the present exemplary embodiment a position with maximum inclination in relation to the y-axis.
  • the cantilever 3 can be controlled, for example, manually or by means of a control data set.
  • the tool 2 is displaced or aligned about the y-axis in such a way that the reference mark 11 remains at the same position I.
  • the GNSS module 702 acquires position data PD. This can be done continuously, ie at intervals with a predetermined period of time, or discretely at predetermined positions.
  • Difference data DD can now be determined by a comparison with positions that are determined using the first calibration data record KDS.
  • the difference data DD are determined by comparing an ideal circle or circle section, defined by the previously manually determined distance R and the previously determined angle value a, with the position data PD.
  • the location and position determination unit 8 then supplements the first calibration data set KDS with appropriate correction data.
  • the calibration data set KDS then contains the difference data DD, which assign a correction value to an angle value and can be applied to a current value.
  • the first calibration data set KDS can be determined in the display device 5 of the location and position determination assembly 4 .
  • the tool 2 is shifted, e.g. manually or by means of a control data set, in such a way that the reference mark 11 remains in the same, predetermined position I, with position data PD being transmitted to the GNSS module 702 of the attitude and position determination assembly 4 during the alignment he be caught.
  • the position data PD recorded in this way are indicative of a target curve along which the tool 2 is displaced or aligned.
  • a target curve is approximated by a circle SK or a section of a circle, taking into account at least three measuring points MP1, MP2, ... MPx according to the position data PD, e.g. by least square fit or taubin fit, to the radius of the to determine an approximated circle SK or segment of a circle that is representative of the distance R.
  • the distance R from the location and position determination unit 8 to the reference mark 11 is equal to the radius R of the circle SK.
  • the first calibration data set KDS can be determined in the display device 5 of the location and position determination assembly 4 .
  • a target curve is also determined here by a circle SK or a section of a circle, taking into account the two measurement points MP1, MP2.
  • Measured values MW are recorded at both measuring points MP1, MP2.
  • the measured values MW have position data PD indicative of the position of the attitude and position determination unit 8 and position data LD indicative of the position in space the situation and position determination unit 8 on.
  • the position data PD are determined with the GNSS module 702 of the position and position determination unit 8
  • the position data LD are determined with the position sensor assembly 703 of the position and position determination unit 8 .
  • the position data PD can be a three-dimensional data set.
  • Values for the angle e and a chord d can then be determined with the help of the determined circle SK.
  • the value for the angle e is a measure of the circular arc section of the specific circle SK between the two measuring points MP1, MP2, while the chord d connects the two measuring points MP1, MP2.
  • the radius of the specific circle SK corresponding to the distance R and the angular value of the angle ⁇ can be determined.
  • the position at which the location and position determination unit 8 with its GNSS antenna center 14 is theoretically located with the reference mark 11 in the perpendicular L can be determined from the measured values MW.
  • a positional deviation of the location and position determination unit 8 relative to the perpendicular L can be determined. For this, no data need be available in which the location and position determination unit 8 with its GNSS antenna center 14 and the reference mark 11 are actually in the perpendicular L.
  • the determined positional deviation from the perpendicular L and the distance R can be added to the calibration data record KDS.
  • the first calibration data set KDS can be determined in the display device 5 of the location and position determination assembly 4 .
  • the location and position determination assembly 4 can be separated from the tool 2 by simply dismantling animals and placed back in the transport container, in which case it is then automatically deactivated.
  • a detection of a Taking or putting back the location and position determination building group 4 in its transport container can be done, for example, by a loading device integrated in the transport container.
  • the first calibration data record KDS can be associated with the tool 2 and a position of the attitude and position determination unit 8 on the tool 2 and stored, so that the calibration process only has to be carried out once for this tool 2 and this position.
  • the first calibration data set KDS can be used together with data that allow the tool 2 to be identified and with data indicative of the position on the tool 2, e.g. in the location and position determination assembly 4 and/or the end device and/or control output device 6 are saved and from there the configuration can later be made according to the calibration data set KDS who the.
  • a first step S100a the location and position determination unit 8 of the location and position determination assembly 4 is attached to the tool 2 .
  • step S200a the reference mark 11 of the tool 2 is aligned by tilting the tool 2 in such a way that the reference mark 11 is perpendicular to the location and position determination unit 8 .
  • step S300a the distance R between the location and position determination unit 8 and the reference mark 11 is determined manually.
  • step S400a the manually determined distance R is read in by the attitude and position determination unit 8 .
  • step S500a the vertical deviation LAB of the location and position determination unit 8 is determined using the position sensor assembly 703.
  • the first calibration data set KDS is determined by evaluating the vertical deviation LAB and the distance R.
  • the tool 2 is aligned in a further step S700a such that the tool 2 assumes a predetermined position I, in particular with maximum inclination, and the reference mark 11 at the same , Predetermined position I remains during alignment.
  • Position data PD are now recorded with the GNSS module 702 during the alignment of the tool 2 .
  • the difference data DD are determined by evaluating the first calibration data set KDS determined in step S600a and the position data PD determined in step S700a.
  • the first calibration data set KDS is supplemented by evaluating the difference data DD.
  • a method for calibrating, in particular for automatic calibrating, according to the third exemplary embodiment will now be explained with reference to FIG.
  • the location and position determination unit 8 of the location and position determination assembly 4 is attached to the tool 2 .
  • a predetermined geostationary point for the tool 2 is approached.
  • the first measured value MW at the first measuring point MP1 includes position data PD indicative of the position of the orientation and position determination unit 8 and position data LD indicative of the position in space of the orientation and position determination unit 8.
  • step S300b the tool 2 is displaced again in such a way that an inclination of the tool 2 is changed, with the reference mark 11 remaining at an identical, predetermined position I, however.
  • step S400b at least one further measured value MW is recorded at a further measuring point MP2, which contains further position data PD indicative of the position of the attitude and position determination unit 8.
  • steps S300b and S400b can be repeated at least once in order to determine at least two further measured values MW at further measuring points MP2, . . . MPx and thus to increase the accuracy.
  • the repetition of steps S300b and S400b may be performed either continuously while the tool 2 is being displaced or at predetermined points.
  • the measured values MW are evaluated in order to determine the vertical deviation LAB of the location and position determination unit 8 and/or the distance R between the location and position determination unit 8 and the reference mark 11.
  • the first calibration data set KDS is determined by evaluating the vertical deviation LAB and/or the distance R.
  • a first step 100c the location and position determination unit 8 of the location and position determination assembly 4 is fastened to the tool 2 be.
  • the tool 2 is shifted in order to approach a predetermined geostationary point for the tool 2.
  • the first measured value MW is then recorded at the first measuring point MP1.
  • the first measured value MW has the position data PD indicative of the position of the attitude and position determination unit 8 , which is recorded with the GNSS module 702 of the attitude and position determination unit 8 .
  • the first measured value MW has the location data LD indicative of the spatial location of the location and position determination unit 8 , which is recorded with the location sensor assembly 703 of the location and position determination unit 8 .
  • step S300c the tool 2 is displaced in such a way that an inclination of the tool 2 is changed, with the reference mark 11 of the tool 2 remaining at the same, predetermined position I.
  • the second measured value MW is recorded at the second measuring point MP2.
  • the second measured value MW has the further position data PD indicative of the position of the location and position determination unit 8 , which is recorded with the GNSS module 702 of the location and position determination unit 8 .
  • the second measured value MW has the further location data LD indicative of the spatial position of the location and position determination unit 8 , which is detected with the location sensor assembly 703 of the location and position determination unit 8 .
  • the measured values MW are evaluated in order to determine the vertical deviation LAB of the location and position determination unit 8 and/or the distance R between the location and position determination unit 8 and the reference mark 11.
  • the calibration data set KDS is determined by evaluating the vertical deviation LAB and/or the distance R.
  • the first calibration data set KDS is assigned to the tool 2 and the position of the location and position determination unit 8 or a component of the location and position determination unit 8 on the tool 2 and stored, so that for this tool 2 and this position of the calibration process only has to be carried out once.
  • the first calibration data record KDS together with data from an identification data record ID (see FIG. 18), which allow the tool 2 to be identified, and with position and location data PLD (also see FIG.
  • the position and location data PLD can be dispensed with, since the frame-shaped holder 10 defines the position and position in space of the location and position determination unit 8. It can also be provided that the tool 2 and, for example, a component of the location and position determination assembly 4 form a unit that is not separated from one another and to which the identification data set ID is assigned. In this way, the tool 2 can be changed in the meantime without a renewed calibration being necessary.
  • a fifth exemplary embodiment of a calibration method for determining the second calibration data set KDS' will now be explained with reference to FIGS -Lines BG of a Cartesian coordinate system is possible.
  • the system 21 for determining the second calibration data record KDS' is designed to generate a first alignment data record ARS 1 (see FIG. 16) indicative of the position of the attitude and position determination unit 8 on the tool 2 with the GNSS To determine module 702 of location and position determination unit 8 at first measuring point MP1'.
  • system 21 for determining the second calibration data set KDS′ is designed in the present exemplary embodiment to bring about a shifting of the reference mark 11 of the tool 2 from the first measuring point MP1′ to the second measuring point MP2′ by shifting the cantilever 3 in such a way that a distance A between the land vehicle 1 and the reference mark 11 is changed.
  • the boom 3 is controlled in such a way that the tool 2 is moved essentially parallel to the reference mark 11 over the ground.
  • the boom 3 does not rotate about the vertical axis of the land vehicle 1 .
  • the displacement takes place in a straight line and without any rotational components, in particular around the vertical axis of the land vehicle 1 .
  • the system 21 for determining the second calibration data set KDS' in the present exemplary embodiment is designed to use the second alignment data set ARS2 (also see Figure 16) indicative of the position of the attitude and position determination unit 8 on the tool 2 to be determined with the GNSS module 702 of the attitude and position determination unit 8 at the second measurement point MP2'.
  • the system 21 for determining the second calibration data record KDS' is designed to generate the calibration data record KDS' by evaluating the first alignment data record ARS1 and the second alignment data record ARS2.
  • the first alignment data set ARS1 and the second alignment data set ARS2 each contain data indicative of the positions of the reference mark 11 at the first measuring point MP1' and the second measuring point MP2'.
  • parameters of a linear equation are then determined which connect the positions according to the first measuring point MP1' and according to the second measuring point MP2'.
  • the straight line G parameterized in this way is then generated and in a third sub-step, data from the GNSS module 702 are then indicative of the position of the north pole N or the position of longitude lines LG and latitude lines BG of a Cartesian Coordinate system used to determine an offset angle W, which is representative of an offset between the orientation of the land vehicle 1 or the land vehicle's own coordinate system and the position of the north pole N or the position of longitude lines LG and latitude lines BG of the Cartesian coordinate system.
  • a first step S100d the location and position determination unit 8 of the location and position determination assembly 4 is attached to the tool 2 .
  • the first alignment data set ARS1 is indicative of the position of the location and position determination unit 8 on the tool 2 with the GNSS module 702 location and position determination unit 8 at the first measurement point MP1'.
  • step S300d the reference mark 11 of the tool 2 is shifted from the first measuring point MP1' to the second measuring point MP2' by moving the boom 3 in such a way that the distance A between the land vehicle 1 and the reference mark 11 is changed.
  • the second alignment data record ARS2 is determined indicative of the position of the location and position determination unit 8 on the tool 2 with the GNSS module 702 of the location and position determination unit 8 at the second measurement point MP2'.
  • the calibration data record KDS' is generated by evaluating the first alignment data record ARS1 and the second alignment data record ARS2.
  • This calibration method according to the fifth exemplary embodiment can be repeated within fixed, predetermined or variable intervals during operation of the land vehicle 1 . In this way, a slow drift of values can be counteracted by continually updating the determination of the offset angle W.
  • a method for determining the position and position in space of the tool 2 will now be explained with reference to FIG.
  • the method for determining the position and spatial orientation of the tool 2 can be carried out after a calibration with steps S100a to S600a according to the first embodiment, after a calibration with steps S100a to S900a according to the second embodiment, after a calibration with steps S100b to S600b according to third exemplary embodiment or after a calibration with steps S100c to S600c according to the fourth exemplary embodiment.
  • the method for determining the position and spatial orientation of the tool 2 can be combined with a calibration with steps S100d to S500d according to the fifth exemplary embodiment.
  • the method for determining the position and spatial orientation of the tool 2 according to the first, second, third or fourth exemplary embodiment can be combined with a calibration with steps S100d to S500d according to the fifth exemplary embodiment.
  • a position data set PDS indicative of the position of the attitude and position determination unit 8 of the attitude and position determination assembly 4 is determined with the GNSS module 702 of the attitude and position determination unit 8 .
  • a position data set LDS indicative of the position in space of the position and position determination unit 8 with the position sensor assembly 703 of the position and position determination unit 8 is determined.
  • data from the inertial navigation system can be used to combine the GNSS module 702 with the inertial navigation system to track the short-term accurate but drifting inertial system with the to merge long-term stable but short-term variable fluctuating data of the GNSS module 702.
  • the position data set PDS and the position data set LDS are evaluated using the first calibration data set KDS and the second calibration data set KDS' in order to generate an output data set ADS indicative of the spatial position and To determine the position of the tool 2.
  • step S1400 the output data record ADS is output.
  • the end device and/or control output device 6 of the location and position determination assembly 4 is designed to generate a control data set SDS for controlling the land vehicle 1 on the basis of the output data set ADS, e.g. for controlling the Outrigger 3 of the land vehicle 1 designed as an excavator, in order to effect direct intervention in the machine control system of the land vehicle 1 .
  • step S1500 e.g. after completion of e.g. It is possible, for example, for a loading device integrated in the transport container to detect that the location and position determination assembly 4 has been put back into its transport container.
  • the order of the steps can also be different. Furthermore, several steps can also be executed at the same time or simultaneously. Furthermore, in deviation from the present exemplary embodiment, individual steps can also be skipped or left out. If necessary, a land vehicle 1 , such as a construction machine, can be retrofitted accordingly quickly. In this case, the free choice of the position of the location and position determination subassembly 4 or a component of the location and position determination subassembly 4 and subsequent calibration with the first calibration data set KDS and/or the second calibration data set KDS' assembly is simplified and there is no need for complex factory calibration of a specially trained construction machine.

Abstract

The invention relates to a method for determining the position and spatial orientation of a soil-working tool (2) on an adjustable boom (3) of an agricultural vehicle (1), having the steps of: (S1100) determining a position data set (PDS), which indicates the position of an orientation-and-position-determining unit (8) of an orientation-and-position-determining assembly (4) on the tool (2), using a GNSS module (702) of the orientation-and-position-determining unit (8); (S1200) determining an orientation data set (LDS), which indicates the spatial orientation of the orientation-and-position-determining unit (8), using an orientation sensor assembly (703) of the orientation-and-position-determining unit (8); (S1300) evaluating the position data set (PDS) and the orientation data set (LDS) using a calibration data set (KDS, KDS') in order to determine an output data set (ADS) which indicates the spatial orientation and position of the tool (2); and (S1400) outputting the output data set (ADS).

Description

VERFAHREN ZUR POSITIONS- UND RAUMLAGEBESTIMMUNG EINES WERKZEUGS EINES LANDFAHRZEUGES PROCEDURE FOR DETERMINING THE POSITION AND SPATIAL LOCATION OF A TOOL OF A LAND VEHICLE
Die Erfindung betrifft ein Verfahren zur Positions- und Raumlagebestimmung eines Werkzeugs zur Bodenbearbeitung an einem verstellbaren Ausleger ei nes Landfahrzeugs. Ferner betrifft die Erfindung ein Com puterprogramm Pro dukt, ein System zur Positions- und Raumlagebestimmung eines Werkzeugs zur Bodenbearbeitung an einem verstellbaren Ausleger eines Landfahrzeugs und eine Lage- und Positionsbestimmungs-Baugruppe für ein derartiges Sys tem. The invention relates to a method for determining the position and spatial location of a tool for tilling the soil on an adjustable boom of a land vehicle. The invention also relates to a computer program product, a system for determining the position and position in space of a tool for tillage on an adjustable boom of a land vehicle and a position and position determination assembly for such a system.
Dabei wird unter einer Positionsbestimmung die Ermittlung einer Position des Werkzeugs oder eines Abschnitts des Werkzeugs in Bezug zu einem definier ten Fixpunkt verstanden, während unter der Raumlagebestimmung die Be stimmung der Ausrichtung des Werkzeugs zum umgebenden Raum verstan den wird, vor allem bezüglich der Horizontalen bzw. der Lotrichtung. A position determination is understood to be the determination of a position of the tool or a section of the tool in relation to a defined fixed point, while the spatial position determination is understood as the determination of the alignment of the tool to the surrounding space, especially with regard to the horizontal or the perpendicular direction.
Auf Baustellen werden Bodenbearbeitungen nach Planvorgaben ausgeführt, welche typischerweise entweder relativ zu einem Bezugspunkt vorliegen oder als absolute geostationäre dreidimensionale Positionsdaten. Dies kann zum Beispiel das Einebnen einer Fläche auf eine absolute Höhe oder eine zu einem Bezugspunkt relative Höhe oder das Ausheben von dreidimensionalen Boden profilen einschließen. On construction sites, soil processing is carried out according to plan specifications, which are typically either relative to a reference point or as absolute geostationary three-dimensional position data. This may include, for example, leveling an area to an absolute elevation or an elevation relative to a reference point, or excavating three-dimensional soil profiles.
Hierzu werden Baumaschinen, wie z.B. Bagger, eingesetzt. Dabei wird unter einem Bagger eine Baumaschine zum Lösen und Bewegen von Boden und Fels, insbesondere zum Ausheben und Wiederverfüllen von Erdvertiefungen, wie etwa Baugruben und Schächten, verstanden. Construction machines such as excavators are used for this. In this context, an excavator is understood to be a construction machine for loosening and moving soil and rock, in particular for digging and backfilling of earth depressions, such as building pits and shafts.
Derartige Bagger sind als selbstfahrende Landfahrzeuge ausgebildet und wei sen einen auf einem Fahrgestell des Baggers um seine Hochachse drehbaren Aufbau mit einem Ausleger auf, an dessen distalem Ende ein Werkzeug, wie eine Baggerschaufel, befestigt ist. Der Ausleger selbst weist eine Mehrzahl von Gelenken auf und kann mit ihnen so radial einwärts und auswärts verlagert werden. Die Verlagerung des Auslegers und des Werkzeugs wird üblicher weise per Hydraulik oder mit Elektromotoren bewirkt. Such excavators are designed as self-propelled land vehicles and have a structure which can be rotated about its vertical axis on a chassis of the excavator and has a boom, at the distal end of which a tool, such as an excavator shovel, is attached. The boom itself has a plurality of joints and can thus be displaced radially inwards and outwards with them will. The displacement of the boom and the tool is usually effected by hydraulics or electric motors.
Bodenprofile müssen je nach Bauvorgaben oft Ausführungsgenauigkeiten von wenigen Zentimetern aufweisen. Beispielsweise wird für eine Bodenplatte ei nes Hauses eine plane Fläche mit einer Abweichung von maximal +/- 1 ,5 cm in Bezug auf die geostationäre Position und Höhe benötigt. Die Erzeugung von Bodenprofilen mit obiger Genauigkeit und absoluter Positionierung erfordert einen speziell dafür ausgerüsteten Bagger oder aufwendige Messverfahren. Depending on the building specifications, floor profiles often have to be executed with an accuracy of a few centimetres. For example, a flat surface with a maximum deviation of +/-1.5 cm in relation to the geostationary position and height is required for a floor slab of a house. The creation of soil profiles with the above accuracy and absolute positioning requires a specially equipped excavator or complex measurement methods.
Alternativ wird insbesondere auf Kleinbaustellen ein nicht speziell dafür aus gerüsteter Bagger verwendet, wobei eine weitere Person zwischen den Erd bearbeitungsvorgängen jeweils die abzutragende Höhe mit einer Messausrüs tung bestimmt. Der Maschinenführer des Baggers und die weitere Person kön nen im Zusammenspiel ein derartiges Bodenprofil bereitstellen. Ein Baustel lenmessgerät zur Unterstützung bei derartigen Arbeiten ist z.B. aus der WO 2014 / 146809 A1 bekannt. Jedoch ist dieses Vorgehen zeitaufwendig und personalintensiv. Alternatively, an excavator that is not specially equipped for this purpose is used, particularly on small construction sites, with another person determining the height to be removed with measuring equipment between each earth-working operation. The machine operator of the excavator and the other person can provide such a soil profile in cooperation. A construction site measuring device to support such work is known, for example, from WO 2014/146809 A1. However, this procedure is time-consuming and personnel-intensive.
Es kann auch ein speziell ausgerüsteter Bagger, meist basierend auf GNSS (Globale Satelliten Navigationssysteme wie GPS, Galileo, GLONASS und Beidu) und/oder Laserreferenzebene, mit technisch aufwendiger Lösung, die vollständig im Bagger integriert ist, verwendet werden. Solche Systeme sind ab Werk verbaut. Diese Bagger sind mit Sensoren an allen, das Werkzeug tragenden, beweglichen Elementen des Auslegers ausgestattet und müssen entsprechend kalibriert und vermessen werden. Diese speziell ausgerüsteten Bagger nutzen oft Systeme, welche in die Maschinensteuerung eingreifen und den Erdaushubprozess teilautomatisieren. A specially equipped excavator can also be used, mostly based on GNSS (Global Satellite Navigation Systems such as GPS, Galileo, GLONASS and Beidu) and/or laser reference plane, with a technically complex solution that is fully integrated in the excavator. Such systems are factory installed. These excavators are equipped with sensors on all moving parts of the boom that carry the tool and must be calibrated and measured accordingly. These specially equipped excavators often use systems that intervene in the machine controls and partially automate the excavation process.
Ein solches System ist z.B. aus der WO 2008 / 091395 A2 bekannt. Das Sys tem ist zur dreidimensionalen Führung eines Baggers, basierend auf GPS und Laserreferenz, ausgebildet und beinhaltet einen mobilen GPS-Empfänger, ein System zur Positionierung eines Werkzeugs in Relation zum Bagger, einen Laserdetektor sowie ein eingebautes Steuerungssystem. Jedoch kann eine externe Laserquelle leicht abgeschattet werden und muss bei einer größeren Änderung der Tiefe neu justiert werden. Ferner sind die Anbringung und Ka librierung aufwendig. Such a system is known, for example, from WO 2008/091395 A2. The system is designed for three-dimensional guidance of an excavator, based on GPS and laser reference, and includes a mobile GPS receiver, a system for positioning a tool in relation to the excavator, a Laser detector as well as a built-in control system. However, an external laser source can easily be shadowed and must be readjusted if the depth changes significantly. Furthermore, the attachment and Ka calibration are expensive.
Mit einem solchen System kann der Arbeitsprozess deutlich schneller erfol gen, es sind aber speziell ausgestattete Bagger und auf das System ange lernte Maschinenführer erforderlich. Diese müssen zwischen den Baustellen nach Bedarf bewegt werden. Diese Vorgehensweise ist auf Großbaustellen üblich. With such a system, the work process can be carried out significantly faster, but specially equipped excavators and machine operators who have been trained in the system are required. These must be moved between construction sites as required. This procedure is common on large construction sites.
Es können auch nicht speziell dafür ausgerüstete Bagger verwendet werden, welche entsprechend nachgerüstet werden. Es sind Nachrüstmöglichkeiten bekannt, die aber technisch aufwendig sind. Bei der Installation solcher Sys teme ist die manuelle Vermessung und Kalibrierung mindestens eines Teils der Baggergeometrie, wie des Auslegers, nötig, damit ein Steuergerät die Po sition des Werkzeugs ermitteln kann. Excavators that are not specially equipped for this purpose can also be used, which are retrofitted accordingly. Retrofitting options are known, but they are technically complex. When installing such systems, manual measurement and calibration of at least part of the excavator geometry, such as the boom, is necessary so that a control unit can determine the position of the tool.
Bei GNSS basierten Systemen müssen meist mehrere dieser Drehpunkte bzw. Gelenkpunkte des Auslegers erfasst werden, da der GNSS-Empfänger typischerweise auf dem Rumpf des Baggers befestigt wird. Die Kalibrierung ist daher ein zeitlich und technisch aufwendiger Prozess. With GNSS-based systems, several of these pivot points or articulation points of the boom usually have to be recorded, since the GNSS receiver is typically attached to the hull of the excavator. The calibration is therefore a time-consuming and technically complex process.
Es gibt auch Nachrüstsysteme, welche mit weniger Drehpunkten auskommen und z.B. über optische Laserreferenzebenen arbeiten. Ein derartiges System ist z.B. aus der DE 3 875 332 T2 zur Bestimmung einer Tiefe bekannt, bis zu der ein Bagger einen Graben ausheben soll. Dieses System wirkt mit einer externen Laserquelle zusammen, um die Tiefe des Grabens auf eine festge legte Entfernung unter der Ebene des durch den Laser erzeugten Strahls zu beziehen. Hierzu werden externe Laserquellen verwendet, welche leicht ab geschattet werden können und bei jeder größeren Änderung der Tiefe neu justiert werden müssen. Ferner sind die Anbringung und Kalibrierung aufwen dig. Es gibt auch Systeme, welche eine Kombination der beiden vorgehend ge nannten Verfahren nutzen und somit entsprechend aufwendig vermessen und kalibriert werden müssen. Des Weiteren gibt es auch Lösungsvorschläge, wel che das Werkzeug über andere Technologien vom Baggerrumpf aus verfolgen und somit eine aufwendige Sensorik und Vermessung am Ausleger umgehen. There are also retrofit systems that get by with fewer pivot points and work, for example, via optical laser reference planes. Such a system is known, for example, from DE 3 875 332 T2 for determining a depth to which an excavator should dig a trench. This system interacts with an external laser source to reference the depth of the trench to a specified distance below the plane of the beam generated by the laser. External laser sources are used for this purpose, which can be easily shaded and must be readjusted with every major change in depth. Furthermore, the attachment and calibration are expensive. There are also systems that use a combination of the two methods mentioned above and therefore have to be measured and calibrated in a correspondingly complex manner. Furthermore, there are also proposed solutions that track the tool from the excavator body using other technologies, thus avoiding the need for complex sensors and measurements on the boom.
Aus der US 2019 / 0003825 A1 ist eine integrierte Sensoreinheit zur Maschi nensteuerung bekannt, welche einen Maschinenführer dabei unterstützt, die korrekte Aushubtiefe zu finden. Die integrierte Sensoreinheit umfasst einen Beschleunigungssensor, einen Laser-Distanz-Sensor (LDM) sowie einen La serempfänger für die Detektion einer Laserreferenzebene und optional einen GPS-Empfänger. Diese Einheit wird am Ausleger des Baggers befestigt und kann über den LDM die Stellung eines Werkzeugs erfassen. Für die Kalibrie rung ist eine händische Vermessung notwendig. Für die Nutzung ist die An bringung einer geeigneten LDM-Referenz notwendig. An integrated sensor unit for machine control is known from US 2019/0003825 A1, which supports a machine operator in finding the correct excavation depth. The integrated sensor unit includes an acceleration sensor, a laser distance sensor (LDM) and a laser receiver for detecting a laser reference plane and optionally a GPS receiver. This unit is attached to the boom of the excavator and can detect the position of a tool via the LDM. Manual measurement is required for calibration. A suitable LDM reference must be attached for use.
Aus der DE 2020 10018131 U1 ist eine Erkennung von Transportzustandsin formationen über an dem Transportobjekt angebrachte Transponder durch eine Transportvorrichtung bekannt, welche Bewegungsdaten, z.B. über ein GPS, erfasst. Transportzustandsinformationen können unter anderem auch Entfernungen zwischen der Transportvorrichtung und dem Transponder sein. Dadurch ist ein System gegeben, welches die Distanz zwischen einem RFID- Transponder, welcher z.B. an einem Werkzeug angebracht werden kann, und einer Transportvorrichtung, wie einem Bagger, ermittelbar macht. RFID (Ra- dio-Frequency Identification) kann zwar eine gute Distanzauflösung bei freier Sichtlinie zum Transponder erzielen, jedoch ist die Messung des Winkels zwi schen dem Baggerrumpf und dem Werkzeug technisch aufwendig und unge nau. DE 2020 10018131 U1 discloses a detection of transport status information via transponders attached to the transport object by a transport device, which records movement data, e.g. via a GPS. Transport status information can also include distances between the transport device and the transponder. This provides a system that makes it possible to determine the distance between an RFID transponder, which can be attached to a tool, for example, and a transport device such as an excavator. Although RFID (Radio-Frequency Identification) can achieve good distance resolution with a clear line of sight to the transponder, measuring the angle between the excavator body and the tool is technically complex and imprecise.
Aus der EP 1 029 306 B1 ist ein Verfahren zur optischen Erfassung von Posi tion und Raumlage eines Werkzeugs in Relation zu einer Maschine bekannt. Dieses Verfahren nutzt Marker auf dem zu folgenden Werkzeug, welche eine vorbestimmte relative Position zueinander aufweisen. Die Erkennung basiert auf Bildverarbeitungsalgorithmen. So können z.B. die Position und Raumlage einer Baggerschaufel in Relation zum Bagger ermittelt werden. Es genügt eine Sensoreinheit zum Verfolgen des Werkzeugs, aber je nach Technologie sind Nutzungsmöglichkeiten und/oder Auflösung beschränkt. So sind z.B. optische Verfahren darauf angewiesen, immer eine ausreichende Sicht auf das Werk zeug zu haben. Ferner ist dieses Verfahren empfindlich gegenüber Verunrei nigungen der Marker oder einer Kamera. EP 1 029 306 B1 discloses a method for optically detecting the position and spatial location of a tool in relation to a machine. This method uses markers on the tool to be followed, which one have predetermined relative position to each other. The detection is based on image processing algorithms. For example, the position and spatial position of an excavator shovel in relation to the excavator can be determined. One sensor unit is sufficient for tracking the tool, but depending on the technology, possibilities of use and/or resolution are limited. For example, optical processes depend on always having a sufficient view of the tool. Furthermore, this method is sensitive to contamination of the markers or a camera.
Aus der US 6,665,465 B2 ist eine Räumschildregelung für eine als Grader ausgebildete Baumaschine bekannt, bei der mit einem Ultraschallsensor aus gehend vom Referenzpunkt die Position und Neigung eines Räumschildes er fasst und angepasst wird. US Pat. No. 6,665,465 B2 discloses a clearing blade control system for a construction machine designed as a grader, in which the position and inclination of a clearing blade is recorded and adjusted using an ultrasonic sensor, starting from the reference point.
Aus der US 2016 / 0076228 A1 ist ein Führungssystem für einen Bagger be kannt, an dessen Ausleger ein Lasersensor angeordnet ist. A guidance system for an excavator is known from US 2016/0076228 A1, on the boom of which a laser sensor is arranged.
Aus der EP 2 806 248 A1 ist ein Verfahren zur Kalibrierung einer Erfassungs einrichtung und eine Erfassungseinrichtung bekannt. A method for calibrating a detection device and a detection device is known from EP 2 806 248 A1.
Es besteht also Bedarf daran, Wege aufzuzeigen, wie die Positions- und Raumlagebestimmung eines Werkzeugs vereinfacht werden kann. There is therefore a need to show ways of simplifying the determination of the position and spatial orientation of a tool.
Die Aufgabe der Erfindung wird gelöst durch ein Verfahren zur Positions- und Raumlagebestimmung eines Werkzeugs zur Bodenbearbeitung an einem ver stellbaren Ausleger eines Landfahrzeugs, mit den Schritten: The object of the invention is achieved by a method for determining the position and spatial orientation of a tool for soil cultivation on an adjustable boom of a land vehicle, with the steps:
Bestimmen eines Positions-Datensatzes indikativ für die Position einer Lage- und Positionsbestimmungseinheit einer Lage- und Positionsbe stimmungs-Baugruppe an dem Werkzeug mit einem GNSS-Modul der Lage- und Positionsbestimmungseinheit, Bestimmen eines Lage-Datensatzes indikativ für die Raumlage der Lage- und Positionsbestimmungseinheit mit einer Lagesensorbau gruppe der Lage- und Positionsbestimmungseinheit, Determining a position data set indicative of the position of a location and position determination unit of a location and position determination assembly on the tool with a GNSS module of the location and position determination unit, Determining a position data set indicative of the position in space of the position and position determination unit with a position sensor assembly of the position and position determination unit,
Auswerten des Positions-Datensatzes und des Lage-Datensatzes unter Verwendung eines Kalibrier-Datensatzes, um einen Ausgangs-Daten satz indikativ für die Raum läge und Position des Werkzeugs zu bestim men, und Evaluating the position data set and the position data set using a calibration data set in order to determine an initial data set indicative of the spatial position and position of the tool, and
Ausgeben des Ausgangs-Datensatzes. Output of the output data record.
Es werden also Positionsdaten, die von einem GNSS-System stammen, und Lagedaten, die von einer Lagesensorbaugruppe der Lage- und Positionsbe stimmungseinheit der Lage- und Positionsbestimmungs-Baugruppe stammen, kombiniert, um die Raumlage und Position des Werkzeugs zu bestimmen. Position data originating from a GNSS system and position data originating from a position sensor assembly of the attitude and position determination unit of the attitude and position determination assembly are combined in order to determine the position in space and position of the tool.
Die Lagesensorbaugruppe kann als Beschleunigungssensorbaugruppe mit mindestens zwei Messachsen ausgebildet sein und ist z.B. dazu ausgebildet, durch Vergleich von mindestens zwei Beschleunigungswerten, die in Richtung der zumindest zweier Messachsen erfasst werden, die aktuelle Raum läge zu bestimmen. The position sensor assembly can be designed as an acceleration sensor assembly with at least two measurement axes and is designed, for example, to determine the current spatial position by comparing at least two acceleration values that are detected in the direction of the at least two measurement axes.
Dabei kann die Lage- und Positionsbestimmungs-Baugruppe oder eine Kom ponente der Lage- und Positionsbestimmungs-Baugruppe, wie z.B. die Lage- und Positionsbestimmungseinheit, mit einem GNSS-Modul, an einer im We sentlichen frei wählbaren Position an dem Werkzeug angebracht werden. Un ter einer im Wesentlichen frei wählbaren Position wird dabei eine Position ver standen, die eine ausreichende Verbindungsqualität zu Satelliten des GNSS- Systems gewährleistet. The attitude and position determination assembly or a component of the attitude and position determination assembly, such as the attitude and position determination unit, with a GNSS module, can be attached to the tool at an essentially freely selectable position. An essentially freely selectable position is understood to mean a position that ensures a sufficient connection quality to satellites of the GNSS system.
Der Kalibrier-Datensatz erlaubt es, die Positionsdaten und die Lagedaten, die indikativ für die Raumlage und Position der Lage- und Positionsbestimmungs einheit oder einer Komponente der Lage- und Positionsbestimmungseinheit sind, auszuwerten, um die Lage und Position einer Referenzmarke des Werk zeugs bestimmen zu können. The calibration data record allows the position data and position data that are indicative of the position in space and position of the attitude and position determination unit or a component of the attitude and position determination unit are to be evaluated in order to be able to determine the location and position of a reference mark of the tool.
Mit anderen Worten, mit dem Kalibrier-Datensatz wird eine Koordinatentrans formation oder ein Basiswechsel durchgeführt, so dass aus der Raum läge und Position der Lage- und Positionsbestimmungseinheit der Lage- und Positions bestimmungs-Baugruppe auf die Raumlage und Position der Referenzmarke geschlossen werden kann. In other words, a coordinate transformation or a base change is carried out with the calibration data record, so that the spatial position and location of the position and position determination unit of the position and position determination assembly can be used to determine the spatial position and position of the reference mark.
Die Referenzmarke kann sowohl ein definierter Punkt auf dem Werkzeug, eine Linie entsprechend einer Kante an dem Werkzeug oder eine Werkzeugspitze sein. Mit anderen Worten, die Referenzmarke ist ein Punkt oder eine Kante an dem Werkzeug, mit dem/der das Werkzeug in Kontakt mit dem zu bearbeiten den Medium kommt. The reference mark can be a defined point on the tool, a line corresponding to an edge on the tool, or a tool tip. In other words, the reference mark is a point or edge on the tool where the tool comes into contact with the media to be processed.
Damit wird es möglich, die Position und Raumlage des Werkzeugs direkt zu bestimmen. Es entfällt also die Notwendigkeit, ausgehend von einem Werk zeugträger, wie einem Landfahrzeug, aufwendig auf die Position und Raum lage des Werkzeugs zu schließen. This makes it possible to directly determine the position and spatial location of the tool. There is therefore no need, starting from a work tool carrier, such as a land vehicle, to infer the position and spatial position of the tool in a complex manner.
Somit entfällt der Bedarf z.B. an speziell ausgebildeten Baumaschinen mit z.B. GNSS-Systemen, sondern es kann im Bedarfsfall ein Landfahrzeug, wie eine Baumaschine, entsprechend schnell nachgerüstet werden. Dabei wird durch die freie Wahl der Position der Lage- und Positionsbestimmungseinheit der Lage- und Positionsbestimmungs-Baugruppe und anschließende Kalibrierung mit dem Kalibrier-Datensatz die Montage vereinfacht und es sind keine auf wendigen Kalibrierungen wie bei einer derartigen speziell ausgebildeten Bau maschine ab Werk erforderlich. This means that there is no need, for example, for specially trained construction machines with e.g. GNSS systems, but if necessary, a land vehicle such as a construction machine can be quickly retrofitted accordingly. The assembly is simplified by the free choice of the position of the location and position determination unit of the location and position determination assembly and subsequent calibration with the calibration data set and there are no complex calibrations as with such a specially trained construction machine ex works.
Gemäß einer Ausführungsform werden zum Bestimmen des Kalibrier-Daten- satzes folgende Schritte ausgeführt: Befestigen der Lage- und Positionsbestimmungseinheit an dem Werk zeug, According to one embodiment, the following steps are carried out to determine the calibration data set: Attaching the location and position determination unit to the tool,
Ausrichten einer Referenzmarke des Werkzeugs durch Neigen des Werkzeugs, derart, dass sich die Referenzmarke mit der Lage- und Po sitionsbestimmungseinheit im Lot befindet, aligning a reference mark of the tool by tilting the tool in such a way that the reference mark is perpendicular to the location and position determination unit,
Bestimmen einer Distanz zwischen der Lage- und Positionsbestim mungseinheit und der Referenzmarke, determining a distance between the location and position determination unit and the reference mark,
Einlesen der Distanz von der Lage- und Positionsbestimmungseinheit, reading the distance from the location and position determination unit,
Bestimmen einer Lotabweichung der Lage- und Positionsbestimmungs einheit mit der Lagesensorbaugruppe der Lage- und Positionsbestim mungseinheit, und Determining a vertical deviation of the location and position determination unit with the location sensor assembly of the location and position determination unit, and
Erzeugen des Kalibrier-Datensatzes durch Auswerten der Lotabwei chung und der Distanz. Generation of the calibration data record by evaluating the plumb deviation and the distance.
Hierbei handelt es sich also um ein manuelles Verfahren, bei dem die Distanz zwischen der Lage- und Positionsbestimmungseinheit der Lage- und Positi onsbestimmungs-Baugruppe und der Referenzmarke z.B. von einem Maschi nenführer mit einem Meterstab oder einer ähnlichen Messeinrichtung mit einer Genauigkeit von z.B. 0,5 cm bestimmt und dann über ein HMI (Human-Ma- chine-lnterface, Benutzerschnittstelle) der Lage- und Positionsbestimmungs einheit zur Verfügung gestellt wird. Die Lotabweichung hingegen wird auto matisch, also ohne Eingriff des Maschinenführers bestimmt. Mit diesem Ver fahren kann ein Kalibrier-Datensatz auch dann bestimmt werden, wenn keine Daten eines GNSS-Systems zur Verfügung stehen, z.B. wenn kein Empfang vorliegt. This is therefore a manual process in which the distance between the attitude and position determination unit of the attitude and position determination assembly and the reference mark is measured, for example, by a machine operator with a meter stick or a similar measuring device with an accuracy of e.g. 0, 5 cm is determined and then provided via an HMI (Human Machine Interface, user interface) of the location and position determination unit. The vertical deviation, on the other hand, is determined automatically, i.e. without intervention by the machine operator. With this method, a calibration data set can also be determined if no data from a GNSS system is available, e.g. if there is no reception.
Gemäß einerweiteren Ausführungsform zur Bestimmung des Kalibrier-Daten satzes werden zusätzlich folgende Schritte ausgeführt: Ausrichten des Werkzeugs, derart, dass das Werkzeug eine vorbe stimmte Position mit einer vorbestimmten Neigung, insbesondere mit einer maximalen Neigung, annimmt und die Referenzmarke an der glei chen, vorbestimmten Position während des Ausrichtens verbleibt, wo bei während des Ausrichtens Positionsdaten mit dem GNSS-Modul der Lage- und Positionsbestimmungseinheit erfasst werden, According to a further embodiment for determining the calibration data set, the following additional steps are carried out: Aligning the tool in such a way that the tool assumes a predetermined position with a predetermined inclination, in particular with a maximum inclination, and the reference mark remains at the same predetermined position during the alignment, with position data being compared with the GNSS system during the alignment module of the situation and position determination unit are recorded,
Bestimmen von Differenzdaten durch Auswerten des bestimmten Ka- librier-Datensatzes und den bestimmten Positionsdaten, und Determining differential data by evaluating the specific calibration data set and the specific position data, and
Ergänzen des Kalibrier-Datensatzes durch Auswerten der Differenzda ten. Supplementing the calibration data set by evaluating the differential data.
Es handelt sich hier um ein Verfahren, das auf dem vorherigen manuellen Ver fahren aufbaut und es um automatische Schritte erweitert. Mit anderen Wor ten, es handelt sich um ein kombiniertes manuelles/automatisches oder auch halbautomatisches Verfahren. This is a process that builds on the previous manual process and adds automated steps to it. In other words, it is a combined manual/automatic or semi-automatic process.
Hierfür sind allerdings Daten eines GNSS-Systems Voraussetzung. Sie wer den erfasst, nachdem die Referenzmarke des Werkzeugs gemäß dem vorhe rigen manuellen Verfahren in eine erste, vorbestimmte Position, in der sie sich mit der Lage- und Positionsbestimmungseinheit im Lot befindet, gebracht wurde, und das Werkzeug nun ausgehend von dieser ersten, vorbestimmten Position durch Ändern der Neigung des Werkzeugs in eine weitere, zweite vorbestimmte Position mit einer vorbestimmten Neigung gebracht wird, wobei die Referenzmarke während des Ausrichtens an der gleichen, vorbestimmten Position verbleibt. However, this requires data from a GNSS system. They are detected after the reference mark of the tool has been brought into a first, predetermined position in accordance with the previous manual method, in which it is perpendicular to the location and position determination unit, and the tool is now starting from this first, predetermined one Position is brought by changing the inclination of the tool in a further, second predetermined position with a predetermined inclination, wherein the reference mark remains during the alignment at the same predetermined position.
Es kann vorgesehen sein, dass ein Maschinenführer z.B. durch ein HMI auf gefordert wird, ein entsprechendes Ausrichten des Werkzeugs manuell zu be wirken. Das Ausrichten kann auch automatisch durch einen Ansteuer-Daten- satz erfolgen. Bei dem Ansteuer-Datensatz kann es sich um eine vorbe stimmte Folge von Steuerbefehlen handeln, mit denen das Werkzeug ohne weiteren Eingriff eines Maschinenführers in die genannte, vorbestimmte Posi tion gebracht wird. Bei der vorbestimmten Position kann es sich um eine Po sition maximaler Neigung handeln, bei der ein oder mehrere Gelenke des Aus legers sich an ihrem Anschlag befinden und ein weiteres Verschwenken nicht mehr möglich ist. Der Ansteuer-Datensatz kann automatisch während des Ab laufs des Verfahrens aktiviert werden. Provision can be made for a machine operator to be prompted, for example by an HMI, to manually align the tool accordingly. Alignment can also be performed automatically by a control data set. The control data record can be a predetermined sequence of control commands, with which the tool is brought into the specified, predetermined position without further intervention by a machine operator. The predetermined position can be a position of maximum inclination, in which one or more joints of the cantilever are at their stop and further pivoting is no longer possible. The control data record can be activated automatically during the course of the process.
Dadurch, dass die Referenzmarke an ihrer Position bleibt, also ortsfest ist, während die übrigen Abschnitte des Werkzeugs verlagert werden, beschreibt die Lage- und Positionsbestimmungseinheit der Lage- und Positionsbestim mungs-Baugruppe eine Verlagerung entlang einer kreisförmigen bzw. kreis abschnittsförmigen Trajektorie. Because the reference mark remains in its position, i.e. is stationary, while the other sections of the tool are displaced, the location and position determination unit of the position and position determination assembly describes a displacement along a circular or circular segment-shaped trajectory.
Es erfolgt dann ein Vergleich von Daten auf Basis der GNSS-Daten mit Daten, die auf Basis des Kalibrier-Datensatzes gewonnen werden, die mit dem ma nuellen Verfahren gewonnen wurden. Mit anderen Worten, es werden beide Verfahren miteinander verglichen und ein Fehler bzw. eine Abweichung be stimmt, der bzw. die dann in einen verbesserten, ergänzten Kalibrier-Daten- satz einmündet. A comparison then takes place of data based on the GNSS data with data obtained on the basis of the calibration data set obtained using the manual method. In other words, both methods are compared with one another and an error or a deviation is determined, which then leads to an improved, supplemented calibration data set.
So kann die Genauigkeit der Positions- und Raumlagebestimmung nochmals gesteigert werden. In this way, the accuracy of the position and spatial position determination can be further increased.
Dieses Verfahren kann auch dann durchgeführt werden, wenn nach einem zwischenzeitlichen Ausfall eines GNSS-Systems dieses wieder zur Verfügung steht. This procedure can also be carried out if a GNSS system is available again after an interim failure.
Gemäß einer weiteren Ausführungsform werden zum Bestimmen des Kalib rier-Datensatzes folgende Schritte ausgeführt: Befestigen der Lage- und Positionsbestimmungseinheit an dem Werk zeug, According to a further embodiment, the following steps are carried out to determine the calibration data set: Attaching the location and position determination unit to the tool,
Verlagern des Werkzeugs, um einen vorbestimmten geostationären Punkt für das Werkzeug anzufahren, und Erfassen von einem ersten Messwert an einem ersten Messpunkt, mit Positionsdaten indikativ für die Position der Lage- und Positionsbestimmungseinheit mit dem GNSS-Modul der Lage- und Positionsbestimmungseinheit, und mit La gedaten indikativ für die Raumlage der Lage- und Positionsbestim mungseinheit mit der Lagesensorbaugruppe der Lage- und Positions bestimmungseinheit, Relocating the tool to approach a predetermined geostationary point for the tool, and acquiring a first measured value at a first measuring point, with position data indicative of the position of the attitude and position determination unit with the GNSS module of the attitude and position determination unit, and with La data indicative of the position in space of the attitude and position determination unit with the position sensor assembly of the attitude and position determination unit,
Verlagern des Werkzeugs, derart, dass eine Neigung des Werkzeugs verändert wird, wobei eine Referenzmarke des Werkzeugs an einer gleichen, vorbestimmten Position verbleibt, Displacing the tool in such a way that an inclination of the tool is changed, with a reference mark of the tool remaining at a same, predetermined position,
Erfassen von mindestens zwei weiteren Messwerten an mindestens zwei weiteren Messpunkten, mit weiteren Positionsdaten indikativ für die Position der Lage- und Positionsbestimmungseinheit mit dem GNSS-Modul der Lage- und Positionsbestimmungseinheit durch zumin dest zweimaliges Durchführen des Vorgängerschritts und dieses Schritts, Acquisition of at least two further measured values at at least two further measuring points, with further position data indicative of the position of the attitude and position determination unit with the GNSS module of the attitude and position determination unit by carrying out the previous step and this step at least twice,
Auswerten der Messwerte, um eine Lotabweichung der Lage- und Po sitionsbestimmungseinheit und/oder eine Distanz zwischen der Lage- und Positionsbestimmungseinheit und der Referenzmarke zu bestim men, evaluating the measured values in order to determine a vertical deviation of the location and position determination unit and/or a distance between the location and position determination unit and the reference mark,
Erzeugen des Kalibrier-Datensatzes durch Auswerten der Lotabwei chung und/oder der Distanz. Generation of the calibration data record by evaluating the perpendicular deviation and/or the distance.
Es handelt sich hier um ein automatisches Verfahren, ohne dass ein manuel les Messen durch den Maschinenführer erforderlich ist. Auch für dieses Verfahren sind Daten eines GNSS-Systems Voraussetzung. Die Lagedaten können nur beim Erfassen von dem ersten Messwert an dem ersten Messpunkt erfasst werden. Es kann aber zusätzlich vorgesehen sein, auch an den weiteren Messpunkten zusätzlich die Lagedaten zu erfassen. This is an automated process that does not require manual measurement by the machine operator. Data from a GNSS system is also a prerequisite for this procedure. The position data can only be acquired when acquiring the first measured value at the first measuring point. However, it can also be provided that the location data is also recorded at the other measuring points.
Zur Auswertung kann vorgesehen sein, dass eine Sollkurve durch einen Kreis oder einen Kreisabschnitt unter Berücksichtigung von Messpunkten gemäß den Positionsdaten angenähert wird, z.B. durch Least SquareFit oder Taubin- fit, um den Radius des angenäherten Kreises oder Kreisabschnitts zu bestim men, der repräsentativ für die Distanz ist. For the evaluation, it can be provided that a target curve is approximated by a circle or a section of a circle, taking into account measurement points according to the position data, e.g. by Least SquareFit or Taubinfit, in order to determine the radius of the approximated circle or section of a circle that is representative of the distance is.
Insgesamt werden zumindest drei Messpunkte durch Verlagern des Werk zeugs angesteuert und dann Messwerte erfasst und ausgewertet. Die Genau igkeit kann gesteigert werden, wenn die Anzahl der angesteuerten Mess punkte erhöht wird. A total of at least three measuring points are controlled by moving the tool and then measured values are recorded and evaluated. The accuracy can be increased if the number of controlled measuring points is increased.
Auch bei diesem Verfahren bleibt die Referenzmarke an ihrer Position, wäh rend die übrigen Abschnitte des Werkzeugs verlagert werden. Dies vereinfacht auch bei diesem Verfahren die Auswertung. With this method, too, the reference mark remains in its position while the other sections of the tool are relocated. This also simplifies the evaluation in this method.
Gemäß einer weiteren Ausführungsform werden zum Bestimmen des Kalib- rier-Datensatzes folgende Schritte ausgeführt: According to a further embodiment, the following steps are carried out to determine the calibration data set:
Befestigen der Lage- und Positionsbestimmungseinheit an dem Werk zeug, Attaching the location and position determination unit to the tool,
Verlagern des Werkzeugs, um einen vorbestimmten geostationären Punkt für das Werkzeug anzufahren, und Erfassen von einem ersten Messwert an einem ersten Messpunkt, mit Positionsdaten indikativ für die Position der Lage- und Positionsbestimmungseinheit mit dem GNSS-Modul der Lage- und Positionsbestimmungseinheit, und mit La- gedaten indikativ für die Raumlage der Lage- und Positionsbestim mungseinheit mit der Lagesensorbaugruppe der Lage- und Positions bestimmungseinheit, Relocating the tool to approach a predetermined geostationary point for the tool, and acquiring a first measured value at a first measuring point, with position data indicative of the position of the attitude and position determination unit with the GNSS module of the attitude and position determination unit, and with La - data indicative of the position in space of the attitude and position determination unit with the position sensor assembly of the attitude and position determination unit,
Verlagern des Werkzeugs, derart, dass eine Neigung des Werkzeugs verändert wird, wobei eine Referenzmarke des Werkzeugs an einer gleichen, vorbestimmten Position verbleibt, Displacing the tool in such a way that an inclination of the tool is changed, with a reference mark of the tool remaining at a same, predetermined position,
Erfassen von einem zweiten Messwert an einem zweiten Messpunkt, mit weiteren Positionsdaten indikativ für die Position der Lage- und Po sitionsbestimmungseinheit mit dem GNSS-Modul der Lage- und Positi onsbestimmungseinheit, und mit weiteren Lagedaten indikativ für die Raumlage der Lage- und Positionsbestimmungseinheit mit der Lage sensorbaugruppe der Lage- und Positionsbestimmungseinheit, Acquisition of a second measured value at a second measuring point, with further position data indicative of the position of the attitude and position determination unit with the GNSS module of the attitude and position determination unit, and with further position data indicative of the position in space of the attitude and position determination unit with the Position sensor assembly of the attitude and position determination unit,
Auswerten der Messwerte, um eine Lotabweichung der Lage- und Po sitionsbestimmungseinheit und/oder eine Distanz zwischen der Lage- und Positionsbestimmungseinheit und der Referenzmarke zu bestim men, und evaluating the measured values in order to determine a vertical deviation of the location and position determination unit and/or a distance between the location and position determination unit and the reference mark, and
Erzeugen des Kalibrier-Datensatzes durch Auswerten der Lotabwei chung und/oder der Distanz. Generation of the calibration data record by evaluating the perpendicular deviation and/or the distance.
Auch hier handelt es sich um ein automatisches Verfahren, ohne dass ein ma nuelles Messen durch den Maschinenführer erforderlich ist. This is also an automatic process that does not require manual measurement by the machine operator.
Ebenfalls sind für dieses Verfahren Daten eines GNSS-Systems Vorausset zung. Die Lagedaten werden hier beim Erfassen von dem ersten Messwert an dem ersten Messpunkt und dem zweiten Messwert an dem zweiten Messpunkt erfasst. Es kann aber zusätzlich vorgesehen sein, an weiteren Messpunkten weitere Messwerte einschließlich der Lagedaten zu erfassen. Auch hier kann zur Auswertung vorgesehen sein, dass eine Sollkurve durch einen Kreis oder einen Kreisabschnitt unter Berücksichtigung von Messpunk ten gemäß den Positionsdaten angenähert wird, z.B. durch Least SquareFit oderTaubinfit, um den Radius des angenäherten Kreises oder Kreisabschnitts zu bestimmen, der repräsentativ für die Distanz ist. Data from a GNSS system is also a prerequisite for this procedure. The position data are recorded here when the first measured value is recorded at the first measuring point and the second measured value is recorded at the second measuring point. However, provision can also be made for further measurement values, including the position data, to be recorded at further measurement points. Here, too, it can be provided for the evaluation that a target curve is approximated by a circle or a circle section, taking into account measuring points according to the position data, e.g. by Least SquareFit or Taubinfit, in order to determine the radius of the approximated circle or circle section that is representative of the distance is.
Gemäß einer weiteren Ausführungsform werden zum Bestimmen des Kalib- rier-Datensatzes folgende Schritte ausgeführt: According to a further embodiment, the following steps are carried out to determine the calibration data set:
Befestigen der Lage- und Positionsbestimmungseinheit an dem Werk zeug, Attaching the location and position determination unit to the tool,
Bestimmen eines ersten Ausrichtungs-Datensatzes indikativ für die Po sition der Lage- und Positionsbestimmungseinheit an dem Werkzeug mit dem GNSS-Modul der Lage- und Positionsbestimmungseinheit an einem ersten Messpunkt, Determining a first alignment data set indicative of the position of the attitude and position determination unit on the tool with the GNSS module of the attitude and position determination unit at a first measuring point,
Verlagern, insbesondere geradliniges Verlagern, einer Referenzmarke des Werkzeugs von dem ersten Messpunkt zu einem zweiten Mess punkt durch Verlagern, insbesondere geradliniges Verlagern, des Aus legers, derart, dass ein Abstand zwischen dem Landfahrzeug und der Referenzmarke verändert wird, Relocating, in particular moving in a straight line, a reference mark of the tool from the first measuring point to a second measuring point by moving, in particular moving in a straight line, the boom in such a way that a distance between the land vehicle and the reference mark is changed,
Bestimmen eines zweiten Ausrichtungs-Datensatzes indikativ für die Position der Lage- und Positionsbestimmungseinheit an dem Werkzeug mit dem GNSS-Modul der Lage- und Positionsbestimmungseinheit an dem zweiten Messpunkt, und determining a second alignment data set indicative of the position of the location and position determination unit on the tool with the GNSS module of the location and position determination unit at the second measuring point, and
Erzeugen des Kalibrier-Datensatzes durch Auswerten des ersten Aus richtungs-Datensatzes und des zweiten Ausrichtungs-Datensatzes. Es wird also nach dem Bestimmen des ersten Ausrichtungs-Datensatzes mit dem Werkzeug an dem ersten Messpunkt das Werkzeug mit der Referenz marke derart verlagert, dass der Abstand zwischen dem Landfahrzeug und dem Werkzeug verändert wird. Dies erfolgt mit dem Ausleger derart, dass das Werkzeug mit der Referenzmarke im Wesentlich parallel über den Boden be wegt wird. Dabei wird unter „im Wesentlichen“ hier innerhalb technisch beding ter Abweichungen der Steuerung des Auslegers liegend verstanden. Dabei erfolgt kein Neigen des Werkzeugs. Wenn z.B. das Werkzeug als Bagger schaufel ausgebildet ist, erfolgt keine Drehbewegung, um die Neigung der Baggerschaufel zu verändern. Ferner erfolgt keine Drehung des Auslegers um die Hochachse des Landfahrzeugs. Somit erfolgt auch keine Drehung des Werkzeugs um die Hochachse des Landfahrzeugs. Wenn z.B. das Landfahr zeug als Bagger mit einem um seine Hochachse drehbaren Aufbau mit einem Ausleger ausgebildet ist, erfolgt keine Drehung um die Hochachse des dreh baren Aufbaus. Mit anderen Worten, die Verlagerung erfolgt geradlinig und rotationskomponentenfrei. Abweichend hiervon kann die Verlagerung auch nicht-geradlinig erfolgen, z.B. S-förmig. Wesentlich ist aber hierbei, dass der erste Messpunkt und der zweite Messpunkt durch eine zu parametrisierende Geradengleichung verbunden werden. Generating the calibration data set by evaluating the first alignment data set and the second alignment data set. After the determination of the first alignment data set with the tool at the first measuring point, the tool with the reference mark is shifted in such a way that the distance between the land vehicle and the tool is changed. This is done with the boom in such a way that the tool is moved essentially parallel to the reference mark over the ground. In this context, “substantially” is understood to mean within technically caused deviations in the control of the boom. There is no tilting of the tool. For example, if the tool is designed as an excavator shovel, there is no rotational movement to change the inclination of the shovel. Furthermore, the boom does not rotate about the vertical axis of the land vehicle. Thus, the tool does not rotate about the vertical axis of the land vehicle. If, for example, the land vehicle is designed as an excavator with a structure that can be rotated about its vertical axis and has a boom, there is no rotation about the vertical axis of the rotatable structure. In other words, the displacement takes place in a straight line and without any rotational components. Deviating from this, the displacement can also take place in a non-linear manner, for example in an S-shape. However, it is essential here that the first measuring point and the second measuring point are connected by a linear equation to be parameterized.
Nach dem Verlagern an den zweiten Messpunkt wird dann der zweite Ausrich tungs-Datensatz bestimmt. Der erste und der zweite Ausrichtung-Datensatz enthalten jeweils Daten indikativ für die Positionen der Referenzmarke an dem ersten Messpunkt und dem zweiten Messpunkt. Mit Hilfe der Daten indikativ für die Positionen können Parameter der Geradengleichung bestimmt werden, die eine Geradengleichung parametrisieren, die die Positionen verbindet. After shifting to the second measuring point, the second alignment data set is then determined. The first and second alignment data sets each contain data indicative of the positions of the reference mark at the first measurement point and the second measurement point. With the help of the data indicative of the positions, parameters of the straight line equation parameterizing a straight line equation connecting the positions can be determined.
Mit Daten des GNSS-Moduls der Lage- und Positionsbestimmungseinheit in dikativ für die Position des Nordpols bzw. der Lage von Längen- und Breiten geraden eines kartesischen Koordinatensystems kann ein Kalibrier-Datensatz bestimmt werden, der eine Kalibrierung in Bezug auf den Nordpol bzw. der Lage von Längen- und Breitengeraden eines kartesischen Koordinatensys- tems erlaubt. Mit anderen Worten, durch das Bestimmen des Kalibrier-Daten- satzes kann die absolute Ausrichtung des Werkzeugs in Bezug auf den Nord pol bzw. die absolute Himmelsrichtung bestimmt werden. Dadurch lässt sich das Einhalten von absoluten Planvorgaben für Bodenbearbeitungen verbes sern. So kann durch das Bestimmen des Kalibrier-Datensatzes die Funktiona lität eines Kompasses mit nur einem einzigen GNSS-Modul bereitgestellt wer den. Ferner kann mit diesem Kalibrier-Datensatz ein landfahrzeugeigenes Ko ordinatensystem mit der Lage des Nordpols bzw. der Lage von Längen- und Breitengeraden eines kartesischen Koordinatensystems angeglichen werden. With data from the GNSS module of the location and position determination unit indicative of the position of the North Pole or the position of longitude and latitude straight lines of a Cartesian coordinate system, a calibration data set can be determined, which is a calibration in relation to the North Pole or the Position of lines of longitude and latitude of a Cartesian coordinate system team allowed. In other words, by determining the calibration data record, the absolute orientation of the tool in relation to the North Pole or the absolute direction of the compass can be determined. This improves compliance with absolute plan specifications for tillage. By determining the calibration data set, the functionality of a compass can be provided with just a single GNSS module. Furthermore, with this calibration data set, a land vehicle's own coordinate system can be aligned with the position of the north pole or the position of longitude and latitude lines of a Cartesian coordinate system.
Gemäß einerweiteren Ausführungsform wird ein Trägheitsnavigationssystem der Lage- und Positionsbestimmungseinheit verwendet, das zusätzlich Daten für den Lage-Datensatz bereitstellt. Durch die Kombination des GNSS-Sys- tems mit dem Trägheitsnavigationssystem kann das kurzzeitig genaue, aber driftende Trägheitssystem mit den langzeitstabilen, aber kurzzeitig variablen schwankenden Daten des GNSS-Systems fusioniert werden. Dies ermöglicht eine genauere Positionsermittlung sowie eine kurzzeitig ausreichend genaue Positionsermittlung bei kurzzeitiger Unterbrechung einer Verbindung zu dem GNSS-System. Eine kurzzeitige Unterbrechung einer Verbindung zu dem GNSS-System kann z.B. bei einem Aushubprozess erfolgen, wenn der Erdaushub in einem als Baggerschaufel ausgebildeten Werkzeug bewegt wird und die GNSS-Antenne dabei kein freies Sichtfeld zu den Satelliten des GNSS-Systems hat. According to a further embodiment, an inertial navigation system of the position and position determination unit is used, which additionally provides data for the position data set. By combining the GNSS system with the inertial navigation system, the briefly accurate but drifting inertial system can be merged with the long-term stable but briefly variable fluctuating data of the GNSS system. This enables a more precise determination of the position as well as a position determination that is sufficiently precise for a short time in the event of a short-term interruption of a connection to the GNSS system. A brief interruption of a connection to the GNSS system can occur during an excavation process, for example, if the excavated earth is moved in a tool designed as an excavator shovel and the GNSS antenna does not have a clear field of view to the satellites of the GNSS system.
Ferner gehören zur Erfindung ein Computerprogrammprodukt, ein System zur Positions- und Raumlagebestimmung eines Werkzeugs zur Bodenbearbei tung an einem verstellbaren Ausleger eines Landfahrzeugs und eine Lage- und Positionsbestimmungs-Baugruppe für ein derartiges System. Die Lage- und Positionsbestimmungs-Baugruppe kann eine Anzeigevorrichtung und/o der ein Endgerät und/oder Steuerausgabegerät aufweisen, wobei die Anzei gevorrichtung und/oder das Endgerät und/oder Steuerausgabegerät als Mo bilgerät ausgebildet sind. Es wird nun die Erfindung anhand der Figuren erläutert. Es zeigen: The invention also includes a computer program product, a system for determining the position and position in space of a tool for soil processing on an adjustable boom of a land vehicle and a position and position determination assembly for such a system. The situation and position determination assembly can have a display device and/or a terminal and/or control output device, the display device and/or the terminal and/or control output device being designed as a mobile device. The invention will now be explained with reference to the figures. Show it:
Figur 1 in schematischer Darstellung ein Landfahrzeug mit einem Sys tem zur Positions- und Raumlagebestimmung eines Werkzeugs des Landfahrzeugs. FIG. 1 shows a schematic representation of a land vehicle with a system for determining the position and spatial orientation of a tool on the land vehicle.
Figur 2 in schematischer Darstellung weitere Details des in Figur 1 ge zeigten Auslegers mit dem Werkzeug. FIG. 2 shows, in a schematic representation, further details of the boom with the tool shown in FIG.
Figur 3 in schematischer Darstellung weitere Details des in Figur 1 ge zeigten Werkzeugs. FIG. 3 shows further details of the tool shown in FIG. 1 in a schematic representation.
Figur 4 in schematischer Darstellung Komponenten des in Figur 1 ge zeigten Systems. FIG. 4 shows a schematic representation of components of the system shown in FIG.
Figur 5 in schematischer Darstellung weitere Details der in Figur 4 ge zeigten Referenzstation. FIG. 5 shows further details of the reference station shown in FIG. 4 in a schematic representation.
Figur 6 in schematischer Darstellung weitere Details einer der Kompo nenten des in Figur 1 gezeigten Systems. FIG. 6 shows further details of one of the components of the system shown in FIG. 1 in a schematic representation.
Figur 7 in schematischer Darstellung ein Werkzeug während eines Ka libriervorgangs. FIG. 7 shows a schematic representation of a tool during a calibration process.
Figur 8 in schematischer Darstellung ein Werkzeug während eines wei teren Kalibriervorgangs. FIG. 8 shows a tool during a further calibration process in a schematic representation.
Figur 9 in schematischer Darstellung einen weiteren Kalibriervorgang. FIG. 9 shows a further calibration process in a schematic representation.
Figur 10 in schematischer Darstellung einen weiteren Kalibriervorgang. Figur 11 in schematischer Darstellung einen Verfahrensablauf gemäß ei nem ersten Ausführungsbeispiel zur Kalibrierung des in Figur 1 gezeigten Systems. FIG. 10 shows a further calibration process in a schematic representation. FIG. 11 shows a schematic representation of a process sequence according to a first exemplary embodiment for calibrating the system shown in FIG.
Figur 12 in schematischer Darstellung einen Verfahrensablauf gemäß ei nem zweiten Ausführungsbeispiel zur Kalibrierung des in Figur 1 gezeigten Systems. FIG. 12 shows a schematic representation of a process sequence according to a second exemplary embodiment for calibrating the system shown in FIG.
Figur 13 in schematischer Darstellung einen Verfahrensablauf gemäß ei nem dritten Ausführungsbeispiel zur Kalibrierung des in Figur 1 gezeigten Systems. FIG. 13 shows a schematic representation of a process sequence according to a third exemplary embodiment for calibrating the system shown in FIG.
Figur 14 in schematischer Darstellung einen Verfahrensablauf gemäß ei nem vierten Ausführungsbeispiel zur Kalibrierung des in Figur 1 gezeigten Systems. FIG. 14 shows a schematic representation of a method sequence according to a fourth exemplary embodiment for calibrating the system shown in FIG.
Figur 15 in schematischer Darstellung ein Werkzeug während eines Ka libriervorgangs gemäß einem fünften Ausführungsbeispiel zur Kalibrierung des in Figur 1 gezeigten Systems. FIG. 15 shows a schematic representation of a tool during a calibration process according to a fifth exemplary embodiment for calibrating the system shown in FIG.
Figur 16 in schematischer Darstellung weitere Details des Kalibriervor gangs gemäß dem fünften Ausführungsbeispiel. FIG. 16 shows, in a schematic representation, further details of the calibration process according to the fifth exemplary embodiment.
Figur 17 in schematischer Darstellung einen Verfahrensablauf gemäß dem fünften Ausführungsbeispiel zur Kalibrierung des in Figur 1 gezeigten Systems. FIG. 17 shows a schematic representation of a process sequence according to the fifth exemplary embodiment for calibrating the system shown in FIG.
Figur 18 in schematischer Darstellung einen Verfahrensablauf zum Be trieb des in Figur 1 gezeigten Systems. FIG. 18 shows a schematic representation of a process sequence for operating the system shown in FIG.
Es wird zunächst auf Figur 1 Bezug genommen. Dargestellt ist ein Landfahrzeug 1 mit einem System 21 zur Positions- und Raumlagebestimmung eines Werkzeugs 2 des Landfahrzeugs 1 . Reference is first made to FIG. A land vehicle 1 is shown with a system 21 for determining the position and spatial orientation of a tool 2 of the land vehicle 1 .
Im vorliegenden Ausführungsbeispiel ist das Landfahrzeug 1 als Bagger mit einem verstellbaren Ausleger 3 ausgebildet, an dessen Ende das Werkzeug 2 befestigt ist, das im vorliegenden Ausführungsbeispiel als Baggerschaufel ausgebildet ist. Mit einem derartigen Landfahrzeug 1 können z.B. Bodenbear beitungen nach Planvorgaben ausgeführt werden, wobei hier lediglich mit ei ner Referenzmarke 11 des Werkzeugs 2 eine Erdoberfläche bearbeitet wird. Bei der Referenzmarke 11 handelt es sich im vorliegenden Ausführungsbei spiel um eine Werkzeugspitze des Werkzeugs 2, mit der die Erdoberfläche bearbeitet wird. Abweichend vom vorliegenden Ausführungsbeispiel kann es sich bei der Referenzmarke 11 um einen definierten Punkt auf dem Werkzeug 2 oder eine Linie entsprechend einer Kante an dem Werkzeug 2 handeln. Fer ner kann abweichend vom vorliegenden Ausführungsbeispiel das Landfahr zeug 1 auch als eine andere Baumaschine mit einem anderen Werkzeug oder auch als Landmaschine mit einem entsprechenden Werkzeug ausgebildet sein. In the present embodiment, the land vehicle 1 is designed as an excavator with an adjustable boom 3, at the end of which the tool 2 is attached, which is designed as an excavator shovel in the present embodiment. With such a land vehicle 1, for example, soil processing can be carried out according to plan specifications, in which case the surface of the earth is processed only with a reference mark 11 of the tool 2. When the reference mark 11 is in the present game Ausführungsbei a tool tip of the tool 2, with which the earth's surface is processed. Deviating from the present exemplary embodiment, the reference mark 11 can be a defined point on the tool 2 or a line corresponding to an edge on the tool 2. Furthermore, deviating from the present exemplary embodiment, the agricultural vehicle 1 can also be designed as another construction machine with a different tool or as an agricultural machine with a corresponding tool.
Von den Komponenten des Systems 21 zur Positions- und Raumlagebestim mung sind in der Figur 1 eine Lage- und Positionsbestimmungs-Baugruppe 4 und ein Endgerät und/oder Steuerausgabegerät 6 dargestellt. Of the components of the system 21 for determining position and spatial position, a position and position determination module 4 and a terminal and/or control output device 6 are shown in FIG.
Im vorliegenden Ausführungsbeispiel weist die Lage- und Positionsbestim mungs-Baugruppe 4 eine Lage- und Positionsbestimmungseinheit 8 und eine Anzeigevorrichtung 5 auf. Abweichend vom vorliegenden Ausführungsbeispiel kann die Lage- und Positionsbestimmungs-Baugruppe 4 auch nur die Lage- und Positionsbestimmungseinheit 8 aufweisen. In the present exemplary embodiment, the location and position determination module 4 has a location and position determination unit 8 and a display device 5 . Deviating from the present exemplary embodiment, the attitude and position determination subassembly 4 can also only have the attitude and position determination unit 8 .
Während die Lage- und Positionsbestimmungseinheit 8 am Werkzeug 2 und die Anzeigevorrichtung 5 am Ausleger 3 befestigt sind, ist das Endgerät und/o der Steuerausgabegerät 6 im Führerstand des Landfahrzeugs 1 angeordnet. Das Endgerät und/oder Steuerausgabegerät 6 kann auch als Mobilgerät aus gebildet sein. Dabei wird unter einem Mobilgerät ein Endgerät verstanden, das aufgrund seiner Größe und seines Gewichts ohne größere körperliche An strengung tragbar und somit mobil einsetzbar ist. Beispiel für Mobilgeräte sind Smartphones oder auch Tablet-Computer sowie Notebooks. While the attitude and position determination unit 8 is attached to the tool 2 and the display device 5 to the boom 3 , the terminal device and/or the control output device 6 is arranged in the driver's cab of the land vehicle 1 . The terminal and/or control output device 6 can also be designed as a mobile device. A mobile device is understood to mean an end device which, due to its size and weight, can be carried without any major physical exertion and can therefore be used on the move. Examples of mobile devices are smartphones or tablet computers and notebooks.
Es wird nun zusätzlich auf Figur 2 Bezug genommen. Reference is now additionally made to FIG.
Die Lage- und Positionsbestimmungseinheit 8 und die Anzeigevorrichtung 5 sind jeweils werkzeuglos an dem Werkzeug 2 bzw. dem Ausleger 3 befestigt und können im vorliegenden Ausführungsbeispiel auch werkzeuglos von dem Werkzeug 2 bzw. dem Ausleger 3 gelöst werden. Hierzu sind zwischen der Lage- und Positionsbestimmungseinheit 8 und dem Werkzeug 2 sowie zwi schen der Anzeigevorrichtung 5 und dem Ausleger 3 jeweils Magnete 9 vor gesehen. Es können starke Permanentmagnete, wie z.B. NdFeB-Magnete, sein. The orientation and position determination unit 8 and the display device 5 are each fastened to the tool 2 or the boom 3 without tools and can also be detached from the tool 2 or the boom 3 without tools in the present exemplary embodiment. For this purpose, magnets 9 are seen between the location and position determination unit 8 and the tool 2 and between the display device 5 and the boom 3 tween. It can be strong permanent magnets such as NdFeB magnets.
Abweichend vom vorliegenden Ausführungsbeispiel kann auch eine rahmen förmige Halterung 10 verwendet werden, um die Lage- und Positionsbestim mungseinheit 8 am Werkzeug 2 und/oder die Anzeigevorrichtung 5 am Ausle ger 3 zu befestigen. Durch die Verwendung der rahmenförmigen Halterung 10, die fest mit dem Werkzeug 2 bzw. dem Ausleger 3 verbunden ist, wird sicher gestellt, dass die Lage- und Positionsbestimmungseinheit 8 und/oder die An zeigevorrichtung 5 jeweils definierte Positionen und Raumlagen haben, die auch nach einer Trennung bzw. Demontage und einer erneuten Montage der Lage- und Positionsbestimmungseinheit 8 und/oder der Anzeigevorrichtung 5 erhalten bleiben. Dies reduziert auch den Aufwand für Kalibrierungen. Deviating from the present exemplary embodiment, a frame-shaped holder 10 can also be used in order to attach the location and position determination unit 8 to the tool 2 and/or the display device 5 to the extension ger 3 . The use of the frame-shaped bracket 10, which is firmly connected to the tool 2 or the boom 3, ensures that the location and position determination unit 8 and/or the display device 5 each have defined positions and spatial positions, which also after a separation or disassembly and re-assembly of the location and position determination unit 8 and/or the display device 5 are preserved. This also reduces the effort for calibrations.
Es wird nun zusätzlich auf Figur 3 Bezug genommen. Reference is now additionally made to FIG.
Die Lage- und Positionsbestimmungseinheit 8 ist derart an dem Werkzeug 2 platziert, dass zumindest in bestimmten Lagen des Werkzeugs 2 ein freies Sichtfeld auf Satelliten 701 (siehe Figur 4) eines GNSS-Systems besteht. Hierzu ist die Lage- und Positionsbestimmungseinheit 8 auf einer Oberseite des als Baggerschaufel ausgebildeten Werkzeugs 2 angeordnet. Location and position determination unit 8 is placed on tool 2 in such a way that at least in certain positions of tool 2 there is a clear field of view of satellites 701 (see FIG. 4) of a GNSS system. For this purpose, the attitude and position determination unit 8 is arranged on an upper side of the tool 2 designed as an excavator shovel.
Unter einem GNSS-System (globales Satelliten Navigationssystem) wird da bei ein System zur Positionsbestimmung und Navigation auf der Erde und auch in der Luft durch den Empfang von Signalen von Satelliten 701 verstan den. Bei dem GNSS-System kann es sich um ein System wie z.B. GPS, Gali leo, GLONASS oder Beidu handeln. A GNSS system (Global Navigation Satellite System) is understood to mean a system for determining position and navigating on earth and also in the air by receiving signals from satellites 701 . The GNSS system can be a system such as GPS, Galileo, GLONASS or Beidu.
Durch den Empfang und die Anwendung von GNSS-Korrekturdaten, beispiels weise RTCM-Daten (Radio Technical Commission for Maritime Services) für RTK (Real Time Kinematic) können Laufzeitfehler durch die Atmosphäre und Ionosphäre korrigiert werden und somit präzise Werte für die Position ermittelt werden. Auch kann das GNSS-System als DGPS-System (Differential Global Positioning System) ausgebildet sein, bei dem durch Ausstrahlen von Korrek turdaten (Bahn- und Zeitsystem) die Genauigkeit der GNSS-Navigation gestei gert wird. By receiving and applying GNSS correction data, such as RTCM (Radio Technical Commission for Maritime Services) data for RTK (Real Time Kinematic), time-of-flight errors through the atmosphere and ionosphere can be corrected and thus precise values for the position can be determined. The GNSS system can also be designed as a DGPS system (Differential Global Positioning System), in which the accuracy of the GNSS navigation is increased by broadcasting correction data (orbit and time system).
Das System 21 und seine Komponenten sind dabei im vorliegenden Ausfüh rungsbeispiel zum drahtlosen, bidirektionalen Datenaustausch ausgebildet und weisen jeweils eine eigene Betriebsenergieversorgung auf. Dabei können für die nachfolgend beschriebenen Aufgaben und Funktionen das System 21 und seine Komponenten jeweils Hard- und/oder Software-Komponenten auf weisen. Somit können z.B. die Anzeigevorrichtung 5 und/oder das Endgerät und/oder Steuerausgabegerät 6 und/oder die Lage- und Positionsbestim mungseinheit 8 Software-Komponenten eines Computerprogrammprodukts zum Betrieb des Systems 21 aufweisen, wobei die Software-Komponenten insbesondere als Module ausgebildet sind. In the present exemplary embodiment, the system 21 and its components are designed for wireless, bidirectional data exchange and each have their own operating power supply. The system 21 and its components can each have hardware and/or software components for the tasks and functions described below. Thus, e.g. the display device 5 and/or the end device and/or control output device 6 and/or the location and position determination unit 8 can have software components of a computer program product for operating the system 21, the software components being designed in particular as modules.
Es wird nun zusätzlich auf Figur 4 Bezug genommen, um weitere Details der in Figur 1 dargestellten Komponenten sowie einer Referenzstation 7 zu erläu tern. Die Lage- und Positionsbestimmungseinheit 8 weist im vorliegenden Ausfüh rungsbeispiel folgende Unterkomponenten auf: Reference is now also made to FIG. 4 in order to explain further details of the components shown in FIG. 1 and a reference station 7 . In the present exemplary embodiment, location and position determination unit 8 has the following subcomponents:
Ein GNSS-Modul 702 für den Empfang von Positionsdaten PD des GNSS- Systems, eine im vorliegenden Ausführungsbeispiel als Beschleunigungs sensorbaugruppe (IMU - Inertial Measuring Unit) ausgebildete Lagesensor baugruppe 703 mit mindestens zwei Messachsen zur Lageerfassung der Lage- und Positionsbestimmungseinheit 8, ein Sende- und Empfangs-Modul 706a zum drahtlosen Datenaustausch mit den anderen Komponenten des Systems 21 zur Positions- und Raumlagebestimmung, eine Anzeigeeinheit 704a, ein Eingabegerät 705, einen Mikrocontroller als Recheneinheit zur Lage- und Positionsberechnung und einen Akkumulator 707a zur Be triebsenergieversorgung. A GNSS module 702 for receiving position data PD of the GNSS system, a sensor assembly in the present embodiment as an acceleration sensor assembly (IMU - Inertial Measuring Unit) trained position sensor assembly 703 with at least two measuring axes for detecting the position and position determination unit 8, a transmitter and receiving module 706a for wireless data exchange with the other components of the system 21 for determining position and position in space, a display unit 704a, an input device 705, a microcontroller as a computing unit for position and position calculation and an accumulator 707a for operating power supply.
Die Lagesensorbaugruppe 703 ist dazu ausgebildet, durch Vergleich von min destens zwei Beschleunigungswerten, die in Richtung zumindest zweier Messachsen erfasst werden, die aktuelle Raum läge der Lage- und Positions bestimmungs-Baugruppe 4 in Relation zur Schwerkraft bzw. zum Lot L (siehe z.B. Figur 7) zu bestimmen. The position sensor assembly 703 is designed to, by comparing at least two acceleration values that are detected in the direction of at least two measurement axes, the current spatial position of the attitude and position determination assembly 4 in relation to gravity or to the perpendicular L (see, e.g., Figure 7) to determine.
Im vorliegenden Ausführungsbeispiel sind die mindestens zwei Messachsen der jeweiligen Beschleunigungssensoren der Lagesensorbaugruppe 703 or thogonal zueinander angeordnet, um die Raumlage beziehungsweise eine Neigung des Werkzeugs 2 zu bestimmen. Mithilfe des Mikrocontrollers werden aus den Positionsdaten PD sowie den Lagedaten LD der Lagesensorbau gruppe 703 sowie im vorliegenden Ausführungsbeispiel einem ersten Kalib- rier-Datensatz KDS und einem zweiten Kalibrier-Datensatz KDS' die Position und Lage sowie Ausrichtung der Referenzmarke 11 bestimmt, wie dies später noch detailliert erläutert wird. In the present exemplary embodiment, the at least two measurement axes of the respective acceleration sensors of the position sensor assembly 703 are arranged orthogonal to one another in order to determine the spatial position or an inclination of the tool 2 . With the aid of the microcontroller, the position and position as well as the alignment of the reference mark 11 are determined from the position data PD and the position data LD of the position sensor assembly 703 and, in the present exemplary embodiment, a first calibration data set KDS and a second calibration data set KDS', as will be done later will be explained in detail later.
Die Lagesensorbaugruppe 703 kann auch ein Trägheitsnavigationssystem aufweisen. Es kann das kurzzeitig genaue, aber driftende Trägheitssystem mit den langzeitstabilen, aber kurzzeitig variablen schwankenden Daten des GNSS-Systems fusioniert werden. Dies ermöglicht eine genauere Positions ermittlung sowie eine kurzzeitig ausreichend genaue Positionsermittlung bei kurzzeitiger Unterbrechung einer Verbindung zu dem GNSS-System. Eine kurzzeitige Unterbrechung einer Verbindung zu dem GNSS-System kann z.B. bei einem Aushubprozess erfolgen, wenn der Erdaushub in einem als Bagger schaufel ausgebildeten Werkzeug 2 bewegt wird und die GNSS-Antenne 13 (siehe Figur 6) dabei kein freies Sichtfeld zu den Satelliten 701 hat. The attitude sensor assembly 703 may also include an inertial navigation system. It can combine the short-term accurate but drifting inertial system with the long-term stable but short-term variable fluctuating data of the GNSS systems are merged. This enables a more precise determination of the position as well as a position determination that is sufficiently precise for a short time in the event of a short-term interruption of a connection to the GNSS system. A brief interruption of a connection to the GNSS system can occur during an excavation process, for example, if the excavated earth is moved in a tool 2 designed as an excavator shovel and the GNSS antenna 13 (see Figure 6) has no clear field of view to the satellites 701 .
Auf Basis dieser Daten wird im Betrieb durch den Mikrocontroller die Differenz zwischen einer Ist-Position und einer Soll-Position des Werkzeugs 2 berech net und durch diesen z.B. auf der Anzeigeeinheit 704a angezeigt oder an eine externe Vorrichtung übermittelt. Based on this data, the microcontroller calculates the difference between an actual position and a target position of the tool 2 during operation and displays it, for example, on the display unit 704a or transmits it to an external device.
Die Anzeigevorrichtung 5 weist im vorliegenden Ausführungsbeispiel eine An zeigeeinheit 704b, ein Sende- und Empfangs-Modul 706b und einen Akkumu lator 707b auf. In the present exemplary embodiment, the display device 5 has a display unit 704b, a transmission and reception module 706b and an accumulator 707b.
Das Endgerät und/oder Steuerausgabegerät 6 weist im vorliegenden Ausfüh rungsbeispiel eine Anzeigeeinheit 704c und ein Sende- und Empfangs-Modul 706c auf. Zur Betriebsenergieversorgung ist im vorliegenden Ausführungsbei spiel eine Verbindung mit einem Bordnetz des Landfahrzeugs 1 vorgesehen. Abweichend vom vorliegenden Ausführungsbeispiel kann auch ein Akkumula tor zur Betriebsenergieversorgung vorgesehen sein. In the present exemplary embodiment, the terminal device and/or control output device 6 has a display unit 704c and a transmission and reception module 706c. In the present exemplary embodiment, a connection to an on-board network of the land vehicle 1 is provided for operating energy supply. Deviating from the present exemplary embodiment, an accumulator can also be provided for supplying operating energy.
Das Endgerät und/oder Steuerausgabegerät 6 kann dazu ausgebildet sein, eine dreidimensionale Positionsdatenkarte einzulesen. Danach wird beispiels weise über die Anzeigeeinheit 5 eine Absoluthöhe und/oder eine Absolutposi tion des Werkzeugs 2 oder der Referenzmarke 11 angezeigt. Es kann auch ein Fehler oder eine Abweichung zu einer Sollhöhe des Werkzeugs 2 oder der Referenzmarke 11 angezeigt werden. Des Weiteren kann beispielsweise über das Endgerät und/oder Steuerausgabegerät 6 eine zwei- oder dreidimensio nale Ansicht der Positionsdatenkarte mit der aktuellen Position des Werk zeugs 2 dargestellt werden. Die Referenzstation 7 weist im vorliegenden Ausführungsbeispiel eine Anzei geeinheit 704d, ein Sende- und Empfangs-Modul 706d und einen Akkumulator 707d auf. The terminal and/or control output device 6 can be designed to read in a three-dimensional position data map. An absolute height and/or an absolute position of the tool 2 or the reference mark 11 is then displayed, for example, via the display unit 5 . An error or a deviation from a target height of the tool 2 or the reference mark 11 can also be displayed. Furthermore, a two- or three-dimensional view of the position data map with the current position of the tool 2 can be displayed, for example, via the terminal and/or control output device 6 . In the present exemplary embodiment, the reference station 7 has a display unit 704d, a transmission and reception module 706d and an accumulator 707d.
Es wird nun zusätzlich auf Figur 5 Bezug genommen. Reference is now additionally made to FIG.
Dargestellt ist die GNSS-Referenzstation 7, die im vorliegenden Ausführungs beispiel auf einem Tripod 12 angeordnet ist. Shown is the GNSS reference station 7, which is arranged on a tripod 12 in the present exemplary embodiment.
Die Referenzstation 7 sollte, wenn absolute Positionsdaten benötigt werden, auf einem Punkt mit bekannter geostationärer Position und freiem Sichtfeld zu den Satelliten 701 positioniert werden. Werden nur relative Positionsdaten be nötigt, so ist jede beliebige Stelle geeignet, welche ein freies Sichtfeld auf Sa telliten 701 des GNSS-Systems bietet. Abhängig von der Netzverfügbarkeit und Übertragungsqualität der Funkverbindungstypen verbindet sich die Lage- und Positionsbestimmungs-Baugruppe 4 mit der Referenzstation 7 automa tisch, beispielsweise über ein Mobilnetz (LTE, 3G, 5G, EDGE, ... ) oder mithilfe der Anzeigevorrichtung 5 als Relaisstation, z.B. über Langdistanzfunk. Als Übertragungsstandards können z.B. WLAN, Bluetooth, 868MHz, LoRa, UWB- Funk oder Mobilfunkstandards verwendet werden. If absolute position data is required, the reference station 7 should be positioned at a point with a known geostationary position and a clear field of view to the satellites 701 . If only relative position data is required, any location that offers a clear field of view of satellites 701 of the GNSS system is suitable. Depending on the network availability and transmission quality of the radio connection types, the situation and position determination assembly 4 automatically connects to the reference station 7, for example via a mobile network (LTE, 3G, 5G, EDGE, ...) or using the display device 5 as a relay station, e.g. via long-distance radio. WLAN, Bluetooth, 868MHz, LoRa, UWB radio or mobile radio standards can be used as transmission standards.
Es wird nun zusätzlich auf Figur 6 Bezug genommen, um weitere Details der Lage- und Positionsbestimmungseinheit 8 zu erläutern. Reference is now also made to FIG. 6 in order to explain further details of attitude and position determination unit 8 .
Die Lage- und Positionsbestimmungseinheit 8 weist im vorliegenden Ausfüh rungsbeispiel eine optionale Anzeige 16 mit z.B. LEDs als Leuchtmittel 15 auf, die über eine Leitungsverbindung (Anzeigeverbinder 17) daten- und be triebsenergieübertragend mit den anderen Komponenten der Lage- und Posi tionsbestimmungs-Baugruppe 4 verbunden ist. Ferner weist die Lage- und Positionsbestimmungseinheit 8 im vorliegenden Ausführungsbeispiel Tasten 18, 19, 20 oder andere Schaltelemente zur Kon figuration der Lage- und Positionsbestimmungs-Baugruppe 4 auf. In the present exemplary embodiment, the location and position determination unit 8 has an optional display 16 with, for example, LEDs as illuminants 15, which are connected to the other components of the location and position determination assembly 4 via a line connection (display connector 17) in order to transmit data and operating energy is. Furthermore, the location and position determination unit 8 in the present exemplary embodiment has keys 18, 19, 20 or other switching elements for configuration of the location and position determination assembly 4.
Des Weiteren ist dargestellt, dass die Lage- und Positionsbestimmungseinheit 8 eine GNSS-Antenne 13 mit einem GNSS-Antennenzentrum 14 aufweist. It is also shown that location and position determination unit 8 has a GNSS antenna 13 with a GNSS antenna center 14 .
Eine Inbetriebnahme der Lage- und Positionsbestimmungs-Baugruppe 4 kann z.B. automatisch ohne Schalter- oder Tasterbetätigung allein durch Entnahme aus einem Transportbehältnis oder z.B. mit dem Taster 18 erfolgen. Nach Ent nahme verbindet sich z.B. die Lage- und Positionsbestimmungseinheit 8 drahtlos selbstständig mit der geeigneten GNSS-Referenzstation 7 oder mit einem GNSS-Korrekturdatennetzwerkdienst. The location and position determination subassembly 4 can be started up automatically, for example, without actuating a switch or button, simply by removing it from a transport container or using the button 18, for example. After removal, e.g. the attitude and position determination unit 8 wirelessly connects itself to the appropriate GNSS reference station 7 or to a GNSS correction data network service.
Die Lage- und Positionsbestimmungseinheit 8 ist dazu ausgebildet, nachdem sie an dem Werkzeug 2 befestigt wurde, einen Positions-Datensatz PDS indi kativ für die Position der Lage- und Positionsbestimmungs-Baugruppe 4 mit dem GNSS-Modul 702 zu bestimmen. The location and position determination unit 8 is designed to determine a position data set PDS indicative of the position of the location and position determination assembly 4 with the GNSS module 702 after it has been attached to the tool 2 .
Des Weiteren ist die Lage- und Positionsbestimmungseinheit 8 dazu ausge bildet, einen Lage-Datensatz LDS indikativ für die Raumlage der Lage- und Positionsbestimmungs-Baugruppe 4 mit der Lagesensorbaugruppe 703 zu be stimmen. Furthermore, the location and position determination unit 8 is designed to determine a location data set LDS indicative of the spatial position of the location and position determination assembly 4 with the position sensor assembly 703 .
Ferner ist die Lage- und Positionsbestimmungseinheit 8 dazu ausgebildet, den Positions-Datensatz PDS und den Lage-Datensatz LDS im vorliegenden Aus führungsbeispiel unter Verwendung des ersten Kalibrier-Datensatzes KDS und des zweiten Kalibrier-Datensatzes KDS' auszuwerten, um einen Aus gangs-Datensatz ADS indikativ für die Raumlage und Position des Werkzeugs 2 zu bestimmen, und den Ausgangs-Datensatz ADS auszugeben. Furthermore, the location and position determination unit 8 is designed to evaluate the position data set PDS and the position data set LDS in the present exemplary embodiment using the first calibration data set KDS and the second calibration data set KDS' in order to generate an output data set To determine ADS indicative of the spatial location and position of the tool 2, and to output the output data record ADS.
Es kann z.B. mit der Referenzmarke 11 des Werkzeugs 2 ein Punkt auf einer gewünschten Höhe angefahren werden und durch Betätigen des Tasters 19 in eine Konfiguration übernommen werden. Da durch den Kalibrier-Datensatz KDS die Lage sowie die Höhe h zwischen der Referenzmarke 11 und z.B. der GNSS-Empfangsantenne 13 bekannt ist, kann nun ausgehend von der Posi tion und Raumlage der Lage- und Positionsbestimmungseinheit 8 die Position und Raumlage der Referenzmarke 11 bestimmt werden. For example, a point at a desired height can be approached with reference mark 11 of tool 2 and by pressing button 19 be transferred to a configuration. Since the position and the height h between the reference mark 11 and, for example, the GNSS receiving antenna 13 are known from the calibration data set KDS, the position and spatial position of the reference mark 11 can now be determined based on the position and spatial position of the position and position determination unit 8 will.
Der erste Kalibrier-Datensatz KDS und der zweite Kalibrier-Datensatz KDS' werden im vorliegenden Ausführungsbeispiel zumindest einmal nach dem Be festigen der Lage- und Positionsbestimmungseinheit 8 an dem Werkzeug 2 bestimmt, wie dies später noch detailliert erläutert wird. In the present exemplary embodiment, the first calibration data record KDS and the second calibration data record KDS′ are determined at least once after the attitude and position determination unit 8 has been attached to the tool 2, as will be explained in detail later.
Es wird nun zusätzlich auf Figuren 7 und 8 Bezug genommen. Reference is now additionally made to FIGS. 7 and 8. FIG.
In Figur 7 ist ein Szenario dargestellt, bei dem das Werkzeug 2 im Lot L aus gerichtet ist. Ferner ist zu erkennen, dass die Lage- und Positionsbestim mungseinheit 8 in dieser Position und Raumlage einen Winkelversatz mit ei nem Winkelwert a zu der Raumlage B der Lage- und Positionsbestimmungs einheit 8 hat. Der mit der Lagesensorbaugruppe 703 gemessene Winkelwert ist der des Winkels d in Bezug zum Lot L. In dieser Position sind die jeweiligen Winkelwerte der Winkel a und d gleich. Durch Berücksichtigen des Winkels a kann der Winkelversatz ausgeglichen werden. A scenario is shown in FIG. 7 in which the tool 2 is aligned in the perpendicular L. It can also be seen that the location and position determination unit 8 in this position and spatial position has an angular offset with an angle value a relative to the spatial position B of the position and position determination unit 8 . The angular value measured by the position sensor assembly 703 is that of the angle d with respect to the perpendicular L. In this position, the respective angular values of the angles a and d are equal. By taking angle a into account, the angular offset can be compensated.
Der Winkel d kann auch als Stabachsenfehler oder Stabachsfehler aufgefasst werden, d.h. als Abweichung vom Lot L, während der Winkel a als Kippach senfehler in Bezug zu der Raumlage B der Lage- und Positionsbestimmungs einheit 8 aufgefasst werden kann. The angle d can also be interpreted as a rod axis error or rod axis error, i.e. as a deviation from the perpendicular L, while the angle a can be interpreted as a tilting axis error in relation to the spatial position B of the location and position determination unit 8 .
In Figur 8 hingegen ist ein Szenario dargestellt, bei dem das Werkzeug 2 durch eine Drehung einen weiteren Winkelversatz mit dem Winkelwert d hat. Das Werkzeug 2 wurde also außer Lot L gebracht durch eine Drehung um die y- Achse. Der Winkel a des Winkelversatzes hat sich hingegen nicht verändert und mit ihm kann der Winkelversatz herausgerechnet werden. Um auf die aktuelle Raumlage und Position der Referenzmarke 11 schließen zu können, ist also der Winkel a des Winkelversatzes und ein Wert für die Distanz R von der Lage- und Positionsbestimmungseinheit 8 bis zur Referenz marke 11 erforderlich. In contrast, FIG. 8 shows a scenario in which the tool 2 has a further angular offset with the angular value d as a result of a rotation. The tool 2 was thus brought out of line L by rotating it around the y-axis. The angle a of the angular offset, on the other hand, has not changed and the angular offset can be calculated with it. In order to be able to deduce the current position in space and position of the reference mark 11, the angle a of the angular offset and a value for the distance R from the attitude and position determination unit 8 to the reference mark 11 are required.
Der erste Kalibrier-Datensatz KDS kann zumindest einen Winkelwert a, indi kativ für den Winkelversatz, und eine Distanz R, indikativ für eine Distanz von der Lage- und Positionsbestimmungseinheit 8 bis zur Referenzmarke 11 , ent halten, die beide als Offsetgrößen aufgefasst werden können, um aus der Raumlage und Position der Lage- und Positionsbestimmungseinheit 8 auf die Raum läge und Position der Referenzmarke 11 schließen zu können. The first calibration data record KDS can contain at least one angle value a, indicative of the angular offset, and a distance R, indicative of a distance from the attitude and position determination unit 8 to the reference mark 11, both of which can be interpreted as offset variables. in order to be able to infer the spatial location and position of the reference mark 11 from the location and position of the location and position determination unit 8 .
Mit anderen Worten, mit dem ersten Kalibrier-Datensatz KDS wird eine Koor dinatentransformation oder ein Basiswechsel durchgeführt, so dass aus der Raumlage und Position der Lage- und Positionsbestimmungseinheit 8 auf die Raum läge und Position der Referenzmarke 11 geschlossen werden kann. In other words, a coordinate transformation or a base change is carried out with the first calibration data set KDS, so that the spatial location and position of the location and position determination unit 8 can be used to determine the spatial location and position of the reference mark 11 .
Mit dem Höhenwert IIGNSS gemäß dem GNSS-Modul 702 kann dann die Höhe hRef der Referenzmarke 11 wie folgt bestimmt werden: h-Ref = h-GNss — h With the height value IIGNSS according to the GNSS module 702, the height hRef of the reference mark 11 can then be determined as follows: h-Ref = h-GNss - h
Der Höhenwert h kann dabei in z.B. einem zweidimensionalen Koordinaten system wie folgt bestimmt werden: h = R cos ( ß ) mit ß = d — a The height value h can be determined in e.g. a two-dimensional coordinate system as follows: h = R cos ( ß ) with ß = d - a
Dabei bezeichnet der Winkelwert d die aktuelle Raum läge der Lage- und Po sitionsbestimmungseinheit 8, bezogen auf das Lot L und eine Senkrechte S durch die Lagesensorbaugruppe 703 der Lage- und Positionsbestimmungs einheit 8. Der Winkelwert ß bezeichnet die um den Offsetwinkel a korrigierte Raumlage der Lage- und Positionsbestimmungseinheit 8, bezogen auf das Lot L und eine Senkrechte S durch die Lagesensorbaugruppe 703 der Lage- und Positionsbestimmungseinheit 8. In dem in Figur 7 gezeigten Szenario ist der Winkelwert ß = d - a = 0, in dem in Figur 8 gezeigten Szenario ß F 0. The angle value d designates the current spatial position of the location and position determination unit 8, based on the perpendicular L and a perpendicular S through the position sensor assembly 703 of the location and position determination unit 8. The angle value ß designates the spatial position of the position corrected by the offset angle a Orientation and position determination unit 8, based on the perpendicular L and a perpendicular S through the position sensor assembly 703 of the position and Position determination unit 8. In the scenario shown in Figure 7, the angle value ß = d - a = 0, in the scenario shown in Figure 8 ß F 0.
Mit der Anzeigevorrichtung 5 und/oder dem Endgerät und/oder Steuerausga begerät 6 kann dann basierend auf dem Ausgangs-Datensatz ADS die Flöhe h oder eine Abweichung hiervon angezeigt werden. Von Vorteil ist dabei, dass die Anzeigevorrichtung 5 durch ihre Anordnung am Ausleger 3 gleichzeitig mit dem Werkzeug 2 im Sichtfeld des Maschinenführers liegt. With the display device 5 and/or the terminal and/or control output device 6, the fleas h or a deviation therefrom can then be displayed based on the output data set ADS. The advantage here is that the display device 5 is in the field of view of the machine operator at the same time as the tool 2 due to its arrangement on the boom 3 .
Es wird nun unter Bezugnahme auf Figur 7 ein erstes Ausführungsbeispiel eines manuellen Kalibrierverfahrens zum Bestimmen des ersten Kalibrier-Da- tensatzes KDS erläutert. A first exemplary embodiment of a manual calibration method for determining the first calibration data set KDS will now be explained with reference to FIG.
Nachdem die Referenzmarke 11 des Werkzeugs 2 durch Neigen des Werk zeugs 2 um die y-Achse derart ausgerichtet wurde, dass sich die Referenz marke 11 mit der Lage- und Positionsbestimmungseinheit 8 im Lot L befindet, wird mit einem Meterstab oder einer ähnlichen Messeinrichtung mit einer Ge nauigkeit von z.B. 0,5 cm die Distanz R zwischen der Lage- und Positionsbe stimmungseinheit 8 und der Referenzmarke 11 manuell bestimmt. After the reference mark 11 of the tool 2 has been aligned by tilting the tool 2 around the y-axis in such a way that the reference mark 11 is in the plumb L with the attitude and position determination unit 8, a meter rule or a similar measuring device with a Accuracy of e.g. 0.5 cm, the distance R between the location and position determination unit 8 and the reference mark 11 is determined manually.
Die Lage- und Positionsbestimmungseinheit 8 ist dazu ausgebildet, diesen Wert einzulesen, nachdem er manuell über z.B. ein HMI der Lage- und Positi onsbestimmungs-Baugruppe 4 eingegeben wurde. The attitude and position determination unit 8 is designed to read in this value after it has been entered manually via, for example, an HMI of the attitude and position determination assembly 4 .
Ferner ist die Lage- und Positionsbestimmungseinheit 8 dazu ausgebildet, eine Lotabweichung LAB der Lage- und Positionsbestimmungseinheit 8 mit der Lagesensorbaugruppe 703 zu bestimmen, d.h. z.B. den Winkelwert a für den Winkelversatz. Furthermore, the location and position determination unit 8 is designed to determine a vertical deviation LAB of the location and position determination unit 8 with the position sensor assembly 703, i.e., for example, the angular value a for the angular offset.
Z.B. aus der Distanz R und dem Winkelwert a erzeugt dann die Lage- und Positionsbestimmungseinheit 8 der Lage- und Positionsbestimmungs-Bau gruppe 4 den Kalibrier-Datensatz KDS. Abweichend vom vorliegenden Ausführungsbeispiel kann die Bestimmung des ersten Kalibrier-Datensatzes KDS in der Anzeigevorrichtung 5 der Lage- und Positionsbestimmungs-Baugruppe 4 erfolgen. For example, the location and position determination unit 8 of the location and position determination assembly 4 then generates the calibration data set KDS from the distance R and the angle value a. Deviating from the present exemplary embodiment, the first calibration data set KDS can be determined in the display device 5 of the location and position determination assembly 4 .
Es wird nun unter Bezugnahme auf Figur 8 ein zweites Ausführungsbeispiel eines kombinierten manuellen/automatischen oder auch halbautomatischen Kalibrierverfahrens zum Bestimmen des ersten Kalibrier-Datensatzes KDS er läutert. A second exemplary embodiment of a combined manual/automatic or also semi-automatic calibration method for determining the first calibration data record KDS will now be explained with reference to FIG.
Das Kalibrierverfahren gemäß dem vorliegenden zweiten Ausführungsbeispiel baut auf dem anhand der Figur 7 beschriebenen Kalibrierverfahren auf und erlaubt eine Steigerung der Genauigkeit. The calibration method according to the present second exemplary embodiment is based on the calibration method described with reference to FIG. 7 and allows the accuracy to be increased.
Hierzu ist die Lage- und Positionsbestimmungseinheit 8 dazu ausgebildet, ein Ausrichten des Werkzeugs 2 zu bewirken, derart, dass das Werkzeug 2 eine vorbestimmte Position, im vorliegenden Ausführungsbeispiel eine Position mit maximaler Neigung in Bezug zur y-Achse annimmt. Hierzu kann der Ausleger 3 z.B. manuell oder mittels eines Ansteuer-Datensatzes angesteuert werden. Dabei wird das Werkzeug 2 derart um die y-Achse verlagert bzw. ausgerichtet, dass die Referenzmarke 11 an der gleichen Position I verbleibt. Während die ses Ausrichtungsvorgangs werden mit dem GNSS-Modul 702 Positionsdaten PD erfasst. Dies kann kontinuierlich, also in Intervallen mit einer vorbestimm ten Zeitdauer, oder diskret an vorbestimmten Positionen erfolgen. For this purpose, the attitude and position determination unit 8 is designed to bring about an alignment of the tool 2 such that the tool 2 assumes a predetermined position, in the present exemplary embodiment a position with maximum inclination in relation to the y-axis. For this purpose, the cantilever 3 can be controlled, for example, manually or by means of a control data set. In the process, the tool 2 is displaced or aligned about the y-axis in such a way that the reference mark 11 remains at the same position I. During this alignment process, the GNSS module 702 acquires position data PD. This can be done continuously, ie at intervals with a predetermined period of time, or discretely at predetermined positions.
Durch einen Vergleich mit Positionen, die mit Hilfe des ersten Kalibrier-Daten satzes KDS bestimmt werden, können nun Differenzdaten DD bestimmt wer den. Difference data DD can now be determined by a comparison with positions that are determined using the first calibration data record KDS.
Die Differenzdaten DD werden bestimmt durch einen Vergleich eines idealen Kreises bzw. Kreisabschnitts, definiert durch die vorher manuell bestimmte Distanz R und den vorher bestimmten Winkelwert a, mit den Positionsdaten PD. Die Lage- und Positionsbestimmungseinheit 8 ergänzt dann den ersten Kalib- rier-Datensatz KDS durch entsprechende Korrekturdaten. The difference data DD are determined by comparing an ideal circle or circle section, defined by the previously manually determined distance R and the previously determined angle value a, with the position data PD. The location and position determination unit 8 then supplements the first calibration data set KDS with appropriate correction data.
Der Kalibrier-Datensatz KDS enthält dann die Differenzdaten DD, die einem Winkelwert jeweils einen Korrekturwert zuordnen und auf einen aktuellen Wert angewendet werden können. The calibration data set KDS then contains the difference data DD, which assign a correction value to an angle value and can be applied to a current value.
Abweichend vom vorliegenden Ausführungsbeispiel kann die Bestimmung des ersten Kalibrier-Datensatzes KDS in der Anzeigevorrichtung 5 der Lage- und Positionsbestimmungs-Baugruppe 4 erfolgen. Deviating from the present exemplary embodiment, the first calibration data set KDS can be determined in the display device 5 of the location and position determination assembly 4 .
Es wird nun unter Bezugnahme auf Figur 9 ein weiteres, drittes Ausführungs beispiel eines automatischen Kalibrierverfahrens zum Bestimmen des ersten Kalibrier-Datensatzes KDS erläutert. A further, third exemplary embodiment of an automatic calibration method for determining the first calibration data set KDS will now be explained with reference to FIG.
Es wird das Werkzeug 2 z.B. manuell oder durch einen Ansteuer-Datensatz verlagert, derart, dass die Referenzmarke 11 an der gleichen, vorbestimmten Position I verbleibt, wobei während des Ausrichtens Positionsdaten PD mit dem GNSS-Modul 702 der Lage- und Positionsbestimmungs-Baugruppe 4 er fasst werden. The tool 2 is shifted, e.g. manually or by means of a control data set, in such a way that the reference mark 11 remains in the same, predetermined position I, with position data PD being transmitted to the GNSS module 702 of the attitude and position determination assembly 4 during the alignment he be caught.
Die so erfassten Positionsdaten PD sind indikativ für eine Sollkurve, entlang der das Werkzeug 2 verlagert bzw. ausgerichtet wird. The position data PD recorded in this way are indicative of a target curve along which the tool 2 is displaced or aligned.
Zur Auswertung kann vorgesehen sein, dass eine Sollkurve durch einen Kreis SK oder einen Kreisabschnitt unter Berücksichtigung von zumindest drei Messpunkten MP1 , MP2, ... MPx gemäß den Positionsdaten PD angenähert wird, z.B. durch Least Square Fit oder Taubin Fit, um den Radius des ange näherten Kreises SK oder Kreisabschnitts zu bestimmen, der repräsentativ für die Distanz R ist. For the evaluation, it can be provided that a target curve is approximated by a circle SK or a section of a circle, taking into account at least three measuring points MP1, MP2, ... MPx according to the position data PD, e.g. by least square fit or taubin fit, to the radius of the to determine an approximated circle SK or segment of a circle that is representative of the distance R.
Es wird dann ein Winkel g zwischen einer Geraden G, die den Mittelpunkt des bestimmten Kreises SK und den ersten Messpunkt MP1 verbindet, und einem Horizont HO, bestimmt. Ferner wird der Winkelwert des Winkels d bestimmt. Der Abstand e ist dabei der Abstand vom Mittelpunkt des bestimmten Kreises SK bis zur Position der Lage- und Positionsbestimmungseinheit 8 bezogen auf den Horizont HO: e = R cos (7) There is then an angle g between a straight line G, which connects the center of the specific circle SK and the first measuring point MP1, and a Horizon HO, definitely. Furthermore, the angular value of the angle d is determined. The distance e is the distance from the center of the specific circle SK to the position of the location and position determination unit 8 in relation to the horizon HO: e = R cos (7)
Der Winkelwert des Winkels a ergibt sich dann zu: oc = 7 - d The angular value of the angle a then results in: oc = 7 - d
Dabei ist die Distanz R von der Lage- und Positionsbestimmungseinheit 8 bis zur Referenzmarke 11 gleich dem Radius R des Kreises SK. The distance R from the location and position determination unit 8 to the reference mark 11 is equal to the radius R of the circle SK.
Abweichend vom vorliegenden Ausführungsbeispiel kann die Bestimmung des ersten Kalibrier-Datensatzes KDS in der Anzeigevorrichtung 5 der Lage- und Positionsbestimmungs-Baugruppe 4 erfolgen. Deviating from the present exemplary embodiment, the first calibration data set KDS can be determined in the display device 5 of the location and position determination assembly 4 .
Es wird nun unter Bezugnahme auf Figur 10 ein weiteres, viertes Ausführungs beispiel eines ebenfalls automatischen Kalibrierverfahrens zum Bestimmen des ersten Kalibrier-Datensatzes KDS erläutert. A further, fourth exemplary embodiment of a likewise automatic calibration method for determining the first calibration data set KDS will now be explained with reference to FIG.
Es werden gemäß diesem Ausführungsbeispiel nur zwei Messpunkte MP1 , MP2 durch Verschwenken des Werkzeugs 2 um die y-Achse angefahren und ausgewertet. According to this exemplary embodiment, only two measurement points MP1, MP2 are approached and evaluated by pivoting the tool 2 about the y-axis.
Zur Auswertung wird auch hier eine Sollkurve durch einen Kreis SK oder einen Kreisabschnitt unter Berücksichtigung von den beiden Messpunkten MP1 , MP2 bestimmt. For the purpose of evaluation, a target curve is also determined here by a circle SK or a section of a circle, taking into account the two measurement points MP1, MP2.
An beiden Messpunkten MP1 , MP2 werden Messwerte MW erfasst. Die Mess werte MW weisen Positionsdaten PD indikativ für die Position der Lage- und Positionsbestimmungseinheit 8 und Lagedaten LD indikativ für die Raumlage der Lage- und Positionsbestimmungseinheit 8 auf. Die Positionsdaten PD wer den mit dem GNSS-Modul 702 der Lage- und Positionsbestimmungseinheit 8 bestimmt, während die Lagedaten LD mit der Lagesensorbaugruppe 703 der Lage- und Positionsbestimmungseinheit 8 bestimmt werden. Die Positionsda ten PD können ein dreidimensionaler Datensatz sein. Measured values MW are recorded at both measuring points MP1, MP2. The measured values MW have position data PD indicative of the position of the attitude and position determination unit 8 and position data LD indicative of the position in space the situation and position determination unit 8 on. The position data PD are determined with the GNSS module 702 of the position and position determination unit 8 , while the position data LD are determined with the position sensor assembly 703 of the position and position determination unit 8 . The position data PD can be a three-dimensional data set.
Mit Hilfe des bestimmten Kreises SK können dann Werte für den Winkel e und eine Kreissehne d bestimmt werden. Der Wert für den Winkel e ist ein Maß für den Kreisbogenabschnitt des bestimmten Kreises SK zwischen den beiden Messpunkten MP1 , MP2, während die Kreissehne d die beiden Messpunkte MP1 , MP2 verbindet. Ferner können der Radius des bestimmten Kreises SK, der der Distanz R entspricht, und der Winkelwert des Winkels a bestimmt wer den. Values for the angle e and a chord d can then be determined with the help of the determined circle SK. The value for the angle e is a measure of the circular arc section of the specific circle SK between the two measuring points MP1, MP2, while the chord d connects the two measuring points MP1, MP2. Furthermore, the radius of the specific circle SK corresponding to the distance R and the angular value of the angle α can be determined.
Zudem kann aus den Messwerten MW die Position bestimmt werden, an der sich die Lage- und Positionsbestimmungseinheit 8 mit ihrem GNSS-Antennen- zentrum 14 theoretisch mit der Referenzmarke 11 im Lot L befindet. An dieser Position kann eine Lageabweichung der Lage- und Positionsbestimmungsein heit 8 zum Lot L bestimmt werden. Hierfür müssen keine Daten vorliegen, bei dem sich die Lage- und Positionsbestimmungseinheit 8 mit ihrem GNSS-An- tennenzentrum 14 und die Referenzmarke 11 tatsächlich im Lot L befinden. Die ermittelte Lageabweichung zum Lot L und die Distanz R können dem Ka- librier-Datensatz KDS hinzugefügt werden. In addition, the position at which the location and position determination unit 8 with its GNSS antenna center 14 is theoretically located with the reference mark 11 in the perpendicular L can be determined from the measured values MW. At this position, a positional deviation of the location and position determination unit 8 relative to the perpendicular L can be determined. For this, no data need be available in which the location and position determination unit 8 with its GNSS antenna center 14 and the reference mark 11 are actually in the perpendicular L. The determined positional deviation from the perpendicular L and the distance R can be added to the calibration data record KDS.
Abweichend vom vorliegenden Ausführungsbeispiel kann die Bestimmung des ersten Kalibrier-Datensatzes KDS in der Anzeigevorrichtung 5 der Lage- und Positionsbestimmungs-Baugruppe 4 erfolgen. Deviating from the present exemplary embodiment, the first calibration data set KDS can be determined in the display device 5 of the location and position determination assembly 4 .
Nach Beendigung von z.B. einer Bodenbearbeitung nach Planvorgaben kann die Lage- und Positionsbestimmungs-Baugruppe 4 durch einfaches Demon tieren von dem Werkzeug 2 getrennt und in das Transportbehältnis zurückge legt werden, wobei es dann selbsttätig deaktiviert wird. Ein Erfassen einer Ent- nähme bzw. eines Zurücklegens der Lage- und Positionsbestimmungs-Bau gruppe 4 in ihr Transportbehältnis kann beispielsweise durch eine in dem Transportbehältnis integrierte Ladevorrichtung erfolgen. After the end of, for example, tillage according to plan specifications, the location and position determination assembly 4 can be separated from the tool 2 by simply dismantling animals and placed back in the transport container, in which case it is then automatically deactivated. A detection of a Taking or putting back the location and position determination building group 4 in its transport container can be done, for example, by a loading device integrated in the transport container.
Der erste Kalibrier-Datensatz KDS kann dem Werkzeug 2 und einer Position der Lage- und Positionsbestimmungseinheit 8 am Werkzeug 2 zugeordnet und gespeichert sein, sodass für dieses Werkzeug 2 und diese Position der Kalib riervorgang nur einmal durchgeführt werden muss. Der erste Kalibrier-Daten satz KDS kann zusammen mit Daten, die eine Identifikation des Werkzeugs 2 erlauben, und mit Daten indikativ für die Position am Werkzeug 2, z.B. in der Lage- und Positionsbestimmungs-Baugruppe 4 und/oder dem Endgerät und/oder Steuerausgabegerät 6 gespeichert werden und von dort kann später die Konfiguration gemäß dem Kalibrier-Datensatz KDS vorgenommen wer den. The first calibration data record KDS can be associated with the tool 2 and a position of the attitude and position determination unit 8 on the tool 2 and stored, so that the calibration process only has to be carried out once for this tool 2 and this position. The first calibration data set KDS can be used together with data that allow the tool 2 to be identified and with data indicative of the position on the tool 2, e.g. in the location and position determination assembly 4 and/or the end device and/or control output device 6 are saved and from there the configuration can later be made according to the calibration data set KDS who the.
Es wird nun unter Bezugnahme auf Figur 11 ein Verfahren zum Kalibrieren, insbesondere zum manuellen Kalibrieren, gemäß dem ersten Ausführungsbei spiel erläutert. A method for calibration, in particular for manual calibration, according to the first exemplary embodiment will now be explained with reference to FIG.
In einem ersten Schritt S100a wird die Lage- und Positionsbestimmungsein heit 8 der Lage- und Positionsbestimmungs-Baugruppe 4 an dem Werkzeug 2 befestigt. In a first step S100a, the location and position determination unit 8 of the location and position determination assembly 4 is attached to the tool 2 .
In einem weiteren Schritt S200a wird die Referenzmarke 11 des Werkzeugs 2 durch Neigen des Werkzeugs 2 ausgerichtet, derart, dass sich die Referenz marke 11 mit der Lage- und Positionsbestimmungseinheit 8 im Lot L befindet. In a further step S200a, the reference mark 11 of the tool 2 is aligned by tilting the tool 2 in such a way that the reference mark 11 is perpendicular to the location and position determination unit 8 .
In einem weiteren Schritt S300a wird die Distanz R zwischen der Lage- und Positionsbestimmungseinheit 8 und der Referenzmarke 11 manuell bestimmt. In a further step S300a, the distance R between the location and position determination unit 8 and the reference mark 11 is determined manually.
In einem weiteren Schritt S400a wird die manuell bestimmte Distanz R von der Lage- und Positionsbestimmungseinheit 8 eingelesen. In einem weiteren Schritt S500a wird die Lotabweichung LAB der Lage- und Positionsbestimmungseinheit 8 mit der Lagesensorbaugruppe 703 bestimmt. In a further step S400a, the manually determined distance R is read in by the attitude and position determination unit 8 . In a further step S500a, the vertical deviation LAB of the location and position determination unit 8 is determined using the position sensor assembly 703.
In einem weiteren Schritt S600a wird der erste Kalibrier-Datensatz KDS durch Auswerten der Lotabweichung LAB und der Distanz R bestimmt. In a further step S600a, the first calibration data set KDS is determined by evaluating the vertical deviation LAB and the distance R.
Es wird nun unter Bezugnahme auf Figur 12 ein weiteres Verfahren gemäß dem zweiten Ausführungsbeispiel zur Steigerung der Genauigkeit der Kalib rierung aus dem ersten Ausführungsbeispiel, insbesondere zum kombinierten manuellen/automatischen Kalibrieren, gemäß dem zweiten Ausführungsbei spiel erläutert. A further method according to the second exemplary embodiment for increasing the accuracy of the calibration from the first exemplary embodiment, in particular for combined manual/automatic calibration, according to the second exemplary embodiment will now be explained with reference to FIG.
Nachdem die Schritte S100a bis S600a gemäß dem ersten Ausführungsbei spiel durchgeführt wurden, wird in einem weiteren Schritt S700a das Werk zeug 2 ausgerichtet, derart, dass das Werkzeug 2 eine vorbestimmte Position I, insbesondere mit maximaler Neigung, annimmt und die Referenzmarke 11 an der gleichen, vorbestimmten Position I während des Ausrichtens verbleibt. Nun werden während des Ausrichtens des Werkzeugs 2 Positionsdaten PD mit dem GNSS-Modul 702 erfasst. After steps S100a to S600a have been carried out according to the first exemplary embodiment, the tool 2 is aligned in a further step S700a such that the tool 2 assumes a predetermined position I, in particular with maximum inclination, and the reference mark 11 at the same , Predetermined position I remains during alignment. Position data PD are now recorded with the GNSS module 702 during the alignment of the tool 2 .
In einem weiteren Schritt S800a werden die Differenzdaten DD durch Auswer ten des im Schritt S600a bestimmten ersten Kalibrier-Datensatzes KDS und den im Schritt S700a bestimmten Positionsdaten PD bestimmt. In a further step S800a, the difference data DD are determined by evaluating the first calibration data set KDS determined in step S600a and the position data PD determined in step S700a.
In einem weiteren Schritt S900a wird der erste Kalibrier-Datensatz KDS durch Auswerten der Differenzdaten DD ergänzt. In a further step S900a, the first calibration data set KDS is supplemented by evaluating the difference data DD.
Es wird nun unter Bezugnahme auf Figur 13 ein Verfahren zum Kalibrieren, insbesondere zum automatischen Kalibrieren, gemäß dem dritten Ausfüh rungsbeispiel erläutert. In einem ersten Schritt S100b wird die Lage- und Positionsbestimmungsein heit 8 der Lage- und Positionsbestimmungs-Baugruppe 4 an dem Werkzeug 2 befestigt. A method for calibrating, in particular for automatic calibrating, according to the third exemplary embodiment will now be explained with reference to FIG. In a first step S100b, the location and position determination unit 8 of the location and position determination assembly 4 is attached to the tool 2 .
In einem weiteren Schritt S200b wird ein vorbestimmter geostationärer Punkt für das Werkzeug 2 angefahren. Der erste Messwert MW am ersten Mess punkt MP1 umfasst Positionsdaten PD indikativ für die Position der Lage- und Positionsbestimmungseinheit 8 und Lagedaten LD indikativ für die Raumlage der Lage- und Positionsbestimmungseinheit 8. In a further step S200b, a predetermined geostationary point for the tool 2 is approached. The first measured value MW at the first measuring point MP1 includes position data PD indicative of the position of the orientation and position determination unit 8 and position data LD indicative of the position in space of the orientation and position determination unit 8.
In einem weiteren Schritt S300b wird das Werkzeug 2 erneut verlagert, derart, dass eine Neigung des Werkzeugs 2 verändert wird, wobei die Referenzmarke 11 aber an einer gleichen, vorbestimmten Position I verbleibt. In a further step S300b, the tool 2 is displaced again in such a way that an inclination of the tool 2 is changed, with the reference mark 11 remaining at an identical, predetermined position I, however.
In einem weiteren Schritt S400b wird mindestens ein weiterer Messwert MW an einem weiteren Messpunkt MP2 erfasst, der weitere Positionsdaten PD in dikativ für die Position der Lage- und Positionsbestimmungseinheit 8 enthält. In a further step S400b, at least one further measured value MW is recorded at a further measuring point MP2, which contains further position data PD indicative of the position of the attitude and position determination unit 8.
Dabei können die Schritte S300b und S400b zumindest einmal wiederholt wer den, um zumindest zwei weitere Messwerte MW an weiteren Messpunkten MP2, ... MPx zu bestimmen und damit die Genauigkeit zu steigern. Die Wie derholung der Schritte S300b und S400b kann entweder kontinuierlich wäh rend des Verlagerns des Werkzeugs 2 oder an vorbestimmten Punkten durch geführt werden. In this case, steps S300b and S400b can be repeated at least once in order to determine at least two further measured values MW at further measuring points MP2, . . . MPx and thus to increase the accuracy. The repetition of steps S300b and S400b may be performed either continuously while the tool 2 is being displaced or at predetermined points.
In einem weiteren Schritt S500b werden die Messwerte MW ausgewertet, um die Lotabweichung LAB der Lage- und Positionsbestimmungseinheit 8 und/o der die Distanz R zwischen der Lage- und Positionsbestimmungseinheit 8 und der Referenzmarke 11 zu bestimmen. In a further step S500b, the measured values MW are evaluated in order to determine the vertical deviation LAB of the location and position determination unit 8 and/or the distance R between the location and position determination unit 8 and the reference mark 11.
In einem weiteren Schritt S600b wird der erste Kalibrier-Datensatz KDS durch Auswerten der Lotabweichung LAB und/oder der Distanz R bestimmt. Es wird nun unter Bezugnahme auf Figur 14 ein Verfahren zum Kalibrieren, insbesondere zum automatischen Kalibrieren, gemäß dem vierten Ausfüh rungsbeispiel erläutert. In a further step S600b, the first calibration data set KDS is determined by evaluating the vertical deviation LAB and/or the distance R. A method for calibration, in particular for automatic calibration, according to the fourth exemplary embodiment will now be explained with reference to FIG.
In einem ersten Schritt 100c wird die Lage- und Positionsbestimmungseinheit 8 der Lage- und Positionsbestimmungs-Baugruppe 4 an dem Werkzeug 2 be festigt. In a first step 100c, the location and position determination unit 8 of the location and position determination assembly 4 is fastened to the tool 2 be.
In einem weiteren Schritt 200c wird das Werkzeug 2 verlagert, um einen vor bestimmten geostationären Punkt für das Werkzeug 2 anzufahren. Es wird dann der erste Messwert MW am ersten Messpunkt MP1 erfasst. Der erste Messwert MW weist die Positionsdaten PD indikativ für die Position der Lage- und Positionsbestimmungseinheit 8 auf, die mit dem GNSS-Modul 702 der Lage- und Positionsbestimmungseinheit 8 erfasst werden. Ferner weist der erste Messwert MW die Lagedaten LD indikativ für die Raum läge der Lage- und Positionsbestimmungseinheit 8 auf, die mit der Lagesensorbaugruppe 703 der Lage- und Positionsbestimmungseinheit 8 erfasst werden. In a further step 200c, the tool 2 is shifted in order to approach a predetermined geostationary point for the tool 2. The first measured value MW is then recorded at the first measuring point MP1. The first measured value MW has the position data PD indicative of the position of the attitude and position determination unit 8 , which is recorded with the GNSS module 702 of the attitude and position determination unit 8 . Furthermore, the first measured value MW has the location data LD indicative of the spatial location of the location and position determination unit 8 , which is recorded with the location sensor assembly 703 of the location and position determination unit 8 .
In einem weiteren Schritt S300c wird das Werkzeug 2 derart verlagert, dass eine Neigung des Werkzeugs 2 verändert wird, wobei die Referenzmarke 11 des Werkzeugs 2 an einer gleichen, vorbestimmten Position I verbleibt. In a further step S300c, the tool 2 is displaced in such a way that an inclination of the tool 2 is changed, with the reference mark 11 of the tool 2 remaining at the same, predetermined position I.
In einem weiteren Schritt S400c wird der zweite Messwert MW an dem zweiten Messpunkt MP2 erfasst. Der zweite Messwert MW weist die weiteren Positi onsdaten PD indikativ für die Position der Lage- und Positionsbestimmungs einheit 8 auf, die mit dem GNSS-Modul 702 der Lage- und Positionsbestim mungseinheit 8 erfasst werden. Ferner weist der zweite Messwert MW die wei teren Lagedaten LD indikativ für die Raumlage der Lage- und Positionsbestim mungseinheit 8 auf, die mit der Lagesensorbaugruppe 703 der Lage- und Po sitionsbestimmungseinheit 8 erfasst werden. In einem weiteren Schritt S500c werden die Messwerte MW ausgewertet, um die Lotabweichung LAB der Lage- und Positionsbestimmungseinheit 8 und/o der die Distanz R zwischen der Lage- und Positionsbestimmungseinheit 8 und der Referenzmarke 11 zu bestimmen. In a further step S400c, the second measured value MW is recorded at the second measuring point MP2. The second measured value MW has the further position data PD indicative of the position of the location and position determination unit 8 , which is recorded with the GNSS module 702 of the location and position determination unit 8 . Furthermore, the second measured value MW has the further location data LD indicative of the spatial position of the location and position determination unit 8 , which is detected with the location sensor assembly 703 of the location and position determination unit 8 . In a further step S500c, the measured values MW are evaluated in order to determine the vertical deviation LAB of the location and position determination unit 8 and/or the distance R between the location and position determination unit 8 and the reference mark 11.
In einem weiteren Schritt S600c wird der Kalibrier-Datensatz KDS durch Aus werten der Lotabweichung LAB und/oder der Distanz R bestimmt. In a further step S600c, the calibration data set KDS is determined by evaluating the vertical deviation LAB and/or the distance R.
Bei allen beschriebenen Verfahren zum Kalibrieren kann vorgesehen sein, dass einzelne Messpunkte MP1 , MP2, ... MPx mehrfach angefahren werden, um Messwerte MW aufzunehmen, um so durch Mehrfachmessungen die Ge nauigkeit zu erhöhen. In all of the calibration methods described, it can be provided that individual measuring points MP1, MP2, .
Ferner kann bei allen beschriebenen Verfahren zum Kalibrieren vorgesehen sein, dass der erste Kalibrier-Datensatz KDS dem Werkzeug 2 und die Posi tion der Lage- und Positionsbestimmungseinheit 8 oder einer Komponente der Lage- und Positionsbestimmungseinheit 8 am Werkzeug 2 zugeordnet und gespeichert wird, sodass für dieses Werkzeug 2 und diese Position der Kalib rierungsvorgang nur einmal durchgeführt werden muss. Der erste Kalibrier- Datensatz KDS zusammen mit Daten eines Identifikation-Datensatzes ID (siehe Figur 18), die eine Identifikation des Werkzeugs 2 erlauben, und mit Positions- und Lage-Daten PLD (siehe ebenfalls Figur 18) indikativ für die Po sition und Lage am Werkzeug 2 können z.B. in einer Komponente der Lage- und Positionsbestimmungs-Baugruppe 4 und/oder dem Endgerät und/oder Steuerausgabegerät 6 gespeichert werden und von dort bei einer erneuten Inbetriebnahme geladen werden, um eine Konfiguration gemäß dem ersten Kalibrier-Datensatz KDS ohne erneute Kalibrierung durchzuführen. Wenn hin gegen statt der Magnete 9 die rahmenförmige Halterung 10 zur Befestigung verwendet wird, kann auf die Positions- und Lage-Daten PLD verzichtet wer den, da durch die rahmenförmige Halterung 10 die Position und Raumlage der Lage- und Positionsbestimmungseinheit 8 festgelegt ist. Es kann auch vorgesehen sein, dass das Werkzeug 2 und z.B. eine Kompo nente der Lage- und Positionsbestimmungs-Baugruppe 4 eine Einheit bilden, die nicht voneinander getrennt werden und denen der Identifikations-Daten satz ID zugeordnet wird. So kann ein zwischenzeitlicher Werkzeugwechsel des Werkzeugs 2 erfolgen, ohne dass eine erneute Kalibrierung nötig ist. Furthermore, in all of the calibration methods described, it can be provided that the first calibration data set KDS is assigned to the tool 2 and the position of the location and position determination unit 8 or a component of the location and position determination unit 8 on the tool 2 and stored, so that for this tool 2 and this position of the calibration process only has to be carried out once. The first calibration data record KDS together with data from an identification data record ID (see FIG. 18), which allow the tool 2 to be identified, and with position and location data PLD (also see FIG. 18) indicative of the position and location on the tool 2 can be stored, for example, in a component of the situation and position determination module 4 and / or the terminal and / or control output device 6 and loaded from there when restarted to configure a configuration according to the first calibration data set KDS without renewed perform calibration. If, on the other hand, instead of the magnets 9, the frame-shaped holder 10 is used for attachment, the position and location data PLD can be dispensed with, since the frame-shaped holder 10 defines the position and position in space of the location and position determination unit 8. It can also be provided that the tool 2 and, for example, a component of the location and position determination assembly 4 form a unit that is not separated from one another and to which the identification data set ID is assigned. In this way, the tool 2 can be changed in the meantime without a renewed calibration being necessary.
Es wird nun unter Bezugnahme auf die Figuren 15 und 16 ein fünftes Ausfüh rungsbeispiel eines Kalibrierverfahrens zum Bestimmen des zweiten Kalibrier- Datensatzes KDS' erläutert, mit dem eine Kalibrierung in Bezug auf den Nord pol N bzw. der Lage von Längengrad-Linien LG und Breitengrad-Linien BG eines kartesischen Koordinatensystems möglich ist. A fifth exemplary embodiment of a calibration method for determining the second calibration data set KDS' will now be explained with reference to FIGS -Lines BG of a Cartesian coordinate system is possible.
Das System 21 zum Bestimmen des zweiten Kalibrier-Datensatzes KDS' ist im vorliegenden Ausführungsbeispiel dazu ausgebildet, einen ersten Ausrich tungs-Datensatz ARS 1 (siehe Figur 16) indikativ für die Position der Lage- und Positionsbestimmungseinheit 8 an dem Werkzeug 2 mit dem GNSS-Modul 702 der Lage- und Positionsbestimmungseinheit 8 an dem ersten Messpunkt MP1 ' zu bestimmen. In the present exemplary embodiment, the system 21 for determining the second calibration data record KDS' is designed to generate a first alignment data record ARS 1 (see FIG. 16) indicative of the position of the attitude and position determination unit 8 on the tool 2 with the GNSS To determine module 702 of location and position determination unit 8 at first measuring point MP1'.
Ferner ist das System 21 zum Bestimmen des zweiten Kalibrier-Datensatzes KDS' im vorliegenden Ausführungsbeispiel dazu ausgebildet, ein Verlagern der Referenzmarke 11 des Werkzeugs 2 von dem ersten Messpunkt MP1 ' zu dem zweiten Messpunkt MP2' durch Verlagern des Auslegers 3 zu bewirken, derart, dass ein Abstand A zwischen dem Landfahrzeug 1 und der Referenz marke 11 verändert wird. Furthermore, the system 21 for determining the second calibration data set KDS′ is designed in the present exemplary embodiment to bring about a shifting of the reference mark 11 of the tool 2 from the first measuring point MP1′ to the second measuring point MP2′ by shifting the cantilever 3 in such a way that a distance A between the land vehicle 1 and the reference mark 11 is changed.
Hierzu wird im vorliegenden Ausführungsbeispiel der Ausleger 3 derart ange steuert, dass das Werkzeug 2 mit der Referenzmarke 11 im Wesentlich paral lel über den Boden bewegt wird. Es erfolgt aber keine Drehung des Auslegers 3 um die Hochachse des Landfahrzeugs 1 . Mit anderen Worten, die Verlage rung erfolgt geradlinig und rotationskomponentenfrei, insbesondere um die Hochachse des Landfahrzeugs 1 . Des Weiteren ist das System 21 zum Bestimmen des zweiten Kalibrier-Daten- satzes KDS' im vorliegenden Ausführungsbeispiel dazu ausgebildet, den zwei ten Ausrichtungs-Datensatz ARS2 (siehe ebenfalls Figur 16) indikativ für die Position der Lage- und Positionsbestimmungseinheit 8 an dem Werkzeug 2 mit dem GNSS-Modul 702 der Lage- und Positionsbestimmungseinheit 8 an dem zweiten Messpunkt MP2‘ zu bestimmen. For this purpose, in the present exemplary embodiment, the boom 3 is controlled in such a way that the tool 2 is moved essentially parallel to the reference mark 11 over the ground. However, the boom 3 does not rotate about the vertical axis of the land vehicle 1 . In other words, the displacement takes place in a straight line and without any rotational components, in particular around the vertical axis of the land vehicle 1 . Furthermore, the system 21 for determining the second calibration data set KDS' in the present exemplary embodiment is designed to use the second alignment data set ARS2 (also see Figure 16) indicative of the position of the attitude and position determination unit 8 on the tool 2 to be determined with the GNSS module 702 of the attitude and position determination unit 8 at the second measurement point MP2'.
Schließlich ist das System 21 zum Bestimmen des zweiten Kalibrier-Datensat- zes KDS' im vorliegenden Ausführungsbeispiel dazu ausgebildet, den Kalib- rier-Datensatz KDS' durch Auswerten des ersten Ausrichtungs-Datensatzes ARS1 und des zweiten Ausrichtungs-Datensatzes ARS2 zu erzeugen. Finally, in the present exemplary embodiment, the system 21 for determining the second calibration data record KDS' is designed to generate the calibration data record KDS' by evaluating the first alignment data record ARS1 and the second alignment data record ARS2.
Der erste Ausrichtung-Datensatz ARS1 und der zweite Ausrichtung-Datensatz ARS2 enthalten jeweils Daten indikativ für die Positionen der Referenzmarke 11an dem ersten Messpunkt MP1' und dem zweiten Messpunkt MP2‘. Es wer den dann in einem ersten Teilschritt Parameter einer Geradengleichung be stimmt, die die Positionen gemäß dem ersten Messpunkt MP1' und gemäß dem zweiten Messpunkt MP2' verbindet. The first alignment data set ARS1 and the second alignment data set ARS2 each contain data indicative of the positions of the reference mark 11 at the first measuring point MP1' and the second measuring point MP2'. In a first partial step, parameters of a linear equation are then determined which connect the positions according to the first measuring point MP1' and according to the second measuring point MP2'.
In einem zweiten Teilschritt wird dann die so parametrisierte Gerade G erzeugt und in einem dritten Teilschritt werden dann Daten des GNSS-Moduls 702 in dikativ für die Position des Nordpols N bzw. der Lage von Längengrad-Linien LG- und Breitengerad-Linien BG eines kartesischen Koordinatensystems her angezogen, um einen Offsetwinkel W zu bestimmen, der repräsentativ für ei nen Versatz zwischen der Ausrichtung des Landfahrzeugs 1 bzw. des land fahrzeugeigenen Koordinatensystems und der Position des Nordpols N bzw. der Lage von Längengrad-Linien LG- und Breitengerad-Linien BG des karte sischen Koordinatensystems ist. In a second sub-step, the straight line G parameterized in this way is then generated and in a third sub-step, data from the GNSS module 702 are then indicative of the position of the north pole N or the position of longitude lines LG and latitude lines BG of a Cartesian Coordinate system used to determine an offset angle W, which is representative of an offset between the orientation of the land vehicle 1 or the land vehicle's own coordinate system and the position of the north pole N or the position of longitude lines LG and latitude lines BG of the Cartesian coordinate system.
Es wird nun unter zusätzlicher Bezugnahme auf Figur 17 ein Verfahren zum Kalibrieren, insbesondere zum Kalibrieren in Bezug auf den Nordpol N bzw. der Lage von Längengrad-Linien LG und Breitengrad-Linien BG eines kartesi schen Koordinatensystems, gemäß dem fünften Ausführungsbeispiel erläu tert. With additional reference to FIG. 17, a method for calibrating, in particular for calibrating with respect to the north pole N or the position of longitude lines LG and latitude lines BG of a Cartesian coordinate system, according to the fifth embodiment, explained.
In einem ersten Schritt S100d wird die Lage- und Positionsbestimmungsein heit 8 der Lage- und Positionsbestimmungs-Baugruppe 4 an dem Werkzeug 2 befestigt. In a first step S100d, the location and position determination unit 8 of the location and position determination assembly 4 is attached to the tool 2 .
In einem weiteren Schritt S200d wird der erste Ausrichtungs-Datensatz ARS1 indikativ für die Position der Lage- und Positionsbestimmungseinheit 8 an dem Werkzeug 2 mit dem GNSS-Modul 702 Lage- und Positionsbestimmungsein heit 8 an dem ersten Messpunkt MP1 ‘ bestimmt. In a further step S200d, the first alignment data set ARS1 is indicative of the position of the location and position determination unit 8 on the tool 2 with the GNSS module 702 location and position determination unit 8 at the first measurement point MP1'.
In einem weiteren Schritt S300d wird die Referenzmarke 11 des Werkzeugs 2 von dem ersten Messpunkt MP1 ‘ zu dem zweiten Messpunkt MP2‘ durch Ver lagern des Auslegers 3 verlagert, derart, dass der Abstand A zwischen dem Landfahrzeug 1 der Referenzmarke 11 verändert wird. In a further step S300d, the reference mark 11 of the tool 2 is shifted from the first measuring point MP1' to the second measuring point MP2' by moving the boom 3 in such a way that the distance A between the land vehicle 1 and the reference mark 11 is changed.
In einem weiteren Schritt S400d wird der zweite Ausrichtungs-Datensatz ARS2 indikativ für die Position der Lage- und Positionsbestimmungseinheit 8 an dem Werkzeug 2 mit dem GNSS-Modul 702 der Lage- und Positionsbe stimmungseinheit 8 an dem zweiten Messpunkt MP2‘ bestimmt. In a further step S400d, the second alignment data record ARS2 is determined indicative of the position of the location and position determination unit 8 on the tool 2 with the GNSS module 702 of the location and position determination unit 8 at the second measurement point MP2'.
In einem weiteren Schritt S500d wird der Kalibrier-Datensatz KDS' durch Aus werten des ersten Ausrichtungs-Datensatzes ARS1 und des zweiten Ausrich tungs-Datensatzes ARS2 erzeugt. In a further step S500d, the calibration data record KDS' is generated by evaluating the first alignment data record ARS1 and the second alignment data record ARS2.
Dieses Kalibrierverfahren gemäß dem fünften Ausführungsbeispiel kann wäh rend des Betriebs des Landfahrzeugs 1 innerhalb fester, vorbestimmter oder auch variabler Intervalle wiederholt werden. So kann einer langsamen Drift von Werten durch eine fortwährend aktualisierte Bestimmung des Offsetwin kels W entgegengewirkt werden. Es wird nun unter Bezugnahme auf Figur 18 ein Verfahren zur Positions- und Raumlagebestimmung des Werkzeugs 2 erläutert. This calibration method according to the fifth exemplary embodiment can be repeated within fixed, predetermined or variable intervals during operation of the land vehicle 1 . In this way, a slow drift of values can be counteracted by continually updating the determination of the offset angle W. A method for determining the position and position in space of the tool 2 will now be explained with reference to FIG.
Das Verfahren zur Positions- und Raumlagebestimmung des Werkzeugs 2 kann nach einer Kalibrierung mit den Schritten S100a bis S600a gemäß dem ersten Ausführungsbeispiel, nach einer Kalibrierung mit den Schritten S100a bis S900a gemäß dem zweiten Ausführungsbeispiel, nach einer Kalibrierung mit den Schritten S100b bis S600b gemäß dem dritten Ausführungsbeispiel oder nach einer Kalibrierung mit den Schritten S100c bis S600c gemäß dem vierten Ausführungsbeispiel durchgeführt werden. The method for determining the position and spatial orientation of the tool 2 can be carried out after a calibration with steps S100a to S600a according to the first embodiment, after a calibration with steps S100a to S900a according to the second embodiment, after a calibration with steps S100b to S600b according to third exemplary embodiment or after a calibration with steps S100c to S600c according to the fourth exemplary embodiment.
Ferner kann das Verfahren zur Positions- und Raumlagebestimmung des Werkzeugs 2 mit einer Kalibrierung mit den Schritten S100d bis S500d gemäß dem fünften Ausführungsbeispiel kombiniert werden. Furthermore, the method for determining the position and spatial orientation of the tool 2 can be combined with a calibration with steps S100d to S500d according to the fifth exemplary embodiment.
Des Weiteren kann das Verfahren zur Positions- und Raumlagebestimmung des Werkzeugs 2 gemäß dem ersten, zweiten, dritten oder vierten Ausfüh rungsbeispiel mit einer Kalibrierung mit den Schritten S1 OOd bis S500d gemäß dem fünften Ausführungsbeispiel kombiniert werden. Furthermore, the method for determining the position and spatial orientation of the tool 2 according to the first, second, third or fourth exemplary embodiment can be combined with a calibration with steps S100d to S500d according to the fifth exemplary embodiment.
In einem ersten Schritt S1100 wird ein Positions-Datensatz PDS indikativ für die Position der Lage- und Positionsbestimmungseinheit 8 der Lage- und Po sitionsbestimmungs-Baugruppe 4 mit dem GNSS-Modul 702 der Lage- und Positionsbestimmungseinheit 8 bestimmt. In a first step S1100, a position data set PDS indicative of the position of the attitude and position determination unit 8 of the attitude and position determination assembly 4 is determined with the GNSS module 702 of the attitude and position determination unit 8 .
In einem weiteren Schritt S1200 wird ein Lage-Datensatz LDS indikativ für die Raumlage der Lage- und Positionsbestimmungseinheit 8 mit der Lagesensor baugruppe 703 der Lage- und Positionsbestimmungseinheit 8 bestimmt. In a further step S1200, a position data set LDS indicative of the position in space of the position and position determination unit 8 with the position sensor assembly 703 of the position and position determination unit 8 is determined.
Zusätzlich können Daten des Trägheitsnavigationssystems verwendet wer den, um durch die Kombination des GNSS-Modul 702 mit dem Trägheitsnavi gationssystem das kurzzeitig genaue, aber driftende Trägheitssystem mit den langzeitstabilen, aber kurzzeitig variablen schwankenden Daten des GNSS- Moduls 702 zu fusionieren. In addition, data from the inertial navigation system can be used to combine the GNSS module 702 with the inertial navigation system to track the short-term accurate but drifting inertial system with the to merge long-term stable but short-term variable fluctuating data of the GNSS module 702.
In einem weiteren Schritt S1300 wird im vorliegenden Ausführungsbeispiel der Positions-Datensatz PDS und der Lage-Datensatz LDS unter Verwendung des ersten Kalibrier-Datensatzes KDS und des zweiten Kalibrier-Datensatzes KDS' ausgewertet, um einen Ausgangs-Datensatz ADS indikativ für die Raum lage und Position des Werkzeugs 2 zu bestimmen. In a further step S1300, in the present exemplary embodiment, the position data set PDS and the position data set LDS are evaluated using the first calibration data set KDS and the second calibration data set KDS' in order to generate an output data set ADS indicative of the spatial position and To determine the position of the tool 2.
In einem weiteren Schritt S1400 wird der Ausgangs-Datensatz ADS ausgege ben. In a further step S1400, the output data record ADS is output.
Es kann vorgesehen sein, dass z.B. das Endgerät und/oder Steuerausgabe gerät 6 der Lage- und Positionsbestimmungs-Baugruppe 4 dazu ausgebildet ist, auf der Basis des Ausgangs-Datensatzes ADS einen Steuer-Datensatz SDS zur Ansteuerung des Landfahrzeugs 1 , z.B. zur Ansteuerung des Ausle gers 3 des als Bagger ausgebildeten Landfahrzeugs 1 , zu erzeugen, um so einen direkten Eingriff in die Maschinensteuerung des Landfahrzeugs 1 zu be wirken. It can be provided that, for example, the end device and/or control output device 6 of the location and position determination assembly 4 is designed to generate a control data set SDS for controlling the land vehicle 1 on the basis of the output data set ADS, e.g. for controlling the Outrigger 3 of the land vehicle 1 designed as an excavator, in order to effect direct intervention in the machine control system of the land vehicle 1 .
In einem weiteren Schritt S1500 wird z.B. nach Beendigung von z.B. einer Bodenbearbeitung nach Planvorgaben die Lage- und Positionsbestimmungs- Baugruppe 4 durch einfaches Demontieren von dem Werkzeug 2 getrennt und in das Transportbehältnis zurückgelegt, wobei es dann selbsttätig deaktiviert wird. Ein Erfassen eines Zurücklegens der Lage- und Positionsbestimmungs- Baugruppe 4 in ihr Transportbehältnis kann beispielsweise durch eine in dem Transportbehältnis integrierte Ladevorrichtung erfolgen. In a further step S1500, e.g. after completion of e.g. It is possible, for example, for a loading device integrated in the transport container to detect that the location and position determination assembly 4 has been put back into its transport container.
Abweichend vom vorliegenden Ausführungsbeispiel kann die Reihenfolge der Schritte auch eine andere sein. Ferner können mehrere Schritte auch zeit gleich bzw. simultan ausgeführt werden. Des Weiteren können auch abwei chend vom vorliegenden Ausführungsbeispiel einzelne Schritte übersprungen oder ausgelassen werden. So kann im Bedarfsfall ein Landfahrzeug 1 , wie eine Baumaschine, entspre chend schnell nachgerüstet werden. Dabei wird durch die freie Wahl der Posi tion der Lage- und Positionsbestimmungs-Baugruppe 4 oder einer Kompo- nente der Lage- und Positionsbestimmungs-Baugruppe 4 und anschließende Kalibrierung mit dem ersten Kalibrier-Datensatz KDS und/oder dem zweiten Kalibrier-Datensatz KDS' die Montage vereinfacht und es sind keine aufwen digen Kalibrierungen einer speziell ausgebildeten Baumaschine ab Werk er forderlich. Deviating from the present exemplary embodiment, the order of the steps can also be different. Furthermore, several steps can also be executed at the same time or simultaneously. Furthermore, in deviation from the present exemplary embodiment, individual steps can also be skipped or left out. If necessary, a land vehicle 1 , such as a construction machine, can be retrofitted accordingly quickly. In this case, the free choice of the position of the location and position determination subassembly 4 or a component of the location and position determination subassembly 4 and subsequent calibration with the first calibration data set KDS and/or the second calibration data set KDS' assembly is simplified and there is no need for complex factory calibration of a specially trained construction machine.
Bezugszeichenliste Reference List
1 Landfahrzeug 1 land vehicle
2 Werkzeug 2 tool
3 Ausleger 3 outriggers
4 Lage- und Positionsbestimmungs-Baugruppe4 attitude and position determination assembly
5 Anzeigevorrichtung 5 display device
6 Endgerät und/oder Steuerausgabegerät 6 terminal and/or control output device
7 Referenzstation 7 reference station
8 Lage- und Positionsbestimmungseinheit 8 attitude and position determination unit
9 Magnet 9 magnets
10 Halterung 10 bracket
11 Referenzmarke 11 reference mark
12 Tripod 12 tripod
13 GNSS-Antenne 13 GNSS antenna
14 GNSS-Antennenzentrum 14 GNSS antenna center
15 Leuchtmittel 15 bulbs
16 Anzeige 16 display
17 Anzeigeverbinder 17 display connector
18 Taste 18 button
19 Taste 19 button
20 Taste 20 button
21 System 21 systems
701 Satellit 701 satellite
702 GNSS-Modul 702 GNSS module
703 Lagesensorbaugruppe 703 position sensor assembly
704a Anzeigeeinheit 704a display unit
704b Anzeigeeinheit 704b display unit
704c Anzeigeeinheit 704c display unit
704d Anzeigeeinheit 704d display unit
705 Eingabegerät 705 input device
706a Sende- und Empfangs-Modul 706b Sende- und Empfangs-Modul706a transmit and receive module 706b transmit and receive module
706c Sende- und Empfangs-Modul706c transmit and receive module
706d Sende- und Empfangs-Modul706d transmit and receive module
707a Akkumulator 707a accumulator
707b Akkumulator 707b accumulator
707d Akkumulator 707d accumulator
A Abstand A distance
ADS Ausgangs-DatensatzADS output data set
ARS1 Ausrichtungs-DatensatzARS1 Alignment Record
ARS2 Ausrichtungs-Datensatz ARS2 alignment record
B Raumlage B spatial position
BG Breitengrad-Linie d Kreissehne e Abstand BG line of latitude d chord e distance
DD Differenzdaten DD difference data
G Gerade h Höhe hGNSS Höhenwert hRef Höhe der ReferenzmarkeG Line h Height hGNSS height value hRef Reference mark height
HO Horizont HO horizon
I Position I position
ID Identifikations-DatensatzID identification record
KDS Kalibrier-Datensatz KDS calibration data set
KDS‘ Kalibrier-Datensatz KDS' calibration data set
L Lot L Lot
LAB Lotabweichung LAB plumb deviation
LDS Lage-Datensatz LDS location record
LG Längengrad-Linie LG longitude line
MP1 Messpunkt MP1 measuring point
MPr Messpunkt MPr measuring point
MP2 Messpunkt MP2 measuring point
MP2‘ Messpunkt MPx Messpunkt MP2' measuring point MPx measuring point
MW Messwerte MW readings
N Nordpol N north pole
PD Positionsdaten PD position data
PDS Positions-Datensatz PDS position record
PLD Positions- und Lage-Daten PLD position and attitude data
R Distanz R distance
S Senkrechte durch die SensorbaugruppeS perpendicular through the sensor assembly
SDS Steuer-Datensatz SDS tax record
SK Kreis SK circle
T Tangente w Offsetwinkel a Winkel ß Winkel T tangent w offset angle a angle ß angle
Y Winkel d Winkel e Winkel Y angle d angle e angle
S100a Schritt S100a step
S100b Schritt S100b step
S100c Schritt S100c step
S100d Schritt S100d step
S200a Schritt S200a step
S200b Schritt S200b step
S200c Schritt S200c step
S200d Schritt S200d step
S300a Schritt S300a step
S300b Schritt S300b step
S300c Schritt S300c step
S300d Schritt S300d step
S400a Schritt S400a step
S400b Schritt S400c SchrittS400b step S400c step
S400d SchrittS400d step
S500a SchrittS500a step
S500b Schritt S500c SchrittS500b step S500c step
S500d SchrittS500d step
S600a SchrittS600a step
S600b SchrittS600b step
S600c Schritt S700a SchrittS600c step S700a step
S800a SchrittS800a step
S900a SchrittS900a step
S1100 SchrittS1100 step
S1200 Schritt S1300 SchrittS1200 step S1300 step
S1400 SchrittS1400 step
S1500 SchrittS1500 step
S1600 Schritt S1600 step

Claims

Patentansprüche patent claims
1. Verfahren zur Positions- und Raumlagebestimmung eines Werkzeugs (2) zur Bodenbearbeitung an einem verstellbaren Ausleger (3) eines Landfahrzeugs (1), mit den Schritten: 1. A method for determining the position and spatial location of a tool (2) for tilling the soil on an adjustable arm (3) of a land vehicle (1), with the steps:
(S1100) Bestimmen eines Positions-Datensatzes (PDS) indikativ für die Position einer Lage- und Positionsbestimmungseinheit (8) einer Lage- und Positionsbestimmungs-Baugruppe (4) an dem Werkzeug (2) mit ei nem GNSS-Modul (702) der Lage- und Positionsbestimmungseinheit (8), (S1100) determining a position data set (PDS) indicative of the position of a position and position determination unit (8) of a position and position determination assembly (4) on the tool (2) with a GNSS module (702) of the position - and position determination unit (8),
(S1200) Bestimmen eines Lage-Datensatzes (LDS) indikativ für die Raumlage der Lage- und Positionsbestimmungseinheit (8) mit einer La gesensorbaugruppe (703) der Lage- und Positionsbestimmungseinheit (8), (S1200) determining a position data set (LDS) indicative of the position in space of the position and position determination unit (8) with a position sensor assembly (703) of the position and position determination unit (8),
(S1300) Auswerten des Positions-Datensatzes (PDS) und des Lage- Datensatzes (LDS) unter Verwendung eines Kalibrier-Datensatzes (KDS, KDS‘), um einen Ausgangs-Datensatz (ADS) indikativ für die Raumlage und Position des Werkzeugs (2) zu bestimmen, und (S1300) Evaluation of the position data set (PDS) and the position data set (LDS) using a calibration data set (KDS, KDS') in order to generate an output data set (ADS) indicative of the spatial position and position of the tool (2nd ) to determine, and
(S1400) Ausgeben des Ausgangs-Datensatzes (ADS). (S1400) Output of output data set (ADS).
2. Verfahren nach Anspruch 1, wobei zum Bestimmen des Kalibrier-Da tensatzes (KDS) folgende Schritte ausgeführt werden: 2. The method according to claim 1, wherein the following steps are carried out to determine the calibration data set (KDS):
(S100a) Befestigen der Lage- und Positionsbestimmungseinheit (8) an dem Werkzeug (2), (S100a) attaching the location and position determination unit (8) to the tool (2),
(S200a) Ausrichten einer Referenzmarke (11 ) des Werkzeugs (2) durch Neigen des Werkzeugs (2), derart, dass sich die Referenzmarke (11) mit der Lage- und Positionsbestimmungseinheit (8) im Lot (L) befindet, (S300a) Bestimmen einer Distanz (R) zwischen der Lage- und Positi onsbestimmungseinheit (8) und der Referenzmarke (11), (S200a) aligning a reference mark (11) of the tool (2) by tilting the tool (2) in such a way that the reference mark (11) is perpendicular (L) to the location and position determination unit (8), (S300a) determining a distance (R) between the orientation and position determining unit (8) and the reference mark (11),
(S400a) Einlesen der Distanz (R) von der Lage- und Positionsbestim mungseinheit (8), (S400a) reading in the distance (R) from the attitude and position determination unit (8),
(S500a) Bestimmen einer Lotabweichung (LAB) der Lage- und Positi onsbestimmungseinheit (8) mit der Lagesensorbaugruppe (703) der Lage- und Positionsbestimmungseinheit (8), und (S500a) determining a vertical deviation (LAB) of the location and position determination unit (8) with the location sensor assembly (703) of the location and position determination unit (8), and
(S600a) Erzeugen des Kalibrier-Datensatzes (KDS) durch Auswerten der Lotabweichung (LAB) und der Distanz (R). (S600a) Generation of the calibration data set (KDS) by evaluating the vertical deviation (LAB) and the distance (R).
3. Verfahren nach Anspruch 2, wobei zusätzlich zum Bestimmen des Ka librier-Datensatzes (KDS) folgende Schritte ausgeführt werden: 3. The method according to claim 2, wherein the following steps are carried out in addition to determining the calibration data record (KDS):
(S700a) Ausrichten des Werkzeugs (2), derart, dass das Werkzeug (2) eine vorbestimmte Position (I) mit einer vorbestimmten Neigung, insbe sondere mit einer maximalen Neigung, annimmt und die Referenz marke (11) an der gleichen, vorbestimmten Position (I) während des Ausrichtens verbleibt, wobei während des Ausrichtens Positionsdaten (PD) mit dem GNSS-Modul (702) der Lage- und Positionsbestimmungs einheit (8) erfasst werden, (S700a) Alignment of the tool (2) such that the tool (2) assumes a predetermined position (I) with a predetermined inclination, in particular with a maximum inclination, and the reference mark (11) at the same predetermined position (I) remains during the alignment, with position data (PD) being recorded with the GNSS module (702) of the attitude and position determination unit (8) during the alignment,
(S800a) Bestimmen von Differenzdaten (DD) durch Auswerten des im Schritt (S600a) bestimmten Kalibrier-Datensatzes (KDS) und den im Schritt (S700a) bestimmten Positionsdaten (PD), und (S800a) determining difference data (DD) by evaluating the calibration data set (KDS) determined in step (S600a) and the position data (PD) determined in step (S700a), and
(S900a) Ergänzen des Kalibrier-Datensatzes (KDS) durch Auswerten der Differenzdaten (DD). (S900a) Supplementing the calibration data set (KDS) by evaluating the difference data (DD).
4. Verfahren nach Anspruch 1, wobei zum Bestimmen des Kalibrier-Da- tensatzes (KDS) folgende Schritte ausgeführt werden: 4. The method according to claim 1, wherein the following steps are carried out to determine the calibration data set (KDS):
(S100b) Befestigen der Lage- und Positionsbestimmungseinheit (8) an dem Werkzeug (2), (S100b) attaching the attitude and position determination unit (8) to the tool (2),
(S200b) Verlagern des Werkzeugs (2), um einen vorbestimmten geo stationären Punkt für das Werkzeug (2) anzufahren, und Erfassen von einem ersten Messwert (MW) an einem ersten Messpunkt (MP1), mit Positionsdaten (PD) indikativ für die Position der Lage- und Positions bestimmungseinheit (8) mit dem GNSS-Modul (702) der Lage- und Po sitionsbestimmungseinheit (8), und mit Lagedaten (LD) indikativ für die Raumlage der Lage- und Positionsbestimmungseinheit (8) mit der La gesensorbaugruppe (703) der Lage- und Positionsbestimmungseinheit (8), (S200b) relocating the tool (2) to approach a predetermined geo-stationary point for the tool (2) and acquiring a first measurement value (MW) at a first measurement point (MP1), with position data (PD) indicative of the position the location and position determination unit (8) with the GNSS module (702) of the location and position determination unit (8), and with location data (LD) indicative of the position in space of the location and position determination unit (8) with the location sensor assembly ( 703) the location and position determination unit (8),
(S300b) Verlagern des Werkzeugs (2), derart, dass eine Neigung des Werkzeugs (2) verändert wird, wobei eine Referenzmarke (11) des Werkzeugs (2) an einer gleichen, vorbestimmten Position (I) verbleibt, (S300b) Displacing the tool (2) in such a way that an inclination of the tool (2) is changed, with a reference mark (11) of the tool (2) remaining at the same, predetermined position (I),
(S400b) Erfassen von mindestens zwei weiteren Messwerten (MW) an mindestens zwei weiteren Messpunkten (MP2, ... MPx), mit weiteren Positionsdaten (PD) indikativ für die Position der Lage- und Positions bestimmungseinheit (8) mit dem GNSS-Modul (702) der Lage- und Po sitionsbestimmungseinheit (8) durch zumindest zweimaliges Durchfüh ren der Schritte (S300b) und (S400b), (S400b) Acquisition of at least two further measured values (MW) at at least two further measuring points (MP2, ... MPx), with further position data (PD) indicative of the position of the attitude and position determination unit (8) with the GNSS module (702) the location and position determination unit (8) by carrying out steps (S300b) and (S400b) at least twice,
(S500b) Auswerten der Messwerte (MW), um eine Lotabweichung (LAB) der Lage- und Positionsbestimmungseinheit (8) und/oder eine Distanz (R) zwischen der Lage- und Positionsbestimmungseinheit (8) und der Referenzmarke (11) zu bestimmen, und (S600b) Erzeugen des Kalibrier-Datensatzes (KDS) durch Auswerten der Lotabweichung (LAB) und/oder der Distanz (R). (S500b) evaluating the measured values (MW) in order to determine a plumb deviation (LAB) of the location and position determination unit (8) and/or a distance (R) between the location and position determination unit (8) and the reference mark (11), and (S600b) Generation of the calibration data set (KDS) by evaluating the vertical deviation (LAB) and/or the distance (R).
5. Verfahren nach Anspruch 1, wobei zum Bestimmen des Kalibrier-Da tensatzes (KDS) folgende Schritte ausgeführt werden: 5. The method according to claim 1, wherein the following steps are carried out to determine the calibration data set (KDS):
(S100c) Befestigen der Lage- und Positionsbestimmungseinheit (8)an dem Werkzeug (2), (S100c) attaching the attitude and position determination unit (8) to the tool (2),
(S200c) Verlagern des Werkzeugs (2), um einen vorbestimmten geo stationären Punkt für das Werkzeug (2) anzufahren, und Erfassen von einem ersten Messwert (MW) an einem ersten Messpunkt (MP1), mit Positionsdaten (PD) indikativ für die Position der Lage- und Positions bestimmungseinheit (8) mit dem GNSS-Modul (702) der Lage- und Po sitionsbestimmungseinheit (8), und mit Lagedaten (LD) indikativ für die Raumlage der Lage- und Positionsbestimmungseinheit (8) mit der La gesensorbaugruppe (703) der Lage- und Positionsbestimmungseinheit (8), (S200c) relocating the tool (2) to approach a predetermined geo-stationary point for the tool (2) and acquiring a first measurement value (MW) at a first measurement point (MP1), with position data (PD) indicative of the position the location and position determination unit (8) with the GNSS module (702) of the location and position determination unit (8), and with location data (LD) indicative of the position in space of the location and position determination unit (8) with the location sensor assembly ( 703) the orientation and position determination unit (8),
(S300c) Verlagern des Werkzeugs (2), derart, dass eine Neigung des Werkzeugs (2) verändert wird, wobei eine Referenzmarke (11) des Werkzeugs (2) an einer gleichen, vorbestimmten Position (I) verbleibt, (S300c) displacing the tool (2) in such a way that an inclination of the tool (2) is changed, with a reference mark (11) of the tool (2) remaining at a same, predetermined position (I),
(S400c) Erfassen von einem zweiten Messwert (MW) an einem zweiten Messpunkt (MP2), mit weiteren Positionsdaten (PD) indikativ für die Po sition der Lage- und Positionsbestimmungseinheit (8) mit dem GNSS- Modul (702) der Lage- und Positionsbestimmungseinheit (8), und mit weiteren Lagedaten (LD) indikativ für die Raum läge der Lage- und Po sitionsbestimmungseinheit (8) mit der Lagesensorbaugruppe (703) der Lage- und Positionsbestimmungseinheit (8), (S400c) detecting a second measured value (MW) at a second measuring point (MP2), with further position data (PD) indicative of the position of the attitude and position determination unit (8) with the GNSS module (702) of the attitude and Position determination unit (8), and with further position data (LD) indicative of the spatial location of the position and position determination unit (8) with the position sensor assembly (703) of the position and position determination unit (8),
(S500c) Auswerten der Messwerte (MW), um eine Lotabweichung (LAB) der Lage- und Positionsbestimmungseinheit (8) und/oder eine Distanz (R) zwischen der Lage- und Positionsbestimmungseinheit (8) und der Referenzmarke (11) zu bestimmen, und (S500c) Evaluation of the measured values (MW) to determine a vertical deviation (LAB) of the situation and position determination unit (8) and/or a to determine the distance (R) between the attitude and position determination unit (8) and the reference mark (11), and
(S600c) Erzeugen des Kalibrier-Datensatzes (KDS) durch Auswerten der Lotabweichung (LAB) und/oder der Distanz (R). (S600c) Generation of the calibration data set (KDS) by evaluating the vertical deviation (LAB) and/or the distance (R).
6. Verfahren nach einem der Ansprüche 1 bis 5, wobei zum Bestimmen des Kalibrier-Datensatzes (KDS‘) folgende Schritte ausgeführt werden: 6. The method according to any one of claims 1 to 5, wherein the following steps are carried out to determine the calibration data set (KDS'):
(S100d) Befestigen der Lage- und Positionsbestimmungseinheit (8) an dem Werkzeug (2), (S100d) attaching the attitude and position determination unit (8) to the tool (2),
(S200d) Bestimmen eines ersten Ausrichtungs-Datensatzes (ARS1) in dikativ für die Position der Lage- und Positionsbestimmungseinheit (8) an dem Werkzeug (2) mit dem GNSS-Modul (702) der Lage- und Posi tionsbestimmungseinheit (8) an einem ersten Messpunkt (MP1‘), (S200d) determining a first orientation data set (ARS1) indicative of the position of the location and position determination unit (8) on the tool (2) with the GNSS module (702) of the location and position determination unit (8) on one first measuring point (MP1'),
(S300d) Verlagern, insbesondere geradliniges Verlagern, einer Refe renzmarke (11) des Werkzeugs (2) von dem ersten Messpunkt (MP1‘) zu einem zweiten Messpunkt (MP2‘) durch Verlagern, insbesondere ge radliniges Verlagern, des Auslegers (3), derart, dass ein Abstand (A) zwischen dem Landfahrzeug (1 ) und der Referenzmarke (11 ) verändert wird, (S300d) relocating, in particular moving in a straight line, a reference mark (11) of the tool (2) from the first measuring point (MP1') to a second measuring point (MP2') by moving, in particular moving in a straight line, the boom (3), such that a distance (A) between the land vehicle (1) and the reference mark (11) is changed,
(S400d) Bestimmen eines zweiten Ausrichtungs-Datensatzes (ARS2) indikativ für die Position der Lage- und Positionsbestimmungseinheit (8) an dem Werkzeug (2) mit dem GNSS-Modul (702) der Lage- und Posi tionsbestimmungseinheit (8) an dem zweiten Messpunkt (MP2‘), und (S400d) determining a second alignment data set (ARS2) indicative of the position of the location and position determination unit (8) on the tool (2) with the GNSS module (702) of the location and position determination unit (8) on the second measuring point (MP2'), and
(S500d) Erzeugen des Kalibrier-Datensatzes (KDS‘) durch Auswerten des ersten Ausrichtungs-Datensatzes (ARS1 ) und des zweiten Ausrich tungs-Datensatzes (ARS2). (S500d) Generation of the calibration data record (KDS') by evaluating the first alignment data record (ARS1) and the second alignment data record (ARS2).
7. Verfahren nach einem der Ansprüche 1 bis 6, wobei ein Trägheitsnavi gationssystem der Lage- und Positionsbestimmungseinheit (8) zusätz lich Daten für den Lage-Datensatz (LDS) bereitstellt. 7. The method according to any one of claims 1 to 6, wherein an inertial navigation system of the orientation and position determination unit (8) provides additional Lich data for the position data set (LDS).
8. Computerprogrammprodukt, ausgebildet zum Ausführen eines Verfah rens nach einem der Ansprüche 1 bis 7. 8. Computer program product, designed to execute a method according to any one of claims 1 to 7.
9. System (21) zur Positions- und Raumlagebestimmung eines Werk zeugs (2) zur Bodenbearbeitung an einem verstellbaren Ausleger (3) eines Landfahrzeugs (1), wobei eine Lage- und Positionsbestimmungs einheit (8) einer Lage- und Positionsbestimmungs-Baugruppe (4) des Systems (21) an dem Werkzeug (2) dazu ausgebildet ist, einen Positi ons-Datensatz (PDS) indikativ für die Position der Lage- und Positions bestimmungseinheit (8) mit einem GNSS-Modul (702) zu bestimmen, einen Lage-Datensatz (LDS) indikativ für die Raumlage der Lage- und Positionsbestimmungseinheit (8) mit einer Lagesensorbaugruppe (703) zu bestimmen, den Positions-Datensatz (PDS) und den Lage-Daten satz (LDS) unter Verwendung eines Kalibrier-Datensatzes (KDS, KDS‘) auszuwerten, um einen Ausgangs-Datensatz (ADS) indikativ für die Raumlage und Position des Werkzeugs (2) zu bestimmen, und den Ausgangs-Datensatz (ADS) auszugeben. 9. System (21) for determining the position and position in space of a tool (2) for tillage on an adjustable arm (3) of a land vehicle (1), wherein a position and position determination unit (8) of a position and position determination assembly ( 4) the system (21) on the tool (2) is designed to determine a position data set (PDS) indicative of the position of the location and position determination unit (8) with a GNSS module (702), one Position data set (LDS) indicative of the position in space of the attitude and position determination unit (8) with a position sensor assembly (703) to determine the position data set (PDS) and the position data set (LDS) using a calibration data set ( Evaluate KDS, KDS') in order to determine an initial data set (ADS) indicative of the spatial orientation and position of the tool (2), and output the initial data set (ADS).
10. System (21) nach Anspruch 9, wobei die Lage- und Positionsbestim mungseinheit (8) an dem Werkzeug (2) befestigbar ist, wobei das Sys tem (21) zum Bestimmen des Kalibrier-Datensatzes (KDS) dazu aus gebildet ist, nach einem Ausrichten einer Referenzmarke (11) des Werkzeugs (2) durch Neigen des Werkzeugs (2), derart, dass sich die Referenzmarke (11 ) mit der Lage- und Positionsbestimmungseinheit (8) im Lot (L) befindet, eine Distanz (R) zwischen der Lage- und Positions bestimmungseinheit (8) und der Referenzmarke (11 ) zu bestimmen, die Distanz (R) von der Lage- und Positionsbestimmungseinheit (8) einzu lesen, eine Lotabweichung (LAB) der Lage- und Positionsbestim mungseinheit (8) mit der Lagesensorbaugruppe (703) der Lage- und Positionsbestimmungseinheit (8) zu bestimmen und den Kalibrier-Da- tensatz (KDS) durch Auswerten der Lotabweichung (LAB) und der Dis tanz (R) zu erzeugen. 10. System (21) according to claim 9, wherein the location and position determination unit (8) can be fastened to the tool (2), the system (21) for determining the calibration data set (KDS) being designed for this purpose after aligning a reference mark (11) of the tool (2) by tilting the tool (2) in such a way that the reference mark (11) is perpendicular to the location and position determination unit (8), a distance (R ) between the attitude and position determination unit (8) and the reference mark (11), to read in the distance (R) from the attitude and position determination unit (8), to determine a vertical deviation (LAB) of the attitude and position determination unit (8 ) with the position sensor assembly (703) of the position and To determine the position determination unit (8) and to generate the calibration data record (KDS) by evaluating the vertical deviation (LAB) and the distance (R).
11. System (21 ) nach Anspruch 10, wobei das System (21 ) zum Bestimmen des Kalibrier-Datensatzes (KDS) zusätzlich dazu ausgebildet ist, ein Ausrichten des Werkzeugs (2) zu bewirken, derart, dass das Werkzeug (2) eine vorbestimmte Position (I) mit einer vorbestimmten Neigung, ins besondere mit einer maximalen Neigung, annimmt und die Referenz marke (11) während des Ausrichtens des Werkzeugs (2) an der glei chen, vorbestimmten Position (I) verbleibt, wobei das System (21) dazu ausgebildet ist, während des Ausrichtens Positionsdaten (PD) mit dem GNSS-Modul (702) der Lage- und Positionsbestimmungseinheit (8) zu erfassen, Differenzdaten (DD) durch Auswerten des bestimmten Kalib rier-Datensatzes (KDS) und den bestimmten Positionsdaten (PD) zu bestimmen, und den Kalibrier-Datensatz (KDS) durch Auswerten der Differenzdaten (DD) zu ergänzen. 11. System (21) according to claim 10, wherein the system (21) for determining the calibration data set (KDS) is additionally designed to cause an alignment of the tool (2) such that the tool (2) has a predetermined Position (I) with a predetermined inclination, in particular with a maximum inclination, and the reference mark (11) during the alignment of the tool (2) at the same surfaces, predetermined position (I) remains, the system (21) is designed to acquire position data (PD) with the GNSS module (702) of the location and position determination unit (8) during alignment, differential data (DD) by evaluating the specific calibration data set (KDS) and the specific position data ( PD) and to supplement the calibration data set (KDS) by evaluating the differential data (DD).
12. System (21) nach Anspruch 9, wobei die Lage- und Positionsbestim mungseinheit (8) an dem Werkzeug (2) befestigbar ist, wobei das Sys tem (21) zum Bestimmen des Kalibrier-Datensatzes (KDS) dazu aus gebildet ist, ein Verlagern des Werkzeugs (2) zu bewirken, um einen vorbestimmten geostationären Punkt für das Werkzeug (2) anzufahren, und mindestens einen ersten Messwert (MW) an einem ersten Mess punkt (MP1) zu erfassen, wobei der erste Messwert (MW) Positionsda ten (PD) indikativ für die Position der Lage- und Positionsbestimmungs einheit (8) aufweist, die mit dem GNSS-Modul (702) der Lage- und Po sitionsbestimmungseinheit (8) erfasst werden, und wobei der erste Messwert (MW) Lagedaten (LD) indikativ für die Raum läge der Lage- und Positionsbestimmungseinheit (8) aufweist, die mit der Lagesensor baugruppe (703) der Lage- und Positionsbestimmungseinheit (8) er fasst werden, wobei das System (21) zum Verlagern des Werkzeugs (2) ausgebildet ist, derart, dass eine Neigung des Werkzeugs (2) ver ändert wird, wobei eine Referenzmarke (11) des Werkzeugs (2) an ei ner gleichen, vorbestimmten Position (I) verbleibt, wobei das System (21 ) zum Erfassen von mindestens zwei weiteren Messwerten (MW) an mindestens zwei weiteren Messpunkten (MP2, ... MPx) ausgebildet ist, wobei die weiteren Messwerte (MW) an den mindestens zwei weiteren Messpunkten (MP2, ... MPx) jeweils weitere Positionsdaten (PD) indi kativ für die Position der Lage- und Positionsbestimmungseinheit (8) aufweisen, die mit dem GNSS-Modul (702) der Lage- und Positionsbe stimmungseinheit (8) erfasst werden, wobei das System (21) zum Aus werten der Messwerte (MW) ausgebildet ist, um eine Lotabweichung (LAB) der Lage- und Positionsbestimmungseinheit (8) und/oder eine Distanz (R) zwischen der Lage- und Positionsbestimmungseinheit (8) und der Referenzmarke (11 ) zu bestimmen, und wobei das System (21 ) dazu ausgebildet ist, den Kalibrier-Datensatz (KDS) durch Auswerten der Lotabweichung (LAB) und/oder der Distanz (R) zu erzeugen. 12. System (21) according to claim 9, wherein the location and position determination unit (8) can be fastened to the tool (2), the system (21) for determining the calibration data set (KDS) being designed for this purpose to cause the tool (2) to be displaced in order to approach a predetermined geostationary point for the tool (2), and to record at least one first measured value (MW) at a first measuring point (MP1), the first measured value (MW) being Positionsda ten (PD) indicative of the position of the attitude and position determination unit (8), which are detected with the GNSS module (702) of the attitude and position determination unit (8), and wherein the first measured value (MW) position data ( LD) would be indicative of the spatial location and position determination unit (8), with the location sensor assembly (703) of the location and position determination unit (8) he recorded, the system (21) for moving the tool (2) is designed such that an inclination of the tool (2) is changed ver, with a reference mark (11) of the tool (2) at ei same, predetermined position (I) remains, the system (21) for detecting at least two further measured values (MW) at at least two further measuring points (MP2, ... MPx), the further measured values (MW) at the at least two further measuring points (MP2, ... MPx) each having further position data ( PD) indicative of the position of the location and position determination unit (8), which are detected with the GNSS module (702) of the location and position determination unit (8), the system (21) for evaluating the measured values ( MW) is designed to determine a vertical deviation (LAB) of the location and position determination unit (8) and/or a distance (R) between the location and position determination unit (8) and the reference mark (11), and wherein the system ( 21) is designed to the calibration data set (KDS) throughc h Evaluation of the perpendicular deviation (LAB) and/or the distance (R).
13. System (21) nach Anspruch 9, wobei die Lage- und Positionsbestim mungseinheit (8) an dem Werkzeug (2) befestigbar ist, wobei das Sys tem (21) zum Bestimmen des Kalibrier-Datensatzes (KDS) dazu aus gebildet ist, ein Verlagern des Werkzeugs (2) zu bewirken, um einen vorbestimmten geostationären Punkt für das Werkzeug (2) anzufahren, zum Erfassen von einem ersten Messwert (MW) an einem ersten Mess punkt (MP1 ) mit Positionsdaten (PD) indikativ für die Position der Lage- und Positionsbestimmungseinheit (8), wobei die Positionsdaten (PD) mit dem GNSS-Modul (702) der Lage- und Positionsbestimmungsein heit (8) erfasst werden, und wobei der erste Messwert (MW) an dem ersten Messpunkt (MP1 ) Lagedaten (LD) indikativ für die Raumlage der Lage- und Positionsbestimmungseinheit (8) aufweist, die mit der Lage sensorbaugruppe (703) der Lage- und Positionsbestimmungseinheit (8) erfasst werden, zum Verlagern des Werkzeugs (2), derart, dass eine Neigung des Werkzeugs (2) verändert wird, wobei eine Referenzmarke (11) des Werkzeugs (2) an einer gleichen, vorbestimmten Position (I) verbleibt, zum Erfassen von einem zweiten Messwert (MW) an einem zweiten Messpunkt (MP2) mit weiteren Positionsdaten (PD) indikativ für die Position der Lage- und Positionsbestimmungseinheit (8), die mit dem GNSS-Modul (702) der Lage- und Positionsbestimmungseinheit (8) erfasst werden, und wobei der zweite Messwert (MW) an dem zwei ten Messpunkt (MP2) weitere Lagedaten (LD) indikativ für die Raum lage der Lage- und Positionsbestimmungseinheit (8) aufweist, die mit der Lagesensorbaugruppe (703) der Lage- und Positionsbestimmungs einheit (8) erfasst werden, wobei das System (21) zum Auswerten der Messwerte (MW) ausgebildet ist, um eine Lotabweichung (LAB) der Lage- und Positionsbestimmungseinheit (8) und/oder eine Distanz (R) zwischen der Lage- und Positionsbestimmungseinheit (8) und der Re ferenzmarke (11 ) zu bestimmen, und wobei das System (21 ) dazu aus gebildet ist, den Kalibrier-Datensatz (KDS) durch Auswerten der Lotab weichung (LAB) und/oder der Distanz (R) zu erzeugen. 13. System (21) according to claim 9, wherein the location and position determination unit (8) can be fastened to the tool (2), the system (21) for determining the calibration data set (KDS) being designed for this purpose to effect a displacement of the tool (2) in order to approach a predetermined geostationary point for the tool (2), for detecting a first measured value (MW) at a first measuring point (MP1) with position data (PD) indicative of the position of the Orientation and position determination unit (8), the position data (PD) being recorded with the GNSS module (702) of the orientation and position determination unit (8), and the first measured value (MW) at the first measuring point (MP1) being position data (LD) indicative of the position in space of the location and position determination unit (8), which is detected with the position sensor assembly (703) of the location and position determination unit (8), for displacing the tool (2) in such a way that an inclination of the tool (2) is changed, whereby an R reference mark (11) of the tool (2) at the same, predetermined position (I) remains, for detecting a second measured value (MW) at a second measuring point (MP2) with further position data (PD) indicative of the position of the attitude and position determination unit (8), which with the GNSS module (702) of the attitude and Position determining unit (8) are recorded, and wherein the second measured value (MW) at the second measuring point (MP2) has further position data (LD) indicative of the spatial position of the position and position determination unit (8), which is connected to the position sensor assembly (703) location and position determination unit (8), the system (21) being designed to evaluate the measured values (MW) in order to determine a vertical deviation (LAB) of the location and position determination unit (8) and/or a distance (R) between the location and position determination unit (8) and the reference mark (11) to be determined, and the system (21) is designed to the calibration data set (KDS) by evaluating the deviation Lotab (LAB) and / or the generate distance (R).
14. System (21) nach einem der Ansprüche 9 bis 13, wobei die Lage- und Positionsbestimmungseinheit (8) an dem Werkzeug (2) befestigbar ist, wobei das System (21) zum Bestimmen des Kalibrier-Datensatzes (KDS‘) dazu ausgebildet ist, einen ersten Ausrichtungs-Datensatz (ARS1) indikativ für die Position der Lage- und Positionsbestimmungs einheit (8) an dem Werkzeug (2) mit dem GNSS-Modul (702) der Lage- und Positionsbestimmungseinheit (8) an einem ersten Messpunkt (MP1‘) zu bestimmen, ein Verlagern, insbesondere geradliniges Verla gern, einer Referenzmarke (11) des Werkzeugs (2) von dem ersten Messpunkt (MP1‘) zu einem zweiten Messpunkt (MP2‘) durch Verla gern, insbesondere geradliniges Verlagern, des Auslegers (3) zu bewir ken, derart, dass ein Abstand (A) zwischen dem Landfahrzeug (1) und der Referenzmarke (11) verändert wird, einen zweiten Ausrichtungs- Datensatz (ARS2) indikativ für die Position der Lage- und Positionsbe stimmungseinheit (8) an dem Werkzeug (2) mit dem GNSS-Modul (702) der Lage- und Positionsbestimmungseinheit (8) an dem zweiten Mess- punkt (MP2‘) zu bestimmen, und wobei das System (21) dazu ausge bildet ist, den Kalibrier-Datensatz (KDS‘) durch Auswerten des ersten Ausrichtungs-Datensatzes (ARS1) und des zweiten Ausrichtungs-Da tensatzes (ARS2) zu erzeugen. 14. System (21) according to one of claims 9 to 13, wherein the location and position determination unit (8) can be attached to the tool (2), the system (21) for determining the calibration data set (KDS') being designed for this purpose is, a first alignment data set (ARS1) indicative of the position of the location and position determination unit (8) on the tool (2) with the GNSS module (702) of the location and position determination unit (8) at a first measurement point ( MP1') to determine a displacement, in particular linear displacement, of a reference mark (11) of the tool (2) from the first measuring point (MP1') to a second measuring point (MP2') by displacement, in particular linear displacement, of the boom (3) to cause a second alignment data set (ARS2) indicative of the position of the location and position determination unit (8 ) on the tool (2) with the GNSS module (702) the orientation and position determination unit (8) on the second measuring Point (MP2 ') to determine, and wherein the system (21) is formed out to generate the calibration data set (KDS') by evaluating the first alignment data set (ARS1) and the second alignment data set (ARS2). .
15. System (21) nach einem der Ansprüche 9 bis 14, wobei die Lage- und Positionsbestimmungseinheit (8) ein Trägheitsnavigationssystem auf weist, das zusätzlich Daten für den Lage-Datensatz (LDS) bereitstellt. 15. System (21) according to any one of claims 9 to 14, wherein the orientation and position determination unit (8) has an inertial navigation system which additionally provides data for the position data set (LDS).
16. Lage- und Positionsbestimmungs-Baugruppe (4) für ein System (21) nach einem der Ansprüche 9 bis 15. 16. attitude and position determination assembly (4) for a system (21) according to any one of claims 9 to 15.
17. Lage- und Positionsbestimmungs-Baugruppe (4) nach Anspruch 16, wobei die Lage- und Positionsbestimmungs-Baugruppe (4) eine Anzei- gevorrichtung (5) und/oder ein Endgerät und/oder Steuerausgabegerät17. location and position determination assembly (4) according to claim 16, wherein the location and position determination assembly (4) gevorrichtung a display (5) and / or a terminal and / or control output device
(6) aufweist, wobei die Anzeigevorrichtung (5) und/oder das Endgerät und/oder Steuerausgabegerät (6) als Mobilgerät ausgebildet sind. (6), wherein the display device (5) and/or the terminal and/or control output device (6) are designed as a mobile device.
EP22716901.8A 2021-03-23 2022-03-18 Method for determining the position and spatial orientation of a tool of an agricultural vehicle Pending EP4314419A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
DE102021107197.6A DE102021107197A1 (en) 2021-03-23 2021-03-23 Process for determining the position and spatial orientation of a tool
PCT/EP2022/057199 WO2022200220A1 (en) 2021-03-23 2022-03-18 Method for determining the position and spatial orientation of a tool of an agricultural vehicle

Publications (1)

Publication Number Publication Date
EP4314419A1 true EP4314419A1 (en) 2024-02-07

Family

ID=81328030

Family Applications (1)

Application Number Title Priority Date Filing Date
EP22716901.8A Pending EP4314419A1 (en) 2021-03-23 2022-03-18 Method for determining the position and spatial orientation of a tool of an agricultural vehicle

Country Status (3)

Country Link
EP (1) EP4314419A1 (en)
DE (1) DE102021107197A1 (en)
WO (1) WO2022200220A1 (en)

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4884939A (en) 1987-12-28 1989-12-05 Laser Alignment, Inc. Self-contained laser-activated depth sensor for excavator
WO1999021134A1 (en) 1997-10-22 1999-04-29 Spectra Precision Ab Contactless measuring of position and orientation
TW500228U (en) 2001-12-05 2002-08-21 Hon Hai Prec Ind Co Ltd Light switch with display device
US9002565B2 (en) 2003-03-20 2015-04-07 Agjunction Llc GNSS and optical guidance and machine control
US20080047170A1 (en) 2006-08-24 2008-02-28 Trimble Navigation Ltd. Excavator 3D integrated laser and radio positioning guidance system
DE102010054379A1 (en) 2010-12-13 2012-06-14 Technische Universität Clausthal Method for determining transport state information of load carried by e.g. forklift truck, involves determining distance between transponder-receiver unit and transponder of transportation load, and transaction data
DE102013206471A1 (en) 2013-03-22 2014-09-25 Mts Maschinentechnik Schrode Ag Mobile construction site surveying device, and device for providing information, in particular for generating instructions for a construction machine operator
EP2806248B1 (en) 2013-04-12 2018-09-12 Leica Geosystems AG Method for calibrating a detection device and detection device
DE102013221301A1 (en) * 2013-10-21 2015-04-23 Mts Maschinentechnik Schrode Ag Method for calibrating the position of a construction machine in a construction site plan
FI125464B (en) * 2014-03-18 2015-10-15 Novatron Oy System and method for locating a construction machine
US10094654B2 (en) 2014-08-25 2018-10-09 Trimble Navigation Limited All-in-one integrated sensing device for machine control
US9428885B2 (en) 2014-09-15 2016-08-30 Trimble Navigation Limited Guidance system for earthmoving machinery
US10066346B2 (en) * 2015-08-12 2018-09-04 Topcon Positioning Systems, Inc. Point cloud based surface construction

Also Published As

Publication number Publication date
WO2022200220A1 (en) 2022-09-29
DE102021107197A1 (en) 2022-09-29

Similar Documents

Publication Publication Date Title
DE102007051198B4 (en) System and method for automatic adjustment of a working device
DE19581454B3 (en) Method and device for determining the location and orientation of a work machine
EP0970595B2 (en) Device and method for assessing a virtual position
DE69815063T2 (en) DEVICE AND METHOD FOR DETERMINING THE POSITION OF A CONTROL PANEL
DE112007002393B4 (en) Navigation system with GPS and laser reference
DE112016003502B4 (en) Construction management system and form measurement method
EP2697605B1 (en) Measuring system and method for determining new points
DE112016003771T5 (en) Construction management system, construction management method and management device
EP3106899B1 (en) Referenced vehicle control system
EP2193333B1 (en) Positioning method
EP1843168B1 (en) Mobile reference station for producing differential corrections
EP2208019B1 (en) Method and device for determining an object from hybrid measurements
EP3874928B1 (en) Method and system for estimating surface roughness of ground for an off-road vehicle to control an implement
DE112005003046T5 (en) Trencher guidance via GPS
DE102013205486A1 (en) Arrangement and method for position detection with a hand-held device
DE102016221284A1 (en) A method of guiding an off-road vehicle along a curved path
DE112017000124T5 (en) Measuring device and method for calibrating a hydraulic excavator
EP1475609B1 (en) GPS / INS compensation system of a land vehicle
DE102013206471A1 (en) Mobile construction site surveying device, and device for providing information, in particular for generating instructions for a construction machine operator
WO2022200220A1 (en) Method for determining the position and spatial orientation of a tool of an agricultural vehicle
DE112016003697T5 (en) Construction method, work machine control system and work machine
DE102019220557A1 (en) Method and measuring arrangement for localizing at least one component of a machine
DE102005006389B4 (en) Method for determining the position of a mobile object, in particular an agricultural machine
EP2837909A2 (en) Method and assembly for mapping an agricultural field
EP2573583B1 (en) Detector and method for detecting a transmitter

Legal Events

Date Code Title Description
STAA Information on the status of an ep patent application or granted ep patent

Free format text: STATUS: UNKNOWN

STAA Information on the status of an ep patent application or granted ep patent

Free format text: STATUS: THE INTERNATIONAL PUBLICATION HAS BEEN MADE

PUAI Public reference made under article 153(3) epc to a published international application that has entered the european phase

Free format text: ORIGINAL CODE: 0009012

STAA Information on the status of an ep patent application or granted ep patent

Free format text: STATUS: REQUEST FOR EXAMINATION WAS MADE

17P Request for examination filed

Effective date: 20231010

AK Designated contracting states

Kind code of ref document: A1

Designated state(s): AL AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HR HU IE IS IT LI LT LU LV MC MK MT NL NO PL PT RO RS SE SI SK SM TR