The present invention relates to a device and a method for detecting the position of a bucket of an excavator. The invention more particularly relates to a device and a method for detecting the position of one or more structures of a bucket of an excavator having a cab and a bucket that is rotatably mounted to a stick being rotatably attached to a boom of the excavator, wherein said excavator comprises a boom that is rotatably attached to the cab by means of a mounting structure. The boom is arranged to rotate with respect to a vertical axis and with respect to a horizontal axis.
Excavators are digging machines, typically mounted on tracks or wheels. A typical excavator has a bucket mounted to the end of a two-member linkage or a three-member linkage. When the excavator has a bucket mounted to the end of a two-member linkage, one of the links, called a boom, is pivotally mounted to a mounting structure of the excavator and extends outward in an upward direction. The other link, is typically referred to as a stick and is pivotally mounted at one end to the outer end of the boom and extends downward from the boom pivot.
When the excavator has a bucket mounted to the end of a three-member linkage, a first boom is pivotally mounted to a mounting structure of the excavator and extends outward in an upward direction. A second boom is rotatably mounted to the distal end of the first boom and extends between the first boom and a stick being pivotally mounted at the distal end of the second boom.
In some constructions, the stick is provided as a telescopic arm.
The bucket is rotatably attached to the outer end of the stick. A typical excavator comprises three or four hydraulic cylinders arranged to independently move the boom(s), the stick, and the bucket under the control of an operator or a machine control system. An excavator is typically provided with a hydraulic drive arranged and configured to rotate the machine base relative to the track to permit repositioning the bucket for operations like dumping.
It requires a skilled operator to operate an excavator efficiently. Since each of the couplings between the machine base, boom(s), stick, and bucket are pivots, extending or retracting any single hydraulic cylinder will cause the digging edge of the bucket to move in an arc.
One problem associated with the operation of an excavator is how to indicate to the operator the position of the bucket. For the large-type excavators (typically above 12-15,000 kg) various devices for determining the position of the bucket have been developed. One known way to determine the position of the bucket is to utilize angular sensors (inertial measurement units (IMU)) to detect the relative angles between the machine base, boom, stick, and bucket. Hereafter, it is possible to calculate the position of the bucket, using principles of geometry, given the measured angles and the lengths of the links. In practice, an IMU is configured to measure the angle of a segment relative to the gravity vector.
The prior art position detection devices are, however, not suitable for being used to detect the position of the bucket of small-sized excavators (typically below 12-15,000 kg). A small-sized excavator typically comprises a cab and a bucket rotatably mounted to a stick being rotatably attached to a boom, possibly rotatably attached to a second boom, rotatably attached to the cab by means of a mounting structure rotatably attached to the cab by means of a shaft having a longitudinal axis (perpendicular to the axis extending from the rear side to the front side) extending basically vertically during normal use of the excavator. The mounting structure is arranged and configured to allow the boom to be rotated with respect to the longitudinal axis of the shaft. It is usually not possible to apply an IMU to measure the rotation of the boom with respect to the longitudinal axis of the shaft. Accordingly, the prior art position detection devices do not take into consideration that the boom can be rotated with respect to the longitudinal axis of the shaft. Accordingly, the prior art position detection devices fail to determine the position of the bucket in an accurate manner when it comes to small-sized excavators. Thus, use of a prior art position detection device will result in inaccurate bucket position determination.
Thus, there is a need for a device and a method which enables a more accurate determination of the position of the bucket in small-sized excavators.
A position detection device according to the invention is a position detection device for detecting the position of a bucket of an excavator having a cab and an arm comprising one or more booms. The excavator comprises a first boom rotatably attached to the cab by a shaft having a longitudinal axis extending basically vertically during normal use of the excavator. The bucket is rotatably mounted to a stick, the stick rotatably attached to the most distal boom. The cab has a longitudinal axis (an axis extending from the rear side to the front side of the cab) and a lateral axis (this axis extends horizontally and is lateral with respect to the longitudinal axis) extending perpendicular thereto. The mounting structure is arranged and configured to allow the first boom and thus the arm to be rotated about the longitudinal axis of the shaft. The position detection device comprises one or more 3-D positioning devices such as antennas arranged and configured to receive satellite signals from one or more satellites. The position detection device comprises a sensor assembly configured to measure a quantity related to the rotation of the first boom about the longitudinal axis of the shaft in order to detect the angular position of the first boom with respect to rotation about the longitudinal axis of the shaft on the basis of the measured quantity. The position detection device comprises a control unit configured to calibrate the sensor assembly.
Hereby, it is possible to provide a position detection device that enables a more accurate determination of the position of the bucket in small-sized excavators. The position detection device takes into account the angular position of the first boom with respect to rotation about the longitudinal axis of the shaft.
By the term “position” of the bucket is meant the coordinate of one or more structures of the bucket and/or the orientation of the bucket and/or the relative position (distance to a predefined position or line or plane such as a horizontal plane) and/or the relative orientation (e.g. angle with respect to a predefined direction such as vertical or horizontal).
By the term “during normal use” is meant “when the excavator is placed on a horizontal surface”.
By the term “bucket” is meant any excavator attachment (any tool suitable for being mounted on the distal end of the stick). Accordingly, the bucket may be an excavator bucket, an excavator-mounted drilling attachment such as an auger, a brush mower, a concrete breaker, a compactor wheel, a crusher bucket, a drum cutter, a forestry mulcher, a hydraulic thumb or a plate compactor.
The proximal end of the first boom is rotatably mounted such that the first boom can rotate with respect to a vertical axis and to a horizontal axis. In one embodiment, the antennas are Global Navigation Satellite System (GNSS) antennas. In one embodiment, the antennas are replaced by other 3-D positioning devices. In one embodiment, the 3-D position devices are laser sensors. In one embodiment, the 3-D position devices are optical sensors such as cameras.
A position detection device according to the invention is a position detection device for detecting the position of a bucket of an excavator having a cab. The position detection device is also configured to detect the orientation of the bucket. It is important to emphasize that the bucket can be rotatably attached to the stick in numerous ways allowing the bucket to rotate relative to the stick with respect to one or more axes of rotation.
The bucket is rotatably mounted to a stick, said stick being rotatably attached to the most distal boom. The arm may comprise one, two or more booms. The stick is attached to the most distal boom. The most proximal boom, however, is rotatably attached to the cab by means of a mounting structure that is rotatably attached to the cab by a shaft. The shaft may be a one-piece body. However, it may also comprise several separate segments.
In one embodiment, the stick is formed as a telescopic arm capable of changing its length. In another embodiment, the stick has a fixed length.
The shaft has a longitudinal axis extending basically vertically during normal use (when the excavator is arranged on a horizontal surface) of the excavator. The cab has a longitudinal axis (extending from its rear end to its front end) and a lateral axis extending perpendicular thereto.
The mounting structure is arranged and configured to allow the boom to be rotated with respect to the longitudinal axis of the shaft.
The position detection device comprises at least one antenna arranged and configured to receive satellite signals from one or more satellites. The antenna may be referred to as a Global Navigation Satellite System, GNSS receiver. In an embodiment, the position detection device comprises two antennas arranged and configured to receive satellite signals from one or more satellites. The position detection device comprises a unit configured to determine a position on the basis of the satellite signals.
The position detection device comprises a sensor assembly configured to detect the angular position of the first boom with respect to rotation about the longitudinal axis of the shaft. In an embodiment, the position detection device is configured to detect the angular position of the first boom with respect to rotation about the longitudinal axis of the shaft on a continuous basis.
In an embodiment, the angular position of the first boom with respect to rotation about the longitudinal axis of the shaft is defined as the angle between any predefined direction and the projection of the longitudinal axis of (at least a portion, e.g. the proximal portion of) the first boom in the plane spanned by the lateral axis of the cab and the longitudinal axis of the cab. This plane extends perpendicular to the longitudinal axis of the shaft.
In an embodiment, the angular position of the first boom with respect to rotation about the longitudinal axis of the shaft is defined as the angle between the longitudinal axis of the cab and the projection of the longitudinal axis of the proximal portion of the first boom in the plane spanned by the lateral axis of the cab and the longitudinal axis of the cab.
In an embodiment, the quantity related to the rotation of the first boom about the longitudinal axis of the shaft is a distance between the cab and the mounting structure.
In an embodiment, the quantity related to the rotation of the first boom about the longitudinal axis of the shaft is an angular measurement.
In an embodiment, the sensor assembly is configured to measure a distance between the cab and the mounting structure. Hereby, it is possible to provide a reliable, simple and efficient way of detecting the angular position of the first boom with respect to rotation about the longitudinal axis of the shaft.
In an embodiment, the sensor assembly is configured to measure the distance between one predefined position of a first group of elements and a predefined position of a second group of elements, wherein the first group of elements comprises the cab, wherein the second group of elements comprises the first boom and the mounting structure.
The measurement of the distance may be carried out using any suitable distance detection unit including laser distance measurement sensors and ultrasonic distance sensors and wire sensors.
In an embodiment, the control unit is configured to calibrate the sensor assembly by measuring the angular position of the first boom with respect to rotation about the longitudinal axis of the shaft using a predefined protocol and for detecting the output from the sensor assembly for a plurality of configurations having different angular positions.
The predefined protocol may be any of the protocols defined in the detailed description and referred to as:
In an embodiment, the predefined protocol applies one or more of the following measurements to detect the angular position:
A position detection device and method according to the invention may apply one or more sensors that may include one or more IMU. By “IMU” is meant an electronic device configured to measure and report a specific force and/or angular rate and/or the orientation of a body using a combination of accelerometers, gyroscopes, and sometimes magnetometers and pressure sensors. Using an IMU it is possible for a satellite-based radio-navigation system receiver to work when satellite-signals are unavailable. In the following, GNSS (Global Navigation Satellite System) antennas are meant when referring to antennas receiving satellite signals.
In an embodiment, the predefined protocol applies the orientation of the cab measured using sensors available on the cab (or a structure fixed to the cab) to detect the angular position.
In an embodiment, the predefined protocol applies the orientation of the boom to detect the angular position.
In an embodiment, the predefined protocol applies the position of the shaft to detect the angular position.
In an embodiment, the predefined protocol applies the position of a fixed point on the bucket to detect the angular position.
In an embodiment, the predefined protocol applies the position of a fixed point on the bucket to detect the angular position.
In an embodiment, the sensor assembly is configured to measure the radial displacement of the rotation cylinder. Hereby, this radial displacement can be used to determine the rotation angle.
In an embodiment, the sensor assembly is configured to measure the distance between a fixed position on the cab or on a structure attached thereto and a fixed position on the mounting structure or a structure attached thereto. Hereby, it is possible to detect the angular position of the first boom with respect to rotation about the longitudinal axis of the shaft in a simple way by applying standard measurement components.
In an embodiment, the angular position of the first boom with respect to rotation about the longitudinal axis of the shaft is detected by measuring the length of a rotation cylinder extending between the cab and the mounting structure.
In an embodiment, the sensor assembly comprises a wire sensor. Hereby, it is possible to provide a simple, robust and reliably way of determining the angular position of the boom with respect to rotation about the longitudinal axis of the shaft. By the term wire (for the wire sensor) is meant any suitable structure having basically the same mechanical properties as a wire including a string, a cord or a line.
In an embodiment, the position detection device comprises one or more inclination sensors or one or more IMU connected to the cab (or a structure attached thereto) and/or on the boom and/or on the stick and/or on the bucket. Hereby, the inclination of one of the components can be taken into account. Accordingly, the determination of the position and/or the orientation of the bucket will be more accurate. The inclination sensors may be mounted on any link or joint of the structure that is rotatably mounted with respect to the shaft.
A position detection device comprises a control unit configured to calibrate the sensor assembly using a predefined list of wire lengths at a number of predefined rotational positions of the boom. Hereby, it is possible to apply a simple sensor assembly to detect the angular position of the first boom with respect to rotation about the longitudinal axis of the shaft on the basis of the distance. The sensor assembly is configured to measure a quantity that is related to the rotation of the first boom about the longitudinal axis of the shaft and to determine the angular position of the first boom with respect to rotation about the longitudinal axis of the shaft on the basis of the measured quantity. This means that a simple sensor can be used to perform the required angular measurements.
In an embodiment, the quantity is a distance between the cab (or a structure fixed to the cab) and the mounting structure.
In an embodiment, the quantity is a rotation measured by one or more rotational sensors.
In an embodiment, the quantity is a vibration signal measured by one or more vibration sensors.
The calibration may be carried out using the GNSS receivers of the excavator to determine the orientation of the cab. It is possible to provide a calibration line extending in a predefined direction (e.g. parallel to the longitudinal axis of the cab) by means of a wire, a string, a rope or a straight beam. Hereafter the cab can be rotated with respect to its vertical axis of rotation while the first boom remains parallel with the calibration line. By noting corresponding values of the rotational angle and the wire length, it is possible to fill out a table like the one shown and explained with reference to
In an embodiment, a position detection device comprises two spaced apart mounting brackets and a wire sheath extending between two sheath mounts arranged at each end of the wire sheath, wherein the wire is slidably arranged in said wire sheath and extends in extension thereof. This solution is easy to implement and allows the wire to be mounted in various positions. Accordingly, the position detection device can be mounted on excavators having different shapes and structures onto which the wire sensor must be mounted.
In an embodiment, the wire protrudes out of each end of the wire sheath.
In an embodiment, a position detection device comprises a display unit configured to display the rotation of the mounting structure with respect to the longitudinal axis of the shaft. Hereby, the operator is capable of controlling the excavator in a more efficient manner.
It may be an advantage that the position detection device comprises a control unit connected to the display, wherein the control unit is configured to receive the detected angular position of the first boom with respect to rotation about the longitudinal axis of the shaft on a continuous basis.
In an embodiment, a position detection device comprises a display unit configured to display the position and/or orientation of the bucket. Hereby, the operator is capable of controlling the excavator in a more efficient manner.
A method according to the invention is a method for determining the position of a bucket of an excavator having a cab and an arm comprising one or more booms, wherein the excavator comprises a first boom rotatably attached to the cab by a mounting structure that is rotatably attached to the cab by a shaft having a longitudinal axis extending basically vertically during normal use of the excavator. The bucket is rotatably mounted to a stick that is rotatably mounted to the most distal boom. The cab has a longitudinal axis and a lateral axis extending perpendicular thereto, wherein the mounting structure is arranged and configured to allow the first boom and thus the arm to be rotated about the longitudinal axis of the shaft. A position detection device comprises at least one 3-D positioning device such as an antenna arranged and configured to receive satellite signals from one or more satellites. The method comprises the step of detecting the angular position of the first boom with respect to rotation about the longitudinal axis of the shaft, calibrating the sensor assembly by measuring the angular position of the first boom with respect to rotation about the longitudinal axis of the shaft using a predefined protocol, and detecting the output from the sensor assembly for a plurality of configurations of the excavator corresponding to different angular positions.
Hereby, it is possible to provide a more accurate determination of the position and/or orientation of the bucket than methods of the prior art.
By the term “during normal use” is meant “when the excavator is placed on a horizontal surface”.
In an embodiment, a position detection device comprises a control unit configured to calibrate the sensor assembly.
In an embodiment, the angular position is determined by measuring a distance between the cab and the mounting structure. Hereby, it is possible to determine the angular position in an easy and reliable manner. It has to be emphasized that one has to measure the distance between two specific predefined positions on the cab (or a structure fixed to the cab) as well as two predefined positions on the mounting structure (or a structure fixed to the mounting structure), respectively.
In an embodiment, the distance between the cab and the mounting structure is measured using a wire sensor. Hereby, it is possible to provide a simple robust and reliable way of detecting the angular position.
In an embodiment, the predefined protocol applies the orientation of the cab measured using sensors available on the cab (or a structure fixed to the cab) to detect the angular position.
In an embodiment, the predefined protocol applies the orientation and position of the cab measured using sensors available on the cab (or a structure fixed to the cab) to detect the angular position.
In an embodiment, the predefined protocol applies the orientation of the boom to detect the angular position.
In an embodiment, the predefined protocol applies the position of the longitudinal axis of the shaft to detect the angular position.
In an embodiment, the predefined protocol applies the position of a fixed point on the bucket to detect the angular position.
In an embodiment, the step of calibrating the sensor assembly is carried out using a calibration procedure, in which the position of the cab is measured using a number of sensors available on the cab or a structure rigidly fixed to the cab, wherein the excavator comprises an arm defined as the structures that are being moved when rotating the mounting structure about the shaft. The calibration procedure comprises the step of placing the excavator in a position, in which the position of the shaft and a fixed point on the arm are known, wherein the calibration procedure moreover comprises the step of rotating the arm with respect to the shaft into a plurality of different angular positions relative to the lateral axis of the cab, wherein for each of these angular positions (into which the arm is positioned) the angle between the arm and the lateral axis of the cab is determined.
In an embodiment, the excavator comprises an arm defined as the structures that are being moved when rotating the mounting structure about the shaft. The step of calibrating the sensor assembly is carried out using a calibration procedure, in which the position of the cab is to be measured using sensors available on the cab or a structure rigidly fixed to the cab. The calibration procedure comprises the steps of arranging the excavator in a position, in which the position of the shaft is known, measuring the absolute position of a point on the arm, and rotating the arm with respect to the shaft into a plurality of different angular positions relative to the lateral axis of the cab, wherein for each of these angular positions (into which the arm is positioned) the angle between the arm and the lateral axis of the cab is determined.
In an embodiment, the excavator comprises an arm defined as the structures that are being moved when rotating the mounting structure about the shaft, wherein the step of calibrating the sensor assembly is carried out using a calibration procedure, in which the position of the cab is measured using sensors available on the cab or a structure rigidly fixed to the cab. The calibration procedure comprises the step of measuring a vector extending between a predefined point on the cab or a structure rigidly fixed to the cab to a fixed point on the arm, wherein the vector is measured by measuring the position of the points by means of 3-D positioning device such as a GNSS antenna arranged and configured to receive satellite signals from one or more satellites and hereby measure the position. The calibration procedure further comprises the step of comparing the orientation vector of the cab and the vector extending between the predefined point and the fixed point on the arm, wherein the latter step is carried out for a plurality of different angles between the arm and the lateral axis of the cab.
In an embodiment, the excavator comprises an arm defined as the structures that are being moved when rotating the mounting structure about the shaft, wherein the step of calibrating the sensor assembly is carried out using a calibration procedure, in which a number of gyroscopes placed on the arm are used to measure the relative angle of the arm from a predetermined point, wherein the measurement of the relative angle is carried out for a plurality of different angles between the arm and the lateral axis of the cab.
In an embodiment, the excavator comprises an arm defined as the structures that are being moved when rotating the mounting structure about the shaft, wherein the step of calibrating the sensor assembly is carried out using a calibration procedure, in which one or more accelerometers and/or gyroscopes and/or magnetometers placed on the arm are used together with one or more accelerometers and/or gyroscopes and/or magnetometers positioned on the cab or a structure rigidly fixed to the cab to measure the angle, wherein the measurement of the relative angle is carried out for a plurality of different angles between the arm and the lateral axis of the cab.
In an embodiment, a position detection device is a position detection device for detecting the position of a bucket of an excavator having a cab and one or more booms, wherein the excavator comprises a first boom being rotatably attached to the cab by means of a mounting structure that is rotatably attached to the cab by a shaft having a longitudinal axis extending basically vertically during normal use of the excavator. The bucket is rotatably mounted to a stick, said stick being rotatably attached to either the first boom or a second boom being rotatably attached to the first boom. The cab has a longitudinal axis and a lateral axis extending perpendicular thereto, wherein the mounting structure is arranged and configured to allow the first boom to be rotated with respect to the longitudinal axis of the shaft. The position detection device comprises one or more antennas arranged and configured to receive satellite signals from one or more satellites. The position detection device comprises a sensor assembly configured to detect the angular position of the first boom with respect to rotation about the longitudinal axis of the shaft, wherein the sensor assembly is configured to measure a distance between the cab and the mounting structure. The sensor assembly is configured to measure the distance between a fixed position on the cab or on a structure attached thereto and a fixed position on the mounting structure or a structure attached thereto. The sensor assembly comprises a wire sensor, wherein the position detection device comprises two spaced apart mounting brackets and a wire sheath extending between two sheath mounts arranged at each end of the wire sheath, wherein the wire is slidably arranged in said wire sheath and extends in extension thereof.
In an embodiment, a position detection device is a position detection device, in which the sensor assembly is configured to measure the distance between one predefined position of a first group of elements and a predefined position of a second group of elements, wherein the first group of elements comprises the cab, wherein the second group of elements comprises the first boom and the mounting structure.
In an embodiment, the position detection device is a position detection device, in which the position detection device comprises a display unit configured to display the rotation of the mounting structure with respect to the longitudinal axis of the shaft.
In an embodiment, a method disclosed herein is a method for determining the position of a bucket of an excavator having a cab and one or more booms, wherein the excavator comprises a first boom being rotatably attached to the cab by a mounting structure that is rotatably attached to the cab by a shaft having a longitudinal axis extending basically vertically during normal use of the excavator. The bucket is rotatably mounted to the stick that is rotatably mounted to either the first boom or a second boom rotatably attached to the first boom. The cab has a longitudinal axis and a lateral axis extending perpendicular thereto, wherein the mounting structure is arranged and configured to allow the first boom to be rotated with respect to the longitudinal axis of the shaft. The position detection device comprises at least one antenna arranged and configured to receive satellite signals from one or more satellites. The method comprises the step of detecting the angular position of the first boom with respect to rotation about the longitudinal axis of the shaft, wherein the angular position is determined by measuring a distance between the cab and the mounting structure, wherein the distance between the cab and the mounting structure is measured using a wire sensor. The wire sensor comprises two spaced apart mounting brackets and a wire sheath extending between two sheath mounts arranged at each end of the wire sheath, wherein the wire is slidably arranged in said wire sheath and extends in extension thereof.
It may be an advantage to have an excavator comprising a position detection device according to the invention.
The invention will become more fully understood from the detailed description given herein below. The accompanying drawings are given by way of illustration only, and thus, they are not limitative of the present invention. In the accompanying drawings:
Referring now in detail to the drawings for the purpose of illustrating embodiments of the present invention, an excavator 6 provided with a position detection device according to the invention is illustrated in
The excavator 6 comprises a rotation cylinder 34 extending between the mounting structure 12 and the cab 32. The rotation cylinder 34 is arranged to rotate the mounting structure 12 with respect to the longitudinal axis of the shaft upon being activated. Accordingly, by controlling the rotation cylinder 34, it is possible to rotate the mounting structure 12 and thus the boom 8 with respect to the longitudinal axis of the shaft.
The excavator 6 comprises a position detection device having a wire sensor (see
The excavator 6 comprises a mounting structure 12 rotatably mounted to the front portion of the cab 32. The excavator 6 comprises a boom 8 rotatably attached to the mounting structure 12. The boom 8 is arranged to be rotated about a horizontal axis (when the excavator is placed on a horizontal surface). The boom 8 is also arranged to be rotated about a vertical axis (when the excavator is placed on a horizontal surface). The position detection device is configured to detect the angle of rotation with respect to the vertical axis.
Typically, the rotational angle is determined using a mathematical formula in combination with known angles and corresponding quantities.
If the length could not be measured, a new length measurement is conducted.
When the rotational angle, however, has been determined the rotational angle is used to determine (e.g. calculate) the position of the bucket. Such calculation will typically use position data determined using a satellite-based positioning system (a Global Navigation Satellite System, GNSS). The process illustrated in
The excavator 6 comprises a boom 8 rotatably attached to the mounting structure 12 by a first boom joint 30. A first cylinder 26 is rotatably mounted to the mounting structure 12 by a first cylinder joint 28. The first boom joint 30 and the first cylinder joint 28 are spaced apart from each other. Accordingly, activation of the first cylinder 26 will cause the boom 8 to rotate with respect to the first boom joint 30.
A stick 24 is rotatably attached to the distal end of the boom 8 by a second boom joint 30′. A second cylinder 26′ is rotatably attached to the boom 8 by a second cylinder joint 28′ and to the stick 24 by a third cylinder joint 28″. Accordingly, activation of the second cylinder 26′ will rotate the stick 24 with respect to the second boom joint 30 and thus the boom 8.
The excavator 6 comprises a bucket 4 rotatably attached to the distal end of the stick 24. A third cylinder 26″ is rotatably attached to the stick 24 and to the bucket 4 in such a manner that activation of the third cylinder 26″ will rotate the bucket 4 relative to the stick 24.
The mounting structure is arranged to be rotated with respect to the longitudinal axis Z of the shaft 14. This may be done by applying a cylinder (not shown) rotatably attached to the cab 32 and to the mounting structure 12.
The position detection device comprises a sensor assembly 10 comprising a wire 16 and a wire sensor 18 attached thereto. The wire sensor 18 is arranged to detect the length and/or the length change of the wire. The wire 16 extends between the wire sensor 18 and a point of attachment at the mounting structure 12. Accordingly, the wire sensor 18 can detect the distance between the mounting structure 12 and the wire sensor 18. This distance can be used to determine the rotational angle of the boom 8 with respect to the longitudinal axis Z of the shaft 14.
In another embodiment, the wire sensor 18 may be replaced with another sensor arranged and configured to determine the distance between the mounting structure 12 and a fixed point on the cab 32 or a structure fixed to the cab 32.
The angle can be calculated using a predefined table such as the one explained with reference to
The excavator 6 comprises a cab-mounted GNSS receiver 20 that is connected to a control unit 46 of the position detection device. It is important to emphasize that the GNSS receiver 20 can be mounted elsewhere.
The position detection device comprises a calculation unit configured to calculate the position of the bucket 4. In an embodiment, the calculation unit is configured to calculate the position of the bucket 4 on the basis of position data provided by the cab-mounted GNSS receivers 20, angular sensors arranged to measure the relative angles between the cab 32, boom 8, stick 24, and bucket 4 as well as the detected rotational angle α. When these data are available, it is possible to calculate the position of the bucket 4, using principles of geometry.
In an embodiment, the position detection device comprises a display configured to visualize the bucket 4 relative to a predefined structure or position or line or height. Hereby, it is possible to provide a position detection device that is user-friendly and easy to use by the operator.
The position detection device comprises a wire sensor 18 having a wire 16 protruding from the housing of the wire sensor 18. The wire 16 extends between the housing of the wire sensor 18 and a fixation point at the mounting structure 12.
The position detection device comprises a sensor assembly 10 having a distance sensor arranged at the rotational cylinder 34 and detects the length of a wire 16 extending between a point of fixation on the mounting structure 12 and the distance sensor arranged on the rotational cylinder 34. The sensor assembly 10 detects the length of the wire 16 by means of the distance sensor. The length of the wire 16 is applied to detect the rotational angle of the boom 8 with respect to said rotational axis.
A side view of the bucket is shown in the middle right area of the display. It can be seen that the blade of the bucket is almost horizontally arranged and very close to the level of the ground (indicated with the line just below the bucket. However, in the upper left box it can be seen that the height of the left corner of the edge of the bucket is 0.05 m, whereas the height of the right corner of the edge of the bucket is 0.09 m. Accordingly, the bucket is not 100% horizontally arranged.
The position detection device comprises a control unit configured to calibrate the sensor assembly of the position detection device. Calibration of the sensor assembly can be done using various calibration procedures.
Calibration of the sensor assembly can be done using a first calibration procedure, in which the orientation and position of the cab 32 is known during the entire calibration procedure. The position and orientation of the cab 32 can be measured using sensors available on the cab 32 or a structure fixed to the cab 32. The first calibration procedure comprises the step of placing the excavator 6 in a position, in which the position of the shaft 14 (to which the boom 8 is rotatably attached) and a fixed point on the stick 24, the bucket 4 or a boom 8 is known. This step can be accomplished by positioning the shaft 14 and the fixed point on the bucket 4 or the boom 8 in known positions on the ground.
The first calibration procedure moreover comprises the step of rotating the boom 8 into a plurality of angular positions relative to the lateral axis X of the cab 32. For each of these angular positions, it is possible to determine the angle α between the boom 8 and the lateral axis X of the cab 32. Calculation of the angle α between the boom 8 and the lateral axis X of the cab 32 can be done using simple geometric formulas. If the position of the shaft 14 is defined as the origin in a two-dimensional coordinate system, in which the boom extends along the ordinate, the angle α between the boom 8 and the lateral axis X of the cab 32 will simply correspond to the angle between the abscissa and the longitudinal axis Y of the cab 32. When the orientation of the cab 32 is known, the angle between the abscissa and the longitudinal axis Y of the cab 32 will be known. Using the first calibration procedure it is possible to provide a calibration curve, a calibration table or a mathematical formula, by which one can determine the a between the boom 8 and the lateral axis X of the cab 32 on the basis of data from the sensor assembly of the position detection device. Table 1 and the table shown in
Calibration of the sensor assembly can be done using a second calibration procedure, in which the orientation and position of the cab 32 is known during the entire calibration procedure. The position and orientation of the cab 32 can be measured using sensors available on the cab 32 or a structure fixed to the cab 32. The second calibration procedure comprises the step of arranging the excavator 6 in a position, in which the position of the shaft (to which the boom 8 is rotatably attached) is known. This can be done by positioning the shaft 14 and the fixed point on the bucket 4 in a known position on the ground. The second calibration procedure further comprises the step of measuring the absolute position of a point on the boom 8 or the bucket 4. The absolute position of a point on the stick 24, a boom 8 or the bucket 4 can be measured by means of a sensor (e.g. an antenna arranged and configured to receive satellite signals from one or more satellites and hereby measure the position). Using the second calibration procedure it is possible to provide a calibration curve, a calibration table (see table 1 or the table shown in
Calibration of the sensor assembly can be done using a third calibration procedure, in which the orientation and position of the cab 32 is known during the entire calibration procedure. The position and orientation of the cab 32 can be measured using sensors available on the cab 32 or a structure fixed to the cab 32. The third calibration procedure comprises the step of measuring a vector from a predefined point on the cab 32 or a structure fixed to the cab 32 to a fixed point on the stick 24, a boom 8 or the bucket 4. The vector can be measured by measuring the position of the points using an antenna arranged and configured to receive satellite signals from one or more satellites and hereby measure the position.
The third calibration procedure further comprises the step of comparing the orientation vector of the cab 32 or a structure fixed to the cab 32 and the vector from a predefined point on the cab 32 or a structure fixed to the cab 32 to a fixed point on the stick 24, a boom 8 or the bucket 4. The relative angle between these vectors corresponds to the a between the boom 8 and the lateral axis X of the cab 32. This procedure is carried out for a plurality of angles α between the boom 8 and the lateral axis X of the cab 32. By detecting the output of the sensor assembly of the position detection device for each angle α it is possible to provide a calibration curve as shown in
Calibration of the sensor assembly can be done using a fourth calibration procedure, in which gyroscopes placed on the boom 8 and/or bucket 4 and/or stick (or another structure attached thereto) are used to measure the relative angle of swing boom from a predetermined angle, here denoted the zero-point, although it could be any angle α.
When the boom 8 has been rotated to a predetermined angle such as the zero angle (e.g. defined by this initial orientation of the boom 8). Any further rotation of the boom 8 may then be tracked by at least one sensor that is affected by a change in the angle α). The sensor may be a gyroscope located on the boom, the stick, the bucket 4 (or another structure attached thereto). A gyroscope only provides information about relative change in the angle α. However, since the gyroscope was used to measure an angular displacement starting from a zero angle, the measurement will correspond to the absolute angle α. By detecting the output of the sensor assembly of the position detection device for each angle α it is possible to provide a calibration curve as shown in
Calibration of the sensor assembly can be done using a fifth calibration procedure, in which one or more accelerometers and/or gyroscopes and/or magnetometers placed on the stick 24, a boom 6 or the bucket are used together with one or more accelerometers and/or gyroscopes and/or magnetometers positioned on the cab 32 or a structure fixed to the cab 32 to measure the angle α.
This method is in particular suitable when the cab 32 is arranged on a non-horizontal surface. When the excavator 6 is positioned in a position in which the longitudinal axis Z of the shaft 14 is not parallel (or anti-parallel) with the gravity vector. In this situation it is possible to calculate the angle α directly from a three-axis accelerometer located on the part of the excavator 6 that is affected by a change in the angle α. Alternatively, if the longitudinal axis Z of the shaft 14 is parallel or almost parallel to the gravity vector, a magnetometer and/or compass may be employed instead of one or more accelerometers and/or gyroscopes and/or magnetometers. By detecting the output of the sensor assembly of the position detection device for each angle α it is possible to provide a calibration curve as shown in
Generally, the orientation of the cab 32 can be detected in several ways.
In an embodiment, the orientation of the cab 32 can be detected using two GNSS antennas arranged and configured to receive satellite signals from one or more satellites.
In an embodiment, the orientation of the cab 32 can be detected using a single GNSS antenna in combination with a 3-D position detection device (e.g. 3D position sensor). In an embodiment, the 3-D position detection device is a laser sensor.
In an embodiment, the orientation of the cab 32 can be detected using a single absolute position (e.g. detected by an antenna arranged and configured to receive satellite signals from one or more satellites) in combination with a detection of a rotation of the excavator 6.
In an embodiment, the orientation of the cab 32 can be detected using a compass.
The position of a known point on cab 32 can be obtained from an antenna arranged and configured to receive satellite signals from one or more satellites.
The position of the pivot point (the shaft 14) can be calculated using information about orientation of the cab 32, the pitch and roll of the cab 32 and a position on the cab 32 or a structure fixed to the cab 32 e.g. in combination with a forward, side and down length from a measuring point to the pivot point (the shaft 14).
The absolute position of a point on the boom 6 or the bucket 4 can be measured using an antenna (arranged and configured to receive satellite signals from one or more satellites) fixed on the boom 6 or bucket 4.
It is also possible to generate a mathematical formula describing the relationship between the sensor data and the angular data.
In practice, the points will typically not be on a straight line.
Number | Date | Country | Kind |
---|---|---|---|
PA 2019 00955 | Aug 2019 | DK | national |
This application is a continuation under 35 U.S.C. 111 of International Patent Application No. PCT/DK2020/050231, filed Aug. 11, 2020, which claims the benefit of and priority to Danish Application No. PA 2019 00955, filed Aug. 13, 2019, each of which is hereby incorporated by reference in its entirety.
Number | Date | Country | |
---|---|---|---|
Parent | PCT/DK2020/050231 | Aug 2020 | US |
Child | 17667740 | US |