Determination of an excavator swing boom angle based on intermittent first interim swing boom angles
A system for determining a swing boom angle of an excavator. The system comprises a first measuring sensor configured to be mounted on a vehicle frame or a swing boom 4 , wherein the first measuring sensor is configured to determine a first interim swing boom angle of the swing boom relative to the vehicle frame. The first interim swing boom angle is one of a discrete amount of one or more intermittent first interim swing boom angles, each of the discrete amount of one or more intermittent first interim swing boom angles being spaced from each other by at least a value of one degree. A second measuring sensor mounted on the swing boom to determine a second interim swing boom angle of the swing boom relative to the vehicle frame, the second interim swing boom angle being from an indiscrete angle range and a processing unit.
1 . A system for determining a swing boom angle of an excavator, wherein the excavator comprises:
a vehicle frame comprising a cabin,
a swing boom arranged on the vehicle frame and configured to be rotated relative to the vehicle frame about a vertical rotation axis that an actual swing boom position defines a swing boom angle, wherein the vertical rotation axis is a vertical axis,
wherein the system comprises:
a first measuring sensor configured to be mounted on:
the vehicle frame, or
the swing boom,
wherein the first measuring sensor is configured to determine a first interim swing boom angle of the swing boom relative to the vehicle frame about the vertical rotation axis, the first interim swing boom angle being one of a discrete amount of one or more intermittent first interim swing boom angles about the vertical rotation axis, each of the discrete amount of one or more intermittent first interim swing boom angles being spaced from each other by at least a value of one degree,
a second measuring sensor configured to be mounted on the swing boom and to determine a second interim swing boom angle of the swing boom relative to the vehicle frame about the vertical rotation axis, the second interim swing boom angle being from an indiscrete angle range, a processing unit configured to:
receive the first interim swing boom angle and the second interim swing boom angle about the vertical rotation axis, and
determine the swing boom angle by applying at least one of a filter and an algorithm to the first interim swing boom angle and the second interim swing boom angle about the vertical rotation axis.
2 . The system according to claim 1 , wherein the system further comprises a display unit configured to be arranged in the cabin, wherein the display unit is connected to the processing unit, the display unit being configured to provide a visualization of swing boom angle information to the operator based on the swing boom angle.
3 . The system according to claim 2 , wherein the system is configured to self-calibrate based on a self-calibration procedure including the steps:
movement of the swing boom to a first position, wherein the first position corresponds to a maximum or a minimum extension level of the cylinder,
movement of the swing boom to a second position, wherein the second position corresponds to the maximum or the minimum extension level of the cylinder opposed to the extension level of the cylinder at the first position,
movement of the swing boom from the second position back to the first position,
recording of measurements from the first and the second measuring sensors during the movement of the swing boom,
recording of measurement timings from the first measuring sensor during the movement of the swing boom,
determination of a range of motion of the swing boom and the position of the first measuring sensor based on the recorded measurements from the second measuring sensor and the measurement timings from the first measuring sensor.
4 . The system according to claim 3 , wherein the system further comprises a global position sensor configured to be mounted on the swing boom, wherein the global position sensor provides a position measurement of the swing boom in a global reference frame.
5 . The system according to claim 3 , the system is configured to self-calibrate based on a self-calibration procedure including the steps:
movement of the swing boom to a first position, wherein the first position corresponds to a maximum or a minimum extension level of the cylinder,
determination of an exact first position of the swing boom at the first position with the global position sensor,
movement of the swing boom to a second position, wherein the second position corresponds to the maximum or the minimum extension level of the cylinder opposed to the extension level of the cylinder at the first position,
determination of an exact second position of the swing boom at the second position with the global position sensor,
movement of the swing boom to a third position, wherein at the third position the first measuring sensor determines an intermittent first interim swing boom angle relative to the vehicle frame,
determination of an exact third position of the swing boom at the third position with the global position sensor,
calculation of a rotation axis position based on the determined exact first, second and third positions expressed in a global reference frame,
calculation of a first swing boom angle defined by the first and second position,
calculation of a second swing boom angle defined by the first and third position,
calculation of a third swing boom angle defined by the third and second position, determination of a position of at least one point on the vehicle frame with the global position sensor,
conversion of the calculated first, second and third swing boom angles based on the position determinations with the global position sensor into swing boom angles relative to the vehicle frame, wherein the conversion is based on the calculated rotation axis position and the position of at least one point on the vehicle frame.
6 . The system according to claim 1 , further comprising a counterpart intended for detection by the first measuring sensor, wherein the counterpart:
is configured to be mounted on the swing boom and to move along with the swing movement of the swing boom if the first measuring sensor is mounted on the vehicle frame, or
is configured to be mounted on the vehicle frame at a known position if the first measuring sensor is mounted on the swing boom to move along with the swing movement of the swing boom.
7 . The system according to claim 1 , wherein the first measuring sensor is at least one hall effect sensor and the counterpart is at least one magnet.
8 . The system according to claim 1 , wherein the first measuring sensor is at least one induction sensor and the counterpart is at least one metal structure.
9 . The system according to claim 1 , wherein the first measuring sensor is at least one light emitting and sensing system and the counterpart is at least one reflector.
10 . The system according to claim 1 , wherein the first measuring sensor is at least one momentary switch and the counterpart is at least one metal structure, wherein the at least one metal structure physically contacts the at least one switch and triggers the at least one switch.
11 . The system according to claim 1 , wherein the first measuring sensor is at least one visual sensor configured to detect colors and the counterpart is a color gradient.
12 . The system according to claim 1 , wherein the excavator comprises a pneumatic or hydraulic cylinder, a first end of which is coupled to the vehicle frame and a second end of which is coupled to the swing boom, the cylinder being configured to extend and to rotate the swing boom based on a level of extension.
13 . The system according to claim 1 , wherein the second measuring sensor is an inertial measurement unit (IMU) having at least one accelerometer and at least one gyroscope.
14 . The system according to claim 1 , wherein the system is configured to self-calibrate based on a self-calibration procedure including the steps:
placement of the excavator on a slope, wherein the slope has at least five degrees, determination of a gravitational acceleration of the swing boom relative to the slope by the accelerometer of the second measuring sensor,
extension of the cylinder to a maximum or a minimum level of extension,
movement of the swing boom to a first position, wherein the first position corresponds to the maximum or the minimum extension level of the cylinder,
determination of the swing boom angle at the first position based on the gravitational acceleration of the swing boom relative to the slope,
movement of the swing boom to a second position, wherein the second position corresponds to the maximum or the minimum extension level of the cylinder opposed to the extension level of the cylinder at the first position,
determination of the swing boom angle at the second position based on the gravitational acceleration of the swing boom relative to the slope,
movement of the swing boom to a third position, wherein at the third position the first measuring sensor determines an intermittent first interim swing boom angle relative to the vehicle frame,
determination of the swing boom angle at the third position based on the gravitational acceleration of the swing boom relative to the slope,
determination of a range of motion of the swing boom and the position of the first measuring sensor based on the determined swing boom angles at the first, the second and the third position.
15 . The system according to claim 1 , wherein the system is configured to self-calibrate based on a self-calibration procedure including the steps:
movement of the swing boom to a first position, wherein the first position corresponds to a maximum or a minimum extension level of the cylinder,
movement of the swing boom to a second position, wherein the second position corresponds to the maximum or the minimum extension level of the cylinder opposed to the extension level of the cylinder at the first position,
movement of the swing boom from the second position back to the first position,
recording of measurements from the first and the second measuring sensors during the movement of the swing boom,
recording of measurement timings from the first measuring sensor during the movement of the swing boom,
determination of a range of motion of the swing boom and the position of the first measuring sensor based on the recorded measurements from the second measuring sensor and the measurement timings from the first measuring sensor.
16 . The system according to claim 1 , wherein the system further comprises a global position sensor configured to be mounted on the swing boom, wherein the global position sensor provides a position measurement of the swing boom in a global reference frame.
17 . The system according to claim 1 , wherein the first measuring sensor is at least one hall effect sensor and the counterpart includes at least one permanent magnet or at least one electro magnet.
18 . The system according to claim 1 , wherein the first measuring sensor is at least one light emitting and sensing system and the counterpart includes at least one mirror.