WO2008017486A1 - Positionsbestimmungsvorrichtung - Google Patents
Positionsbestimmungsvorrichtung Download PDFInfo
- Publication number
- WO2008017486A1 WO2008017486A1 PCT/EP2007/007058 EP2007007058W WO2008017486A1 WO 2008017486 A1 WO2008017486 A1 WO 2008017486A1 EP 2007007058 W EP2007007058 W EP 2007007058W WO 2008017486 A1 WO2008017486 A1 WO 2008017486A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- beams
- receiver
- transmitter
- reference objects
- work machine
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Ceased
Links
- 0 C*I[C@]1*2(*3*2C)C(C2)C3*2*1C1C(C*=C)C1 Chemical compound C*I[C@]1*2(*3*2C)C(C2)C3*2*1C1C(C*=C)C1 0.000 description 3
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/87—Combinations of systems using electromagnetic waves other than radio waves
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01D—HARVESTING; MOWING
- A01D34/00—Mowers; Mowing apparatus of harvesters
- A01D34/006—Control or measuring arrangements
- A01D34/008—Control or measuring arrangements for automated or remotely controlled operation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C15/00—Surveying instruments or accessories not provided for in groups G01C1/00 - G01C13/00
- G01C15/002—Active optical surveying means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0244—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using reflecting strips
Definitions
- the invention relates to a position determining device for a mobile, in particular self-propelled machine according to the preamble of claim 1, a mobile machine and a positioning system with such a position determining device and a positioning method for a mobile machine according to the preamble of claim 17.
- Mobile machines are used in many areas. For example, self-propelled transport vehicles automatically transport goods from a first location to a second location, or are intended to perform tillage vehicles such as lawn mowers, markers, cleaners, or construction equipment, tillage over a given area of a terrain, or along a predetermined path.
- tillage vehicles such as lawn mowers, markers, cleaners, or construction equipment
- tillage over a given area of a terrain, or along a predetermined path.
- a corresponding guidance or control of the vehicle which is usually realized by means of positioning systems.
- the positioning systems use, for example, mechanical or inductive position elements to provide position information for the vehicle. Advantages in terms of accuracy, time and ease of use are provided by the use of positioning optical positioning systems and control of the tillage vehicle.
- Such a positioning system comprises a transmitting and a receiving component for measurements based on optical radiation to the reference objects - for example Reflectors represent - which components are assigned to the tillage vehicle, generally mounted on this, are. From the measurements, conclusions about the location of the positioning system or the location / position of the tillage vehicle relative to the reference objects can be derived. The position thus determined is used as the basis of control of the vehicle.
- the absolute position of the vehicle can be derived.
- this requires reference objects that either have to be known or measured in terms of their position. In many cases, for example, for private individuals - such a survey is too time-consuming and not necessary, since often the knowledge of the relative position is sufficient.
- Positioning systems with triangulation sensors are known as optical positioning systems for tillage vehicles.
- the directions to the objects are determined by means of angle measurements to reflective reference objects Reference objects and from this determines the position of the positioning system or tillage vehicle with respect to these.
- US 5,426,584 describes a control system for a lawnmower tillage vehicle with a triangulation sensor for determining the position of the lawn mower against reflective reference points.
- the triangulation sensor comprises a laser source for emitting laser beams and a beam scanner for generating a substantially horizontal, rotating emission direction of the beams so that the beams are directed against the reference points.
- the beams reflected at the reference points are detected by a detector of the triangulation sensor and evaluated with respect to the horizontal angles between the reference points.
- the beam scanner is gimballed.
- the measurements In order to be able to determine the angles with the required accuracy, the measurements must take place at precisely defined - virtually point-like - reference points. If the lawn mower drives over uneven terrain, the rays are emitted horizontally due to the gimbal, but the reference points are not hit due to the difference in level. Therefore, the beam scanner is formed with an additional precessing mechanism for scanning movement of the beams in the vertical direction. However, the scanning movement is not exactly controllable, which causes inaccuracies in the measurement and thus in the position determination and control of the lawnmower. - A -
- US 6,556,598 shows a similar system for determining the position of a lawn mower over reference points according to the principle of triangulation.
- the system includes a pendulum suspended laser projection unit having a laser for emitting laser radiation and a mirror rotating about a vertical axis for generating a rotating emission direction of the radiation.
- the laser radiation is directed against the reference points and the radiation reflected at the reference points is directed to a detector of the system. So that the reference points are exactly hit and the point of impact of the radiation can be determined exactly, the radiation is rotated in a controlled manner by additionally rotating the mirror about a horizontal axis, also in the vertical direction.
- the exact - horizontal and vertical - rotation angles of the mirror are measured by angle encoders and included in the angle determination of the reference points.
- the training of the system, as well as the data analysis are so extremely complex.
- US 5,011,288 discloses a position control system for a moving vehicle.
- the system includes a transmitter having a laser source for emitting laser radiation in all azimuthal directions and a receiver for receiving beams reflected from reference objects.
- the transmitter and receiver are mounted on a rotating table so that scanning is possible in all directions. From received signals of the receiver, the distances to the reference objects are determined according to the phase measurement principle. In addition, the azimuthal angles between the reference objects are determined by means of an angle encoder and the received signals. From the positions and the angles, the relative position of the vehicle is derived and, where appropriate, for controlling the same used.
- the construction with a rotating table is very complex and bulky.
- this structure is unsuitable for an exact position determination for controlling the vehicle, as this at least about a position determination of each reference object per second is necessary.
- the rotating table with the chunky structure is very impractical and unsuitable for the required angular velocity.
- the reflectors can fall out of the scanning range of the laser beam.
- WO 2004/026538 describes a method for a mobile work machine for automatic execution of tasks.
- the working machine has a position-determining device with a transmitter, a receiver and a rotating deflection means, the components being mounted in such a way that a vertical alignment results.
- the emitted beams are now deflected by the deflection means in all horizontal directions, reflected on reference objects and detected by the receiver. From this, angle information for the reference objects is derived.
- reflections are received by the transmitter spaced apart by an optical system with another detector and the direction from which the reflex comes, detected. Using geometric calculations, distances to the reference objects are determined and the position of the machine is determined, the position then being used to control the machine.
- the object of the invention is to overcome disadvantages of the prior art and to provide a less complex and easy-to-use position-determining device for a mobile work machine, as well as a mobile work machine with such a position-determining device.
- a further object is the provision of a precise positioning system for a sports field marking machine, so that an automatic and exact control and thus a precisely predeterminable application of a marking substance are made possible.
- the invention is based on the consistent integration of an optical range-measuring functionality in a positioning system for a mobile work machine such as a tillage vehicle.
- a positioning system of low complexity is provided for the generic exact position determination.
- the position determination is based on distance measurements to reference objects - the positioning system according to the invention is a so-called “self-positioning system.” On the basis of the distance measurements, the position of the work machine relative to the reference objects can be determined and from this control instructions for the working machine are derived.
- the positioning system has a transmitter for emitting optical transmission beams, in particular laser beams, which are directed against the reference objects.
- the transmission beams are detected again after their transmission and subsequent reflection on the reference objects by means of a receiver of the positioning system, the distances to the reference objects, in particular according to the phase measurement principle or the principle of pulse transit time measurement, are determined from the receiver signals of the receiver.
- the directing of the transmission beams against the reference objects and the reflected beams as receiving beams against the receiver by means of a deflection of the positioning by means of a deflection of the positioning.
- the deflection means is designed to generate a horizontal and rotating emission direction of the transmission beams and arranged rotatable about a vertical axis.
- the position of the tillage vehicle relative to the reference objects are further derived by means of a computing and control component of the positioning system and generated from the knowledge of the position control instructions for the tillage vehicle, at least with respect to its track.
- the position of the groundworking vehicle in this coordinate system can be determined and the vehicle can be controlled, for example, according to a path predetermined in the coordinate system.
- the control of the vehicle relative to the reference objects can be stored by the computing and control component, for example as part of a learning journey.
- the calculation and control component can also have a control program which takes into account various input parameters. For example, different driving patterns for the surface to be processed can be stored.
- the transmitter and the receiver of the positioning system are part of a rangefinder.
- the rangefinder used is, for example, a device in the manner of the laser range finder marketed by Leica Geosystems, Switzerland, which is sold under the product name "Disto.”
- a data processing unit is additionally assigned to the range finder and can be realized by the abovementioned calculation and control component.
- the data processing unit may represent one component of the rangefinder and the computing and control component another component of the positioning system that is separate from the distance meter
- Data processing unit is provided for determining the distances from the received signals.
- a microcontroller is used as a data processing unit, wherein the microcontroller is designed in particular for the frequency control of the transmitter and / or receiver.
- the positioning system is designed for distance measurement according to the phase measurement principle.
- These are the transmission beams of the transmitter is intensity modulated with a high frequency modulation frequency.
- the transmitted beams reflected at a reference object are received by the receiver and then mixed with a mixer frequency to generate a low-frequency measurement signal for the data evaluation.
- the phase difference of the measurement signal is formed with a reference signal.
- the parameters of the distance measurement with respect to the application for the ground-handling vehicle are adapted. Since positional determinations must be carried out in short time intervals, such as a position determination per second, for a precise control of a soil tillage implement, and generally two or more measurements for reference objects are required for a position determination, the rotational speed of the deflection means is correspondingly high in the transmission beams. For example, the diverter performs three full (360 °) revolutions per second. However, this requires a very short signal time - for example, by a factor of 1000 shorter than for a conventional rangefinder - the transmit and receive beams for the distance measurement.
- the low-frequency phase measuring frequency is increased, for example, to a phase measuring frequency in the range of 100 kHz compared to a phase measuring frequency used in a conventional rangefinder, such as the "Disto".
- a phase measuring frequency in the range of 100 kHz
- a conventional rangefinder such as the "Disto"
- the angles of the reference objects to one another are taken into account in addition to the distances. With known direction of travel of the tillage vehicle, the angle of the reference objects can also be determined to the direction of travel of the vehicle. The angles can be derived from the constant rotational speed of the deflecting means and the received signals of the receiver.
- means for detecting / monitoring the rotational speed can additionally be used, such as, for example, a light barrier for picking up reference signals for determining the angle.
- the rotational speed can be controlled, as well as irregularities in the rotational movement-an "egg" can be taken into account and corrected.
- ⁇ br/> ⁇ br/> In one embodiment of the invention, four reference signals are tapped in a 360 "rotation of the deflection means.
- cooperative objects are particularly suitable which, in comparison with non-cooperative objects, have a, for example 50 times, higher reflectance.
- Such reference objects can be distinguished by their reflectivity from the background, so that the positions of the reference objects can already be determined from the fluctuation in the intensity of the radiation reflected at the objects.
- the position of the positioning system or tillage vehicle relative to the reference objects can be derived by known methods, as used for example in photogrammetry. An example of this are correlation methods or correlation calculations.
- the cooperative reference objects have a reflective surface, which is formed for example of triple prisms, microlenses, glass beads, reflective foil or other conventional reflection elements.
- reference objects extending in height, such as reflector rods, so that no target search in the vertical direction has to be carried out.
- alternative objects reflecting optical radiation such as white house walls, may also be used as reference objects.
- Such goals as house walls or other - preferably not or difficult to move - objects can be used in particular for - slower - Review of the reference objects. In this way deviations - eg due to shifts - of the positions of the reference objects can be detected and the positioning system can be recalibrated in relation to the reference objects.
- the number of required reference objects depends on their position, the nature of the terrain to be processed, and the intended accuracy of the measurement. As a rule, apart from particularly favorable constellations, at least 3 or 4 reference objects are required. If an angle is additionally taken into account, the number of reference objects can be reduced to two. In special conditions - eg when the tillage vehicle is approaching a docking station, the positioning of the vehicle can also take place with a single reference object.
- the number of required reference objects can also be reduced by making the reference objects distinguishable from one another, for example by applying codings or through filters.
- reference posts with different diameters are provided as coded reference objects. Based on the distance measurement, the rotational speed of the deflection and the different signal widths, the post diameter can be determined and the various reference posts are identified. Alternatively, two posts can be placed side by side to create the same effect.
- the actually required number of reference objects is additionally dependent on possible restrictions for reducing ambiguity.
- the three distances define a plane at which the relative position to be determined can be mirrored.
- the set of reference objects is selected such that, if possible, at least two of the reference objects can be detected from each point of the terrain to be processed.
- an azimuthal expansion angle for the reflector posts can additionally be determined in each case from the rotational speed and the received signals, since the extended reflector posts do not produce a point-like reflection, but generate a broad reflection signal.
- the azimuthal angle within which reflections are received by one respective reflector post can be determined.
- a coarse distance of this post to the working machine can now be calculated from the azimuthal expansion angle of the post determined by the working machine. For example, such a calculation is based on the tangent set.
- the coarse distances thus determined are e.g. suitable for precise distance measurement according to the phase measurement principle. Since, as described above, reflections are received at the required high scanning speed for only very short times, the determined coarse distances can be taken into account for the resolution of phase ambiguities for which otherwise a sufficient number of signal periods must be received. As a result, very fast scan speeds and thus also a high position determination rate can be achieved. This in turn allows a more precise and faster position determination for the work machine and thus a more precise control of the same.
- Working machine be reduced. For example, once the mobile work machine loses its position due to a malfunction - eg, a lightning strike, improper handling, or manual movement - it may be difficult to find the position relative to the reference objects.
- the coarse distances can be used for coarse positioning so that the work machine can re-synchronize with an internal terrain plan based on this coarse positioning.
- the positioning system or the work machine can be assigned further components for position determination.
- the positioning system additionally comprises direction-measuring components, such as a compass, and / or inertial sensors, which register a change with respect to a known starting position.
- direction-measuring components such as a compass, and / or inertial sensors, which register a change with respect to a known starting position.
- GPS sensor With a GPS sensor, the position of the positioning system can be roughly determined by means of a distance and possibly angle measurement on a reference object.
- the transmitter of the positioning system comprises a radiation source, in particular a laser, and a transmission optics - collimation optics - for emitting a collimated transmission beam for the distance measurement.
- a laser as a transmitter is designed to emit transmission beams in a predetermined wavelength range.
- the transmitter is a laser, the transmission beams in the non-visible Wavelength range, for example in the range between 790 nm and 950 nm, in particular transmission beams of the wavelength of 850 nm emits, used.
- an additional visible radiation source can be provided, which can be used eg during a learning run of the positioning system, so that a user does not unconsciously cover the invisible beam. As a result, the visual connection of the positioning system to the reference objects required for determining the position can also be checked visually.
- the receiver has a receiving optical system and a receiving element sensitive to the emission wavelength of the transmitter.
- the receiving element is a photodiode, e.g. a pin diode or an avalanche diode.
- the rangefinder with the transmitter and the receiver as constituents further common with respect to the phase measurement components.
- a beam splitter for branching a part of the transmission beams as reference beams and a reference receiver for receiving the reference beams after passing through a reference path are provided.
- the reference path further optical elements can be arranged.
- Other components used or usable are frequency mixers and phase meters.
- the deflection of the positioning system is arranged as mentioned above rotatable about a vertical axis. Furthermore, the deflecting means is designed and arranged relative to the transmitter, that the transmission beams are rotated substantially in a horizontal plane. In particular, the rotation is continuous by 360 °. At continuous 360 ° Rotation of the deflection means is scanned by the transmission beams, the environment around the positioning system evenly for reference objects, so located in the horizontal plane objects that are not obscured by obstacles are detected.
- the deflection means can be realized by means of an optical reflection element, such as a mirror or a prism.
- the reflection element is designed to be rotatable, for example by being arranged in, on or on a rotary element which is set in rotational motion by a drive.
- the drive is motorized.
- To drive components other than the engine such as toothed or friction belt, or gears may be used as drive means.
- a mirror is arranged as deflection means at an angle of 45 ° on a hollow body as a rotation element, through which the transmission or reception beams are guided to the deflection means or to the receiver.
- the hollow body is rotated by a motor and a toothed belt at a fixed rotational speed about the vertical axis through its center of gravity.
- Bumps such as ripples and valleys, terrain or terrain at different levels are
- Positioning system arranged in or on a receptacle which is arranged like a pendulum on a carrier component.
- the carrier component is a plate with a frame-like
- the carrier component may be a gimbal or
- the carrier component may comprise a corresponding bearing receptacle in which the receptacle is mounted, for example via one or two bearings, such as ball bearings or a ball joint with e.g. two rotational degrees of freedom.
- the carrier component can also be formed by a component of the soil cultivation vehicle.
- the receptacle may be composed of a plurality of components, eg housings or housing parts, or may be formed in one piece.
- the receptacle is a housing in which the transmitter and the receiver are fixed and the deflection means are rotatably arranged.
- Such a construction further comprises an opening, such as a window, for the transmit and receive beams.
- the receptacle comprises a housing for the transmitter and the receiver, a hollow body through which the transmitting and receiving beams are directed in the direction of the deflecting means, as well as a on the hollow body rotatably mounted rotary member on which the deflection means is positioned by means of a holder.
- the arrangement of transmitter, receiver and deflecting means of the positioning system according to the invention is carried out in such a way that the most compact and stable system possible is provided.
- the transmitter, the receiver and the deflection means are arranged such that the beam path of the transmission beams and the beam path of the reception beams are substantially parallel.
- the transmitter and receiver are as close as possible to each other and arranged opposite to the deflection so that the transmitter beams emitted by the transmitter meet a deflection of the deflection, are reflected at the deflection in the direction of the reference objects, and reflected from the reference objects beams over the same deflection be reflected to the receiver.
- the transmitter, the receiver and the deflection means are arranged such that the transmission beams and the reception beams are coaxial.
- the arrangement of transmitter, receiver and deflection means is such that the beam path of the transmission beams between transmitter and deflection means and the beam path of the receiving beams between the deflection and the receiver and the vertical axis about which the deflection rotates and the For example, represents a rotation axis through the center of gravity of the arrangement, are substantially parallel and optionally coaxial.
- Such arrangements are known per se for different rangefinders.
- the positioning system can protect a protective housing, e.g. a dome-like plastic housing.
- the housing is preferably made transparent or has along its circumference a window for the transmission and reception beams of the system.
- the positioning system is mounted on a platform of the harrow.
- a tillage device for integrated recording of the positioning system can be formed.
- the training is such that a part of the system is used - sunk - in the tillage vehicle.
- the positioning system according to the invention being designed as a compact, handy and comparatively small and lightweight system - which can be implemented advantageously with the use of a rangefinder according to the previously mentioned "Disto" - a ground-working vehicle, which for example represents a lawnmower, can be designed to receive the positioning system in a modular manner
- a distance meter according to the "Disto” also has the advantage that it is already available as a complete system for distance measurement and only an interface to the Provide communication with the computing and control unit or the computing and control component - eg in the form of appropriate software - in the rangefinder respectively whose data processing unit is to be integrated.
- the inventive positioning system is additionally optimized for the arrangement on the harrow by the fact that the rotation of the transmitted beams is realized with the rotation of only the deflection means. This avoids cable routing problems, among other things.
- a - e.g. at a favorable position for an operator - arranged in the soil cultivation device computing and control component communication to the transmitter and receiver or to the data processing unit simply via cable connections.
- the tillage vehicle for which the positioning system according to the invention is provided can, in principle, represent any movable device / vehicle.
- the positioning system is used on a lawnmower that autonomously departs a terrain, or on a marker for generating marking lines and / or surfaces.
- the positioning system can be used to navigate construction machinery such as excavators, pavers or trucks.
- Another advantageous application for the positioning system according to the invention is the use of the same on a cleaning device.
- existing posts can be used advantageously as reference objects.
- a reflective coating such as a reflective foil, be mounted on the post.
- a positioning system according to the invention is very well suitable eg for use in sports field marking work.
- four reflector posts of known diameter can be positioned in the corners of a sports field so that there is good line of sight from every point on the sports field to each of the reflectors.
- the position-determining device according to the invention and the position-determining method can also be used in other areas.
- the position determination method can be used for any objects, such as a piece of furniture, whose positions are to be determined, for example, in a room or which are to be positioned precisely on a terrain.
- the position-determining device can be attached to an object and then, according to the invention, its position can be determined relative to erected reflectors.
- FIG. 1 shows an inventive tillage vehicle, positioning system and reference object
- FIG. 2 shows a section of the positioning system from FIG. 1 and a reference object on FIG. 1;
- FIG. 3 shows a typical received signal of a positioning system according to the invention
- 5A-5D show a further embodiment of a positioning system according to the invention in four views.
- FIGS. 6A-6C show three different soil tillage vehicles with a positioning system according to the invention.
- FIG. 1 Shown in FIG. 1 are a ground-handling vehicle according to the invention with a positioning system 1a according to the invention, as well as a plurality of reference objects according to the invention.
- a self-propelled lawnmower 2a here represents the ground-working vehicle, which lawnmower 2a is navigated by means of the positioning system 1a and the reference objects via a terrain T to be machined-to-be-mowed.
- the reference objects are designed as posts 3a, 3b, 3c, 3d, 3e, 3f with a reflective coating - reflector rods.
- Distributed over the terrain T are six posts 3a, 3b, 3c, 3d, 3e, 3f, one of the posts 3c being docked Station DS is arranged for the lawnmower 2a.
- the posts 3a, 3b, 3c, 3d, 3e, 3f are only sketched here, the special design can be done with coded posts.
- the posts 3a, 3b, 3c, 3d, 3e, 3f - as indicated for the post 3d at the top right - have different diameters and / or combinations of two or more posts are provided.
- the positioning system Ia receives different signals on the basis of which the respective coded posts can be identified.
- the optical positioning system 1a emits horizontal laser transmission beams 5a in a rotating emission direction as indicated by the arrow.
- the nature of the terrain T and the number and arrangement of the posts 3a, 3b, 3c, 3d, 3e, 3f are such that the positioning system 1a arranged on the lawnmower 2a detects at least three posts from every position of the terrain T.
- the positioning system 1a is partially recessed in the lawnmower 2a, so that the lawnmower 2a and the system form a compact arrangement. Furthermore, the arrangement is kept low by the partial sinking, whereby the height of the posts 3a, 3b, 3c, 3d, 3e, 3f can be reduced.
- FIG. 1 A section of the positioning system 1a of FIG. 1 and a post 3a of FIG. 1 are shown in more detail in FIG.
- the post 3a is provided with a reflective coating 3a '.
- the coating is formed of a plurality of glass beads 3a ".
- the post 3a is 3 cm in diameter D and the reflective coating 3a 'extends 1 m in height H.
- the shown Section of the positioning system Ia comprises a deflection mirror 9a which deflects the transmission beams 5a of a laser diode (not shown) as a transmitter of the positioning system 1a in the direction of the post 3a, at which post 3a they are reflected back to the deflection mirror 9a.
- a deflection mirror 9a which deflects the transmission beams 5a of a laser diode (not shown) as a transmitter of the positioning system 1a in the direction of the post 3a, at which post 3a they are reflected back to the deflection mirror 9a.
- the deflecting mirror 9a is rotated.
- the deflecting mirror 9a is mounted in a mirror mount 9a ', which is mounted on a rotary element forming a cylindrical hollow body attachment 15a, which is offset by a motor in rotational movement.
- the transmission beams 5a pass through the hollow body attachment 15a to the deflection mirror 9a.
- the beams are deflected in such a way that they are substantially horizontal.
- the rays are rotated by the rotation of the deflection mirror 9a - here by 360 °.
- a protective cover in the manner of a transparent plastic bell 21 is set.
- the opening of the plastic bell 21 is shown only for the purpose of illustrating the screw 21 'between the plastic bell 21 and an annular plate 22, the bell is closed.
- the transparent protective cover it is also possible to use a sleeve with a window along the circumference.
- the annular plate 22 is attached to the lawnmower 2a of FIG.
- the lawnmower 2a For receiving the part of the positioning system Ia which extends below the plastic Bell 21 extends, the lawnmower 2a has a recess.
- the lawnmower 2a may also have a recess into which the plate 22 can be inserted.
- the lawnmower 2a can already be formed or be with an integrated plate, in which the positioning system Ia can be used.
- the part of the positioning system Ia - not shown - on the underside of the bell - so sunk in the lawnmower 2a and well protected against mechanical and environmental damage.
- FIG. 3 shows a typical received signal 8 of a receiver of a positioning system according to the invention for a 360 ° rotation of the deflection means.
- the inner signal represents a reference signal 8 'in relation to the rotational movement of the deflection means of the system.
- the reference signal 8' is connected to a sensor, such as a sensor. a photoelectric sensor, recorded for checking and, if necessary, correction of the rotational movement - in the illustrated embodiment, four measurements are performed 8a '-8d' to 360 °.
- the received signal 8 shows three
- Peaks 8a, 8b, 8c represent reflective
- Reference objects reflected signals that are based on their
- Intensity can be distinguished from the background.
- the different peaks 8a, 8b, 8c also correspond to reference objects with different diameters and / or reflectivities, so that an assignment to specific reference objects is possible.
- From the received signal 8 three distances to the corresponding reference objects are calculated.
- the horizontal angle between the reference objects is determined from the received signal 8 and the known rotational speed, taking into account the reference signal 8 '. Since here also the Direction of travel 16 of the tillage vehicle is known, the horizontal angle between the direction of travel 11 and the reference objects are determined.
- the diameters of the reflecting reference objects are known, in particular of the same size in each case, then in addition over the width bs a of the peaks 8a, 8b, 8c and the known diameters d of the reference objects a coarse
- Distance GE are derived to the reference objects.
- a peak width angle a ⁇ sss resulting peak between the beginning and end of the peak determines a coarse removal can be the reference object on the basis of
- This coarse distance GE can be used, for example, for the resolution of phase ambiguities in the additionally performed according to the invention carried out high-precision distance measurement according to the phase measurement principle or relevance checking the distances determined by the phase measurement.
- FIG. 4 shows a more detailed embodiment of a positioning system Ib according to the invention for a ground-handling vehicle.
- the receptacle 14b of the positioning system Ib is composed of several components, such as housing parts.
- the transmitter, the receiver and the computing and control component 30 of the positioning system Ib are arranged in a further housing 23.
- Transmitter, receiver and computing and control components form a rangefinder 12b approximately according to the "Disto" from Leica Geosystems In contrast to the "Disto", the rangefinder 12b is for use on a tillage vehicle customized.
- the transmitter emits transmit beams 5b at a frequency of at least 100 kHz in order to enable distance measurements according to the phase measurement principle for very short signal times of approximately 100 ⁇ s.
- the short signal times arise from the rotation of the transmission beams 5b, which is realized by means of a deflection means 9b, which is rotated at at least three revolutions per second.
- the deflection means 9b is mounted on a rotary member 15b in the form of a hollow body.
- the rotation element 15b in turn is rotatably mounted about a vertical axis 10b on a hollow cylinder 14b 'of the receptacle 14b and also forms a part of the receptacle 14b.
- the rotation takes place by means of a motor drive via a toothed belt 16.
- the transmission beams 5b of the transmitter are directed in a rotating emission direction and the reflected transmission beams are directed as receiving beams 7b to the receiver.
- the receptacle 14b of the positioning system 1b is gimballed in a carrier component 13b. In this way, the receptacle 14b also aligned vertically in the case of inclination positions of the groundworking vehicle with gravitational influence, so that the horizontality of the transmitted beams 5b is maintained.
- the carrier component 13b comprises a first holder 13b ', in which the receptacle 14b is rotatably mounted about a first axis and a second holder 13b'', in which the first holder 13b' is rotatably mounted about a second axis.
- the second bracket 13b '' is attached via screws 17 and damping elements 18 to a platform 20 of the tillage vehicle.
- 5A to 5D show an embodiment of a positioning system Ic according to the invention in various views, FIG. 5A showing a top view of the positioning system Ic, FIG. 5B a cross section along the section AA of FIG. 5A, FIG. 5C a side view of the positioning system Ic and FIG 5D shows a cross section along the section line BB from FIG. 5C.
- FIG. 5A shows a top view of the positioning system Ic
- FIG. 5B a cross section along the section AA of FIG. 5A
- FIG. 5C a side view of the positioning system Ic
- the illustrated positioning system Ic has a receptacle 14c, which is composed of a receiving body with a cylindrical hollow body 14c 'and a rotary member 15c.
- the rotation element 15c is designed as a mirror holder for a mirror 9c as a deflection and rotatably mounted on a cylindrical bearing 25 on the cylindrical hollow body 14c '.
- the rotation element 15c has an outer toothing 26 and is rotated via a pinion 27 which is driven by an electric motor 28.
- On the cylindrical hollow body 14c ' is further - on a flange of the hollow body 14c' - a sensor 24 is arranged, which picks up reference signals with respect to the rotational movement.
- a transmitter 4c and a receiver 6c of the positioning system Ic are arranged.
- the transmitter 4c comprises a laser diode and a collimating optics, the receiver 6c a photodiode and a receiving optics.
- Transmission beams emitted by the transmitter 4c pass through the cylindrical hollow body 14c 'to the mirror 9c, where they are reflected.
- the transmitted beams reflected from reference objects again strike the mirror 9c and are reflected as receive beams to the receiver 6c.
- the transmit and receive beams are not shown.
- Transmitter 4c, receiver 6c and mirror 9c are arranged here such that the beam path of the transmission beams and the beam path of the reception beams are substantially parallel.
- the transmitter 4c and the receiver 6c are arranged as close to each other as possible, so that the transmit and receive beams are steerable over the same surface of the mirror 9c and without additional optical elements, which allows the formation of a less complex and compact system for distance measurement.
- the laser and photodiode of the positioning system are mounted on a printed circuit board 29, which further includes a microprocessor as a data processing unit.
- Transmitter 4c, receiver 6c and microprocessor form a rangefinder 12c.
- the microprocessor is additionally implemented as a computing and control unit for calculating the position of the positioning system Ic or of the tillage vehicle for which the positioning system Ic is used, and for deriving control instructions for the vehicle.
- an interface for communication with a computing and control unit could be formed on the rangefinder 12c and the computing and control unit be arranged outside the receptacle 14c.
- the receptacle 14c of the positioning system Ic is arranged like a pendulum on a support component 13c of the system.
- Carrier component 13c comprises a first gimbal 13c 'and a second gimbal 13c' ', via which
- Gimbals 13c 'and 13c' 'the receptacle 14c is gimballed so that it aligns vertically under the action of gravity. With the orientation of
- Recording 14c is of course also a corresponding
- FIGS. 6A to 6C show a positioning system according to the invention for various ground-handling vehicles. The representations of the figures are not to be considered as true to scale.
- Figure 6A shows in plan view a marking cart 2d as a tilling vehicle for producing ground-based markings 31 on a ground - e.g. on a sports field.
- a marking cart 2d as a tilling vehicle for producing ground-based markings 31 on a ground - e.g. on a sports field.
- ground cylindrical reflector rods 3g are placed as reference objects. These are scanned on the basis of the transmitted beams 5d of the positioning system Id arranged on the marking trolley 2d.
- the transmission beams are transmitted in a horizontal, rotating emission direction so that they span a horizontal beam plane 30.
- the tillage vehicle of FIG. 6B illustrates a slipform paver 2e when creating a coating layer 32 along a predetermined path.
- reflector rods 3h are arranged as reference objects.
- the reflector rods 3h may be arranged, for example, each 30 m apart.
- a positioning system Ie is mounted on the driver's cab of the slipform paver 2e.
- the positioning system emits radiation and continuously scans the environment for the reference objects based on the rotation of the radiation about a vertical axis 10e. By means of the radiation emitted and received by the positioning system, the distances to the reference objects and from this the position of the slipform paver 2e relative to these are determined.
- the predetermined path relative to the reflector bars 3h may be set, respectively, the reflector bars 3h may be positioned correspondingly, and the paver may be controlled relative to the reflector bars 3h.
- FIG. 6C shows an excavator 2f as a ground-handling vehicle with a positioning system If according to the invention.
- the positioning system If is - just as in the preceding Figures 6A and 6B - outlined only by a housing, which does not exclude, however, that e.g. the computing and control component of the positioning system If is arranged in the driver's cab and is in communication - via cable or radio - with the receiver or a data processing unit of the positioning system If.
- Four reflector rods 3i are positioned on the terrain T2 to be processed.
- the positioning system If continuously scans the environment around a vertical axis 10f by means of laser radiation. From the detected reflector rods 3i, the relative position of the excavator 2f and control instructions with respect to its positioning are derived in the computing and control component.
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Electromagnetism (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Environmental Sciences (AREA)
- Aviation & Aerospace Engineering (AREA)
- Life Sciences & Earth Sciences (AREA)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Guiding Agricultural Machines (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
Eine erfindungsgemässe Positionsbestimmungsvorrichtung (1b) für eine mobile, insbesondere selbstfahrende Arbeitsmaschine, weist eine Trägerkomponente (13b) zur Befestigung der Positionsbestimmungsvorrichtung (Ib) an der Arbeitsmaschine, eine sich unter Wirkung der Schwerkraft vertikal ausrichtenden, an der Trägerkomponente (13b) angeordneten Aufnahme (14b) und eine Rechen- und Steuerkomponente (30) zum Ableiten der Position der Arbeitsmaschine wenigstens aus den Empfangssignalen und zum Erzeugen von Steueranweisungen für die Arbeitsmaschine auf. Die Aufnahme ist ausgebildet mit einem Sender zur Emission von optischen Sendestrahlen (5b), einem Empfänger (6c) zum Empfangen von an Referenzobjekten reflektierten Sendestrahlen (5b) als Empfangsstrahlen (7b) und zum Erzeugen von Empfangssignalen sowie einem um eine vertikale Achse rotierbaren Umlenkmittel (9b) zum Lenken einerseits der Sendestrahlen (5b) in horizontale Richtungen, sodass eine im Wesentlichen horizontale Ebene aufgespannt wird, und andererseits der Empfangsstrahlen (7b) gegen den Empfänger. Der Sender und der Empfänger sind dabei Bestandteil eines Entfernungsmessers (12b), wobei aus den Empfangssignalen wenigstens die Entfernungen zu den Referenzobjekten nach dem Phasen- oder Pulslauf zeitmessprinzip bestimmt werden.
Description
Positionsbθstimmungsvorrichtung
Die Erfindung betrifft eine Positionsbestimmungsvorrichtung für eine mobile, insbesondere selbstfahrende Arbeitsmaschine nach dem Oberbegriff des Anspruchs 1, eine mobile Arbeitsmaschine und ein Positionsbestimmungssystem mit einer solchen Positionsbestimmungsvorrichtung sowie ein Positionsbestimmungsverfahren für eine mobile Arbeitsmaschine nach dem Oberbegriff des Anspruchs 17.
Mobile Arbeitsmaschinen werden in vielen Bereichen angewendet. Beispielsweise transportieren selbstfahrende Transportfahrzeuge Waren automatisiert von einem ersten Ort an einen zweiten Ort oder sollen Bodenbearbeitungsfahrzeuge, wie Rasenmäher, Markiergeräte, Reinigungsgeräte oder Baumaschinen, eine Bodenbearbeitung über einen vorgegebenen Bereich eines Terrains bzw. entlang eines vorgegebenen Weges durchführen. Um eine Bewegung des Fahrzeugs über den Bereich oder entlang des Weges zu erreichen, ist eine entsprechende Führung bzw. Steuerung des Fahrzeugs, die üblicherweise mittels Positioniersystemen realisiert wird, erforderlich. Die Positioniersysteme verwenden beispielsweise mechanische oder induktive Positionselemente zur Bereitstellung von Positionsinformationen für das Fahrzeug. Vorteile hinsichtlich Genauigkeit, Zeitbedarf und Handhabungsfreund- lichkeit bietet die Verwendung von optischen Positioniersystemen zur Positionsbestimmung und daraus Steuerung des Bodenbearbeitungsfahrzeugs.
So sind diverse optische Positioniersysteme bekannt, die auf einer Positionsbestimmung relativ zu Referenzobjekten basieren. Ein solches Positioniersystem umfasst eine Sende- und eine Empfangskomponente für Messungen anhand optischer Strahlung zu den Referenzobjekten - die beispielsweise
Reflektoren darstellen - welche Komponenten dem Bodenbearbeitungsfahrzeug zugeordnet, im Allgemeinen auf diesem montiert, sind. Aus den Messungen können Rückschlüsse über den Standort des Positioniersystems bzw. den Standort/die Position des Bodenbearbeitungsfahrzeugs relativ zu den Referenzobjekten abgeleitet werden. Die so bestimmte Position wird als Grundlage einer Steuerung des Fahrzeugs verwendet.
Sind die Referenzobjekte hinsichtlich ihrer Position bekannt, so kann die absolute Position des Fahrzeugs abgeleitet werden. Dies setzt jedoch Referenzobjekte voraus, die entweder hinsichtlich ihrer Position bekannt sein oder vermessen werden müssen. In vielen Fällen beispielsweise für Privatpersonen - ist eine solche Vermessung zu aufwändig und auch nicht notwendig, da oftmals die Kenntnis der Relativposition ausreichend ist.
Ein wichtiges Kriterium bei den optischen Positioniersystemen zur Positionsbestimmung relativ zu - im Allgemeinen mehreren - Referenzobjekten, ist die Messgeschwindigkeit. Meist müssen für eine eindeutige Positionsbestimmung Messungen zu zwei oder mehr Referenzobjekten erfolgen. Um das Bodenbearbeitungsfahrzeug gattungsgemäss genau führen zu können, sind also üblicherweise mehrere Messungen innerhalb eines vorgegebenen, im Verhältnis zur Fahrgeschwindigkeit des Fahrzeugs kleinen Zeitintervalls - z.B. drei Messungen pro Sekunde für eine Positionsbestimmung pro Sekunde - erforderlich.
Als optische Positioniersysteme für Bodenbearbeitungsfahrzeuge sind Positioniersysteme mit Triangulationssensoren bekannt. Mittels der Triangulationssensoren werden anhand von Winkelmessungen zu reflektiven Referenzobjekten die Richtungen zu den
Referenzobjekten und daraus die Position des Positioniersystems respektive Bodenbearbeitungsfahrzeugs gegenüber diesen bestimmt.
So beschreibt die US 5,426,584 ein Steuersystem für einen Rasenmäher als Bodenbearbeitungsfahrzeug mit einem Triangulationssensor zur Bestimmung der Position des Rasenmähers gegenüber reflektiven Referenzpunkten. Der Triangulationssensor umfasst eine Laserquelle zur Emission von Laserstrahlen und einen Strahl-Scanner zur Erzeugung einer im Wesentlichen horizontalen, rotierenden Emissionsrichtung der Strahlen, sodass die Strahlen gegen die Referenzpunkte gelenkt werden. Die an den Referenzpunkten reflektierten Strahlen werden von einem Detektor des Triangulationssensors detektiert und in Bezug auf die Horizontalwinkel zwischen den Referenzpunkten ausgewertet. Damit die Strahlen auch dann in die horizontale Richtung gelenkt werden, wenn der Rasenmäher über Unebenheiten, wie Wellen oder Senken, des Terrains fährt, ist der Strahl-Scanner kardanisch aufgehängt.
Um die Winkel mit der erforderlichen Genauigkeit bestimmen zu können, müssen die Messungen zu genau festgelegten - quasi punktförmigen - Referenzpunkten erfolgen. Fährt der Rasenmäher über unebenes Terrain, so werden die Strahlen zwar aufgrund der kardanischen Aufhängung horizontal emittiert, die Referenzpunkte aber - aufgrund des Niveuunterschieds - dennoch nicht getroffen. Deshalb ist der Strahl-Scanner mit einem zusätzlichen Präzessionsmechanismus für eine Scanbewegung der Strahlen in vertikaler Richtung ausgebildet. Die Scanbewegung ist jedoch nicht exakt kontrollierbar, was Ungenauigkeiten in der Messung und damit in der Positionsbestimmung und Steuerung des Rasenmähers bewirkt.
- A -
Die US 6,556,598 zeigt ein ähnliches System zum Bestimmen der Position eines Rasenmähers gegenüber Referenzpunkten nach dem Prinzip der Triangulation. Das System umfasst eine pendelnd aufgehängte Laser-Projektionseinheit mit einem Laser zur Emission von Laserstrahlung und einem um eine vertikale Achse rotierenden Spiegel zum Erzeugen einer rotierenden Emissionsrichtung der Strahlung. Die Laserstrahlung wird gegen die Referenzpunkte gerichtet und die an den Referenzpunkten reflektierte Strahlung zu einem Detektor des Systems gelenkt. Damit die Referenzpunkte exakt getroffen werden und der Auftreffpunkt der Strahlung genau bestimmbar ist, wird die Strahlung durch zusätzliches Rotieren des Spiegels um eine horizontale Achse auch in vertikaler Richtung kontrolliert rotiert. Die exakten - horizontalen und vertikalen - Rotationswinkel des Spiegels werden mittels Winkelencodern gemessen und in die Winkelbestimmung der Referenzpunkte einbezogen. Die Ausbildung des Systems, sowie die Datenauswertung sind also äusserst komplex.
Die US 5,011,288 offenbart ein Positionskontrollsystem für ein bewegtes Fahrzeug. Das System weist einen Sender mit einer Laserquelle zum Emittieren von Laserstrahlung in alle azimutalen Richtungen und einen Empfänger zum Empfang von an Referenzobjekten reflektierten Strahlen auf. Der Sender und der Empfänger sind auf einem rotierenden Tisch befestigt, sodass in alle Richtungen gescannt wird. Aus Empfangssignalen des Empfängers werden nach dem Phasenmessprinzip die Distanzen zu den Referenzobjekten bestimmt. Zusätzlich werden mithilfe eines Winkelencoders und den Empfangssignalen die azimutalen Winkel jeweils zwischen den Referenzobjekten ermittelt. Aus den Positionen und den Winkeln wird die relative Position des Fahrzeugs abgeleitet und gegebenenfalls zum Steuern desselben
verwendet. Der Aufbau mit einem rotierenden Tisch ist sehr aufwändig und sperrig. Ebenso ist dieser Aufbau für eine exakte Positionsbestimmung zum Steuerung des Fahrzeugs untauglich, da hierfür mindestens etwa eine Positionsbestimmung eines jeden Referenzobjekts pro Sekunde notwendig ist. Der rotierende Tisch mit dem klobigen Aufbau ist für die dafür geforderte Winkelgeschwindigkeit sehr unpraktisch und ungeeignet. Darüber hinaus können bei Unebenheiten im Gelände die Reflektoren aus dem Scannbereich des Laserstrahls fallen.
Die WO 2004/026538 beschreibt eine Methode für eine mobile Arbeitsmaschine zum automatischen Ausführen von Aufgaben. Die Arbeitsmaschine weist dazu eine Positionsbestimmungseinrichtung mit einem Sender, einem Empfänger und einem rotierenden Umlenkmittel auf, wobei die Komponenten so gelagert sind, dass sich eine vertikale Ausrichtung ergibt. Die emittierten Strahlen werden durch das Umlenkmittel nun in alle horizontalen Richtungen gelenkt, an Referenzobjekten reflektiert und durch den Empfänger detektiert. Daraus werden Winkelinformationen für die Referenzobjekte abgeleitet. Zusätzlich werden vom Sender beabstandet durch ein optisches System mit einem weiteren Detektor Reflexe empfangen und die Richtung, aus welcher der Reflex kommt, detektiert. Mittels geometrischen Berechnungen werden Distanzen zu den Referenzobjekten ermittelt und die Position der Maschine bestimmt, wobei die Position dann zum Steuern der Maschine verwendet wird. Der Aufbau mit den mehreren Empfängern sowie die nötigen Berechnungen sind sehr aufwändig und kompliziert. Ebenso ist die Erfindungsidee in der WO 2004/026538 auf eine verhältnismässig grobe Positionsbestimmung gerichtet, mittels welcher beispielsweise eine Eingrenzung eines Arbeitsgebietes für eine mobile Maschine erfolgt. Für eine
präzise und mit hoher Wiederholungsrate erfolgende Positionsbestimmung ist die beschriebene Methode hingegen eher ungeeignet.
Die Aufgabe der Erfindung ist es, Nachteile des Standes der Technik zu beheben und eine wenig komplexe und einfach zu handhabende Positionsbestimmungsvorrichtung für eine mobile Arbeitsmaschine, sowie eine mobile Arbeitsmaschine mit einer solchen Positionsbestimmungsvorrichtung zur Verfügung zu stellen.
Eine weitere Aufgabe ist die Bereitstellung eines präzisen Positioniersystems für eine Sportplatzmarkierungsmaschine, sodass eine automatische und exakte Steuerung und dadurch eine genau vorgebbare Ausbringung einer Markierungssubstanz ermöglicht werden.
Diese Aufgaben werden durch die Gegenstände der Ansprüche 1, 12, 14 und 17 oder der davon abhängigen Ansprüche gelöst bzw. die Lösungen weitergebildet.
Die Erfindung basiert auf der konsequenten Integration einer optisch entfernungsmessenden Funktionalität in ein Positioniersystem für eine mobile Arbeitsmaschine wie zum Beispiel ein Bodenbearbeitungsfahrzeug. Indem die optische Entfernungsmessung nach dem Pulslaufzeit- oder Phasenmessprinzip und deren Vorteile für die Arbeitsmaschine anwendbar gestaltet werden, wird ein Positioniersystem geringer Komplexität zur gattungsgemäss genauen Positionsbestimmung bereitgestellt.
Die Positionsbestimmung beruht auf Entfernungsmessungen zu Referenzobjekten - das erfindungsgemässe Positioniersystem ist ein sogenanntes „self-positioning system". Anhand der Entfernungsmessungen können die Position die Arbeitsmaschine gegenüber den Referenzobjekten festgestellt
und daraus Steueranweisungen für die Arbeitsmaschine abgeleitet werden.
Das erfindungsgemässe Positioniersystem verfügt über einen Sender zur Emission von optischen Sendestrahlen, insbesondere Laserstrahlen, die gegen die Referenzobjekte gerichtet werden. Die Sendestrahlen werden nach ihrer Aussendung und nachfolgenden Reflexion an den Referenzobjekten mittels eines Empfängers des Positioniersystems wieder erfasst, wobei aus den Empfangs- Signalen des Empfängers die Entfernungen zu den Referenzobjekten, insbesondere nach dem Phasenmessprinzip oder dem Prinzip der Pulslaufzeitmessung, bestimmt werden.
Das Richten der Sendestrahlen gegen die Referenzobjekte und der reflektierten Strahlen als Empfangsstrahlen gegen den Empfänger erfolgt mittels eines Umlenkmittels des Positioniersystems. Das Umlenkmittel ist dabei zum Erzeugen einer horizontalen und rotierenden Emissionsrichtung der Sendestrahlen ausgebildet und um eine vertikale Achse rotierbar angeordnet.
Aus den gemessenen Entfernungen, die Positionsinformationen der Referenzobjekte darstellen, werden weiters mittels einer Rechen- und Steuerkomponente des Positioniersystems die Position des Bodenbearbeitungsfahrzeugs relativ zu den Referenzobjekten abgeleitet und aus der Kenntnis der Position Steueranweisungen für das Bodenbearbeitungsfahrzeug zumindest in Bezug auf dessen Fahrweg erzeugt. Sind die Referenzobjekte in einem Koordinatensystem eingemessen, so kann die Position des Bodenbearbeitungsfahrzeugs in diesem Koordinatensystem be- stimmt werden und das Fahrzeug beispielsweise entsprechend einem im Koordinatensystem vorgegebenen Weg gesteuert werden. Bei nicht eingemessenen Referenzobjekten erfolgt
die Steuerung des Fahrzeugs relativ zu den Referenzobjekten. Die Grenzen der zu bearbeitenden Fläche, die das Bodenbearbeitungsfahrzeug relativ zu den Referenzobjekten abfahren soll, kann von der Rechen- und Steuerkomponente z.B. im Rahmen einer Lernfahrt gespeichert werden. Die Rechen- und Steuerkomponente kann auch ein Steuerprogramm aufweisen, welches verschiedene Eingabeparameter berücksichtigt. Beispielsweise können verschiedene Fahrmuster für die zu bearbeitenden Fläche abgespeichert sein.
Der Sender und der Empfänger des Positioniersystems sind Bestandteil eines Entfernungsmessers. Als Entfernungsmesser wird beispielsweise eine Vorrichtung in der Art des unter dem Produktnamen „Disto" vertriebenen Laserentfernungs- messers der Firma Leica Geosystems, Schweiz, eingesetzt. Dem Entfernungsmesser ist zusätzlich eine Datenverarbeitungseinheit zugeordnet. Diese kann durch die vorgängig erwähnte Rechen- und Steuerkomponente realisiert bzw. in diese integriert sein. Alternativ können die Datenverarbeitungseinheit ein Bauteil des Entfernungsmessers und die Rechen- und Steuerkomponente ein weiteres, vom Entfernungsmesser separates Bauteil des Positioniersystems darstellen. Die
Datenverarbeitungseinheit ist zum Bestimmen der Entfernungen aus den Empfangssignalen vorgesehen. Beispielsweise wird ein Mikrokontroller als Datenverarbeitungseinheit verwendet, wobei der Mikrokontroller insbesondere auch zur Frequenzsteuerung von Sender und/oder Empfänger ausgebildet ist.
In einer Ausführungsform der Erfindung ist das Positioniersystem zur Entfernungsmessung nach dem Phasenmessprinzip ausgeführt. Dazu werden die Sendestrahlen
des Senders mit einer hochfrequenten Modulationsfrequenz intensitätsmoduliert . Die an einem Referenzobjekt reflektierten Sendestrahlen werden vom Empfänger empfangen und anschliessend zum Erzeugen eines niederfrequenten Messsignals für die Datenauswertung mit einer Mischerfrequenz gemischt. Um die Entfernung zu bestimmen, wird die Phasendifferenz des Messsignals mit einem Referenzsignal gebildet.
Um mit dem erfindungsgemässen Positioniersystem entsprechend durch Auswertung der Phasenlage der Signale die Entfernungen messen zu können, werden die Parameter der Entfernungsmessung in Bezug auf die Anwendung für das Bodenbearbeitungsfahrzeug angepassst. Da für eine präzise Steuerung eines Bodenbearbeitungsgerät Positionsbestimmungen in kurzen Zeitintervallen, wie etwa eine Positionsbestimmung pro Sekunde, durchgeführt werden müssen und für eine Positionsbestimmung im Allgemeinen zwei oder mehr Messungen zu Referenzobjekten erforderlich sind, ist die Rotationsgeschwindigkeit des Umlenkmittels re- spektive der Sendestrahlen entsprechend hoch. Beispielsweise führt das Umlenkmittel drei volle (360°) Umdrehungen pro Sekunde durch. Dies bedingt jedoch eine äusserst kurze Signalzeit - z.B. um den Faktor 1000 kürzer als für einen üblichen Entfernungsmesser - der Sende- und Empfangsstrahlen für die Entfernungsmessung. Um nun dennoch auswertbare Empfangssignale zu erhalten, wird die niederfrequente Phasenmessfrequenz im Vergleich zu einer in einem üblichen Entfernungsmesser, wie dem „Disto", verwendeten Phasenmessfrequenz - die im Bereich von einigen kHz liegt - erhöht - beispielsweise auf eine Phasenmessfrequenz im Bereich von 100 kHz. Damit können auch für kurze Signalzeiten - z.B. von etwa 100 μs - ausreichend viele Signalperioden für die Phasenmessung erfasst werden.
In einer Weiterbildung der Erfindung werden zusätzlich zu den Entfernungen auch die Winkel der Referenzobjekte zueinander berücksichtigt. Mit bekannter Fahrtrichtung des Bodenbearbeitungsfahrzeugs können weiters auch die Winkel der Referenzobjekte zur Fahrtrichtung des Fahrzeugs bestimmt werden. Die Winkel sind aus der konstanten Rotationsgeschwindigkeit des Umlenkmittels und den Empfangssignalen des Empfängers ableitbar. Zur Steigerung der Messgenauigkeit können zusätzlich Mittel zum Erfassen/Überwachen der Rotationsgeschwindigkeit eingesetzt werden, wie z.B. eine Lichtschranke zum Abgreifen von Referenzsignalen für die Winkelbestimmung. Damit sind die Rotationsgeschwindigkeit regelbar, sowie Unregelmässig- keiten in der Rotationsbewegung - ein „Eiern" berücksichtig- und korrigierbar. In einer Ausführungsform der Erfindung werden bei einer 360 "-Rotation des Umlenkmittels vier Referenzsignale abgegriffen.
Als Referenzobjekte, zu denen die Entfernungs- und ggf. Winkelmessungen erfolgen, eignen sich insbesondere kooperative Objekte, die im Vergleich zu nicht-kooperativen Objekten einen, z.B. 50fach, höheren Reflexionsgrad aufweisen. Derartige Referenzobjekte können anhand ihres Reflexionsvermögens vom Hintergrund unterschieden werden, sodass die Positionen der Referenzobjekte bereits aus der Schwankung in der Intensität der an den Objekten reflektierten Strahlung festgelegt werden können. Anhand der Bestimmung der Entfernung und ggf. des Winkels bei den Intensitätsmaxima ist mit bekannten Verfahren, wie sie beispielsweise auch in der Photogrammetrie verwendet werden, die Position des Positioniersystems respektive Bodenbearbeitungsfahrzeugs relativ zu den Referenzobjekten ableitbar. Ein Beispiel hierfür stellen Korrelationsverfahren bzw. Korrelationsrechnungen dar.
Die kooperativen Referenzobjekte weisen eine reflektive Oberfläche auf, die z.B. aus Tripelprismen, Mikrolinsen, Glaskugeln, reflektierender Folie oder anderen üblichen Reflexionselementen ausgebildet ist. Da für das erfindungsgemässe Positioniersystem keine quasipunktförmigen Reflektoren benötigt werden, können vorteilhaft in der Höhe erstreckte Referenzobjekte, wie Reflektorstäbe, eingesetzt werden, sodass keine Zielsuche in vertikaler Richtung durchgeführt werden muss. Ge- gebenenfalls können als Referenzobjekte auch alternative, optische Strahlung reflektierende Ziele, wie z.B. weisse Hauswände, verwendet werden. Solche Ziele wie Hauswände oder andere - vorzugsweise nicht oder schwer verschiebbare - Objekte können insbesondere zur - langsameren - Überprüfung der Referenzobjekte herangezogen werden. Damit können Abweichungen - z.B. aufgrund von Verschiebungen - der Positionen der Referenzobjekte erkannt und das Positioniersystem in Bezug auf die Referenzobjekte rekalibriert werden.
Die Anzahl der benötigten Referenzobjekte ist abhängig von deren Lage, der Beschaffenheit des zu bearbeitenden Terrains, und der beabsichtigten Genauigkeit der Messung. Im Regelfall werden aber, abgesehen von besonders günstigen Konstellationen, mindestens 3 oder 4 Referenzobjekte benötigt. Wird zusätzlich ein Winkel berücksichtigt, kann die Zahl der Referenzobjekte auf zwei reduziert werden. Bei speziellen Rahmenbedingungen - z.B. wenn das Bodenbearbeitungsfahrzeug auf eine Docking Station zufährt, kann die Positionierung des Fahrzeugs auch mit einem einzigen Referenzobjekt erfolgen. Die Anzahl der benötigten Referenzobjekte kann auch reduziert werden, indem die Referenzobjekte voneinander unterscheidbar gestaltet werden, beispielsweise durch Aufbringen von Codierungen
oder durch Filter. Beispielsweise sind in einer erfindungsgemässen Ausführungsform Referenzpfosten mit unterschiedlichen Durchmessern als codierte Referenzobjekte vorgesehen. Anhand der Entfernungsmessung, der Rotationsgeschwindigkeit des Umlenkmittels und den unterschiedlichen Signalbreiten können die Pfostendurchmesser ermittelt und die verschiedenen Referenzpfosten identifiziert werden. Alternativ können zum Erzeugen desselben Effekts auch zwei Pfosten nebeneinander platziert werden.
Die jeweils tatsächlich benötigte Zahl an Referenzobjekten ist zusätzlich abhängig von möglichen Einschränkungen zur Reduzierung einer Mehrdeutigkeit. Bei drei Entfernungsmessungen zu den verschiedenen Referenzobjekten wird durch die drei Entfernungen eine Ebene definiert, an der die zu bestimmende Relativposition gespiegelt werden kann. Als Lösung ergeben sich zwei mögliche Positionen, von denen aber meist eine Position aus Plausibilitätsgründen, z.B. weil sie unter der Erdoberfläche liegen würde, oder aufgrund einfacher weiterer Informationen ausgeschlossen werden kann, wie z.B. der Unterscheidung zwischen Nord und Süd, die auch durch einen einfachen Magnetkompass getroffen werden kann. Die Menge der Referenzobjekte wird insbesondere so gewählt, dass nach Möglichkeit von jedem Punkt des zu bearbeitenden Terrains aus wenigstens zwei der Referenzobjekte erfasst werden können.
Werden kooperative Reflektorpfosten mit bekanntem Durchmesser als Referenzobjekte verwendet, so kann zusätzlich aus der Rotationsgeschwindigkeit und den Empfangssignalen ein azimutaler Ausdehnungswinkel jeweils für die Reflektorpfosten bestimmt werden, da die ausgedehnten Reflektorpfosten keinen punktförmigen Reflex,
sondern ein ausgedehntes Reflexionssignal erzeugen. Somit kann aus der Breite jeweils der Empfangssignale für jeden Reflektorpfosten der azimutale Winkel, innerhalb welchem Reflexe von jeweils einem Reflektorpfosten empfangen werden, ermittelt werden. Bei bekanntem Durchmesser eines Reflektorpfostens kann aus dem von der Arbeitsmaschine aus ermittelten azimutalen Ausdehnungswinkel des Pfostens nun eine grobe Entfernung dieses Pfostens zur Arbeitsmaschine berechnet werden. Beispielsweise erfolgt eine solche Berechnung anhand des Tangenssatzes.
Die derart ermittelten Grobentfernungen sind z.B. für die präzise Entfernungsmessung nach dem Phasenmessprinzip verwendbar. Da - wie vorgängig beschrieben - bei der erforderlichen hohen Scanngeschwindigkeit Reflexe für nur sehr kurze Zeiten empfangen werden, können zur Auflösung von Phasenmehrdeutigkeiten, für welche sonst ausreichend viele Signalperioden empfangen werden müssen, die ermittelten Grobentfernungen berücksichtigt werden. Dadurch können sehr schnelle Scanngeschwindigkeiten und somit auch eine hohe Positionsbestimmungsrate erreicht werden. Dies wiederum ermöglicht eine präzisere und schnellere Positionsbestimmung für die Arbeitsmaschine und somit eine genauere Steuerung derselben.
Eine weitere Möglichkeit zur Verwendung der Grobentfernungen ist eine Überprüfung der durch die
Pulslaufzeit- oder Phasenmessung erhaltenen Distanzen auf
Relevanz. So können beispielsweise fehlerbehaftete
Messungen erkannt und für die Positionsbestimmung unberücksichtigt bleiben. Dadurch kann z.B. eine Fehlerwahrscheinlichkeit bei der Steuerung der
Arbeitsmaschine vermindert werden.
Verliert beispielsweise die mobile Arbeitsmaschine einmal ihre Position durch eine Fehlfunktion - z.B. Störung durch Blitzschlag, unsachgemässe Behandlung oder Verschieben von Hand - kann es schwierig sein, die Position relativ zu den Referenzobjekten wieder zu finden. Um die Arbeitsmaschine nicht händisch neu initialisieren oder an eine Ausgangsposition zurückführen zu müssen, können die Grobentfernungen zur groben Positionsbestimmung verwendet werden, damit sich die Arbeitsmaschine basierend auf diese Grobpositionierung wieder mit einem internen Geländeplan synchronisieren kann.
Ebenso können zur Überbrückung kurzfristiger Sichtverluste zu den Referenzobjekten und/oder zur Identifikation der erfassten Referenzobjekte dem Positioniersystem respektive der Arbeitsmaschine weitere Komponenten zur Positionsbestimmung zugeordnet sein. Beispielsweise weist das Positioniersystem zusätzlich Komponenten zur Richtungsmessung, wie einen Kompass, und/oder Inertialsensoren, die eine Veränderung bezüglich einer bekannten Startposition registrieren, auf. Ebenfalls möglich ist die Anbringung eines GPS-Sensors. Mit einem GPS-Sensor kann die Position des Positioniersystems grob und anhand einer Entfernungs- und ggf. Winkelmessung auf ein Referenzobjekt genau bestimmt werden.
Der Sender des erfindungsgemässen Positioniersystems umfasst eine Strahlungsquelle, insbesondere einen Laser, und eine Sendeoptik - Kollimationsoptik - zum Aussenden eines kollimierten Sendestrahlenbündels für die Entfernungsmessung. Ein Laser als Sender ist zur Emission von Sendestrahlen in einem vorgegebenen Wellenlängenbereich ausgebildet. In einer Ausführungsform der Erfindung wird als Sender ein Laser, der Sendestrahlen im nicht-sichtbaren
Wellenlängenbereich, z.B. im Bereich zwischen 790 nm und 950 nm, insbesondere Sendestrahlen der Wellenlänge von 850 nm, aussendet, eingesetzt. Neben einem nicht-sichtbare Strahlung emittierenden Sender kann eine zusätzliche sichtbare Strahlungsquelle vorgesehen werden, die z.B. bei einer Lernfahrt des Positioniersystems verwendet werden kann, damit ein Benutzer den unsichtbaren Strahl nicht unbewusst abdeckt. Damit kann auch die Sichtverbindung des Positioniersystems zu den zur Positionsbestimmung benötigten Referenzobjekten visuell überprüft werden.
Der Empfänger weist eine Empfangsoptik sowie ein für die Emissionswellenlänge des Senders sensitives Empfangselement auf. Insbesondere ist das Empfangselement eine Photodiode, z.B. eine Pin-Diode oder eine Avalanche-Diode .
Für Entfernungsmessungen nach dem Phasenmessprinzip weist der Entfernungsmesser mit dem Sender und dem Empfänger als Bestandteile weitere in Bezug auf die Phasenmessung übliche Komponenten auf. So sind beispielsweise ein Strahlteiler zum Abzweigen eines Teils der Sendestrahlen als Referenzstrahlen sowie ein Referenzempfänger zum Empfangen der Referenzstrahlen nach Durchlaufen eines Referenzweges vorgesehen. Im Referenzweg können weitere optische Elemente angeordnet sein. Weitere verwendete oder verwendbare Komponenten sind Frequenzmischer und Phasenmesser.
Um die Sendestrahlen des Senders in die rotierende Emissionsrichtung zu lenken, ist das Umlenkmittel des Positioniersystems wie vorgängig erwähnt um eine vertikale Achse rotierbar angeordnet. Weiters ist das Umlenkmittel derart ausgebildet und gegenüber dem Sender angeordnet, dass die Sendestrahlen im Wesentlichen in einer Horizontalebene rotiert werden. Insbesondere erfolgt die Rotation kontinuierlich um 360°. Bei kontinuierlicher 360°-
Rotation des Umlenkmittels wird durch die Sendestrahlen die Umgebung ringsum das Positioniersystem gleichmässig nach Referenzobjekten abgetastet, sodass in der Horizontalebene gelegene Objekte, die nicht durch Hindernisse verdeckt sind, erfasst werden.
Das Umlenkmittel ist durch ein optisches Reflexionselement, wie einen Spiegel oder ein Prisma, realisierbar. Das Reflexionselement ist rotierbar ausgeführt, beispielsweise indem es in, an oder auf einem Rotationselement angeordnet ist, welches durch einen Antrieb in Rotationsbewegung versetzt wird. Der Antrieb erfolgt motorisch. Zum Antrieb können ausser dem Motor Komponenten wie Zahn- oder Reibriemen, oder Zahnräder als Antriebsmittel eingesetzt sein.
In einer Ausführungsform des erfindungsgemässen Positioniersystems ist ein Spiegel als Umlenkmittel in einem Winkel von 45° an einem Hohlkörper als Rotationselement, durch welchen die Sende- bzw. Empfangsstrahlen zum Umlenkmittel bzw. zum Empfänger geführt werden, angeordnet. Der Hohlkörper wird über einen Motor und einen Zahnriemen mit einer festen Rotationsgeschwindigkeit um die vertikale Achse durch seinen Schwerpunkt rotiert.
Um die Horizontalität der Sendestrahlen auch dann zu gewährleisten, wenn das Bodenbearbeitungsfahrzeug über
Unebenheiten, wie Wellen und Senken, eines Terrains oder ein Terrain mit unterschiedlichen Niveaus fährt, sind
Sender, Empfänger und Umlenkmittel des erfindungsgemässen
Positioniersystems in bzw. an einer Aufnahme angeordnet, die pendelartig an einer Trägerkomponente angeordnet ist.
Durch die pendelartige Anordnung der Aufnahme erfolgt eine
Ausrichtung derselben - und damit auch von Sender,
Empfänger und Umlenkmittel - unter der Wirkung der Schwerkraft, also vertikal. Infolge der schwer- kraftbeeinflussten vertikalen Ausrichtung von Sender, Empfänger und Umlenkmittel werden die Entfernungsmessungen in den verschiedenen Stellungen des Bodenbearbeitungsfahrzeugs in einer Ebene, die im Wesentlichen horizontal ist, durchgeführt.
Die pendelartige Anordnung kann auf unterschiedliche Art und Weise realisiert werden. Beispielsweise ist die Trägerkomponente als Platte mit einer rahmenartigen
Konstruktion oder einer Halterung, in welcher die Aufnahme in zwei Richtungen - schwingbar aufgehängt ist, ausgeführt. Die Trägerkomponente kann einen Kardanring bzw.
-ringe für eine kardanische Aufhängung der Aufnahme aufweisen. Alternativ kann die Trägerkomponente eine entsprechende Lageraufnahme aufweisen, in welcher die Aufnahme gelagert ist, beispielsweise über ein oder zwei Lager, wie Kugellager oder ein Kugelgelenk mit z.B. zwei rotatorischen Freiheitsgraden. Die Trägerkomponente ist auch durch ein Bauteil des Bodenbearbeitungsfahrzeugs bildbar.
Die Aufnahme kann aus mehreren Bauteilen, z.B. Gehäusen oder Gehäuseteilen, zusammengesetzt, oder aber einstückig ausgebildet sein. Beispielsweise stellt die Aufnahme ein Gehäuse dar, in welchem der Sender und der Empfänger fest und das Umlenkmittel rotierbar angeordnet sind. Eine solche Ausbildung umfasst weiters eine Öffnung, wie ein Fenster, für die Sende- und Empfangsstrahlen. In einer anderen Ausführungsform umfasst die Aufnahme ein Gehäuse für den Sender und den Empfänger, einen Hohlkörper, durch welchen die Sende- und Empfangsstrahlen in Richtung des Umlenkmittels geleitet werden, sowie ein auf dem Hohlkörper
drehbar angeordnetes Rotationselement, auf welchem das Umlenkmittel mittels eines Halters positioniert ist.
In einer Weiterbildung der Erfindung erfolgt die Anordnung von Sender, Empfänger und Umlenkmittel des erfindungsgemässen Positioniersystems derart, dass ein möglichst kompaktes und stabiles System bereitgestellt wird. Indem die Anordnung so gewählt wird, dass die
Strahlführung über vergleichsmässig wenige optische
Elemente erfolgt, werden die Komplexität des Systems sowie Strahlungsverluste gering gehalten.
So sind in einer Ausführungsform des erfindungsgemässen Positioniersystems der Sender, der Empfänger und das Umlenkmittel derart angeordnet, dass der Strahlengang der Sendestrahlen und der Strahlengang der Empfangsstrahlen im Wesentlichen parallel sind. Dazu sind Sender und Empfänger möglichst nahe nebeneinander und gegenüber dem Umlenkmittel so angeordnet, dass die vom Sender emittierten Sendestrahlen auf eine Umlenkfläche des Umlenkmittels treffen, an der Umlenkfläche in Richtung der Re- ferenzobjekte reflektiert werden, und die von den Referenzobjekten reflektierten Strahlen über dieselbe Umlenkfläche zum Empfänger reflektiert werden.
In einer weiteren Ausführungsform sind der Sender, der Empfänger und das Umlenkmittel derart angeordnet, dass die Sendestrahlen und die Empfangsstrahlen koaxial sind.
In einer weiteren Ausführungsform erfolgt die Anordnung von Sender, Empfänger und Umlenkmittel derart, dass der Strahlengang der Sendestrahlen zwischen Sender und Umlenkmittel und der Strahlengang der Empfangsstrahlen zwischen Umlenkmittel und Empfänger und die vertikale Achse, um die das Umlenkmittel rotiert und die
beispielsweise eine Rotationsachse durch den Schwerpunkt der Anordnung darstellt, im Wesentlichen parallel und gegebenenfalls koaxial sind. Solche Anordnungen sind für verschiedene Entfernungsmesser an sich bekannt.
Das erfindungsgemässe Positioniersystem kann zum Schutz der Systemkomponenten ein Schutzgehäuse, z.B. ein kuppelartiges Plastik-Gehäuse, aufweisen. Das Gehäuse ist vorzugsweise transparent ausgeführt oder weist entlang seines Umfangs ein Fenster für die Sende- und Empfangsstrahlen des Systems auf. Das Positioniersystem ist beispielsweise auf einer Plattform des Bodenbearbeitungsgeräts montiert. Ebenso kann ein Bodenbearbeitungsgerät zur integrierten Aufnahme des Positioniersystems ausgebildet sein. Z.B. ist die Ausbildung derart, dass ein Teil des Systems in das Bodenbearbeitungsfahrzeug eingesetzt - versenkt - wird.
Indem das erfindungsgemässe Positioniersystem als kompaktes, handliches und vergleichsweise kleines und leichtes System ausgebildet ist - was vorteilhaft mit einer Verwendung eines Entfernungsmessers gemäss dem vorgängig erwähnten „Disto" realisierbar ist - kann ein Bodenbearbeitungsfahrzeug, welches z.B. einen Rasenmäher darstellt, zur modulartigen Aufnahme des Positioniersystems ausgebildet werden. Ebenfalls kann ein Bodenbearbeitungsfahrzeug in einfacher Art und Weise mit dem erfindungsgemässen Positioniersystem auf- oder umgerüstet werden. Die Verwendung eines Entfernungsmessers gemäss dem „Disto" birgt weiters den Vorteil, dass dieser bereits als vollständiges System zur Entfernungsmessung verfügbar ist und lediglich eine Schnittstelle zur Kommunikation mit der Rechen- und Steuereinheit vorzusehen oder aber die Rechen- und Steuerkomponente - z.B. in Form einer entsprechenden Software - in den Entfernungsmesser
respektive dessen Datenverarbeitungseinheit zu integrieren ist.
Das erfindungsgemässe Positioniersystem ist für die Anordnung am Bodenbearbeitungsgerät zusätzlich dadurch optimiert, dass die Rotation der Sendestrahlen mit der Rotation lediglich des Umlenkmittels verwirklicht wird. Damit werden unter anderem Probleme der Kabelführung vermieden. So kann bei einer - z.B. an einer für einen Bediener günstigen Position - im Bodenbearbeitungsgerät angeordneten Rechen- und Steuerkomponente eine Kommunikation zum Sender und Empfänger bzw. zur Datenverarbeitungseinheit einfach über Kabelverbindungen erfolgen.
Das Bodenbearbeitungsfahrzeug, für welches das erfindungsgemässe Positioniersystem vorgesehen ist, kann im Prinzip jedes bewegliche Gerät/Fahrzeug darstellen. Beispielsweise wird das Positioniersystem auf einem Rasenmäher, der selbständig ein Terrain abfährt, oder auf einem Markiergerät zum Erzeugen von Markierlinien und/oder -flächen eingesetzt. Ebenso kann das Positioniersystem zum Navigieren von Baumaschinen, wie Bagger, Fertiger oder Lastwagen, verwendet werden. Eine weitere günstige Einsatzmöglichkeit für das erfindungsgemässe Positioniersystem stellt die Verwendung desselben auf einem Reinigungsgerät dar. Wird das Reinigungsgerät z.B. in einer Tiefgarage eingesetzt, können bereits vorhandene Pfosten vorteilhaft als Referenzobjekte verwendet werden. Dazu kann ggf. eine reflektive Beschichtung, wie eine Reflexfolie, auf den Pfosten angebracht werden.
Vorteilhaft ist dieses System für Arbeitsmaschinen anzuwenden, die im Allgemeinen auf ebenem Terrain zum Einsatz kommen. Eine sichergestellte ständige und gute
Sichtverbindung zu allen aufgestellten Reflektoren ermöglicht mit der erfindungsgemässen Positionsbestimmungsvorrichtung eine sehr präzise und zuverlässige Positionierung mit einer hohen Wiederholungsrate, sodass vorgegebene Linien, entlang welchen die mobile Maschine fahren soll, exakt einhaltbar sind. Sehr gut eignet sich deshalb ein erfindungsgemässes Positionierbestimmungssystem z.B. zum Einsatz für Sportplatzmarkierungsarbeiten. Beispielsweise können vier Reflektorpfosten mit bekanntem Durchmesser in den Ecken eines Sportplatzes positioniert werden, sodass eine gute Sichtverbindung von jedem Punkt auf dem Sportplatz zu jedem der Reflektoren gegeben ist. Mittels der erfindungsgemässen Positionsbestimmungsvorrichtung können nun mit einer hohen Wiederholungsrate fortlaufend Positionen einer Markierungsmaschine hochpräzise bestimmt und somit die Maschine exakt gesteuert werden, sodass dadurch Sportplatzmarkierungen automatisiert und sehr präzise aufbringbar sind.
Insbesondere können die erfindungsgemässe Positionsbestimmungsvorrichtung und das Positionsbestimmungsverfahren jedoch auch in anderen Bereichen Anwendung finden. So kann beispielsweise das Positionsbestimmungsverfahren für beliebige Objekte wie z.B. ein Möbel, verwendet werden, deren Positionen z.B. in einem Raum bestimmt oder welche auf einem Terrain exakt positioniert werden sollen. Dazu kann die Positionsbestimmungsvorrichtung an einem Objekt angebracht und anschliessend erfindungsgemäss dessen Position relativ zu aufgestellten Reflektoren bestimmt werden.
Die Erfindung wird nachfolgend anhand von in den Zeichnungen schematisch dargestellten Ausführungsbeispielen rein beispielhaft näher beschrieben. Im Einzelnen zeigen
Fig. 1 ein erfindungsgemässes Bodenbearbeitungsfahr- zeug, Positioniersystem und Referenzobjekt;
Fig. 2 einen Ausschnitt des Positioniersystems aus Fig. 1 und ein Referenzobjekt auf Fig. 1;
Fig. 3 ein typisches Empfangssignal eines erfindungsgemässen Positioniersystems ;
Fig. 4 ein Ausführungsbeispiel eines erfindungsgemässen Positioniersystems ;
Fig. 5A - 5D ein weiteres Ausführungsbeispiel eines erfindungsgemässen Positioniersystems in vier Ansichten; und
Fig. 6A - 6C drei verschiedene Bodenbearbeitungsfahrzeuge mit einem erfindungsgemässen PositionierSystem.
In Figur 1 dargestellt sind ein erfindungsgemässes Bodenbearbeitungsfahrzeug mit einem erfindungsgemässen Positioniersystem Ia, sowie eine Mehrzahl erfindungsgemässer Referenzobjekte. Ein selbstfahrender Rasenmäher 2a stellt hier das Bodenbearbeitungsfahrzeug dar, welcher Rasenmäher 2a anhand des Positioniersystems Ia und der Referenzobjekte über ein zu bearbeitendes - zu mähendes - Terrain T navigiert wird. Die Referenzobjekte sind als Pfosten 3a, 3b, 3c, 3d, 3e, 3f mit einer reflektiven Beschichtung - Reflektorstäbe - ausgebildet. Über das Terrain T verteilt sind sechs Pfosten 3a, 3b, 3c, 3d, 3e, 3f angeordnet, wobei einer der Pfosten 3c an einer Docking
Station DS für den Rasenmäher 2a angeordnet ist. Die Pfosten 3a, 3b, 3c, 3d, 3e, 3f sind hier lediglich skizziert, die spezielle Ausführung kann mit codierten Pfosten erfolgen. Beispielsweise weisen die Pfosten 3a, 3b, 3c, 3d, 3e, 3f - wie für den Pfosten 3d rechts oben angezeigt - unterschiedliche Durchmesser auf und/oder es sind Kombinationen von zwei oder mehreren Pfosten vorgesehen. Je nach Art und/oder Anzahl der Pfosten empfängt das Positioniersystem Ia unterschiedliche Signale, anhand derer die jeweiligen - codierten - Pfosten identifizierbar sind.
Das optische Positioniersystem Ia emittiert horizontale Laser-Sendestrahlen 5a in eine rotierende Emissionsrichtung, wie durch den Pfeil angedeutet. Die Beschaffenheit des Terrains T und die Anzahl und Anordnung der Pfosten 3a, 3b, 3c, 3d, 3e, 3f sind derart, dass das auf dem Rasenmäher 2a angeordnete Positioniersystem Ia von jeder Position des Terrains T aus wenigstens drei Pfosten detektiert. Das Positioniersystem Ia ist hier teilweise im Rasenmäher 2a versenkt, sodass Rasenmäher 2a und System eine kompakte Anordnung bilden. Weiters wird durch die teilweise Versenkung die Anordnung niedrig gehalten, wodurch auch die Höhe der Pfosten 3a, 3b, 3c, 3d, 3e, 3f verringert werden kann.
Ein Ausschnitt des Positioniersystems Ia aus Figur 1 und ein Pfosten 3a aus Figur 1 sind in Figur 2 detaillierter dargestellt. Der Pfosten 3a ist mit einer reflektiven Beschichtung 3a' versehen. Wie aus dem herausgezeichneten Detail des Pfostens 3a ersichtlich ist die Beschichtung aus einer Vielzahl von Glaskügelchen 3a'' gebildet. Der Pfosten 3a ist 3 cm im Durchmesser D und die reflektive Beschichtung 3a' 1 m in der Höhe H erstreckt. Der gezeigte
Ausschnitt des Positioniersystems Ia umfasst einen Umlenkspiegel 9a, der als Umlenkmittel die Sendestrahlen 5a einer - nicht dargestellten - Laserdiode als Sender des Positioniersystems Ia in Richtung des Pfostens 3a lenkt, an welchem Pfosten 3a sie zurück zum Umlenkspiegel 9a reflektiert werden. Dadurch, dass der reflektive Pfosten 3a in der Höhe erstreckt ist, ist eine sehr hohe Trefferwahrscheinlichkeit des Pfostens 3a gegeben. Für ein Terrain, das bedeutende Niveauunterschiede aufweist, können entsprechend höhere Pfosten verwendet werden.
Wie mit dem Pfeil angezeigt wird der Umlenkspiegel 9a rotiert. Dazu ist der Umlenkspiegel 9a in einer Spiegelhalterung 9a' gehaltert, die auf einem ein Rotationselement bildenden zylindrischen Hohlkörperaufsatz 15a angebracht ist, welcher über einen Motor in Rotationsbewegung versetzt wird. Die Sendestrahlen 5a gelangen durch den Hohlkörperaufsatz 15a zum Umlenkspiegel 9a. Am Umlenkspiegel 9a werden die Strahlen derart umgelenkt, dass sie im Wesentlichen horizontal sind. Weiters werden die Strahlen durch die Rotation des Umlenkspiegels 9a rotiert - hier um 360°. Über die Anordnung mit dem Umlenkspiegel 9a ist eine Schutzhülle in der Art einer transparenten Kunststoff-Glocke 21 gesetzt. Die Öffnung der Kunststoff-Glocke 21 ist nur zwecks der Darstellung der Schraubverbindung 21' zwischen der Kunststoff-Glocke 21 und einer ringförmigen Platte 22 eingezeichnet, die Glocke ist geschlossen. Alternativ zur transparenten Schutzhülle kann auch eine Hülle mit einem Fenster entlang des Umfangs verwendet werden.
Die ringförmige Platte 22 ist am Rasenmäher 2a von Figur 1 angebracht. Zur Aufnahme des Teils des Positioniersystems Ia, der sich unterhalb der Kunststoff-
Glocke 21 erstreckt, weist der Rasenmäher 2a eine Ausnehmung auf. Der Rasenmäher 2a kann auch eine Ausnehmung aufweisen, in welche die Platte 22 einsetzbar ist. Alternativ kann der Rasenmäher 2a bereits mit einer integrierten Platte ausgebildet werden oder sein, in welche das Positioniersystem Ia einsetzbar ist. Der nicht dargestellte Teil des Positioniersystems Ia - an der Unterseite der Glocke - ist also im Rasenmäher 2a versenkt und gegen mechanische und umweltbedingte Beschädigungen gut geschützt.
Figur 3 zeigt ein typisches Empfangssignal 8 eines Empfängers eines erfindungsgemässen Positioniersystems für eine 360° -Umdrehung des Umlenkmittels. Das innere Signal stellt ein Referenzsignal 8' in Bezug auf die Rotationsbewegung des Umlenkmittels des Systems dar. Das Referenzsignal 8' ist mit einem Sensor, wie z.B. einer Lichtschranke, zur Kontrolle und ggf- Korrektur der Rotationsbewegung aufgenommen - im gezeigten Ausführungsbeispiel sind vier Messungen 8a' -8d' auf 360° durchgeführt. Das Empfangssignal 8 zeigt drei
Peaks 8a, 8b, 8c. Die Peaks 8a, 8b, 8c stellen von reflektiven
Referenzobjekten reflektierte Signale dar, die anhand ihrer
Intensität vom Hintergrund unterschieden werden können. Die unterschiedlichen - Peaks 8a, 8b, 8c korrespondieren weiters zu Referenzobjekten mit verschiedenen Durchmessern und/oder Reflexionsvermögen, sodass eine Zuordnung zu spezifischen Referenzobjekten möglich ist. Aus dem Empfangssignal 8 werden drei Entfernungen zu den korrespondierenden Referenzobjekten berechnet. Zusätzlich werden aus dem Empfangssignal 8 und der bekannten Rotationsgeschwindigkeit - unter Berücksichtigung des Referenzsignals 8' - die Horizontalwinkel zwischen den Referenzobjekten ermittelt. Da hier ausserdem die
Fahrtrichtung 16 des Bodenbearbeitungsfahrzeugs bekannt ist, sind auch die Horizontalwinkel zwischen der Fahrtrichtung 11 und den Referenzobjekten bestimmbar.
Sind die Durchmesser der reflektierenden Referenzobjekte bekannt, insbesondere jeweils gleich gross, so kann zusätzlich über die Breite bsa der Peaks 8a, 8b, 8c und den bekannten Durchmessern d der Referenzobjekte eine grobe
Entfernung GE zu den Referenzobjekten abgeleitet werden.
Wird zum Beispiel ein Peakbreitenwinkel ßsa^ der sich zwischen Peakanfang und Peakende ergibt, bestimmt, kann eine Grobentfernung zum Referenzobjekt anhand des
Tangenssatzes wie folgt bestimmt werden:
GE = d / 2*tan(ß8a/2)
Diese Grobentfernung GE kann beispielsweise für das Auflösen von Phasenmehrdeutigkeiten bei der zusätzlich erfindungsgemäss durchgeführten hochpräzisen Entfernungsmessung nach dem Phasenmessprinzip oder zur Relevanzüberprüfung der durch die Phasenmessung ermittelten Entfernungen verwendet werden.
Die Figur 4 zeigt eine detailliertere Ausführungsform eines erfindungsgemässen Positioniersystems Ib für ein Bodenbearbeitungsfahrzeug. Die Aufnahme 14b des Positioniersystems Ib ist aus mehreren Bauteilen, wie Gehäuseteilen, zusammengesetzt. In der Aufnahme 14b sind in einem weiteren Gehäuse 23 der Sender, der Empfänger und die Rechen- und Steuerkomponente 30 des Positioniersystems Ib angeordnet. Sender, Empfänger und Rechen- und Steuerkomponente bilden einen Entfernungsmesser 12b in etwa gemäss dem „Disto" der Firma Leica Geosystems. Im Unterschied zum „Disto" ist der Entfernungsmesser 12b für die Verwendung auf einem Bodenbearbeitungsfahrzeug
angepasst. So emittiert der Sender etwa Sendestrahlen 5b mit einer Frequenz von wenigstens 100 kHz, um Entfernungsmessungen nach dem Phasenmessprinzip für sehr kurze Signalzeiten - von ca. 100 μs - zu ermöglichen. Die kurzen Signalzeiten entstehen aus der Rotation der Sendestrahlen 5b, welche anhand eines Umlenkmittels 9b, das mit wenigstens drei Umdrehungen pro Sekunde rotiert wird, verwirklicht wird. Das Umlenkmittel 9b ist auf einem Rotationselement 15b in Form eines Hohlkörpers befestigt. Das Rotationselement 15b wiederum ist um eine vertikale Achse 10b drehbar auf einem Hohlzylinder 14b' der Aufnahme 14b aufgesetzt und bildet ebenfalls einen Bestandteil der Aufnahme 14b. Die Rotation erfolgt anhand eines motorischen Antriebs über einen Zahnriemen 16.
Über das Umlenkmittel 9b werden die Sendestrahlen 5b des Senders in eine rotierende Emissionsrichtung gelenkt und die reflektierten Sendestrahlen als Empfangsstrahlen 7b zum Empfänger. Um zu erreichen, dass die Sendestrahlen 5b in einer Ebene, die im Wesentlichen horizontal ist, rotiert werden, ist die Aufnahme 14b des Positioniersystems Ib kardanisch in einer Trägerkomponente 13b aufgehängt. Damit richtete sich die Aufnahme 14b auch bei Neigungsstellungen des Bodenbearbeitungsfahrzeugs schwerkraftbeeinflusst vertikal aus, sodass die Horizontalität der Sendestrahlen 5b beibehalten wird. Die Trägerkomponente 13b umfasst eine erste Halterung 13b' , in welcher die Aufnahme 14b um eine erste Achse drehbar gelagert ist und eine zweite Halterung 13b' ' , in welcher die erste Halterung 13b' um eine zweite Achse drehbar gelagert ist. Die zweite Halterung 13b' ' wird über Schrauben 17 und Dämpfungselemente 18 an einer Plattform 20 des Bodenbearbeitungsfahrzeugs angebracht .
In den Teilfiguren 5A bis 5D ist eine Ausführungsform eines erfindungsgemässen Positioniersystems Ic in verschiedenen Ansichten dargestellt, wobei Figur 5A eine Draufsicht auf das Positioniersystem Ic zeigt, Figur 5B einen Querschnitt entlang der Schnittlinie A-A aus Figur 5A, Figur 5C eine Seitenansicht des Positioniersystems Ic und Figur 5D einen Querschnitt entlang der Schnittlinie B-B aus Figur 5C. Die Figuren werden im Folgenden zusammenhängend beschrieben.
Das dargestellte Positioniersystem Ic weist eine Aufnahme 14c auf, die aus einem Aufnahmekörper mit einem zylindrischen Hohlkörper 14c' und einem Rotationselement 15c zusammengesetzt ist. Das Rotationselement 15c ist als Spiegelhalter für einen Spiegel 9c als Umlenkmittel ausgebildet und über eine Kugellagerung 25 drehbar am zylindrischen Hohlkörper 14c' gelagert. Das Rotationselement 15c weist eine Aussenverzahnung 26 auf und wird über ein Ritzel 27, das von einem Elektromotor 28 angetrieben wird, rotiert. Am zylindrischen Hohlkörper 14c' ist weiters - an einem Flansch des Hohlkörpers 14c' - ein Sensor 24 angeordnet, der Referenzsignale in Bezug auf die Rotationsbewegung abgreift .
Im Aufnahmekörper sind ein Sender 4c und ein Empfänger 6c des Positioniersystems Ic angeordnet. Der Sender 4c umfasst eine Laserdiode sowie eine Kollimationsoptik, der Empfänger 6c eine Photodiode und eine Empfangsoptik. Vom Sender 4c emittierte Sendestrahlen gelangen durch den zylindrischen Hohlkörper 14c' zum Spiegel 9c, wo sie reflektiert werden. Die an Referenzobjekten reflektierten Sendestrahlen treffen wieder auf den Spiegel 9c und werden als Empfangsstrahlen zum Empfänger 6c reflektiert. Die Sende- und Empfangsstrahlen sind nicht eingezeichnet.
Sender 4c, Empfänger 6c und Spiegel 9c sind hier derart angeordnet, dass der Strahlengang der Sendestrahlen und der Strahlengang der Empfangsstrahlen im Wesentlichen parallel sind. Dazu sind der Sender 4c und der Empfänger 6c möglichst nahe nebeneinander angeordnet, sodass die Sende- und Empfangsstrahlen über dieselbe Fläche des Spiegels 9c und ohne zusätzliche optische Elemente lenkbar sind, was die Ausbildung eines wenig komplexen und kompakten Systems zur Entfernungsmessung ermöglicht.
Die Laser- und Photodiode des Positioniersystems sind auf einer Leiterplatte 29 angebracht, die weiters auch einen Mikroprozessor als Datenverarbeitungseinheit umfasst. Sender 4c, Empfänger 6c und Mikroprozessor bilden einen Entfernungsmesser 12c. Der Mikroprozessor ist zusätzlich als Rechen- und Steuereinheit zum Berechnen der Position des Positioniersystems Ic bzw. des Bodenbearbeitungsfahrzeugs, für welches das Positioniersystem Ic verwendet wird, und zum Ableiten von Steueranweisungen für das Fahrzeug ausgeführt. Alternativ könnte am Entfernungsmesser 12c eine Schnittstelle zur Kommunikation mit einer Rechen- und Steuereinheit ausgebildet und die Rechen- und Steuereinheit ausserhalb der Aufnahme 14c angeordnet sein.
Die Aufnahme 14c des Positioniersystems Ic ist pendelartig an einer Trägerkomponente 13c des Systems angeordnet. Die
Trägerkomponente 13c umfasst einen ersten Kardanring 13c' und einen zweiten Kardanring 13c' ' , über welche
Kardanringe 13c' und 13c' ' die Aufnahme 14c kardanisch aufgehängt ist, sodass sie sich unter der Wirkung der Schwerkraft vertikal ausrichtet. Mit der Ausrichtung der
Aufnahme 14c erfolgt natürlich auch eine entsprechende
Ausrichtung aller in, an oder auf der Aufnahme 14c
angeordneten Komponenten, so z.B. des Entfernungsmessers 12c und des Spiegels 9c.
In den Figuren 6A bis 6C ist ein erfindungsgemässes Positioniersystems für verschiedene Bodenbearbeitungsfahrzeuge gezeigt. Die Darstellungen der Figuren sind nicht als massstäblich zu betrachten.
Figur 6A zeigt in Draufsicht einen Markierwagen 2d als Bodenbearbeitungsfahrzeug zum Erzeugen bodengebundener Markierungen 31 auf einem Untergrund - z.B. auf einem Sportplatz. Auf dem Untergrund sind als Referenzobjekte zylindrische Reflektorstäbe 3g platziert. Diese werden anhand der Sendestrahlen 5d des auf dem Markierwagen 2d angeordneten Positioniersystems Id abgetastet. Die Sendestrahlen werden in eine horizontale, rotierende Emissionsrichtung gesendet, sodass sie eine horizontale Strahlebene 30 aufspannen.
Das Bodenbearbeitungsfahrzeug aus Figur 6B stellt einen Gleitschalungsfertiger 2e beim Erstellen einer Belagschicht 32 entlang eines vorgegebenen Weges dar. Entlang des Weges sind Reflektorstäbe 3h als Referenzobjekte angeordnet. Die Reflektorstäbe 3h können beispielsweise jeweils 30 m voneinander entfernt angeordnet sein. Auf der Fahrerkabine des Gleitschalungsfertigers 2e ist ein erfindungsgemässes Positioniersystem Ie angebracht. Das Positioniersystem emittiert Strahlung und tastet anhand der Rotation der Strahlung um eine vertikale Achse 10e die Umgebung kontinuierlich nach den Referenzobjekten ab. Mittels der vom Positioniersystem emittierten und empfangenen Strahlung werden die Entfernungen zu den Refe- renzobjekten und daraus die Position des Gleitschalungsfertigers 2e relativ zu diesen bestimmt. Sind die Reflektorstäbe 3h in ein Koordinatensystem - z.B. des
Geländes - eingemessen, so kann die absolute Position des Fertigers bestimmt und dieser entsprechend gesteuert werden. Alternativ kann der vorgegebene Weg relativ zu den Reflektorstäben 3h festgelegt, respektive die Reflektorstäbe 3h entsprechen positioniert werden, und der Fertiger relativ zu den Reflektorstäben 3h gesteuert werden.
In Figur 6C ist ein Bagger 2f als Bodenbearbeitungsfahrzeug mit einem erfindungsgemässen Positioniersystem If dargestellt. Das Positioniersystem If ist - ebenso wie in den vorangehenden Figuren 6A und 6B - lediglich durch ein Gehäuse skizziert, was jedoch nicht ausschliesst, dass z.B. die Rechen- und Steuerkomponente des Positioniersystems If in der Fahrerkabine angeordnet ist und in Kommunikationsverbindung - über Kabel oder Funk - mit dem Empfänger oder einer Datenverarbeitungseinheit des Positioniersystems If steht. Auf dem zu bearbeitenden Terrain T2 sind vier Reflektorstäbe 3i positioniert. Das Positioniersystem If tastet mittels Laserstrahlung kontinuierlich die Umgebung um eine vertikale Achse 10f ab. Aus den erfassten Reflektorstäben 3i werden in der Rechen- und Steuerkomponente die Relativposition des Baggers 2f und Steueranweisungen in Bezug auf dessen Positionierung abgeleitet.
Claims
1. Positionsbestimmungsvorrichtung (Ia, Ib, Ic, Id, Ie, If) für eine mobile, insbesondere selbstfahrende Arbeitsmaschine (2a, 2d, 2e, 2f) , mit
■ einer Trägerkomponente (13b, 13c) zur Befestigung der Positionsbestimmungsvorrichtung (Ia, Ib, Ic, Id, Ie, If) an der Arbeitsmaschine (2a, 2d, 2e, 2f) , ■ einer sich unter Wirkung der Schwerkraft vertikal ausrichtenden, an der Trägerkomponente (13b, 13c) angeordneten Aufnahme (14b, 14c) mit o einem Sender (4c) zur Emission von optischen
Sendestrahlen (5a,5b,5d), o einem Empfänger (6c) zum Empfangen von an Referenzobjekten (3a-3i) reflektierten Sendestrahlen (5a,5b,5d) als Empfangsstrahlen (7b) und zum Erzeugen von Empfangssignalen (8) und o einem um eine vertikale Achse rotierbaren Umlenkmittel (9a, 9b, 9c) zum Lenken einerseits der
Sendestrahlen (5a,5b,5d) in horizontale Richtungen, sodass eine im Wesentlichen horizontale Ebene aufgespannt wird, und andererseits der Empfangsstrahlen (7b) gegen den Empfänger (6c), und ■ einer Rechen- und Steuerkomponente (30) zum Ableiten der Position der Arbeitsmaschine (2a, 2d, 2e, 2f) wenigstens aus den Empfangssignalen (8) und zum Erzeugen von Steueranweisungen für die
Arbeitsmaschine (2a, 2d, 2e, 2f) , dadurch gekennzeichnet, dass
der Sender (4c) und der Empfänger (6c) Bestandteil eines Entfernungsmessers (12b, 12c) sind und die Rechen- und Steuerkomponente (30) zum Ableiten der Position wenigstens aus anhand der Empfangssignale (8) nach dem Phasen- oder Pulslaufzeitmessprinzip bestimmten Entfernungen zu den Referenzobjekten (3a-3i) ausgebildet ist.
2. Positionsbestimmungsvorrichtung nach Anspruch 1, dadurch gekennzeichnet, dass
■ die Aufnahme (14b, 14c) zusätzlich ein, insbesondere motorisches, Antriebsmittel zur kontinuierlichen Rotation des Umlenkmittels (9a, 9b, 9c) mit einer bekannten Rotationsgeschwindigkeit aufweist, und
■ die Rechen- und Steuerkomponente (30) zum Bestimmen von azimutaler Winkelinformationen der Referenzobjekte (3a-3i) aus den Empfangssignalen (8) und der Rotationsgeschwindigkeit ausgebildet ist, wobei die Winkelinformationen zum Ableiten der Position verwendet werden.
3. Positionsbestimmungsvorrichtung nach Anspruch 2, wobei der Sender und der Empfänger zur Entfernungsmessung nach dem Phasenmessprinzip ausgebildet sind, dadurch gekennzeichnet, dass die Rechen- und Steuerkomponente (30) ausgebildet ist zum Ableiten von Grobentfernungen zu den Referenzobjekten (3a-3i) jeweils aus einer bekannten Breite der Referenzobjekte (3a-3i) und einer aus den Empfangssignalen ableitbaren Peakbreite (bsa) / insbesondere wobei die Grobentfernungen zum Auflösen von Phasenmehrdeutigkeiten bei der Entfernungsmessung zu den Referenzobjekten (3a-3i) nach dem Phasenmessprinzip verwendet werden.
4. Positionsbestimmungsvorrichtung nach einem der vorangehenden Ansprüche, wobei der Sender und der Empfänger zur Entfernungsmessung nach dem Phasenmessprinzip ausgebildet sind, dadurch gekennzeichnet:, dass die Sendestrahlen (5b) mit einer Frequenz von wenigstens 100 kHz moduliert sind.
5. Positionsbestimmungsvorrichtung nach einem der vorangehenden Ansprüche, dadurch gekennzeichnet, dass der Sender (4c), der Empfänger (6c) und das Umlenkmittel (9a, 9b, 9c) derart angeordnet sind, dass der Strahlengang der Sendestrahlen (5a,5b,5d) und der Empfangsstrahlen (7b) im Wesentlichen parallel sind.
6. Positionsbestimmungsvorrichtung nach einem der vorangehenden Ansprüche, dadurch gekennzeichnet, dass der Sender, der Empfänger und das Umlenkmittel derart angeordnet sind, dass die Sendestrahlen und die Empfangsstrahlen koaxial sind.
7. Positionsbestimmungsvorrichtung nach einem der vorangehenden Ansprüche, dadurch gekennzeichnet, dass der Sender, der Empfänger und das Umlenkmittel (9b) derart angeordnet sind, dass
■ der Strahlengang der Sendestrahlen (5b) zwischen Sender und Umlenkmittel (9b) und/oder
■ der Strahlengang der Empfangsstrahlen (7b) zwischen Umlenkmittel (9b) und Empfänger und
■ die vertikale Achse (10b) im Wesentlichen parallel, insbesondere koaxial, sind.
8. Positionsbestimmungsvorrichtung nach einem der vorangehenden Ansprüche, dadurch gekennzeichnet, dass das Umlenkmittel (9a, 9b, 9c) ein optisches Reflexionselement, wie einen Spiegel (9c) oder ein Prisma, das an, auf oder in einem um die vertikale Achse (10b, 10e, 10f) rotierbaren Rotationselement (15a,15bl5c) angeordnet ist, aufweist.
9. Positionsbestimmungsvorrichtung nach einem der vorangehenden Ansprüche, dadurch gekennzeichnet, dass die Aufnahme über ein Gelenk, insbesondere Kugelgelenk, an der Trägerkomponente angeordnet ist.
10. Positionsbestimmungsvorrichtung nach einem der vorangehenden Ansprüche, dadurch gekennzeichnet, dass die Trägerkomponente (13c) zwei
Kardanringe (13c' , 13c' ' ) , in denen die Aufnahme (14c) kardanisch aufgehängt ist, aufweist.
11. Positionsbestimmungsvorrichtung nach einem der vorangehenden Ansprüche, dadurch gekennzeichnet, dass der Sender zur Emission von Sendestrahlen im nichtsichtbaren Wellenlängenbereich, beispielsweise zur Emission von Sendestrahlen mit einer Wellenlänge von 850 nm, ausgebildet ist.
12. Mobile Arbeitsmaschine (2a, 2d, 2e, 2f) , insbesondere Rasenmäher (2a) oder Sportplatzmarkierungswagen, mit einer Positionsbestimmungsvorrichtung (Ia, Ib, Ic, Id, Ie, If) nach einem der Ansprüche 1 bis 11.
13. Mobile Arbeitsmaschine nach Anspruch 12, dadurch gekennzeichnet, dass ein Bauteil des Bodenbearbeitungsfahrzeugs als die Trägerkomponente ausgebildet ist.
14. Positionsbestimmungssystem mit
■ einer Arbeitsmaschine nach Anspruch 12 oder 13 und
■ mehreren als Reflektorstäbe ausgebildeten Referenzobjekten (3a-3i) .
15. Positionsbestimmungssystem nach Anspruch 14, dadurch gekennzeichnet, dass die Reflektorstäbe zylinderförmig und mit bekanntem Durchmesser ausgebildet sind.
16. Positionsbestimmungssystem nach Anspruch 14 oder 15, dadurch gekennzeichnet, dass die Referenzobjekte (3a-3i) als Grenzpfosten ein Gebiet definieren, innerhalb welchen von jedem Punkt aus ein freier Sichtkontakt zu jedem der Referenzobjekte (3a- 3i) besteht.
17. Positionsbestimmungsverfahren für eine mobile Arbeitsmaschine, mit im Gelände angeordneten, zylinderförmigen
Reflektoren mit jeweils bekannten Durchmessern,
und den Schritten
■ um eine vertikale Achse mit bekannter Winkelgeschwindigkeit rotierendes Aussenden von optischen Sendestrahlen in alle azimutalen Richtungen von der Arbeitsmaschine aus, sodass die Sendestrahlen eine im Wesentlichen horizontale Ebene aufspannen, ■ Empfangen von an den Reflektoren reflektierten Sendestrahlen als Empfangsstrahlen und daraus Erzeugen von Empfangssignalen,
■ Ermitteln von Grobentfernungen von der Arbeitsmaschine zu den Reflektoren anhand den bekannten Durchmessern und von der vertikalen Achse aus jeweils für die Reflektoren anhand der Empfangssignale und der Winkelgeschwindigkeit bestimmten azimutalen Winkelausdehnungen,
■ Bestimmen von Entfernungen von der Arbeitsmaschine zu den Reflektoren aus den Empfangssignalen anhand des Phasenmessprinzips unter Verwendung der Grobentfernungen, und ■ Ableiten einer Position der Arbeitsmaschine relativ zu den Reflektoren anhand der Entfernungen.
18. Positionsbestirπmungsverfahren nach Anspruch 17, dadurch gekennzeichnet, dass die Grobentfernungen zum Auflösen von
Phasenmehrdeutigkeiten verwendet werden.
19. Positionsbestimmungsverfahren nach Anspruch 17 oder 18, dadurch gekennzeichnet, dass ■ ein Ermitteln von azimutaler Winkelinformationen der Reflektoren relativ zur Arbeitsmaschine aus den Empfangssignalen und der Winkelgeschwindigkeit erfolgt, und
■ zum Ableiten der Position der Arbeitsmaschine zusätzlich die Winkelinformationen verwendet werden.
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CH01297/06A CH700014B1 (de) | 2006-08-11 | 2006-08-11 | Positioniersystem für ein Bodenbearbeitungsfahrzeug. |
| CH01297/06 | 2006-08-11 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| WO2008017486A1 true WO2008017486A1 (de) | 2008-02-14 |
Family
ID=37401056
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| PCT/EP2007/007058 Ceased WO2008017486A1 (de) | 2006-08-11 | 2007-08-09 | Positionsbestimmungsvorrichtung |
Country Status (2)
| Country | Link |
|---|---|
| CH (1) | CH700014B1 (de) |
| WO (1) | WO2008017486A1 (de) |
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US8269984B2 (en) | 2007-10-26 | 2012-09-18 | Leica Geosystems Ag | Distance-measuring method for a device projecting a reference line, and such a device |
| CN103891463A (zh) * | 2012-12-28 | 2014-07-02 | 苏州宝时得电动工具有限公司 | 自动割草系统 |
| WO2014101840A1 (zh) * | 2012-12-28 | 2014-07-03 | 苏州宝时得电动工具有限公司 | 自动割草系统 |
| US8930024B2 (en) | 2010-03-29 | 2015-01-06 | F Robotics Acquisitions Ltd. | Robotic lawnmower and charging and control systems therefor |
| CN107101578A (zh) * | 2017-04-26 | 2017-08-29 | 长沙迪迈数码科技股份有限公司 | 一种井下测点坐标测量方法 |
| US11977391B1 (en) * | 2023-04-14 | 2024-05-07 | Jack George Lawrence, Jr. | Robot navigation with obstacle detection using a distance measuring sensor |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| DE102013203712B4 (de) | 2013-03-05 | 2024-05-16 | Robert Bosch Gmbh | Autonomfortbewegungsgerätebasisstation |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| DE3821892C1 (en) * | 1988-06-29 | 1990-02-22 | Johann F. Dipl.-Phys. 2000 Hamburg De Hipp | Method and device for position measurement of container repositioning vehicles |
| US5011288A (en) * | 1988-05-13 | 1991-04-30 | Honda Giken Kogyo Kabushiki Kaisha | Position control system for unmanned automated vehicle |
| US5367458A (en) * | 1993-08-10 | 1994-11-22 | Caterpillar Industrial Inc. | Apparatus and method for identifying scanned reflective anonymous targets |
| WO2004026538A1 (en) * | 2002-09-20 | 2004-04-01 | Wilkenson Scoop Ab | Method and device for automatic motion of a work vehicle |
-
2006
- 2006-08-11 CH CH01297/06A patent/CH700014B1/de unknown
-
2007
- 2007-08-09 WO PCT/EP2007/007058 patent/WO2008017486A1/de not_active Ceased
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5011288A (en) * | 1988-05-13 | 1991-04-30 | Honda Giken Kogyo Kabushiki Kaisha | Position control system for unmanned automated vehicle |
| DE3821892C1 (en) * | 1988-06-29 | 1990-02-22 | Johann F. Dipl.-Phys. 2000 Hamburg De Hipp | Method and device for position measurement of container repositioning vehicles |
| US5367458A (en) * | 1993-08-10 | 1994-11-22 | Caterpillar Industrial Inc. | Apparatus and method for identifying scanned reflective anonymous targets |
| WO2004026538A1 (en) * | 2002-09-20 | 2004-04-01 | Wilkenson Scoop Ab | Method and device for automatic motion of a work vehicle |
Cited By (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US8269984B2 (en) | 2007-10-26 | 2012-09-18 | Leica Geosystems Ag | Distance-measuring method for a device projecting a reference line, and such a device |
| US8422035B2 (en) | 2007-10-26 | 2013-04-16 | Leica Geosystems Ag | Distance-measuring method for a device projecting a reference line, and such a device |
| US8930024B2 (en) | 2010-03-29 | 2015-01-06 | F Robotics Acquisitions Ltd. | Robotic lawnmower and charging and control systems therefor |
| CN103891463A (zh) * | 2012-12-28 | 2014-07-02 | 苏州宝时得电动工具有限公司 | 自动割草系统 |
| WO2014101840A1 (zh) * | 2012-12-28 | 2014-07-03 | 苏州宝时得电动工具有限公司 | 自动割草系统 |
| US9820433B2 (en) | 2012-12-28 | 2017-11-21 | Positec Power Tools (Suzhou Co., Ltd.) | Auto mowing system |
| US10555456B2 (en) | 2012-12-28 | 2020-02-11 | Positec Power Tools (Suzhou) Co., Ltd. | Auto mowing system |
| CN107101578A (zh) * | 2017-04-26 | 2017-08-29 | 长沙迪迈数码科技股份有限公司 | 一种井下测点坐标测量方法 |
| CN107101578B (zh) * | 2017-04-26 | 2019-07-02 | 长沙迪迈数码科技股份有限公司 | 一种井下测点坐标测量方法 |
| US11977391B1 (en) * | 2023-04-14 | 2024-05-07 | Jack George Lawrence, Jr. | Robot navigation with obstacle detection using a distance measuring sensor |
Also Published As
| Publication number | Publication date |
|---|---|
| CH700014B1 (de) | 2010-06-15 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| DE112007002393B4 (de) | Navigationssystem mit GPS und Laserreferenz | |
| DE68914553T2 (de) | Lasermesssystem. | |
| DE3888732T2 (de) | Verfahren und Vorrichtung für laser-optische Navigation. | |
| EP1307704B1 (de) | Messanordnung und messempfänger zur entfernungs- und/oder positionsbestimmung | |
| DE69122965T2 (de) | Räumliche positionierungsvorrichtung | |
| EP1882196B1 (de) | Verfahren und system zur lagebestimmung einer empfängereinheit | |
| DE112006003390B4 (de) | Verwaltetes Durchmesssystem und Verfahren zum Erlangen von genauen Vermessungsdaten in Abwesenheit von präzisen GPS-Daten | |
| DE69812673T2 (de) | Verfahren und geraet zur zuweisung von anonymen reflektoren zur erkannten winkelposition | |
| DE69005105T2 (de) | Anordnung zur ortsbestimmung. | |
| EP1842077B1 (de) | Verfahren zum ermitteln einer lageinformation mindestens eines objekts | |
| DE3781519T2 (de) | Standortbestimmungsgeraet. | |
| EP2201330B1 (de) | Distanzmessendes verfahren für ein referenzlinienprojizierendes gerät und ebensolches gerät | |
| DE69716671T2 (de) | Steuervorrichtung für Baumaschinen | |
| WO2008017486A1 (de) | Positionsbestimmungsvorrichtung | |
| EP1703300A1 (de) | Verfahren und System zur Bestimmung von Position und Orientierung eines Objekts | |
| DE4445464A1 (de) | Abtastvorrichtung | |
| DE69005106T2 (de) | Anordnung zum erstellen oder bestimmen der ortung eines messpunktes. | |
| DE112005001760T5 (de) | Positionsverfolgungs- und Steuersystem mit einem Kombinations-Laserdetektor- und Globalnavigationssatellitenempfänger-System | |
| EP0841535A2 (de) | Verfahren und Vorrichtung zur Flächen- und Raumvermessung | |
| EP1517117A1 (de) | Verfahren und System zur Bestimmung einer Aktualposition eines Positionierungsgerätes | |
| EP2511659A1 (de) | Geodätisches Markierungssystem zur Markierung von Zielpunkten | |
| DE3808972A1 (de) | Vorrichtung zur kontinuierlichen verfolgung und positionsmessung eines objektes | |
| WO2013113759A1 (de) | Vermessungssystem mit einem vermessungsgerät und einem scanmodul | |
| DE102010043359A1 (de) | Lichtstrahlempfänger mit Sprachausgabe | |
| DE10155488A1 (de) | Verfahren zur Erfassung der Oberfläche einer Fahrbahn |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| 121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 07786642 Country of ref document: EP Kind code of ref document: A1 |
|
| NENP | Non-entry into the national phase |
Ref country code: DE |
|
| NENP | Non-entry into the national phase |
Ref country code: RU |
|
| 122 | Ep: pct application non-entry in european phase |
Ref document number: 07786642 Country of ref document: EP Kind code of ref document: A1 |