A device for spreading active agents comprising: a boom, which is arranged pivotably about a rotation axis; a sensor arrangement for the detection of an angular velocity of the boom about the rotation axis; a sensor for the detection of an angular position of the boom; a control unit processing output signals from the sensor; and an actuator, acting on the present angular position of the boom based on control signals from the control unit. For the determination of an angular position of the boom, the control unit calculates an angular position of the boom in relation to a reference plane by integration of the angular velocity and merges the angular position calculated by means of the angular velocity, with the detected angular position to determine the present angular position of the boom to return the boom to a desired angular position.
|
17. A device for spreading liquid and/or solid active agents, comprising:
a carrier vehicle;
at least one boom arranged pivotably about at least one rotation axis;
at least one sensor arrangement for the detection of an angular velocity (w) and/or the acceleration of the boom about the rotation axis in relation to a reference plane;
at least one sensor arrangement for the detection of an angular position (alpha1, d_alpha1) of the boom about the rotation axis in relation to a reference plane;
a control unit processing output signals (alpha0) of the sensor arrangements to control signals;
at least one actuator acting on the present angular position (alpha0) of the boom about the rotation axis in dependence on control signals from the control unit;
wherein the actuator converts the control signals to a physical quantity of force to produce a force or a force couple which exerts a torque on the boom.
20. A device for spreading liquid and/or solid active agents, comprising:
a carrier vehicle;
at least one boom arranged pivotably about at least one rotation axis;
at least one sensor arrangement for the detection of an angular velocity (w) and/or the acceleration of the boom about the rotation axis in relation to a reference plane;
at least one sensor arrangement for the detection of an angular position (alpha1, d_alpha1) of the boom about the rotation axis in relation to a reference plane;
a control unit processing output signals (alpha0) of the sensor arrangements to control signals;
at least one actuator acting on the present angular position (alpha0) of the boom about the rotation axis in dependence on control signals from the control unit; wherein, for the purpose of determining an angular position (alpha0) of the boom about the rotation axis in relation to an initial alignment;
wherein the control unit calculates at least one angular position (alpha2) of the boom in relation to the reference plane by means of temporal integration of the angular velocity (w) and wherein the actuator converts the control signals to a physical quantity to produce a force or a force couple which exerts a torque on the boom.
19. A device for spreading liquid and/or solid active agents, comprising:
a carrier vehicle;
at least one boom arranged pivotably about at least one rotation axis;
at least one sensor arrangement for the detection of an angular velocity (w) and/or the acceleration of the boom about the rotation axis in relation to a reference plane;
at least one sensor arrangement for the detection of an angular position (alpha1, d_alpha1) of the boom about the rotation axis in relation to a reference plane;
a control unit processing output signals (alpha0) of the sensor arrangements to control signals; and
at least one actuator acting on the present angular position (alpha0) of the boom about the rotation axis in dependence on control signals from the control unit; wherein, for the purpose of determining an angular position (alpha0) of the boom about the rotation axis in relation to an initial alignment;
wherein the control unit calculates at least one angular position (alpha2) of the boom in relation to the reference plane by means of temporal integration of the angular velocity (w), and
wherein the actuator converts the control signals to mechanical movement thus producing a force or a force couple which exerts a torque on the boom.
1. A device for spreading liquid and/or solid active agents, comprising:
a carrier vehicle;
at least one boom arranged pivotably about at least one rotation axis;
at least one sensor arrangement for the detection of an angular velocity (w) and/or the acceleration of the boom about the rotation axis in relation to a reference plane;
at least one sensor arrangement for the detection of an angular position (alpha1, d_alpha1) of the boom about the rotation axis in relation to a reference plane;
a control unit processing output signals (alpha0) of the sensor arrangements to control signals; and
at least one actuator acting on the present angular position (alpha0) of the boom about the rotation axis in dependence on control signals from the control unit; wherein, for the purpose of determining an angular position (alpha0) of the boom about the rotation axis in relation to an initial alignment, the control unit calculates at least one angular position (alpha2) of the boom in relation to the reference plane by means of temporal integration of the angular velocity (w); and
wherein the control unit comprises means which carry out a kalman filtering, and/or comprises means for the low-pass filtering of the sensor-detected angular position (alpha1, d_alpha1) as well as means for the comparison under continuous zero balance of the low-pass filtered, sensor-detected angular position (alpha1, d_alpha1) with the angular position (alpha2), which is calculated by means of an angular velocity (w).
6. A device for spreading liquid and/or solid active agents, comprising:
a carrier vehicle;
at least one boom arranged pivotably about at least one rotation axis;
at least one sensor arrangement for the detection of an angular velocity (w) and/or the acceleration of the boom about the rotation axis in relation to a reference plane;
at least one sensor arrangement for the detection of an angular position (alpha1, d_alpha1) of the boom about the rotation axis in relation to a reference plane;
a control unit processing output signals (alpha0) of the sensor arrangements to control signals; and
at least one actuator acting on the present angular position (alpha0) of the boom about the rotation axis in dependence on control signals from the control unit; wherein, for the purpose of determining an angular position (alpha0) of the boom about the rotation axis in relation to an initial alignment, wherein the control unit:
calculates at least one angular position (alpha2) of the boom in relation to the reference plane by means of temporal integration of the angular velocity (w);
detects an angular velocity (w) of the boom about the rotation axis in relation to a reference plane;
detects an angular position (alpha1, d_alpha1) of the boom about the rotation axis in relation to a reference plane;
calculates an angular position (alpha2) of the boom in relation to the reference plane by means of temporal integration of the angular velocity (w); and
merges the angular position (alpha2) of the boom, which angular position (alpha2) is calculated by means of the angular velocity (w), with the detected angular position (alpha1, d_alpha1) of the boom for the purpose of determining the present angular position (alpha0) of the boom in relation to the reference plane; and
wherein:
by way of merging the angular position (alpha2) of the boom, which angular position (alpha2) is calculated by the control unit by means of a detected angular velocity (w), with a relative rotation between carrier vehicle and boom, reference is taken to a reference plane corresponding to a long-term alignment of the carrier vehicle; or
by way of merging the angular position (alpha2) of the boom, which angular position (alpha2) is calculated by the control unit by means of a detected angular velocity (w), with an angular position (alpha1) of the boom, which angular position (alpha1) is detected by the detection of an angle (alpha) between the boom and the reference plane, reference is taken to a reference plane corresponding to an artificial horizon.
5. A device for spreading liquid and/or solid active agents, comprising:
a carrier vehicle;
at least one boom arranged pivotably about at least one rotation axis;
at least one sensor arrangement for the detection of an angular velocity (w) and/or the acceleration of the boom about the rotation axis in relation to a reference plane;
at least one sensor arrangement for the detection of an angular position (alpha1, d_alpha1) of the boom about the rotation axis in relation to a reference plane;
a control unit processing output signals (alpha0) of the sensor arrangements to control signals; and
at least one actuator acting on the present angular position (alpha0) of the boom about the rotation axis in dependence on control signals from the control unit; wherein, for the purpose of determining an angular position (alpha0) of the boom about the rotation axis in relation to an initial alignment, wherein the control unit:
calculates at least one angular position (alpha2) of the boom in relation to the reference plane by means of temporal integration of the angular velocity (w);
detects an angular velocity (w) of the boom about the rotation axis in relation to a reference plane;
detects an angular position (alpha1, d_alpha1) of the boom about the rotation axis in relation to a reference plane;
calculates an angular position (alpha2) of the boom in relation to the reference plane by means of temporal integration of the angular velocity (w); and
merges the angular position (alpha2) of the boom, which angular position (alpha2) is calculated by means of the angular velocity (w), with the detected angular position (alpha1, d_alpha1) of the boom for the purpose of determining the present angular position (alpha0) of the boom in relation to the reference plane; and
wherein:
the angular velocity (w) is detected by means of at least one angular rate sensor, which is arranged at the boom and which detects the angular velocity (w) of the boom; and/or
the angular velocity (w) of the boom is detected by means of an angular velocity of the carrier vehicle about its longitudinal axis, which runs parallel to the rotation axis, and by means of a relative rotation (d_alpha1) between the carrier vehicle and the boom; and/or
the angular velocity (w) is detected by means of a temporal integration of an angular acceleration; and/or
the angular velocity (w) is detected by way of a temporal integration of an angular acceleration, which is determined by means of translational accelerations; and/or
the angular position (alpha1) of the boom about the rotation axis in relation to the reference plane is detected by means of a tilt angle (alpha) between the boom and the horizontal or the vertical.
2. The device as recited in
3. The device as recited in
7. The device of
8. The device as recited in
9. The device as recited in
10. The device as recited in
11. The device as recited in
12. The device as recited in
13. The device as recited in
14. The device as recited in
15. The device as recited in
at least one angle of rotation sensor arranged between the boom and the carrier vehicle and/or
at least one tilt sensor, which detects an angle (alpha_t) between the carrier vehicle and the reference plane, and at least one tilt sensor, which detects an angle (alpha_g) between the boom and the reference plane.
16. The device as recited in
|
This application claims priority from German Application No. DE 10 2013 110 304.9 filed Sep. 18, 2013, the contents of which are incorporated herein by this reference.
The present invention relates to a device for spreading liquid and/or solid active agents according to the preamble of the independent claim 1 as well as to a method for the motion control and/or motion regulation of a device for spreading liquid and/or solid active agents according to the preamble of claim 11.
Field sprayers and spray booms hitched to work machines, such as tractors, in some cases have very large working widths of more than 20 meters. Such wide spray booms are folded and collapsed in for transport purposes. In the field, symmetrical cantilevered arms of several meters length are located on both sides of the work machine, which cantilevered arms have a varying spacing from the ground according to surface conditions and field relief. Since the downward-directed nozzles for spreading a spraying agent, for instance, a plant protection agent, which nozzles are arranged on the cantilevered arms, each have a defined spray cone, varying the spacing of the nozzles to the ground results in an uneven covering of the field with spraying agent. In addition, the danger of the spraying agent drifting greatly increases as the distance of the spray nozzles from the ground increases, since even slight air movements negatively affect the finely dispersed drops.
With increasing cantilever dimensions and the associated working width there is therefore a necessity to guide the spray boom at as uniform a spacing from the ground as possible, because minimal inclines of the spray boom will lead to large spacing differences of the nozzles to the ground.
In this context, it is known to suspend a spray boom from a carrier vehicle to be rotatable or pivotable about at least one axis of rotation about a central pivot point. The rotation or pivot axis in this instance preferably runs parallel to the longitudinal axis of the carrier vehicle. In order to ensure an even spreading of the spraying agent, the spacing between the top surface of the growth and the spray nozzles must be constantly controlled to a defined spacing. On horizontal agricultural fields, this can generally be achieved by self-leveling, in which the spray boom aligns itself in the horizontal plane with the center of gravity of the spray boom being located below the pivot point and the spray boom being suspended, for instance, to be freely and swingingly rotatable. The desired effect will not occur, however, for agricultural fields running along a slope.
In order to constantly control to a defined spacing, the spacing between the top surface of the growth for agricultural fields running in any plane and the spray nozzles arranged on a spray boom pivotably suspended about a central pivot point, it is therefore known to pivot the spray boom, which is, for instance, raised to a desired spacing from the ground, about a pivot axis running through a central pivot point such that the spacing is optimized over the entire working width. For this purpose, an alignment changing torque has to be exerted on the spray boom about a pivot axis running through a central pivot point. This is carried out by means of at least one actuator, which transmits, at least as required, a force or a force couple effecting an alignment changing torque about a pivot axis from the carrier vehicle onto the spray boom in order to change the alignment of the spray boom.
This alignment changing torque accelerates the spray boom in a desired target rotational direction. Without countermeasures, the spray boom would continue to rotate about the pivot axis even after the impact of the alignment changing torque has ended, since the spray boom would retain its angular momentum due to the mass moment of inertia. In order to decelerate the spray boom, a braking torque in opposite to the previous alignment changing torque therefore has to be induced. This braking torque counteracts the rotary movement initiated by the alignment changing torque and thus damps the system of the spray boom rotatably suspended about the central pivot point.
Up to now, mechanical dampers, which are arranged between the carrier vehicle and the spray boom, are usually used for generating the braking torque. Assuming that a relative movement in the form of a rotation about the pivot axis occurs between the carrier vehicle and boom, then a mechanical damper mounted in between would counteract the relative rotation or the rotary movement, respectively, of the boom and would decelerate it as desired. If the carrier vehicle, however, rotates about the pivot axis due to bumps, for example, and the spray boom stands still, this will also result in a relative rotation between the carrier vehicle and the spray boom. A mechanical damper arranged between the carrier vehicle and the spray boom would counteract this relative rotation and thus transmit a torque acting about the pivot axis to the spray boom, such that a coupling exists between carrier vehicle and spray boom.
The coupling likewise exists if a measuring system is used as a basis for regulating the torque, which measuring system measures a relative angle and/or a relative rotation between carrier vehicle and spray boom.
In addition, measuring systems are known, which use tilt sensors arranged at the spray boom for determining the position of the spray boom. The angular velocity of the spray boom can be acquired independently of the carrier vehicle from the temporal derivation of the tilt. In the instance of lateral accelerations such as occur, for example, when driving along curves, tilt sensors however provide an incorrect tilt. An incorrect angular velocity will therefore also be calculated.
A spreading device for spreading liquid active agents is known from US 2011/0282554 A1. The device comprises:
The distance sensors can be LIDAR (Light Detection and Ranging), RADAR (RAdio Detection and Ranging), or ultrasonic sensors, or they can be sensors based on interferometry or on radio frequency, such as, for example, GPS sensors. The angle of rotation sensor or the yaw rate sensor can be a gyroscope. In order to maintain the cantilevered ends at the uniform distance to the ground like the middle part, a vertical error of the two cantilevered ends is first calculated by way of a comparison of the output signals of the distance sensors. If this vertical error is not equal to zero for one or for both cantilevered ends, an initial control signal is generated in order to actuate an actuator assigned to a cantilever in question and to reset the cantilevered end having a vertical error to the specified spacing from the ground. If one of the cantilevers is lifted in the process, this leads to a rolling movement of the carrier vehicle in the direction toward the cantilever to be lifted, whereby, without further measures, the remaining cantilever would have a vertical error resulting from a lowering. In order for a control loop comprised of distance sensors, control unit, and actuators, to be regulation-technically stable and to not build up uncontrollable sway, for instance, and/or to not lead to a lateral toppling of the carrier vehicle, it is provided by means of the control unit to generate a compensation control signal counteracting an instability of the control loop by way of the output signal of the angle of rotation sensor or the yaw rate sensor, which detects the roll angle or the roll rate of the carrier vehicle about its longitudinal axis, and to output to the actuators a control signal determined by way of the initial control signal and the compensation control signal.
A spreading device for spreading liquid active agents is also known from WO 2012/146255 A1. The device comprises:
As a reaction to undesirable vertical movements, which, in an undampened control loop, can induce rotary oscillations of the spray boom about the longitudinal axis of the carrier vehicle, a damping and compensation by a mass displacement by way of a shift of the blocks along the two cantilevers is provided. Output signals from acceleration sensors, which are fastened at the cantilevers and which detect vertical oscillations of the spray boom, serve as input variable from the control unit, which input variable enters into the control signals to the actuating device. A regulation of the uniform distance of the cantilevers to the ground is not disclosed.
A spreading device for spreading liquid active agents is known from DE 10 2007 045 846 A1. The device comprises:
Once position and alignment of the spray boom have been manually set, the control signals generated by the control unit prevent position changes when braking or accelerating, during bounding or rebounding, respectively, of the carrier vehicle, or also when driving over bumps. Errors creeping in by way of the different positioning of the acceleration sensors and the reference sensors can be compensated more precisely by the reference sensors. Regulation of the uniform spacing of the spray boom to the ground is not disclosed.
For the sake of completeness, it should be mentioned that, in addition, spray booms are known that consist of segments, which are adjustable relative to one another, in order to allow for a sectional adaptation to the ground contour in the instance of very wide working widths. A spray boom which has a cantilever that is put together of segments is already known from DE 32 02 569 A1. In this instance, individual segments are connected to each other, with the movement of the individual segments in relation to each other being carried out passively. For this mechanism, a supporting element is necessary on the outer side of each of the cantilevers in order to enable the pivoting process.
The object of the invention is to develop a device, such as, for instance, a field sprayer, for spreading liquid and/or solid active agents with a carrier vehicle and at least one boom with cantilevers projecting on both sides of the carrier vehicle, which boom is arranged pivotably about at least one rotation axis running preferably in parallel to a longitudinal axis of the carrier vehicle, which device enables maintaining as precisely as possible the spacing of the cantilevers in relation to the ground surface, also in the instance of uneven ground and a moving or rolling carrier vehicle, as well as specifying a method for controlling such a device, by means of which method it is made possible to maintain as precisely as possible the spacing of the cantilevers in relation to the ground surface, also in the instance of uneven ground and a moving or rolling carrier vehicle.
The task is respectively solved by the features of the independent claims.
Features of further advantageous developments of the invention are indicated in the dependent claims, in the following section with the general description, in the figures as well as in the corresponding section including the description of the figures.
A first object of the invention thus relates to a device for spreading liquid and/or solid active agents. The device comprises:
A pivot angle expressing an angular position of the boom in relation to the reference plane is obtained by temporal integration of the angular rate, termed as angular velocity. Disturbances caused by the carrier vehicle or by translational accelerations have no influence on the calculation in this context, whereas measuring errors are likewise integrated and cause an angle drift of the pivot angle.
Although measurement of the angular position in relation to the reference plane, for instance, by measurement of the relative rotation between carrier vehicle and boom or measurement of a tilt angle relative to the acceleration of gravity, has the disadvantage of influences from disturbances caused by rotary movements of the carrier vehicle or by translational accelerations such as occur when driving along curves, for example, this is offset by the advantage that this type of detection of the angular position is not subject to any angle drift.
By merging the calculated angular position and the measured angular position, referred to as the detected angular position, the present angular position in relation to the reference plane is determined very precisely, with only the advantages of each of the measuring methods being used and without having to put up with their disadvantages.
The advantage, as compared to the prior art, lies in obtaining a measuring system consisting of the at least one sensor arrangement for the detection of an angular velocity of the boom about the rotation axis in relation to a reference plane, at least one sensor arrangement for the detection of an angular position of the boom about the rotation axis in relation to the reference plane, and a control unit processing the output signals of the sensor arrangements to control signals, which measuring system expresses the present angular position and rotary movements of the boom in relation to the reference plane independently of the carrier vehicle and which generates control signals therefrom for the regulation of a constant alignment of the boom in relation to the reference plane. Two measuring systems, which are based on different physical principles, are used and merged for the determination of the present angular position. Thereby, the disadvantages of each of the measuring methods are suppressed.
The at least one sensor arrangement for the detection of an angular velocity of the boom about the rotation axis in relation to the reference plane can comprise an angular rate sensor, which detects the angular velocity of the boom.
In this context, an angular rate sensor is employed for the detection of the angular velocity, which angular rate sensor is mounted directly on the boom. Rotary movements of the carrier vehicle thus have no influence on determining the angular velocity of the boom. An output signal of an angular rate sensor, which output signal is proportional to the measurand or reflects it, thus corresponds to the rotary movement of the boom in relation to any optional reference plane, for instance, in relation to the surface of the earth or orthogonal to the acceleration of gravity, respectively, or in relation to a long-term alignment of the carrier vehicle reflecting an averaged ground profile.
This measurand or an output signal, respectively, of an angular rate sensor detecting angular velocities of the boom, which output signal is integrated into the control signals for the actuator or actuators and serves as an input variable for the control unit, and which output signal is proportional to this measurand or reflects it, can be used for the purpose of obtaining an active damping of the boom in the form of an actively induced brake torque.
Alternatively or additionally, the at least one sensor arrangement for the detection of an angular velocity of the boom about the rotation axis in relation to a reference plane can comprise at least one angular rate sensor arranged on the carrier vehicle for the purpose of measuring angular velocities of the carrier vehicle at least about its longitudinal axis and thus measuring rotary movements representing disturbances of the carrier vehicle.
Additionally, the at least one sensor arrangement for the detection of an angular velocity of the boom about the rotation axis in relation to a reference plane can in this instance comprise at least one angle of rotation sensor or rotational angular velocity sensor, which detects the relative rotation between carrier vehicle and boom, such that the absolute angular velocity of the boom about the rotation axis can then be determined from the two measured values of the angular velocity of the carrier vehicle in relation to its longitudinal axis and relative rotation between carrier vehicle and boom.
Alternatively or in addition to an angular rate sensor, the at least one sensor arrangement for the detection of an angular velocity of the boom about the rotation axis in relation to a reference plane can comprise an angular acceleration sensor. A measure for the angular velocity can be obtained by temporal integration of this sensor output signal.
Alternatively or in addition to an angular rate sensor and/or to an angular acceleration sensor, the at least one sensor arrangement for the detection of an angular velocity of the boom about the rotation axis in relation to a reference plane can typically comprise at least two acceleration sensors arranged in the area of the cantilevers of the boom, for instance, at their ends. It should be mentioned here, however, that one sensor may already suffice, which can be arranged in the area of one of the cantilevers of the boom, for example, at an end. The output signal of that sensor or the output signals of a plurality of sensors reflect the translational accelerations at the ends of the cantilevers. The difference between the output signals from two acceleration sensors arranged at the opposite ends of the cantilevers multiplied by the boom width results in the angular accelerations, by the temporal integration of which the angular velocity is in turn obtained.
In summary, it is thus obvious that the means for determining an angular velocity of the boom about the rotation axis in relation to a reference plane can comprise one or a plurality of inertial sensors arranged at the boom.
Inertial sensors serve for measuring accelerations and angular rates. By combining a plurality of inertial sensors in an inertial measurement unit, also termed “IMU”, accelerations can be measured in up to six degrees of freedom that a rigid body can have (three translational and three rotational degrees of freedom). An IMU is the main component of an inertial navigation system, also termed INS.
Examples of inertial sensors are acceleration sensors and angular rate sensors.
An angular rate sensor detects the rotational speed or angular velocity, respectively, of a body about a specified rotation axis or pivoting axis, with an output signal of an angular rate sensor being preferably uniquely proportional to a detected angular velocity.
By integration of the angular velocity over a time interval, it is possible to derive the angle by which the body has rotated in that time interval. The angular rates about the three spatial axes are termed as:
The measuring principle is essentially based on two measuring principles, on the one hand on the Coriolis force, which acts on a mechanically moving system, and on the other hand the Sagnac effect, which can be observed with light.
Examples of mechanical, moving systems using the Coriolis force are:
Examples of optical systems using the Sagnac effect are:
As a rule, inertial measurement units contain the following sensor types:
Magnetic field sensors, for instance, such as compass sensors, can be additionally provided for determining the constant of integration and/or for improving the accuracy and/or and or for correcting a drift of the sensors, and/or for receiving signals from an existing and/or future global navigation satellite system, also abbreviated as GNSS, such as:
The at least one sensor arrangement for the detection of an angular position of the boom about the rotation axis in relation to the reference plane can comprise at least one sensor, which detects a relative rotation between carrier vehicle and boom in relation to the rotation axis.
At least one sensor for the detection of a relative rotation between carrier vehicle and boom can be an angle of rotation sensor arranged between the boom and the carrier vehicle.
Alternatively or additionally, detection of a relative rotation between the carrier vehicle and boom can be realized by way of at least one tilt sensor, which detects an angle between the carrier vehicle and the reference plane, and by way of at least one tilt sensor which detects an angle between the boom and the reference plane, where the difference of the angle between the carrier vehicle and the reference plane and the angle between the boom and the reference plane, as detected by the sensors, is proportional to the relative rotation between carrier vehicle and boom.
By merging the angular position of the boom, which angular position is calculated by means of a sensor-detected angular velocity, with the relative rotation between carrier vehicle and boom, which relative rotation is sensor-detected directly by means of an angle of rotation sensor or indirectly by subtraction of the tilt of the boom and of the carrier vehicle in relation to the reference plane, it is possible to take reference to a reference plane corresponding to a long-term alignment of the carrier vehicle and reflecting an averaged ground profile.
The at least one sensor arrangement for the detection of an angular position of the boom about the rotation axis in relation to the reference plane can alternatively or additionally comprise at least one tilt sensor detecting an angle between the boom and the reference plane.
By merging the angular position of the boom, which angular position is calculated by way of an angular velocity, with an angular position of the boom, which angular position is detected by way of the detection of an angle between the boom and the reference plane, it is possible to take reference to a reference plane corresponding to an artificial horizon.
Tilt sensors do have the disadvantage of being associated with lateral accelerations. This disadvantage is, however, compensated by merger with the angular position of the boom, which angular position is calculated by way of an angular velocity.
In summary, the reference plane can be either an artificial horizon, where the at least one sensor arrangement for the detection of an angular position of the boom about the rotation axis in relation to a reference plane preferentially comprises a tilt sensor, or the reference plane can be a long-term alignment of the carrier vehicle, where the at least one sensor arrangement for the detection of an angular position of the boom about the rotation axis in relation to a reference plane preferentially comprises detection of a relative rotation between the carrier vehicle and boom, for instance, by way of an angle of rotation sensor, which detects the angle between the boom and carrier vehicle.
For the purpose of determining the present angular position of the boom about the rotation axis in relation to the reference plane by way of merging the angular position of the boom, which is calculated by way of an angular velocity, with the angular position of the boom, which is sensor-detected directly or indirectly by subtraction, the control unit is preferably provided with means for carrying out a Kalman filtering.
For the determination of the present angular position of the boom about the rotation axis in relation to the reference plane by way of merging the angular position of the boom, which angular position is calculated by way of an angular velocity, with the angular position of the boom, which is sensor-detected directly or indirectly by subtraction, the control unit can alternatively or additionally be equipped with means for the low-pass filtering of the sensor-detected angular position as well as with means for the comparison of the low-pass filtered, sensor-detected angular position under continuous zero balance with the angular position, which is calculated by way of an angular velocity in order to compensate the angle drift.
The control unit regulates and/or controls the angular position of the boom about the rotation axis along the driving direction of the carrier vehicle by means of at least one actuator, which comprises, for instance, at least one hydraulic cylinder.
The control unit can allow for a manual operating mode, in which the actuator, which acts on the angular position of the boom about the rotation axis in relation to the carrier vehicle, performs no active control and the boom is guided, for instance, nearly actuating power-free.
In the manual operating mode, at least a part of the boom, for instance, at least a middle part, which is arranged between the cantilevers, follows the motion of the carrier vehicle as seen over a longer period of time, since the carrier vehicle basically follows the field relief and thus the contour of the field.
High frequency rolling movements of the carrier vehicle, however, should have no influence on the angular position of the boom in relation to a long-term alignment of the carrier vehicle or to a reference plane corresponding to an artificial horizon.
The control unit moreover allows for an automatic operating mode, in which the actuator carries out an active motion, in order to thus adapt the angular position of the boom in relation to the reference plane.
The invention allows a very accurate determination of a present angular position of the boom in relation to a reference plane. In comparison to determining the angular position by way of a plurality of ultrasonic sensors, this is less elaborate and less cost-intensive.
In addition, the device can comprise an actuator influencing an average distance of the boom in relation to the ground or to the growth in dependence on control signals from the control unit, for instance, in the form of one or a plurality of hydraulic cylinders, which actuator converts control signals into mechanical motion or another physical quantity, such as, for instance, pressure, and thus exerts a force on the boom, which force raises or lowers the boom. Instead of the hydraulic cylinder, other suitable actuators can generally also be employed, for example, pneumatic, electromechanical, or electromotive actuators.
Furthermore, the device can comprise at least one sensor arrangement for detecting at least one average distance of the boom in relation to the ground or to the growth. Preferably, such a sensor arrangement typically comprises at least one distance sensor arranged at one end of a cantilever of the boom. By means of these distance sensors, which are arranged at the ends of the cantilevers of the boom, and by means of an appropriate consideration of their output signals in producing control signals by means of the control unit, it is possible to increase the reliability with which it can be prevented that the boom or spreading means for solid and/or liquid active agents arranged thereat, such as, for instance, spray nozzles, come into contact with the ground and/or with the growth. It should be noted that the sensor arrangement can optionally comprise only one single distance sensor at one end of one of the cantilevers of the boom. By means of such a distance sensor, which is arranged at one end of one of the cantilevers of the boom, and by an appropriate consideration of its output signal in producing control signals by means of the control unit, it is possible to increase the reliability with which it can be prevented that the boom or spreading means for solid and/or liquid active agents arranged thereat, such as, for instance, spray nozzles, come into contact with the ground and/or with the growth.
Alternatively or additionally, such a sensor arrangement can comprise at least one distance sensor arranged at the part of the boom not projecting beyond the width of the carrier vehicle.
By way of the distance signals of the sensors, the control unit can produce control signals provided at least for the actuator to influence at least one average distance of the boom in relation to the ground or to the growth.
In order to exclude influences from uneven mass distributions of the boom as far as possible, the rotation axis preferably runs through the center of gravity of the boom.
The at least one boom can be arranged on the carrier vehicle in a permanent manner or so as to be exchangeable for another apparatus for agricultural soil treatment and/or growth treatment.
In this context, the carrier vehicle can be driven or towed such that the device:
Additional advantages in comparison with prior art over and above those already mentioned will result from completely solving the proposed task together with the remedy of any disadvantages of prior art.
Moreover, it is reliably prevented that the cantilevers come into contact with the ground by precisely maintaining the distances of the cantilevers in relation to the ground surface and/or to the growth, independent of the moving and/or rolling carrier vehicle.
A second object of the invention relates to a method for controlling a previously described device by way of regulation of the angular position of the boom of the device, which is arranged on the carrier vehicle to be movable about a rotation axis based on a present angular position, where the following is provided for the purpose of determining the present angular position:
By merging the calculated angular position and the measured angular position, referred to as the detected angular position, the present angular position in relation to the reference plane is determined very precisely, with only the advantages of each of the measuring methods being used and without having to put up with their disadvantages.
The method preferentially provides merging the angular position of the boom in relation to the reference plane, which angular position is calculated by way of the angular velocity, with the angular position of the boom in relation to the reference plane, which angular position is detected independently of the angular velocity, in order to generate a control signal, which returns the boom from its present angular position to a desired angular position in relation to the reference plane.
The method can provide for detecting the angular velocity by way of an angular rate sensor, which is arranged on the boom and which detects the angular velocity of the boom.
In this context, an angular rate sensor is employed for the detection of the angular velocity, which angular rate sensor is mounted directly on the boom. Rotary movements of the carrier vehicle thus have no influence on determining the angular velocity of the boom. An output signal of an angular rate sensor, which output signal is proportional to the measurand or reflects it, thus corresponds to the rotary movement of the boom in relation to any optional reference plane, for instance, in relation to the surface of the earth or orthogonal to the acceleration of gravity, respectively, or in relation to a long-term alignment of the carrier vehicle reflecting an averaged ground profile.
This measurand or an output signal, respectively, of an angular rate sensor detecting angular velocities of the boom, which output signal is integrated into the control signals and which output signal is proportional to this measurand or reflects it, can be used for the purpose of obtaining an active damping of the boom in the form of an actively induced brake torque.
Additionally or alternatively, a method can be provided to detect the angular velocity of the boom by way of the angular velocity of the carrier vehicle about its longitudinal axis, which runs parallel to the rotation axis, along with the relative rotation between the carrier vehicle and boom such that the absolute angular velocity of the boom about the rotation axis can then be determined from the two measured values of the angular velocity of the carrier vehicle in relation to its longitudinal axis and relative rotation between the carrier vehicle and boom.
For this purpose, it can be provided to locate an angular rate sensor on the carrier vehicle of the device in order to detect the angular velocity of the carrier vehicle about its longitudinal axis, which angular velocity is also referred to as the roll rate, and to provide an angle of rotation sensor or a rotational angular velocity sensor between the carrier vehicle and boom.
As an alternative or in addition, it can be provided to detect an angular acceleration and to obtain the angular velocity by temporal integration.
Alternatively or additionally, it can be provided to detect translational accelerations in the area of the cantilevers of the boom, preferably at the oppositely positioned ends of the cantilevers, and to first calculate the angular acceleration of the boom by way of a difference between the translational accelerations at the oppositely positioned ends of the cantilevers and to then in turn calculate the angular velocity by temporal integration.
In addition to or instead of the previous exemplary embodiments, which comprise detection of the relative rotation between the carrier vehicle and boom, the method can provide to detect the relative rotation between the carrier vehicle and boom by way of the difference between the angular position of the boom about the rotation axis in relation to a reference plane and the angular position of the carrier vehicle about its longitudinal axis in relation to the reference plane, which longitudinal axis runs parallel to the rotation axis, where the difference of the angle between the carrier vehicle and the reference plane, which angle is detected by the sensors, and the angle between the boom and the reference plane is proportional to a relative rotation between the carrier vehicle and boom. For the detection of the angular position of the boom about the rotation axis in relation to a reference plane and of the angular position of the carrier vehicle about its longitudinal axis in relation to the reference plane, which longitudinal axis runs parallel to the rotation axis, tilt angle sensors can be provided respectively at the boom and at the carrier vehicle, which tilt angle sensors detect tilt angles between the boom and the vertical and/or the horizontal or between the carrier vehicle and the vertical and/or the horizontal, respectively.
By merging the angular position of the boom, which angular position is calculated by way of a detected angular velocity, with a calculated and/or detected relative rotation between carrier vehicle and boom, the method can provide for taking reference to a reference plane corresponding to a long-term alignment of the carrier vehicle and reflecting an averaged ground profile.
For the detection of an angular position of the boom about the rotation axis in relation to a reference plane, the method can provide for detecting a tilt angle, which reflects an angle between the boom and the reference plane, by means of a tilt sensor, for instance.
By merging the angular position of the boom, which angular position is calculated by means of an angular velocity, with an angular position of the boom, which angular position is detected by the detection of an angle between the boom and the reference plane, it is possible to take reference to a reference plane corresponding to an artificial horizon.
For the purpose of determining the present angular position of the boom about the rotation axis in relation to the reference plane by way of merging the angular position of the boom, which is calculated by means of an angular velocity, with the angular position of the boom, which is detected directly or indirectly by subtraction, the method can provide to carry out a Kalman filtering.
For determining the present angular position of the boom about the rotation axis in relation to the reference plane by way of merging the angular position of the boom, which angular position is calculated by way of an angular velocity, with the angular position of the boom, which is detected directly or indirectly by subtraction, the method can alternatively or additionally provide for carrying out a low-pass filtering of the detected angular position as well as a comparison of the low-pass filtered, detected angular position under continuous zero balance with the angular position, which is calculated by way of an angular velocity in order to compensate the angle drift.
The method allows utilizing all advantages of the described device.
Besides the use in connection with a previously described device for spreading liquid and/or solid active agents, the method is suitable for the use with any devices for agricultural ground and/or growth treatment, which, for the purpose of protecting the ground or the growth, dispense from equipment that is supported on the ground, but where nevertheless a high precision is required for guiding in a specified angular position, for instance, in perpendicular or in parallel to the ground.
Both the apparatus and the method can alternatively or additionally have individual or a combination of a plurality of features initially described in connection with the prior art and/or in one or a plurality of documents mentioned regarding the prior art.
Moreover, the apparatus can alternatively or additionally have individual or a combination of a plurality of features previously described in connection with the method, as well as the method can alternatively or additionally have individual or a combination of a plurality of features previously described in connection with the apparatus.
It is to be understood that the regulation of the spray boom can be realized by means of at least one inertial sensor, such as, for instance, an angular rate sensor, such as a gyroscope, which is provided at or in the spray boom and/or at or in a part of the spray boom, for example at or in a middle part. The inertial sensor detects an effective angular velocity of the spray boom and/or of a part of a spray boom independently of a motion of the carrier vehicle. On the basis of the detected angular velocity, an active damping and/or regulation is carried out. An actual angle of twist, which is termed angular position in relation to a reference plane, can be calculated by means of a temporal integral over the angular velocity.
The angular position of the spray boom and/or of a part of a spray boom relative to the carrier vehicle is additionally detected by means of an angle sensor, a rotary encoder, for instance, whereby the absolute angular position of the spray boom or of the part of the spray boom in relation to the carrier vehicle is determined.
By merging the sensor data angular velocity or angular rate, respectively, and absolute angular position or angular position, respectively, which sensor data are obtained by way of the output signals of the sensors, and by an appropriate filtering, for instance, by means of a Kalman filter, it is possible to guide the spray boom or the part of the spray boom which is provided with an inertial sensor, along with the carrier vehicle without high frequency rolling movements disturbing the position and alignment of the spray boom or of the part of the spray boom.
Possible alternatives to an angular rate sensor in the form of a gyroscope, for instance, are one or more angular acceleration sensors or symmetrically arranged angular acceleration sensors, of which the output signals are integrated. If, for instance, two symmetrically arranged angular acceleration sensors are provided in different directions, it is possible to detect the angular acceleration in one direction by way of the angular accelerations of the one or of the other angular acceleration sensor, respectively, and to calculate the angular velocity in the corresponding direction by a temporal integral over the detected angular acceleration.
In summary, the invention thus provides for referencing the present position of the boom to a reference plane in order to be able to regulate the angular position of the boom or in order to be able to regulate the boom to a defined angle, respectively, independently of the motion of the carrier vehicle. This reference plane can be a plane running orthogonal to the direction of acceleration of gravity, or it can correspond to a long-term alignment of the carrier vehicle.
For this purpose, the invention provides for merging two measuring signals, which are obtained by way of mutually independent measuring methods, a calculated angular position of the boom on the one hand, and an angular position of the boom, which angular position is measured or detected, respectively, to a merged control signal or measuring signal, respectively.
The merged measuring signal represents the present angular position of the boom in relation to a reference plane corresponding to a rotation angle between the boom and the reference plane. The reference plane, in this instance, preferably corresponds to an artificial horizon or to a long-term alignment of the carrier vehicle. The result is insensitive to rotatory and translational motions of the carrier vehicle and is not subjected to any angle drift. Furthermore, this merged measuring signal is also non-lagging in relation to the actual rotary movement and thus excellently suited for a regulation that is not undesirably coupled, in particular not high-frequency coupled, to the carrier vehicle.
It is important to point out that the arrangement of the boom at the carrier vehicle, which arrangement is pivotable about at least one rotation axis running preferably parallel to the longitudinal axis of the carrier vehicle, comprises both an arrangement of a boom, which is in itself rigid or articulated, which arrangement is pivotable about at least one rotation axis running preferably parallel to the longitudinal axis of the carrier vehicle, and also an arrangement, which is pivotable about at least one rotation axis running preferably parallel to the longitudinal axis of the carrier vehicle, and which arrangement is an arrangement of two cantilevers of a boom, which are each arranged at the carrier vehicle or at a boom middle part pivotably about respective rotation axes running preferably parallel to the longitudinal axis of the carrier vehicle. The invention and its advantages will be explained in further detail in the following passages by means of exemplary embodiments, which are illustrated in the figures. The size ratios of the individual elements do not necessarily reflect the real size ratios in the figures. It is to be understood that in some instances various aspects of the invention may be shown exaggerated or enlarged in relation to other elements to facilitate an understanding of the invention. The same or equivalent elements of the invention are designated by identical reference characters. Furthermore and for the sake of clarity, only the reference characters relevant for describing the respective figure are provided. It should be understood that the detailed description and specific examples of the transfer case according to the invention are intended for purposes of illustration only and are not intended to limit the scope of the invention.
The schematic illustrations show as follows:
A device 01 for spreading liquid and/or solid active agents as shown entirely or in parts in
The at least one sensor arrangement for the detection of an angular velocity w of the boom 02 or of parts of the boom 02, such as, for example, its cantilevers 21, 22, in relation to a reference plane can comprise one or more angular rate sensors 25, 26 arranged on the boom 02 and detecting the angular velocity w of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, about the at least one rotation axis 20.
Preferably at least one angular rate sensor 25, 26 is employed in this context for the detection of the angular velocity, which angular rate sensor 25, 26 is mounted directly onto the boom 02, for instance at its middle part, or onto a part of the boom 02, which is arranged pivotably about its respective rotation axis 20, such as, for instance, a cantilever 21, 22 of the boom 02, which cantilever is arranged pivotably about a respective rotation axis 20. Rotary movements of the carrier vehicle 10 thus have no influence on the determination of the angular velocity of the boom 02 or of the angular velocities of parts of the boom 02. An output signal of an angular rate sensor 25, 26, which output signal is proportional to the measurand or reflects it, thus corresponds to the rotary movement of the boom 02 or of a part of the boom 02 formed, for instance, by a cantilever 21, 22, in relation to any optional reference plane, for instance, in relation to the surface of the earth or orthogonal to the acceleration of gravity, respectively, or in relation to a long-term alignment of the carrier vehicle 10 reflecting an averaged ground profile.
This measurand or an output signal, respectively, of an angular rate sensor 25, 26 detecting angular velocities of the boom 02 or of parts of the boom 02 formed by the cantilevers 21, 22, which output signal is integrated into the control signals to the actuators 03 and serves as an input variable for the control unit, and which output signal is proportional to this measurand or reflects it, can be used for the purpose of obtaining an active damping of the boom 02 in the form of an actively induced brake torque.
The at least one sensor arrangement for the detection of an angular velocity of the boom 02 or of parts of the booms 02, such as, for instance, its cantilevers 21, 22, about at least one rotation axis 20 in relation to a reference plane can comprise at least two acceleration sensors 27, 28 arranged in the area of the cantilevers 21, 22 of the boom 20, for instance, at the cantilever ends 23, 24. The output signals of the sensor arrangement reflect the translational accelerations at the ends 23, 24 of the cantilevers 21, 22. The difference between the output signals from two acceleration sensors 27, 28 arranged at the opposite ends 23, 24 of the cantilevers 21, 22 multiplied by the working width and/or boom width or with the distance, respectively, between the two acceleration sensors 27, 28, results in the angular accelerations, by the temporal integration of which the angular velocity is in turn obtained.
The at least one sensor arrangement for the detection of an angular velocity of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, about at least one rotation axis 20 in relation to a reference plane can alternatively comprise at least one angular rate sensor, also termed rotational angular velocity sensor, arranged at the carrier vehicle 10 for the purpose of measuring angular velocities of the carrier vehicle 10 at least about its longitudinal axis running in parallel to the at least one rotation axis 20, and thus for measuring rotary movements of the carrier vehicle 10 representing disturbances. In this context, the at least one sensor arrangement for the detection of an angular velocity of the boom 02 about the rotation axis in relation to a reference plane preferably additionally comprises at least one angle of rotation sensor or one rotational angular velocity sensor, which detects a relative rotation between carrier vehicle 10 and boom 02 or between carrier vehicle 10 and, for instance, parts of the boom 02 formed by the cantilevers 21, 22, such that the absolute angular velocity of the boom 02 or of, for instance, parts of the boom 02 formed by the cantilevers 21, 22, about the respective at least one rotation axis 20 can be determined from the two measured values of the angular velocity of the carrier vehicle 10 in relation to its longitudinal axis and of the relative rotation between carrier vehicle 10 and boom 02 or between carrier vehicle 10 and parts of the boom 02 formed by, for instance, the cantilevers 21, 22. By means of an angle of rotation sensor, the relative rotation between carrier vehicle 10 and boom 02 or the relative rotation, respectively, of parts of the boom 02 formed by, for instance, cantilevers 21, 22, which parts are each arranged at the carrier vehicle 10 to be pivotable about the respectively own rotation axes, is directly detected, whereas the relative rotation between carrier vehicle 10 and boom 02 or the relative rotation, respectively, of parts of the boom 02 formed by, for instance, cantilevers 21, 22, which parts are each arranged at the carrier vehicle 10 to be pivotable about the respective rotation axes, is indirectly detected by temporal integration of the angular velocity by way of a rotational angular velocity sensor.
The at least one sensor arrangement for the detection of an angular velocity of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, about at least one rotation axis in relation to a reference plane comprises an angular acceleration sensor instead of or in addition to an angular rate sensor. A measure for the angular velocity can be obtained by temporal integration of this sensor output signal.
The at least one sensor arrangement for the detection of an angular position of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, about the at least one rotation axis 20 in relation to the reference plane can comprise at least one sensor, which detects a relative rotation between carrier vehicle 10 and boom 02 or between carrier vehicle 10 and parts of the boom 02, such as, for instance, its cantilevers 21, 22, in relation to the at least one rotation axis 20.
The at least one sensor for the detection of a relative rotation between carrier vehicle 10 and boom 02 or between carrier vehicle 10 and parts of the boom 02, such as, for instance, its cantilevers 21, 22, can comprise:
In this context, the difference between the angle sensors between the carrier vehicle 10 and the reference plane, which angle is detected by the tilt sensors and the angle between the boom 02 or parts of the boom 02, such as, for instance, its cantilevers 21, 22, and the reference plane is proportional to a relative rotation between carrier vehicle 10 and boom 02 or to a relative rotation, respectively, between carrier vehicle 10 and parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20.
By a merger of the angular position alpha2 of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, which angular position alpha2 is calculated by means of a sensor-detected angular velocity w, with a relative rotation d_alpha1 between carrier vehicle 10 and boom 02 or between carrier vehicle 10 and parts of the boom 02, respectively, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, which relative rotation d_alpha1 is directly sensor-detected by means of an angle of rotation sensor or indirectly sensor-detected by subtraction of the tilt alpha_g of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, and the tilt alpha_t of the carrier vehicle 10 in relation to reference plane, reference can be taken to a reference plane corresponding to a long-term alignment of the carrier vehicle 10 and reflecting an averaged ground profile.
The at least one sensor arrangement for the detection of an angular position of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, about the rotation axis 20 in relation to the reference plane can comprise at least one tilt sensor, which detects an angle alpha_g between the boom 02 or parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, and the reference plane.
By merging the angular position alpha2 of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, which angular position alpha2 is calculated by way of an angular velocity w, with an angular position alpha1 of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, which angular position alpha1 is detected by way of a detection of an angle alpha between the boom 02 and the reference plane or between parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, and the reference plane, reference can be taken to a reference plane corresponding to an artificial horizon.
For the determination of the present angular position of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, about the at least one rotation axis in relation to the reference plane by way of merging the angular position of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, which angular position is calculated by way of an angular velocity, with the angular position of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, which angular position is sensor-detected directly or indirectly by subtraction, the control unit can:
The control unit regulates and/or controls the angular position of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, about the at least one rotation axis 20 along the driving direction of the carrier vehicle 10 by means of at least one actuator 03, which comprises, for instance, at least one hydraulic cylinder. Instead of the hydraulic cylinder, other suitable actuators 03 can generally also be employed at any time, for example, pneumatic, electromechanical, or electromotive actuators 03 or actuating means.
The control unit allows for an automatic operating mode, in which the actuator 03 carries out an active motion, in order to thus adapt the angular position of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, in relation to the reference plane.
The invention allows a very accurate determination of a present angular position of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, in relation to a reference plane. In comparison to determining the angular position by way of a plurality of ultrasonic sensors, this is less elaborate and less cost-intensive.
The at least one boom 02 can be arranged at the carrier vehicle 10 in a permanent manner or so as to be exchangeable for another apparatus for agricultural soil treatment and/or growth treatment.
In this context, the carrier vehicle 10 can be driven or towed such that the device 01:
The device 01 allows for control by a method, where the control is carried out based on a present angular position by way of a regulation of the angular position of the boom 02, which is arranged at a carrier vehicle 10 to be movable about a rotation axis 20, or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20.
Determination of the present angular position in different exemplary embodiments illustrated in
By merging the calculated angular position alpha2 with the measured angular position, referred to as the detected angular position alpha1 or d_alpha1, respectively, the present angular position in relation to the reference plane is determined very precisely, with only the advantages of each of the measuring methods being used and without having to put up with their disadvantages.
By merging the angular position alpha2 of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, in relation to the reference plane, which angular position alpha2 is calculated by means of an angular velocity w, with the angular position alpha1 or d_alpha1, respectively, of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, in relation to the reference plane, which angular position alpha1 or d_alpha1, respectively, is detected independently of the angular velocity w, a control signal can be generated, which returns the boom 02 or parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, from its or their present angular position alpha0, respectively, to a desired angular position in relation to the reference plane.
According to the invention, the angular velocity w can be detected in a plurality of ways.
The angular velocity w can be detected by way of, for instance, at least one angular rate sensor 25, 26, which is arranged on the boom 02 or on parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, which angular rate sensor 25, 26 detects the angular velocity of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20.
For the detection of the angular velocity w, an angular rate sensor 25, 26 can accordingly be used, which is mounted directly onto the boom 02 or onto parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20. Rotary movements of the carrier vehicle 10 thus have no influence on the determination of the angular velocity w of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20. An output signal of an angular rate sensor 25, 26, which output signal is proportional to the measurand or reflects it, thus corresponds to the rotary movement of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, in relation to any optional reference plane, for instance, in relation to the surface of the earth or orthogonal to the acceleration of gravity, respectively, or in relation to a long-term alignment of the carrier vehicle 10 reflecting an averaged ground profile.
This measurand or an output signal respectively, of at least one angular rate sensor 25, 26 detecting angular velocities of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, which output signal is integrated into the control signals and which output signal is proportional to this measurand or reflects it, can be used for the purpose of obtaining an active damping, in the form of an actively induced brake torque, of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20.
Alternatively or additionally, the angular velocity w can be detected by way of an angular velocity of the carrier vehicle 10 about its longitudinal axis, which runs in parallel to the rotation axis 20, and by way of a relative rotation between carrier vehicle 10 and boom 02 or between carrier vehicle 10 and parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, such that the absolute angular velocity w of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, about the at least one rotation axis 20 can then be determined from the two measured values angular velocity of the carrier vehicle 10 in relation to its longitudinal axis and relative rotation between carrier vehicle 10 and boom 02 or between carrier vehicle 10 and parts of the boom 02, respectively, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20.
In order to detect the angular velocity w of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, by way of an angular velocity of the carrier vehicle 10 about its longitudinal axis, which runs in parallel to the rotation axis 20, and by way of a relative rotation d_alpha1 between carrier vehicle 10 and boom 02 or by way of one or more relative rotations d_alpha1, respectively, between carrier vehicle 10 and parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, it can be provided to arrange an angular rate sensor at the carrier vehicle 10 of the device 01, in order to detect the angular velocity, also termed roll rate, of the carrier vehicle 10 about its longitudinal axis, and to provide an angle of rotation sensor or a rotational angular velocity sensor between carrier vehicle 10 and boom 02 or an angle of rotation sensor or a rotational angular velocity sensor, respectively, between carrier vehicle 10 and each of the parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20.
The angular velocity w can alternatively or additionally be detected by way of temporal integration of an angular acceleration and/or by way of temporal integration of an angular acceleration, which is determined by means of translational accelerations.
In order to detect the angular velocity w, translational accelerations in the area of the cantilevers 21, 22 of the boom 02, preferably at the oppositely positioned ends 23, 24 of the cantilevers 21, 22, can be detected, for instance, and, by way of a difference of the translational accelerations at the oppositely positioned ends 23, 24 of the cantilevers 21, 22 and with the knowledge of the boom width, also termed working width, the angular acceleration of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, can first be calculated and in turn the angular velocity w can be calculated by temporal integration.
The angular position alpha1 of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, about the at least one rotation axis 20 in relation to the reference plane can be detected by way of a tilt angle alpha between the boom 02 or between parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, and the horizontal or vertical (
The relative rotation d_alpha1 between carrier vehicle 10 and boom 02 or between carrier vehicle 10 and parts of the boom 02, respectively, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, can be immediately detected, for instance, by way of an angle of twist d_alpha1 between boom 02 and carrier vehicle 10, or indirectly by way of the difference between the angular position alpha_g of the boom 02 about the rotation axis 20 in relation to the reference plane and the angular position alpha_t of the carrier vehicle 10 about its longitudinal axis, which runs in parallel to the rotation axis 20, in relation to the reference plane. The difference of the sensor-detected angle d_alpha1 between the carrier vehicle 10 and the reference plane and of the angle between the boom and the reference plane is proportional to a relative rotation d_alpha1 between carrier vehicle 10 and boom 02. This relative rotation d_alpha1 corresponds to a tilt of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, in relation to a reference plane formed by the carrier vehicle 10, for instance, by its long-term alignment. For the detection of the angular position alpha_g of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, about the at least one rotation axis 20 in relation to the reference plane and of the angular position alpha_t of the carrier vehicle 10 about its longitudinal axis, which runs in parallel to the at least one rotation axis 20, in relation to the reference plane, tilt angle sensors can be provided respectively at the boom 020 and at the carrier vehicle 10 (
For the immediate detection of the relative rotation d_alpha1, an angle of rotation sensor can be provided between boom 02 or between parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, and carrier vehicle 10.
By merging the angular position alpha2 of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, which angular position alpha2 is calculated by means of a detected angular velocity w, with a calculated and/or detected relative rotation d_alpha1 between carrier vehicle 10 and boom 02 or between carrier vehicle 10 and parts of the boom 02, respectively, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, reference is taken to a reference plane corresponding to a long-term alignment of the carrier vehicle 10 and reflecting an averaged ground profile.
By merging the angular position alpha2 of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, which angular position alpha2 is calculated by means of a detected angular velocity w, with an angular position alpha1 of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, which angular position alpha1 is detected by means of a detection of an angle alpha between the boom 02 or between parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, and the reference plane, reference can be taken to a reference plane corresponding to an artificial horizon.
For the determination of a present angular position alpha0 of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, about the at least one rotation axis 20 in relation to the reference plane by way of merging the angular position alpha2 of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, which angular position alpha2 is calculated by way of an angular velocity w, with the angular position alpha1 or d_alpha1 of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, which angular position alpha1 or d_alpha1 is directly detected or indirectly detected by subtraction, it is preferably provided to carry out a Kalman filtering and/or—in order to compensate for the angle drift—a low-pass filtering of the detected angular position alpha1 or d_alpha1, respectively, as well as a comparison under continuous zero balance of the low-pass filtered detected angular position alpha1 or d_alpha1, respectively, with the angular position alpha2, which is calculated by means of an angular velocity w.
For the detection of the angular velocity w, preferentially at least one angular rate sensor 25, 26 is employed in this context, which angular rate sensor 25, 26 is mounted directly onto the boom 02, such as, for instance onto its middle part, or onto parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20. Rotary movements of the carrier vehicle 10 thus have no influence on the determination of the angular velocity w of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20. An output signal, which is proportional to the measurand or reflects it, thus corresponds to the rotary movement of the boom 02 or of parts of the boom 02, such as, for instance, its cantilevers 21, 22, which are arranged pivotably about respective rotation axes 20, in relation to any optional reference plane, for instance, in relation to the surface of the earth or orthogonal to the acceleration of gravity, respectively.
It is important to mention that an angular rate sensor 25, 26 is preferably employed for the determination of the angular velocity w, which angular rate sensor 25, 26 is mounted directly onto the boom 02. The rotary movements of the carrier vehicle 10 thus have no influence on the measurement. Its measurand thus corresponds to the rotary movement of the boom in relation to the surface of the earth or orthogonal to the acceleration of gravity, respectively.
The invention also comprises an angular rate sensor 25, 26 on a carrier vehicle 10, the angular rate sensor having the purpose of measuring rotary movements (disturbances) of the carrier vehicle, where the relative rotation d_alpha1 between carrier vehicle 10 and a boom 02, which is preferably designed as spray boom, can be additionally measured by an angle sensor, which is also referred to as a rotary encoder or rotary sensor, or by an angular velocity sensor, which is also referred to as an angular rate sensor, where the absolute angular velocity w of the spray boom can be determined from the two measured values.
The invention accordingly also comprises a carrier vehicle 10 with a boom 02 mounted thereat and with an angular rate sensor 25, 26.
The invention is commercially applicable in particular in the area of the production of agricultural devices for spreading liquid and/or solid active agents.
The invention has been described with reference to a preferred embodiment. Those skilled in the art will appreciate that numerous changes and modifications can be made to the preferred embodiments of the invention and that such changes and modifications can be made without departing from the spirit of the invention. It is, therefore, intended that the appended claims cover all such equivalent variations as fall within the true spirit and scope of the invention.
Leeb, Theodor, Hirthammer, Otto
Patent | Priority | Assignee | Title |
Patent | Priority | Assignee | Title |
6131821, | Apr 10 1996 | SA EXEL INDUSTRIES | Field sprayer |
8235231, | May 21 2008 | Liebherr-Werk Nenzing GmbH | Crane control with active heave compensation |
9151013, | Apr 20 2009 | Robert Bosch GmbH | Mobile working machine comprising a position control device of a working arm, and method for controlling the position of a working arm of a mobile working machine |
20050251026, | |||
20070084352, | |||
20090069987, | |||
20090082930, | |||
20090118892, | |||
20110282554, | |||
20120211301, | |||
20120215410, | |||
DE102004004491, | |||
DE102004033900, | |||
DE102007045846, | |||
DE102010035291, | |||
DE1020131103049, | |||
DE19962687, | |||
DE3202569, | |||
DK2559332, | |||
EP922385, | |||
EP1416095, | |||
EP1444894, | |||
EP2042276, | |||
EP2123588, | |||
EP2308755, | |||
EP2511678, | |||
EP2559332, | |||
EP3183963, | |||
GB1380029, | |||
GB2252295, | |||
JP2001275409, | |||
JP2004321135, | |||
JP2004350567, | |||
JP2008129813, | |||
JP200829261, | |||
JP201130464, | |||
JP6178603, | |||
RU2241328, | |||
RU2242116, | |||
WO36376, | |||
WO134511, | |||
WO2004112610, | |||
WO2007046980, | |||
WO2010121713, | |||
WO2012045964, | |||
WO2012146255, | |||
WO2015040133, | |||
WO9737533, | |||
WO2004112610, | |||
WO20041126110, |
Executed on | Assignor | Assignee | Conveyance | Frame | Reel | Doc |
Sep 18 2014 | HORSCH LEEB Application Systems GmbH | (assignment on the face of the patent) | / | |||
Nov 23 2015 | LEEB, THEODOR | HORSCH LEEB Application Systems GmbH | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 038001 | /0884 | |
Nov 23 2015 | HIRTHAMMER, OTTO | HORSCH LEEB Application Systems GmbH | ASSIGNMENT OF ASSIGNORS INTEREST SEE DOCUMENT FOR DETAILS | 038001 | /0884 |
Date | Maintenance Fee Events |
Date | Maintenance Schedule |
Aug 20 2022 | 4 years fee payment window open |
Feb 20 2023 | 6 months grace period start (w surcharge) |
Aug 20 2023 | patent expiry (for year 4) |
Aug 20 2025 | 2 years to revive unintentionally abandoned end. (for year 4) |
Aug 20 2026 | 8 years fee payment window open |
Feb 20 2027 | 6 months grace period start (w surcharge) |
Aug 20 2027 | patent expiry (for year 8) |
Aug 20 2029 | 2 years to revive unintentionally abandoned end. (for year 8) |
Aug 20 2030 | 12 years fee payment window open |
Feb 20 2031 | 6 months grace period start (w surcharge) |
Aug 20 2031 | patent expiry (for year 12) |
Aug 20 2033 | 2 years to revive unintentionally abandoned end. (for year 12) |