US20180163363A1 - Excavator Implement Length And Angle Offset Determination Using A Laser Distance Meter - Google Patents
Excavator Implement Length And Angle Offset Determination Using A Laser Distance Meter Download PDFInfo
- Publication number
- US20180163363A1 US20180163363A1 US15/372,737 US201615372737A US2018163363A1 US 20180163363 A1 US20180163363 A1 US 20180163363A1 US 201615372737 A US201615372737 A US 201615372737A US 2018163363 A1 US2018163363 A1 US 2018163363A1
- Authority
- US
- United States
- Prior art keywords
- ldm
- implement
- tilt
- excavator
- distance
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000012804 iterative process Methods 0.000 claims abstract description 10
- 238000005259 measurement Methods 0.000 claims description 29
- 230000001133 acceleration Effects 0.000 description 8
- 230000008878 coupling Effects 0.000 description 6
- 238000010168 coupling process Methods 0.000 description 6
- 238000005859 coupling reaction Methods 0.000 description 6
- 238000000034 method Methods 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 4
- 230000003044 adaptive effect Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000005304 joining Methods 0.000 description 2
- 238000005520 cutting process Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000003860 storage Methods 0.000 description 1
Images
Classifications
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/36—Component parts
- E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
- E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
- E02F3/435—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/30—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets with a dipper-arm pivoted on a cantilever beam, i.e. boom
- E02F3/32—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets with a dipper-arm pivoted on a cantilever beam, i.e. boom working downwardly and towards the machine, e.g. with backhoes
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/36—Component parts
- E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
- E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
- E02F3/435—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
- E02F3/437—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like providing automatic sequences of movements, e.g. linear excavation, keeping dipper angle constant
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/2025—Particular purposes of control systems not otherwise provided for
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/26—Indicating devices
- E02F9/264—Sensors and their calibration for indicating the position of the work tool
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/26—Indicating devices
- E02F9/264—Sensors and their calibration for indicating the position of the work tool
- E02F9/265—Sensors and their calibration for indicating the position of the work tool with follow-up actions (e.g. control signals sent to actuate the work tool)
Definitions
- the present disclosure relates to excavators which, for the purposes of defining and describing the scope of the present application, comprise an excavator boom and an excavator stick subject to swing and curl, and an excavating implement that is subject to swing and curl control with the aid of the excavator boom and excavator stick, or other similar components for executing swing and curl movement.
- excavators which, for the purposes of defining and describing the scope of the present application, comprise an excavator boom and an excavator stick subject to swing and curl, and an excavating implement that is subject to swing and curl control with the aid of the excavator boom and excavator stick, or other similar components for executing swing and curl movement.
- many types of excavators comprise a hydraulically or pneumatically or electrically controlled excavating implement that can be manipulated by controlling the swing and curl functions of an excavating linkage assembly of the excavator.
- Excavator technology is, for example, well represented by the disclosures of U.S. Pat. No
- an excavator calibration framework comprises an excavator, a laser distance meter (LDM), a first laser reflector, and a second laser reflector.
- the excavator comprises a machine chassis, an excavating linkage assembly, an implement dynamic sensor, an excavating implement, and control architecture.
- the excavating linkage assembly comprises an excavator boom and an excavator stick that collectively define a plurality of linkage assembly positions.
- the excavating implement is mechanically coupled to the excavator stick.
- the excavating implement is configured to tilt about a tilt axis.
- the implement dynamic sensor is positioned on the excavating implement and is configured to generate a tilt angle signal ( ⁇ tilt ) representing an angular degree to which the tilt axis of the excavating implement is tilted with respect to horizontal.
- the first laser reflector is positioned at a first calibration node on the excavating implement.
- the second laser reflector is positioned at a second calibration node on the excavating implement.
- the LDM is configured to generate a first LDM distance signal D LDM1 indicative of a distance between the LDM and the first laser reflector and a first LDM angle of inclination signal ⁇ INC1 indicative of an angle between the LDM and the first laser reflector.
- the LDM is configured to generate a second LDM distance signal D LDM2 indicative of a distance between the LDM and the second laser reflector and a second LDM angle of inclination signal ⁇ INC2 indicative of an angle between the LDM and the second laser reflector.
- the control architecture comprises one or more linkage assembly actuators and an architecture controller programmed to determine the tilt axis of the excavating implement relative to horizontal based on the tilt angle signal ( ⁇ tilt ) and execute an iterative process to curl the excavating implement and create a set of bucket angles.
- the architecture controller is further programmed to move the linkage assembly to align the LDM and the first calibration node, calculate a pair of first calibration node measurements based on the first LDM distance signal D LDM1 and the first LDM angle of inclination signal ⁇ INC1 , determine a first set of dimensions comprising implement distance values and LDM offset values, wherein the first set of dimensions are at least partially based on the set of bucket angles and the pair of first calibration node measurements, align the tilt axis with horizontal to generate a first rotation factor, and determine a set of rotated implement distance values at least partially based on the implement distance values and the first rotation factor.
- the architecture controller is further programmed to move the linkage assembly to align the LDM and the second calibration node, calculate a pair of second calibration node measurements based on the second LDM distance signal D LDM2 and the second LDM angle of inclination signal ⁇ INC2 , determine a second set of dimensions comprising implement profile values, wherein the second set of dimensions is at least partially based on the pair of second calibration node measurements and the LDM offset values, align the tilt axis with horizontal to generate a second rotation factor, and determine a set of rotated implement profile values at least partially based on the implement profile values and the second rotation factor.
- the architecture controller is further programmed to determine implement dimensions between the first calibration node and the second calibration node at least partially based on the set of rotated implement distance values and the set of rotated implement profile values, and operate the excavator using the implement dimensions.
- the concepts of the present disclosure are described herein with primary reference to the excavator illustrated in FIG. 1 , it is contemplated that the concepts will enjoy applicability to any type of excavator, regardless of its particular mechanical configuration.
- the concepts may enjoy applicability to a backhoe loader including a backhoe linkage.
- FIG. 1 is a side view of an excavator incorporating aspects of the present disclosure
- FIG. 2 is a perspective view of a dynamic sensor disposed on a linkage of the excavator of FIG. 1 and according to various concepts of the present disclosure
- FIG. 3 is a side elevation view of a linkage assembly of an excavator calibration framework including a laser distance meter (LDM) and implement dimension points of an excavating implement of the excavator of FIG. 1 ; and
- LDM laser distance meter
- FIG. 4 is a flow chart of an optimization process used to determine implement dimensions of the excavating implement of the excavator of FIG. 1 .
- the present disclosure relates to earthmoving machines and, more particularly, to earthmoving machines such as excavators including components subject to adaptive control.
- many types of excavators typically have a hydraulically controlled earthmoving implement that can be manipulated by a joystick or other means in an operator control station of the machine, and is also subject to partially or fully automated control.
- the user of the machine may control the lift, tilt, angle, and pitch of the implement.
- one or more of these variables may also be subject to partially or fully automated control based on information sensed or received by an adaptive environmental sensor of the machine.
- an excavator calibration framework utilizes a laser distance meter to determine excavator implement lengths and angle offsets of sensors disposed thereon, as described in greater detail further below. Such determined values may be utilized by an excavator control to operate the excavator.
- an excavator calibration framework 90 comprises an excavator 100 , a laser distance meter (LDM) 124 , a first laser reflector 130 A, and a second laser reflector 130 B.
- the excavator 100 comprises a machine chassis 102 , an excavating linkage assembly 104 , an implement dynamic sensor 120 , an excavating implement 114 , and control architecture 106 .
- the excavating linkage assembly 104 comprises an excavator boom 108 and an excavator stick 110 that collectively define a plurality of linkage assembly positions.
- one or more dynamical sensors may be positioned on excavator components such as, for example, the excavator boom 108 , the excavator stick 110 , and/or the machine chassis 102 .
- the excavating linkage assembly 104 may be configured to swing with, or relative to, the machine chassis 102 .
- the excavator stick 110 may be configured to curl relative to the excavator boom 108 . While the excavator 100 will be referenced herein, it should be understood that the embodiments described below also apply to other types of excavators, including those having a two-piece, variable-angle (VA) excavator boom.
- VA variable-angle
- the excavating implement 114 is mechanically coupled to the excavator stick 110 . Further, the excavating implement 114 is configured to tilt about a tilt axis TA. In embodiments, the excavating implement 114 is mechanically coupled to a terminal point G of the excavator stick 110 . The terminal point G intersects a curl axis CA about which the excavating implement 114 is configured to curl.
- the excavating implement 114 may be mechanically coupled to the excavator stick 110 through an implement coupling 112 .
- the excavating implement 114 may be mechanically coupled to the excavator stick 110 via the implement coupling 112 and configured to rotate about a rotary axis.
- the rotary axis may be defined by the implement coupling 112 joining the excavator stick 110 and the excavating implement 114 .
- the rotary axis R may be defined by a multidirectional, stick coupling joining the excavator boom 108 and the excavator stick 110 along a plane such that the excavator stick 110 is configured to rotate about the rotary axis. Rotation of the excavator stick 110 about the rotary axis defined by the stick coupling may result in a corresponding rotation of the excavating implement 114 , which is coupled to the excavator stick 110 , about the rotary axis defined by the stick coupling.
- the implement dynamic sensor 120 is positioned on the excavating implement 114 and is configured to generate a tilt angle signal ( ⁇ tilt ) representing an angular degree to which the tilt axis TA of the excavating implement is tilted with respect to horizontal.
- the implement dynamic sensor 120 comprises an inertial measurement unit (IMU), an inclinometer, an accelerometer, a gyroscope, an angular rate sensor, a rotary position sensor, a position sensing cylinder, or combinations thereof.
- the IMU may comprise a 3-axis accelerometer and a 3-axis gyroscope.
- the implement dynamic sensor 120 includes accelerations A x , A y , and A z , respectively representing x-axis, y-axis-, and z-axis acceleration values.
- the first laser reflector 130 A is positioned at a first calibration node on the excavating implement 114 .
- the second laser reflector 130 B is positioned at a second calibration node on the excavating implement 114 .
- the excavating implement 114 comprises a terminal point J and a tilt point K, which intersects a point of the tilt axis TA and is disposed above the implement dynamic sensor 120 .
- the first calibration node is positioned at the terminal point J of the excavating implement 114
- the second calibration node is positioned at the tilt point K of the excavating implement 114 .
- the LDM 124 is configured to generate a first LDM distance signal D LDM1 indicative of a distance between the LDM 124 and the first laser reflector 130 A and a first LDM angle of inclination signal ⁇ INC1 indicative of an angle between the LDM 124 and the first laser reflector 130 A.
- the LDM 124 is configured to generate a second LDM distance signal D LDM2 indicative of a distance between the LDM 124 and the second laser reflector 130 B and a second LDM angle of inclination signal ⁇ INC2 indicative of an angle between the LDM 124 and the second laser reflector 130 B.
- the first laser reflector 130 A and the second laser reflector 130 B are positioned at the first calibration node and the second calibration node, respectively, by direct securement to the excavating implement 114 , with the use of a reflector support pole, or a combination thereof.
- the LDM 124 may be, for example, a Bosch GLM 100 C LDM as made commercially available by Robert Bosch GmbH of Germany.
- a laser signal from the LDM 124 may be transmitted in a direction of an arrow 132 to the calibration node 128 and an aligned laser reflector, such as, for example, the first laser reflector 130 A or the second laser reflector 130 B , and the laser signal may be reflected back to the LDM 124 in the direction of an arrow 134 , as illustrated in FIG. 1 .
- the control architecture 106 comprises one or more linkage assembly actuators and an architecture controller.
- the one or more linkage assembly actuators facilitate movement of the excavating linkage assembly 104 .
- the one or more linkage assembly actuators may comprise a hydraulic cylinder actuator, a pneumatic cylinder actuator, an electrical actuator, a mechanical actuator, or combinations thereof.
- the control architecture 106 may comprise a non-transitory computer-readable storage medium comprising the machine readable instructions.
- the architecture controller is programmed to determine the tilt axis TA of the excavating implement 114 relative to horizontal based on the tilt angle signal ( ⁇ tilt ). Further, as set forth in step 204 of the control scheme 200 of FIG. 4 , the architecture controller is programmed to execute an iterative process to curl the excavating implement 114 and create a set of bucket angles.
- the iterative process comprises curling the excavating implement 114 about the curl axis CA to a linkage assembly position, and determining a bucket angle ( ⁇ bucket ) of the terminal point J relative to horizontal at the linkage assembly position. The iterative process may be repeated n times until n exceeds a threshold.
- the architecture controller may be programmed to determine a set of rotated implement distance values through steps 206 - 212 of FIG. 4 .
- the architecture controller is programmed to move the linkage assembly 104 to align the LDM 124 and the first calibration node.
- the architecture controller is programmed to determine implement distance values (IDV).
- the architecture controller is programmed to calculate a pair of first calibration node measurements based on the first LDM distance signal D LDM1 and the first angle of inclination signal ⁇ INC1 , and to determine a first set of dimensions comprising the implement distance values (IDV) and LDM offset values.
- the first set of dimensions are at least partially based on the set of bucket angles and the pair of first calibration node measurements.
- the first set of dimensions further comprise an offset bucket angle ( ⁇ bucket,offset ), a length (GJ) between the terminal point G and the terminal point J, a horizontal distance (GJ x0 ) between the terminal point G and the terminal point J, and a vertical distance (GJ y0 ) between the terminal point G and the terminal point J.
- the architecture controller is programmed to align the tilt axis with horizontal to generate a first rotation factor.
- the architecture controller is programmed to determine a set of rotated implement distance values at least partially based on the implement distance values (IDV) and the first rotation factor.
- the implement distance values (IDV) comprise a horizontal distance (GJ x0 ) and a vertical distance (GJ y0 ) between the terminal point G of the excavator stick 110 and the terminal point J of the excavating implement 114 .
- the rotated implement distance values comprise a rotated horizontal distance (GJ x ) and a rotated vertical distance (GJ y ).
- the pair of first calibration node measurements may comprise a height H and a distance D between the first calibration node and the LDM based on the LDM distance signal D LDM and angle of inclination signal ⁇ INC , such that
- the LDM offset values may define an offset horizontal distance (D 0 ) and an offset vertical distance (H 0 ) between a boom terminal point A and a laser origin (for example, the LDM point of FIGS. 1 and 3 ) of the LDM 124 .
- the first set of dimensions further comprise an offset bucket angle ( ⁇ bucket,offset ); and a length (GJ) between the terminal point G and a terminal point J of the excavating implement 114 , at which terminal point J the first calibration node is positioned, the first set of dimensions are determined based on a following set of first dimension equations:
- AG x is a horizontal distance between the boom terminal point A and the terminal point G of the excavator stick 110
- AG y is a vertical distance between the boom terminal point A and the terminal point G of the excavator stick 110 .
- Equations 15-16 may be set equal to one another, as shown in Equation 17 below, such that an approximation of GJ may equal either one, and is taken to equal Equation 15 in Equation 18 below.
- implement distance values comprise GJ y0 and GJ x0 , which are determined as follows:
- GJ y0 cb*cGJ ⁇ sb*sGJ;
- GJ x0 sb*cGJ+cb*sGJ. (20)
- first rotation factor is at least partially based on ⁇ tilt .
- the set of rotated implement distance values comprise GJ y and GJ x , which are based on a following set of implement distance rotation equations:
- GJ y GJ y0 cos( ⁇ tilt ) ⁇ GJ x0 sin( ⁇ tilt ); and (21)
- the architecture controller may be programmed to further determine a set of rotated implement profile values through steps 214 - 220 of FIG. 4 .
- the architecture controller is programmed to move the linkage assembly 104 to align the LDM 124 and the second calibration node.
- the architecture controller is programmed to determine implement profile values (IPV).
- the architecture controller is programmed to calculate a pair of second calibration node measurements based on the second LDM distance signal D LDM2 and the second angle of inclination signal ⁇ INC2 , and to determine a second set of dimensions comprising the implement profile values (IPV).
- the second set of dimensions is at least partially based on the pair of second calibration node measurements and the LDM offset values.
- step 218 the architecture controller is programmed to align the tilt axis with horizontal to generate a second rotation factor.
- step 220 the architecture controller is programmed to determine a set of rotated implement profile values at least partially based on the implement profile values (IPV) and the second rotation factor.
- IPV implement profile values
- the implement profile values (IPV) comprise a horizontal distance (GK x0 ) and a vertical distance (GK y0 ) between the terminal point G of the excavator stick 110 and the tilt point K of the excavating implement 114 .
- the rotated implement profile values comprise a rotated horizontal distance (GK x ) and a rotated vertical distance (GK y ).
- the pair of second calibration node measurements may comprise a height ⁇ and a distance ⁇ circumflex over (D) ⁇ between the second calibration node and the LDM based on the LDM distance signal D LDM and angle of inclination ⁇ INC .
- D distance signal
- ⁇ INC angle of inclination
- the second set of dimensions may be determined based on a following set of second dimension equations:
- implement profile values comprise GK y0 and GK x0 , which are determined by a following set of equations:
- GK y0 AK y ⁇ AG y ;
- AG is a horizontal distance between the boom terminal point A and the terminal point G of the excavator stick 110
- AG y is a vertical distance between the boom terminal point A and the terminal point G of the excavator stick 110 .
- the second rotation factor may be at least partially based on ⁇ tilt .
- the set of rotated implement profile values comprise GK y and GK x , which are based on a following set of implement profile rotation equations:
- the architecture controller may be programmed to, as illustrated in step 222 of FIG. 4 , determine implement dimensions between the first calibration node and the second calibration node at least partially based on the set of rotated implement distance values (IDV) and the set of rotated implement profile values (IPV). For example, and referring to FIG. 3 , the architecture controller is programmed to determine implement dimensions comprising a horizontal distance (JK x ) and a vertical distance (JK y ) between the terminal point J and the tilt point K at least partially based on the implement profile values (GK x , GK y ) and the implement distance values (GJ x , GJ y ).
- the architecture controller may be programmed to operate the excavator using the implement dimensions, which may be, for example, the horizontal distance (JK x ) and the vertical distance (JK y ).
- implement dimensions may be based on a following set of equations:
- the architecture controller is further programmed to calibrate a z-axis of the implement dynamic sensor 120 to align with the tilt axis TA.
- the z-axis of the implement dynamic sensor 120 is solved, for example, through a steady state acceleration utilizing a single axis alignment function that is at least partially based on at least three measurements.
- the tilt axis TA is positioned in a plane that intersects the gravity vector.
- a first, full left tilt measurement is taken after the excavating implement 114 has been rotated about the tilt axis to the left such that a leading edge of the excavating implement 114 is tilted to the left of the tilt axis in a direction facing the leading edge.
- a second, roughly zero tilt measurement is taken in which the excavating implement 114 is at roughly a zero tilt such that a leading edge of the excavating implement 114 is not tilted with respect to the tilt axis TA in the direction facing the leading edge.
- a third, full right tilt measurement is taken after the excavating implement 114 has been rotated about the tilt axis to the right such that a leading edge of the excavating implement 114 is tilted to the right of the tilt axis in the direction facing the leading edge.
- An acceleration based z-axis alignment method assuming an acceleration along the tilt point K remains constant (and is the z-axis) while the other accelerations along the other two axes change during rotation.
- the z-axis alignment finds a rotation for the appropriate acceleration value that keeps a constant acceleration, which indicates that the associated axis is the z-axis pointing along the tilt axis TA that intersects the tilt point K.
- the z-axis of the implement dynamic sensor 120 may be determined and aligned with the tilt axis TA of the excavating implement 114 .
- the architecture controller may be programmed to calibrate ⁇ tilt with respect to the tilt axis TA and at least partially based on an alignment of the LDM 124 with a center of the tilt point K, which intersects a point of the tilt axis TA, and a center point of a leading edge of the excavating implement 114 .
- Either or both of the center of the tilt point K and the center point of a leading edge of the excavating implement 114 may be marked such as, for example, by a chalk marking.
- the architecture controller may be further programmed to determine a set of measurements to assist with an LDM setup and the calibration prior to execution of the iterative process. The determination may be at least partially based on a measurement of a half-width of the excavating implement 114 to determine the center point of the leading edge of the excavating implement 114 , and a measurement of the center of the tilt point K of the excavating implement 114 .
- the architecture controller may be further programmed to measure a center line of the excavator boom 108 , align a measured center line of the excavator boom 108 with the LDM 124 , align the LDM 124 with the center of the tilt point K, and pull the excavating implement 114 in toward the LDM 124 while keeping the LDM 124 aligned with the center of the tilt point K. Further, the architecture controller may be programmed to rotate at least one of the excavating linkage assembly 104 and the LDM 124 to keep the LDM 124 aligned with the center of the tilt point K.
- the embodiments of the present disclosure may assist to permit a speedy and more cost efficient method of determining excavating implement dimension lengths and angle offsets in a manner that minimizes a risk of human error and increased accuracy with such value determinations.
- a signal may be “generated” by direct or indirect calculation or measurement, with or without the aid of a sensor.
- variable being a “function” of a parameter or another variable is not intended to denote that the variable is exclusively a function of the listed parameter or variable. Rather, reference herein to a variable that is a “function” of a listed parameter is intended to be open ended such that the variable may be a function of a single parameter or a plurality of parameters.
- references herein of a component of the present disclosure being “configured” or “programmed” in a particular way, to embody a particular property, or to function in a particular manner, are structural recitations, as opposed to recitations of intended use. More specifically, the references herein to the manner in which a component is “configured” or “programmed” denotes an existing physical condition of the component and, as such, is to be taken as a definite recitation of the structural characteristics of the component.
Abstract
A framework comprises a laser distance meter (LDM), first and second laser reflectors at respective nodes, and an excavator including a chassis, a linkage assembly (LA) including a boom and stick, an implement including the nodes and tilting about axis TA, an implement sensor generating signal θtilt, and architecture. The LDM generates LDM distance signals DLDM and LDM angle of inclination signals θINC between the LDM and the laser reflectors. The architecture comprises LA actuators and a controller programmed to determine the TA relative to horizontal based on θtilt and execute an iterative process to curl the excavating implement and create bucket angles, align the LDM and the first node to determine a set of rotated IDV, align the LDM and the second node to determine a set of rotated IPV, and determine implement dimensions between the nodes based on the set of rotated IDV and IPV.
Description
- The present disclosure relates to excavators which, for the purposes of defining and describing the scope of the present application, comprise an excavator boom and an excavator stick subject to swing and curl, and an excavating implement that is subject to swing and curl control with the aid of the excavator boom and excavator stick, or other similar components for executing swing and curl movement. For example, and not by way of limitation, many types of excavators comprise a hydraulically or pneumatically or electrically controlled excavating implement that can be manipulated by controlling the swing and curl functions of an excavating linkage assembly of the excavator. Excavator technology is, for example, well represented by the disclosures of U.S. Pat. No. 8,689,471, which is assigned to Caterpillar Trimble Control Technologies LLC and discloses methodology for sensor-based automatic control of an excavator, US 2008/0047170, which is assigned to Caterpillar Trimble Control Technologies LLC and discloses an excavator 3D laser system and radio positioning guidance system configured to guide a cutting edge of an excavator bucket with high vertical accuracy, and US 2008/0000111, which is assigned to Caterpillar Trimble Control Technologies LLC and discloses methodology for an excavator control system to determine an orientation of an excavator sitting on a sloped site.
- According to the subject matter of the present disclosure, an excavator calibration framework comprises an excavator, a laser distance meter (LDM), a first laser reflector, and a second laser reflector. The excavator comprises a machine chassis, an excavating linkage assembly, an implement dynamic sensor, an excavating implement, and control architecture. The excavating linkage assembly comprises an excavator boom and an excavator stick that collectively define a plurality of linkage assembly positions. The excavating implement is mechanically coupled to the excavator stick. The excavating implement is configured to tilt about a tilt axis. The implement dynamic sensor is positioned on the excavating implement and is configured to generate a tilt angle signal (θtilt) representing an angular degree to which the tilt axis of the excavating implement is tilted with respect to horizontal. The first laser reflector is positioned at a first calibration node on the excavating implement. The second laser reflector is positioned at a second calibration node on the excavating implement. The LDM is configured to generate a first LDM distance signal DLDM1 indicative of a distance between the LDM and the first laser reflector and a first LDM angle of inclination signal θINC1 indicative of an angle between the LDM and the first laser reflector. The LDM is configured to generate a second LDM distance signal DLDM2 indicative of a distance between the LDM and the second laser reflector and a second LDM angle of inclination signal θINC2 indicative of an angle between the LDM and the second laser reflector. The control architecture comprises one or more linkage assembly actuators and an architecture controller programmed to determine the tilt axis of the excavating implement relative to horizontal based on the tilt angle signal (θtilt) and execute an iterative process to curl the excavating implement and create a set of bucket angles. The architecture controller is further programmed to move the linkage assembly to align the LDM and the first calibration node, calculate a pair of first calibration node measurements based on the first LDM distance signal DLDM1 and the first LDM angle of inclination signal θINC1, determine a first set of dimensions comprising implement distance values and LDM offset values, wherein the first set of dimensions are at least partially based on the set of bucket angles and the pair of first calibration node measurements, align the tilt axis with horizontal to generate a first rotation factor, and determine a set of rotated implement distance values at least partially based on the implement distance values and the first rotation factor. The architecture controller is further programmed to move the linkage assembly to align the LDM and the second calibration node, calculate a pair of second calibration node measurements based on the second LDM distance signal DLDM2 and the second LDM angle of inclination signal θINC2, determine a second set of dimensions comprising implement profile values, wherein the second set of dimensions is at least partially based on the pair of second calibration node measurements and the LDM offset values, align the tilt axis with horizontal to generate a second rotation factor, and determine a set of rotated implement profile values at least partially based on the implement profile values and the second rotation factor. The architecture controller is further programmed to determine implement dimensions between the first calibration node and the second calibration node at least partially based on the set of rotated implement distance values and the set of rotated implement profile values, and operate the excavator using the implement dimensions.
- Although the concepts of the present disclosure are described herein with primary reference to the excavator illustrated in
FIG. 1 , it is contemplated that the concepts will enjoy applicability to any type of excavator, regardless of its particular mechanical configuration. For example, and not by way of limitation, the concepts may enjoy applicability to a backhoe loader including a backhoe linkage. - The following detailed description of specific embodiments of the present disclosure can be best understood when read in conjunction with the following drawings, where like structure is indicated with like reference numerals and in which:
-
FIG. 1 is a side view of an excavator incorporating aspects of the present disclosure; -
FIG. 2 is a perspective view of a dynamic sensor disposed on a linkage of the excavator ofFIG. 1 and according to various concepts of the present disclosure -
FIG. 3 is a side elevation view of a linkage assembly of an excavator calibration framework including a laser distance meter (LDM) and implement dimension points of an excavating implement of the excavator ofFIG. 1 ; and -
FIG. 4 is a flow chart of an optimization process used to determine implement dimensions of the excavating implement of the excavator ofFIG. 1 . - The present disclosure relates to earthmoving machines and, more particularly, to earthmoving machines such as excavators including components subject to adaptive control. For example, and not by way of limitation, many types of excavators typically have a hydraulically controlled earthmoving implement that can be manipulated by a joystick or other means in an operator control station of the machine, and is also subject to partially or fully automated control. The user of the machine may control the lift, tilt, angle, and pitch of the implement. In addition, one or more of these variables may also be subject to partially or fully automated control based on information sensed or received by an adaptive environmental sensor of the machine. In the embodiments described herein, an excavator calibration framework utilizes a laser distance meter to determine excavator implement lengths and angle offsets of sensors disposed thereon, as described in greater detail further below. Such determined values may be utilized by an excavator control to operate the excavator.
- Referring initially to
FIG. 1 , anexcavator calibration framework 90 comprises anexcavator 100, a laser distance meter (LDM) 124, afirst laser reflector 130A, and asecond laser reflector 130B. Theexcavator 100 comprises amachine chassis 102, anexcavating linkage assembly 104, an implementdynamic sensor 120, anexcavating implement 114, andcontrol architecture 106. Theexcavating linkage assembly 104 comprises anexcavator boom 108 and anexcavator stick 110 that collectively define a plurality of linkage assembly positions. In embodiments, one or more dynamical sensors may be positioned on excavator components such as, for example, theexcavator boom 108, theexcavator stick 110, and/or themachine chassis 102. Theexcavating linkage assembly 104 may be configured to swing with, or relative to, themachine chassis 102. Further, theexcavator stick 110 may be configured to curl relative to theexcavator boom 108. While theexcavator 100 will be referenced herein, it should be understood that the embodiments described below also apply to other types of excavators, including those having a two-piece, variable-angle (VA) excavator boom. - The
excavating implement 114 is mechanically coupled to theexcavator stick 110. Further, theexcavating implement 114 is configured to tilt about a tilt axis TA. In embodiments, theexcavating implement 114 is mechanically coupled to a terminal point G of theexcavator stick 110. The terminal point G intersects a curl axis CA about which theexcavating implement 114 is configured to curl. Theexcavating implement 114 may be mechanically coupled to theexcavator stick 110 through animplement coupling 112. For example, theexcavating implement 114 may be mechanically coupled to theexcavator stick 110 via theimplement coupling 112 and configured to rotate about a rotary axis. In an embodiment, the rotary axis may be defined by theimplement coupling 112 joining theexcavator stick 110 and theexcavating implement 114. In an alternative embodiment, the rotary axis R may be defined by a multidirectional, stick coupling joining theexcavator boom 108 and theexcavator stick 110 along a plane such that theexcavator stick 110 is configured to rotate about the rotary axis. Rotation of theexcavator stick 110 about the rotary axis defined by the stick coupling may result in a corresponding rotation of theexcavating implement 114, which is coupled to theexcavator stick 110, about the rotary axis defined by the stick coupling. - The implement
dynamic sensor 120 is positioned on theexcavating implement 114 and is configured to generate a tilt angle signal (θtilt) representing an angular degree to which the tilt axis TA of the excavating implement is tilted with respect to horizontal. In embodiments, the implementdynamic sensor 120 comprises an inertial measurement unit (IMU), an inclinometer, an accelerometer, a gyroscope, an angular rate sensor, a rotary position sensor, a position sensing cylinder, or combinations thereof. The IMU may comprise a 3-axis accelerometer and a 3-axis gyroscope. As shown inFIG. 2 , the implementdynamic sensor 120 includes accelerations Ax, Ay, and Az, respectively representing x-axis, y-axis-, and z-axis acceleration values. - The
first laser reflector 130A is positioned at a first calibration node on the excavatingimplement 114. Thesecond laser reflector 130B is positioned at a second calibration node on the excavatingimplement 114. In embodiments, theexcavating implement 114 comprises a terminal point J and a tilt point K, which intersects a point of the tilt axis TA and is disposed above the implementdynamic sensor 120. The first calibration node is positioned at the terminal point J of theexcavating implement 114, and the second calibration node is positioned at the tilt point K of theexcavating implement 114. - The LDM 124 is configured to generate a first LDM distance signal DLDM1 indicative of a distance between the
LDM 124 and thefirst laser reflector 130A and a first LDM angle of inclination signal θINC1 indicative of an angle between theLDM 124 and thefirst laser reflector 130A. The LDM 124 is configured to generate a second LDM distance signal DLDM2 indicative of a distance between theLDM 124 and thesecond laser reflector 130B and a second LDM angle of inclination signal θINC2 indicative of an angle between theLDM 124 and thesecond laser reflector 130B. In embodiments, thefirst laser reflector 130A and thesecond laser reflector 130B are positioned at the first calibration node and the second calibration node, respectively, by direct securement to the excavatingimplement 114, with the use of a reflector support pole, or a combination thereof. The LDM 124 may be, for example, a Bosch GLM 100C LDM as made commercially available by Robert Bosch GmbH of Germany. A laser signal from theLDM 124 may be transmitted in a direction of anarrow 132 to the calibration node 128 and an aligned laser reflector, such as, for example, thefirst laser reflector 130A or thesecond laser reflector 130B , and the laser signal may be reflected back to theLDM 124 in the direction of anarrow 134, as illustrated inFIG. 1 . - The
control architecture 106 comprises one or more linkage assembly actuators and an architecture controller. In embodiments, the one or more linkage assembly actuators facilitate movement of the excavatinglinkage assembly 104. The one or more linkage assembly actuators may comprise a hydraulic cylinder actuator, a pneumatic cylinder actuator, an electrical actuator, a mechanical actuator, or combinations thereof. Further, thecontrol architecture 106 may comprise a non-transitory computer-readable storage medium comprising the machine readable instructions. - As shown through
step 202 of acontrol scheme 200 ofFIG. 4 , the architecture controller is programmed to determine the tilt axis TA of the excavating implement 114 relative to horizontal based on the tilt angle signal (θtilt). Further, as set forth instep 204 of thecontrol scheme 200 ofFIG. 4 , the architecture controller is programmed to execute an iterative process to curl the excavating implement 114 and create a set of bucket angles. In embodiments, the iterative process comprises curling the excavating implement 114 about the curl axis CA to a linkage assembly position, and determining a bucket angle (θbucket) of the terminal point J relative to horizontal at the linkage assembly position. The iterative process may be repeated n times until n exceeds a threshold. - Further, the architecture controller may be programmed to determine a set of rotated implement distance values through steps 206-212 of
FIG. 4 . For example, instep 206, the architecture controller is programmed to move thelinkage assembly 104 to align theLDM 124 and the first calibration node. In step 208, the architecture controller is programmed to determine implement distance values (IDV). For example, the architecture controller is programmed to calculate a pair of first calibration node measurements based on the first LDM distance signal DLDM1 and the first angle of inclination signal θINC1, and to determine a first set of dimensions comprising the implement distance values (IDV) and LDM offset values. The first set of dimensions are at least partially based on the set of bucket angles and the pair of first calibration node measurements. In embodiments, the first set of dimensions further comprise an offset bucket angle (θbucket,offset), a length (GJ) between the terminal point G and the terminal point J, a horizontal distance (GJx0) between the terminal point G and the terminal point J, and a vertical distance (GJy0) between the terminal point G and the terminal point J. Instep 210, the architecture controller is programmed to align the tilt axis with horizontal to generate a first rotation factor. Instep 212, the architecture controller is programmed to determine a set of rotated implement distance values at least partially based on the implement distance values (IDV) and the first rotation factor. - In embodiments, the implement distance values (IDV) comprise a horizontal distance (GJx0) and a vertical distance (GJy0) between the terminal point G of the
excavator stick 110 and the terminal point J of the excavating implement 114. Further, the rotated implement distance values comprise a rotated horizontal distance (GJx) and a rotated vertical distance (GJy). - The pair of first calibration node measurements may comprise a height H and a distance D between the first calibration node and the LDM based on the LDM distance signal DLDM and angle of inclination signal θINC, such that
-
D=D LDMcos(θINC), and (1) -
H=D LDMsin(θINC). (2) - Further, the LDM offset values may define an offset horizontal distance (D0) and an offset vertical distance (H0) between a boom terminal point A and a laser origin (for example, the LDM point of
FIGS. 1 and 3 ) of theLDM 124. In embodiments, in which the first set of dimensions further comprise an offset bucket angle (θbucket,offset); and a length (GJ) between the terminal point G and a terminal point J of the excavating implement 114, at which terminal point J the first calibration node is positioned, the first set of dimensions are determined based on a following set of first dimension equations: -
AG y +GJcos(θbucket Measured−θbucket,offset)=H+H 0; and (3) -
AG x +GJsin(θbucket Measured−θbucket,offset)=D+D 0. (4) - With respect to Equations 3-4, θbucket=θbucket Measured−θbucket,offset and is an actual bucket angle, AGx is a horizontal distance between the boom terminal point A and the terminal point G of the
excavator stick 110, and AGy is a vertical distance between the boom terminal point A and the terminal point G of theexcavator stick 110. Further, solutions to the first dimension equations (i.e., Equations 3-4) are determined by a following solution set, in which: -
cb=cos(θbucket Measured); -
sb=sin(θbucket Meazured (5) -
rhs=[AG x −D, AG y −H]; (7) -
lhs=[[ones; zeros], [zeros; ones], [cb;sb], [−sb;cb]]; and (8) -
sol=((lhs)(lhs)T)−1(lhs)T(rhs) (9) - From Equations 5-9, the follow set of solutions may be determined:
-
H 0 =sol(1); (10) -
D 0 =sol(2); (11) -
cGJ=sol(3); (12) -
sGJ=sol(4); and (13) -
θbucket,offset=tan−1(sGJ,cGJ). (14) - From Equations 10-14 above, two more solutions for GJ are derivable:
-
GJ sol,1 =sol(3)/cos(Γbucket,offset); and (15) -
GJ sol,2 =sol(4)/sin(Γbucket,offset). (16) - Equations 15-16 may be set equal to one another, as shown in Equation 17 below, such that an approximation of GJ may equal either one, and is taken to equal Equation 15 in Equation 18 below.
-
GJ sol,1 =GJ sol,2; and (17) -
GJ approx =GJ sol,1. (18) - Further, the implement distance values comprise GJy0 and GJx0, which are determined as follows:
-
GJ y0 =cb*cGJ−sb*sGJ; and (19) -
GJ x0 =sb*cGJ+cb*sGJ. (20) - In embodiments, first rotation factor is at least partially based on θtilt. Further, the set of rotated implement distance values comprise GJy and GJx, which are based on a following set of implement distance rotation equations:
-
GJ y =GJ y0cos(θtilt)−GJ x0sin(θtilt); and (21) -
GJ x =GJ y0sin(θtilt)+GJ x0cos(θtilt). (22) - The architecture controller may be programmed to further determine a set of rotated implement profile values through steps 214-220 of
FIG. 4 . For example, instep 214, the architecture controller is programmed to move thelinkage assembly 104 to align theLDM 124 and the second calibration node. Instep 216, the architecture controller is programmed to determine implement profile values (IPV). For example, the architecture controller is programmed to calculate a pair of second calibration node measurements based on the second LDM distance signal DLDM2 and the second angle of inclination signal θINC2, and to determine a second set of dimensions comprising the implement profile values (IPV). The second set of dimensions is at least partially based on the pair of second calibration node measurements and the LDM offset values. Instep 218, the architecture controller is programmed to align the tilt axis with horizontal to generate a second rotation factor. And instep 220, the architecture controller is programmed to determine a set of rotated implement profile values at least partially based on the implement profile values (IPV) and the second rotation factor. - In embodiments, the implement profile values (IPV) comprise a horizontal distance (GKx0) and a vertical distance (GKy0) between the terminal point G of the
excavator stick 110 and the tilt point K of the excavating implement 114. Further, the rotated implement profile values comprise a rotated horizontal distance (GKx) and a rotated vertical distance (GKy). - The pair of second calibration node measurements may comprise a height Ĥ and a distance {circumflex over (D)} between the second calibration node and the LDM based on the LDM distance signal DLDM and angle of inclination θINC. For example, as set forth above in Equations 1-2, though now with respect to the second calibration node:
-
{circumflex over (D)}=D LDMcos(θINC), and -
Ĥ=D LDMsin(θINC). - The second set of dimensions may be determined based on a following set of second dimension equations:
-
AK y =Ĥ+H 0; and (23) -
AK x ={circumflex over (D)}+D 0. (24) - Further, the implement profile values (IPV) comprise GKy0 and GKx0, which are determined by a following set of equations:
-
GK y0 =AK y −AG y; and (25) -
GK x0 =AK x −AG x (26) - With respect to Equations 25-26 and referring to
FIG. 3 , and as described above, AG), is a horizontal distance between the boom terminal point A and the terminal point G of theexcavator stick 110, and AGy is a vertical distance between the boom terminal point A and the terminal point G of theexcavator stick 110. - In embodiments, the second rotation factor may be at least partially based on θtilt. Additionally, the set of rotated implement profile values comprise GKy and GKx, which are based on a following set of implement profile rotation equations:
-
GK y =GK x0cos(θtilt)−GK y0sin(θtilt); and (27) -
GK x =GK y0sin(θtilt)+GK x0cos(θtilt). (28) - The architecture controller may be programmed to, as illustrated in
step 222 ofFIG. 4 , determine implement dimensions between the first calibration node and the second calibration node at least partially based on the set of rotated implement distance values (IDV) and the set of rotated implement profile values (IPV). For example, and referring toFIG. 3 , the architecture controller is programmed to determine implement dimensions comprising a horizontal distance (JKx) and a vertical distance (JKy) between the terminal point J and the tilt point K at least partially based on the implement profile values (GKx, GKy) and the implement distance values (GJx, GJy). Further, the architecture controller may be programmed to operate the excavator using the implement dimensions, which may be, for example, the horizontal distance (JKx) and the vertical distance (JKy). Such implement dimensions may be based on a following set of equations: -
JK x =GJ x −GK x; and (29) -
JK y =GJ y −GK y. (30) - In embodiments, the architecture controller is further programmed to calibrate a z-axis of the implement
dynamic sensor 120 to align with the tilt axis TA. For example, the z-axis of the implementdynamic sensor 120 is solved, for example, through a steady state acceleration utilizing a single axis alignment function that is at least partially based on at least three measurements. The tilt axis TA is positioned in a plane that intersects the gravity vector. A first, full left tilt measurement is taken after the excavating implement 114 has been rotated about the tilt axis to the left such that a leading edge of the excavating implement 114 is tilted to the left of the tilt axis in a direction facing the leading edge. A second, roughly zero tilt measurement is taken in which the excavating implement 114 is at roughly a zero tilt such that a leading edge of the excavating implement 114 is not tilted with respect to the tilt axis TA in the direction facing the leading edge. Further, a third, full right tilt measurement is taken after the excavating implement 114 has been rotated about the tilt axis to the right such that a leading edge of the excavating implement 114 is tilted to the right of the tilt axis in the direction facing the leading edge. An acceleration based z-axis alignment method assuming an acceleration along the tilt point K remains constant (and is the z-axis) while the other accelerations along the other two axes change during rotation. Thus, the z-axis alignment finds a rotation for the appropriate acceleration value that keeps a constant acceleration, which indicates that the associated axis is the z-axis pointing along the tilt axis TA that intersects the tilt point K. Thus, the z-axis of the implementdynamic sensor 120 may be determined and aligned with the tilt axis TA of the excavating implement 114. - Further, the architecture controller may be programmed to calibrate θtilt with respect to the tilt axis TA and at least partially based on an alignment of the
LDM 124 with a center of the tilt point K, which intersects a point of the tilt axis TA, and a center point of a leading edge of the excavating implement 114. Either or both of the center of the tilt point K and the center point of a leading edge of the excavating implement 114 may be marked such as, for example, by a chalk marking. - The architecture controller may be further programmed to determine a set of measurements to assist with an LDM setup and the calibration prior to execution of the iterative process. The determination may be at least partially based on a measurement of a half-width of the excavating implement 114 to determine the center point of the leading edge of the excavating implement 114, and a measurement of the center of the tilt point K of the excavating implement 114. With respect to the LDM setup, the architecture controller may be further programmed to measure a center line of the
excavator boom 108, align a measured center line of theexcavator boom 108 with theLDM 124, align theLDM 124 with the center of the tilt point K, and pull the excavating implement 114 in toward theLDM 124 while keeping theLDM 124 aligned with the center of the tilt point K. Further, the architecture controller may be programmed to rotate at least one of the excavatinglinkage assembly 104 and theLDM 124 to keep theLDM 124 aligned with the center of the tilt point K. - It is contemplated that the embodiments of the present disclosure may assist to permit a speedy and more cost efficient method of determining excavating implement dimension lengths and angle offsets in a manner that minimizes a risk of human error and increased accuracy with such value determinations.
- A signal may be “generated” by direct or indirect calculation or measurement, with or without the aid of a sensor.
- For the purposes of describing and defining the present invention, it is noted that reference herein to a variable being a “function” of a parameter or another variable is not intended to denote that the variable is exclusively a function of the listed parameter or variable. Rather, reference herein to a variable that is a “function” of a listed parameter is intended to be open ended such that the variable may be a function of a single parameter or a plurality of parameters.
- It is also noted that recitations herein of “at least one” component, element, etc., should not be used to create an inference that the alternative use of the articles “a” or “an” should be limited to a single component, element, etc.
- It is noted that recitations herein of a component of the present disclosure being “configured” or “programmed” in a particular way, to embody a particular property, or to function in a particular manner, are structural recitations, as opposed to recitations of intended use. More specifically, the references herein to the manner in which a component is “configured” or “programmed” denotes an existing physical condition of the component and, as such, is to be taken as a definite recitation of the structural characteristics of the component.
- It is noted that terms like “preferably,” “commonly,” and “typically,” when utilized herein, are not utilized to limit the scope of the claimed invention or to imply that certain features are critical, essential, or even important to the structure or function of the claimed invention. Rather, these terms are merely intended to identify particular aspects of an embodiment of the present disclosure or to emphasize alternative or additional features that may or may not be utilized in a particular embodiment of the present disclosure.
- For the purposes of describing and defining the present invention it is noted that the terms “substantially” and “approximately” are utilized herein to represent the inherent degree of uncertainty that may be attributed to any quantitative comparison, value, measurement, or other representation. The terms “substantially” and “approximately” are also utilized herein to represent the degree by which a quantitative representation may vary from a stated reference without resulting in a change in the basic function of the subject matter at issue.
- Having described the subject matter of the present disclosure in detail and by reference to specific embodiments thereof, it is noted that the various details disclosed herein should not be taken to imply that these details relate to elements that are essential components of the various embodiments described herein, even in cases where a particular element is illustrated in each of the drawings that accompany the present description. Further, it will be apparent that modifications and variations are possible without departing from the scope of the present disclosure, including, but not limited to, embodiments defined in the appended claims. More specifically, although some aspects of the present disclosure are identified herein as preferred or particularly advantageous, it is contemplated that the present disclosure is not necessarily limited to these aspects.
- It is noted that one or more of the following claims utilize the term “wherein” as a transitional phrase. For the purposes of defining the present invention, it is noted that this term is introduced in the claims as an open-ended transitional phrase that is used to introduce a recitation of a series of characteristics of the structure and should be interpreted in like manner as the more commonly used open-ended preamble term “comprising.”
Claims (20)
1. An excavator calibration framework comprising an excavator, a laser distance meter (LDM), a first laser reflector, and a second laser reflector, wherein:
the excavator comprises a machine chassis, an excavating linkage assembly, an implement dynamic sensor, an excavating implement, and control architecture;
the excavating linkage assembly comprises an excavator boom and an excavator stick that collectively define a plurality of linkage assembly positions;
the excavating implement is mechanically coupled to the excavator stick;
the excavating implement is configured to tilt about a tilt axis;
the implement dynamic sensor is positioned on the excavating implement and is configured to generate a tilt angle signal (θtilt) representing an angular degree to which the tilt axis of the excavating implement is tilted with respect to horizontal;
the first laser reflector is positioned at a first calibration node on the excavating implement;
the second laser reflector is positioned at a second calibration node on the excavating implement;
the LDM is configured to generate a first LDM distance signal DLDM1 indicative of a distance between the LDM and the first laser reflector and a first LDM angle of inclination signal θINC1 indicative of an angle between the LDM and the first laser reflector;
the LDM is configured to generate a second LDM distance signal DLDM2 indicative of a distance between the LDM and the second laser reflector and a second LDM angle of inclination signal θINC2 indicative of an angle between the LDM and the second laser reflector; and
the control architecture comprises one or more linkage assembly actuators and an architecture controller programmed to
determine the tilt axis of the excavating implement relative to horizontal based on the tilt angle signal (θtilt);
execute an iterative process to curl the excavating implement and create a set of bucket angles;
move the linkage assembly to align the LDM and the first calibration node;
calculate a pair of first calibration node measurements based on the first LDM distance signal DLDM1 and the first LDM angle of inclination signal θINC1;
determine a first set of dimensions comprising implement distance values and LDM offset values, wherein the first set of dimensions are at least partially based on the set of bucket angles and the pair of first calibration node measurements;
align the tilt axis with horizontal to generate a first rotation factor;
determine a set of rotated implement distance values at least partially based on the implement distance values and the first rotation factor;
move the linkage assembly to align the LDM and the second calibration node;
calculate a pair of second calibration node measurements based on the second LDM distance signal DLDM2 and the second LDM angle of inclination signal θINC2;
determine a second set of dimensions comprising implement profile values, wherein the second set of dimensions is at least partially based on the pair of second calibration node measurements and the LDM offset values;
align the tilt axis with horizontal to generate a second rotation factor;
determine a set of rotated implement profile values at least partially based on the implement profile values and the second rotation factor;
determine implement dimensions between the first calibration node and the second calibration node at least partially based on the set of rotated implement distance values and the set of rotated implement profile values and
operate the excavator using the implement dimensions.
2. An excavator calibration framework as claimed in claim 1 , wherein:
the excavating implement comprises a terminal point J and a tilt point K;
the tilt point K intersects a point of the tilt axis and is disposed above the implement dynamic sensor;
the first calibration node is positioned at the terminal point J of the excavating implement; and
the second calibration node is positioned at the tilt point K of the excavating implement.
3. An excavator calibration framework as claimed in claim 2 , wherein:
the excavating implement is mechanically coupled to a terminal point G of the excavator stick that intersects a curl axis about which the excavating implement is configured to curl;
the implement distance values comprise a horizontal distance (GJx0) and a vertical distance (GJy0) between the terminal point G of the excavator stick and the terminal point J of the excavating implement;
the rotated implement distance values comprise a rotated horizontal distance (GJx) and a rotated vertical distance (GJy);
the implement profile values comprise a horizontal distance (GKx0) and a vertical distance (GKy0) between the terminal point G of the excavator stick and the tilt point K of the excavating implement; and
the rotated implement profile values comprise a rotated horizontal distance (GKx) and a rotated vertical distance (GKy).
4. An excavator calibration framework as claimed in claim 1 , wherein the pair of first calibration node measurements comprise a height H and a distance D between the first calibration node and the LDM based on the LDM distance signal DLDM and angle of inclination signal θINC, such that
D=D LDMcos(θINC), and
H=D LDMsin(θINC); and
D=D LDMcos(θINC), and
H=D LDMsin(θINC); and
the LDM offset values define an offset horizontal distance (D0) and an offset vertical distance (H0) between a boom terminal point A and a laser origin of the LDM.
5. An excavator calibration framework as claimed in claim 4 , wherein:
the first set of dimensions further comprise:
an offset bucket angle (θbucket,offset); and
a length (GJ) between the terminal point G and a terminal point J of the excavating implement, the first calibration node positioned at the terminal point J; and
the first set of dimensions are determined based on a following set of first dimension equations:
AG y +GJcos(θbucket Measured−θbucket,offset)=H+H 0; and
AG x +GJsin(θbucket Measured−θbucket,offset)=D+D 0;
AG y +GJcos(θbucket Measured−θbucket,offset)=H+H 0; and
AG x +GJsin(θbucket Measured−θbucket,offset)=D+D 0;
where θbucket is an actual bucket angle, AGx is a horizontal distance between the boom terminal point A and the terminal point G of the excavator stick, and AGy is a vertical distance between the boom terminal point A and the terminal point G of the excavator stick.
6. An excavator calibration framework as claimed in claim 5 , wherein solutions to the first dimension equations are determined by a following solution set, in which:
cb=cos(θbucket Measured);
sb=sin(θbucket Measured
rhs[AG x −D, AG y −H];
lhs=[[ones; zeros], [zeros; ones], [cb;sb], [−sb;cb]]; and
sol=((lhs)(lhs)T)−1(lhs)T(rhs);
cb=cos(θbucket Measured);
sb=sin(θbucket Measured
rhs[AG x −D, AG y −H];
lhs=[[ones; zeros], [zeros; ones], [cb;sb], [−sb;cb]]; and
sol=((lhs)(lhs)T)−1(lhs)T(rhs);
from which a following set of solutions are determined:
H 0 =sol(1);
D 0 =sol(2);
cGJ=sol(3);
sGJ=sol(4);
θbucket,offset=tan−1(sGJ,cGJ);
H 0 =sol(1);
D 0 =sol(2);
cGJ=sol(3);
sGJ=sol(4);
θbucket,offset=tan−1(sGJ,cGJ);
such that:
GJ sol,1 =sol(3)/cos(θbucket,offset);
GJ sol,2 =sol(4)/sin(θbucket,offset).
GJ sol,1 =sol(3)/cos(θbucket,offset);
GJ sol,2 =sol(4)/sin(θbucket,offset).
7. An excavator calibration framework as claimed in claim 6 , wherein:
GJ sol,1 =GJ sol,2; and
GJ approx =GJ sol,1;
GJ sol,1 =GJ sol,2; and
GJ approx =GJ sol,1;
such that the implement distance values comprise GJy0, and GJx0, which are determined as follows:
GJ y0 =cb*cGJ−sb*sGJ; and
GJ x0 =sb*cGJ+cb*sGJ.
GJ y0 =cb*cGJ−sb*sGJ; and
GJ x0 =sb*cGJ+cb*sGJ.
8. An excavator calibration framework as claimed in claim 7 , wherein:
the first rotation factor is at least partially based on θtilt; and
the set of rotated implement distance values comprise GJy and GJx, which are based on a following set of implement distance rotation equations:
GJ y =GJ y0cos(θtilt)−GJ x0sin(θtilt); and
GJ x =GJ y0sin(θtilt)+GJ x0cos(θtilt).
GJ y =GJ y0cos(θtilt)−GJ x0sin(θtilt); and
GJ x =GJ y0sin(θtilt)+GJ x0cos(θtilt).
9. An excavator calibration framework as claimed in claim 1 , wherein the pair of second calibration node measurements comprise a height Ĥ and a distance {circumflex over (D)} between the second calibration node and the LDM based on the LDM distance signal DLDM and angle of inclination θINC, such that
{circumflex over (D)}=D LDMcos(θINC), and
Ĥ=D LDMsin(θINC); and
{circumflex over (D)}=D LDMcos(θINC), and
Ĥ=D LDMsin(θINC); and
the LDM offset values define an offset horizontal distance (D0) and an offset vertical distance (H0) between a boom terminal point A and a laser origin of the LDM.
10. An excavator calibration framework as claimed in claim 9 , wherein the second set of dimensions are determined based on a following set of second dimension equations:
AK y =Ĥ+H 0;
AK x ={circumflex over (D)}+D 0;
AK y =Ĥ+H 0;
AK x ={circumflex over (D)}+D 0;
such that the implement profile values comprise GKy0 and GKx0, which are determined by a following set of equations:
GK y0 =AK y −AG y; and
GK x0 =AK x −AG x.
GK y0 =AK y −AG y; and
GK x0 =AK x −AG x.
11. An excavator calibration framework as claimed in claim 10 , wherein:
the second rotation factor is at least partially based on θtilt; and
the set of rotated implement profile values comprise GKy and GKx, which are based on a following set of implement profile rotation equations:
GK y =GK x0cos(θtilt)−GK y0sin(θtilt); and
GK x =GK y0sin(θtilt)+GK x0cos(θtilt).
GK y =GK x0cos(θtilt)−GK y0sin(θtilt); and
GK x =GK y0sin(θtilt)+GK x0cos(θtilt).
12. An excavator calibration framework as claimed in claim 1 , wherein the architecture controller is programmed to:
determine implement dimensions comprising a horizontal distance (JKx) and a vertical distance (JKy) between the terminal point J and the tilt point K at least partially based on the implement profile values (GKx, GKy) and the implement distance values (GJx, GJy); and
operate the excavator using the horizontal distance (JKx) and the vertical distance (JKy).
13. An excavator calibration framework as claimed in claim 12 , wherein the horizontal distance (JKx) and the vertical distance (JKy) are based on a following set of equations:
JK x =GJ x −GK x; and
JK y =GJ y −GK y.
JK x =GJ x −GK x; and
JK y =GJ y −GK y.
14. An excavator calibration framework as claimed in claim 1 , wherein:
the excavating implement is mechanically coupled to a terminal point G of the excavator stick; and
the terminal point G intersects a curl axis about which the excavating implement is configured to curl.
15. An excavator calibration framework as claimed in claim 14 , wherein the iterative process comprises:
curling the excavating implement about the curl axis to a linkage assembly position, and
determining a bucket angle (θbucket) of the terminal point J relative to horizontal at the linkage assembly position, and the iterative process is repeated n times until n exceeds a threshold.
16. An excavator calibration framework as claimed in claim 1 , wherein the architecture controller is further programmed to:
calibrate a z-axis of the implement dynamic sensor to align with the tilt axis.
17. An excavator calibration framework as claimed in claim 1 , wherein the architecture controller is further programmed to:
calibrate θtilt with respect to the tilt axis and at least partially based on an alignment of the LDM with a center of a tilt point K, which intersects a point of the tilt axis, and a center point of a leading edge of the excavating implement.
18. An excavator calibration framework as claimed in claim 17 , wherein the architecture controller is further programmed to determine a set of measurements to assist with an LDM setup and the calibration of θtilt prior to execution of the iterative process, the determination at least partially based on:
a measurement of a half-width of the excavating implement to determine the center point of the leading edge of the excavating implement; and
a measurement of the center of the tilt point K of the excavating implement.
19. An excavator calibration framework as claimed in claim 18 , wherein, with respect to the LDM setup, the architecture controller is further programmed to:
measure a center line of the excavator boom;
align a measured center line of the excavator boom with the LDM;
align the LDM with the center of the tilt point K; and
pull the excavating implement in toward the LDM while keeping the LDM aligned with the center of the tilt point K.
20. An excavator calibration framework as claimed in claim 19 , wherein the architecture controller is further programmed to rotate at least one of the excavating linkage assembly and the LDM to keep the LDM aligned with the center of the tilt point K.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US15/372,737 US9995017B1 (en) | 2016-12-08 | 2016-12-08 | Excavator implement length and angle offset determination using a laser distance meter |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US15/372,737 US9995017B1 (en) | 2016-12-08 | 2016-12-08 | Excavator implement length and angle offset determination using a laser distance meter |
Publications (2)
Publication Number | Publication Date |
---|---|
US9995017B1 US9995017B1 (en) | 2018-06-12 |
US20180163363A1 true US20180163363A1 (en) | 2018-06-14 |
Family
ID=62485387
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
US15/372,737 Active US9995017B1 (en) | 2016-12-08 | 2016-12-08 | Excavator implement length and angle offset determination using a laser distance meter |
Country Status (1)
Country | Link |
---|---|
US (1) | US9995017B1 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111501895A (en) * | 2020-03-23 | 2020-08-07 | 潍柴动力股份有限公司 | Calibration method, calibration device and calibration system for excavator sensor |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
USD834109S1 (en) * | 2016-10-17 | 2018-11-20 | Gary Marvin Jenks | Toy excavator |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5848485A (en) * | 1996-12-27 | 1998-12-15 | Spectra Precision, Inc. | System for determining the position of a tool mounted on pivotable arm using a light source and reflectors |
US6263595B1 (en) * | 1999-04-26 | 2001-07-24 | Apache Technologies, Inc. | Laser receiver and angle sensor mounted on an excavator |
US6480289B1 (en) * | 1997-10-29 | 2002-11-12 | Hitachi Construction Machinery Co. Ltd. | Position measuring apparatus and optical deflection angle measuring apparatus for underground excavators |
US20030147727A1 (en) * | 2001-06-20 | 2003-08-07 | Kazuo Fujishima | Remote control system and remote setting system for construction machinery |
US20030226290A1 (en) * | 2000-05-05 | 2003-12-11 | Savard Hassel J | Laser-guided construction equipment |
US20130333364A1 (en) * | 2012-06-19 | 2013-12-19 | Caterpillar Trimble Control Technologies Llc | Method and system for controlling an excavator |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4829418A (en) | 1987-04-24 | 1989-05-09 | Laser Alignment, Inc. | Apparatus and method for controlling a hydraulic excavator |
US6253160B1 (en) | 1999-01-15 | 2001-06-26 | Trimble Navigation Ltd. | Method and apparatus for calibrating a tool positioning mechanism on a mobile machine |
KR101669787B1 (en) | 2014-05-14 | 2016-10-27 | 가부시키가이샤 고마쓰 세이사쿠쇼 | Hydraulic shovel calibration system and calibration method |
US10094654B2 (en) | 2014-08-25 | 2018-10-09 | Trimble Navigation Limited | All-in-one integrated sensing device for machine control |
-
2016
- 2016-12-08 US US15/372,737 patent/US9995017B1/en active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5848485A (en) * | 1996-12-27 | 1998-12-15 | Spectra Precision, Inc. | System for determining the position of a tool mounted on pivotable arm using a light source and reflectors |
US6480289B1 (en) * | 1997-10-29 | 2002-11-12 | Hitachi Construction Machinery Co. Ltd. | Position measuring apparatus and optical deflection angle measuring apparatus for underground excavators |
US6263595B1 (en) * | 1999-04-26 | 2001-07-24 | Apache Technologies, Inc. | Laser receiver and angle sensor mounted on an excavator |
US20030226290A1 (en) * | 2000-05-05 | 2003-12-11 | Savard Hassel J | Laser-guided construction equipment |
US20030147727A1 (en) * | 2001-06-20 | 2003-08-07 | Kazuo Fujishima | Remote control system and remote setting system for construction machinery |
US20130333364A1 (en) * | 2012-06-19 | 2013-12-19 | Caterpillar Trimble Control Technologies Llc | Method and system for controlling an excavator |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111501895A (en) * | 2020-03-23 | 2020-08-07 | 潍柴动力股份有限公司 | Calibration method, calibration device and calibration system for excavator sensor |
Also Published As
Publication number | Publication date |
---|---|
US9995017B1 (en) | 2018-06-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10253476B2 (en) | Excavator limb length determination using a laser distance meter | |
EP3559352B1 (en) | Machine control architecture for generating sensor location and offset angle | |
AU2017302521B2 (en) | Excavating implement heading control | |
US9976279B2 (en) | Excavating implement heading control | |
US10900196B2 (en) | Excavator four-bar linkage length and angle offset determination using a laser distance meter | |
US9816249B2 (en) | Excavating implement heading control | |
US9995017B1 (en) | Excavator implement length and angle offset determination using a laser distance meter | |
US10794038B2 (en) | Implement angle determination using a laser distance meter | |
US10364552B2 (en) | Excavator linkage angle determination using a laser distance meter | |
US10480155B2 (en) | Excavator implement teeth grading offset determination |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
AS | Assignment |
Owner name: CATERPILLAR TRIMBLE CONTROL TECHNOLOGIES LLC, OHIO Free format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNORS:HOWELL, MARK NICHOLAS;FREI, SAMUEL JOSEPH;REEL/FRAME:040599/0914 Effective date: 20161207 |
|
STCF | Information on status: patent grant |
Free format text: PATENTED CASE |
|
CC | Certificate of correction | ||
MAFP | Maintenance fee payment |
Free format text: PAYMENT OF MAINTENANCE FEE, 4TH YEAR, LARGE ENTITY (ORIGINAL EVENT CODE: M1551); ENTITY STATUS OF PATENT OWNER: LARGE ENTITY Year of fee payment: 4 |