US20220195705A1 - Method for putting down a tool of a construction machine - Google Patents
Method for putting down a tool of a construction machine Download PDFInfo
- Publication number
- US20220195705A1 US20220195705A1 US17/595,355 US202017595355A US2022195705A1 US 20220195705 A1 US20220195705 A1 US 20220195705A1 US 202017595355 A US202017595355 A US 202017595355A US 2022195705 A1 US2022195705 A1 US 2022195705A1
- Authority
- US
- United States
- Prior art keywords
- tool
- construction machine
- ground
- orientation
- determining
- 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.)
- Pending
Links
- 238000010276 construction Methods 0.000 title claims abstract description 71
- 238000000034 method Methods 0.000 title claims abstract description 33
- 230000005484 gravity Effects 0.000 claims abstract description 10
- 238000000151 deposition Methods 0.000 claims description 17
- 238000005259 measurement Methods 0.000 claims description 9
- 238000004590 computer program Methods 0.000 claims description 6
- 239000012636 effector Substances 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 238000003825 pressing Methods 0.000 description 2
- 241000750008 Alburnus tarichi Species 0.000 description 1
- 238000003491 array Methods 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 230000001960 triggered effect Effects 0.000 description 1
Images
Classifications
-
- 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)
-
- 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
- E02F9/2041—Automatic repositioning of implements, i.e. memorising determined positions of the implement
-
- 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
Definitions
- the present invention relates to a method for depositing a tool of a construction machine on the ground with the aid of tool center point estimation. Further, the invention relates to a computer program, which performs each step of the method when executed on a computing device, and to a machine-readable storage medium that stores the computer program. Finally, the invention relates to an electronic control device that is configured to execute the method according to the invention.
- Algorithms for determining the kinematic chain are known.
- one or more of the following sensors are arranged on each link of the tool arm, inertial measurement unit (IMU), angle sensors, linear sensors, which send sensor data to a computing device.
- the sensor data thus ascertained are filtered individually for each sensor and are fused for the purpose of estimating the state of the orientation of the respective sensor relative to a stationary inertial coordinate system.
- Such an algorithm is used, for example, in tool center point estimation.
- Tool center point estimation is an algorithm for estimating the state of orientation and position of an end effector.
- the end effector is a tool or a part of a tool that has a tool arm having a plurality of links connected by joints.
- the orientation of the link on which the sensor is located is first determined. This is done for all links of the tool arm. From the relative orientation of two successive links, the joint angle of the joint connecting the two links can be calculated if the kinematics are known (for example, if the Denavit-Hartenberg parameters are known). Finally, if all joint angles and the dimensions of the links are known, the entire configuration of the tool arm follows directly from the forward kinematics, and hence the orientation and position of the end effector.
- a method for depositing a tool of a construction machine on the ground is proposed. “Depositing” is understood here as the process of guiding the tool to the ground until the underside of the tool rests securely on the ground.
- the position and orientation of the links of the kinematic chain, including the tool, relative to the construction machine or to the earth's gravity are determined by means of one or more of the following sensors, inertial measurement unit, angle sensor, linear sensor, by use of an algorithm for determining the kinematic chain.
- the algorithm for determining the kinematic chain is based on sensor signals from the sensors arranged on at least the at least one part of the tool, and preferably arranged on each link of the kinematic chain between the construction machine and the tool.
- Inertial measurement units can be easily and inexpensively retrofitted and can be used for other methods.
- the orientation of at least one part of the construction machine contacting the ground is determined relative to the earth's gravity.
- the orientation between the at least one part of the construction machine contacting the ground and a part of the construction machine indicating the orientation of the construction machine is known, or can at least be ascertained. Due to the direct contact between the at least one part contacting the ground and the surface of the ground, the two orientations correspond, at least at the point of contact.
- the orientation of the surface typically changes only slightly over a distance corresponding to the distance between the at least one part contacting the ground and the tool—provided the construction machine is not directly on a ledge—the orientation of the surface of the ground at the place where the tool is deposited can be estimated from the orientation of the surface of the ground at the point of contact, and thus substantially corresponds to the orientation of the at least one part of the construction machine contacting the ground.
- the orientation of the at least one part of the construction machine contacting the ground is determined via the inertial measurement unit, and particularly preferably by the previously mentioned algorithm for determining the kinematic chain.
- a sensor signal of an inertial sensor of the inertial measurement unit on the construction machine is used.
- the inertial sensor is arranged on the construction machine in such a manner that the orientation between this inertial sensor and the at least one part of the construction machine contacting the ground is known from the design of the construction machine, or can at least be ascertained.
- the orientation of the vertical axis of the construction machine relative to the earth's gravity can be determined in order to determine the orientation of the at least one part of the construction machine contacting the ground.
- the at least one part of the construction machine contacting the ground is realized by wheels or a track chain, i.e. elements that contact the ground to move the construction machine.
- the construction machine may also stand on the ground with the at least one part contacting the ground; examples of this are a support or a foot.
- the movement of the tool is controlled by closed-loop control, taking into account the position and orientation of the tool and the orientation of the at least one part of the construction machine contacting the ground.
- the closed-loop control of the movement of the tool as the tool is being deposited is executed in such a manner that the underside of the tool, which is to rest on the ground after being deposited, is brought to the same level, hence in particular to the same height, and to the same orientation as the at least one part contacting the ground.
- the orientation of the at least one part of the construction machine contacting the ground corresponds substantially to the orientation of the surface of the ground at the place of deposit.
- the inclination of the tool is determined and, in the determination of the orientation of the at least one part of the construction machine contacting the ground, the inclination of this part is determined.
- at least one joint angle of a joint between the tool and the construction machine may be controlled by closed-loop control such that the underside of the tool is deposited horizontally and/or—even if the ground is not horizontal—parallel to the ground.
- the joint angle is controlled by closed-loop control such that the inclination of the underside of the tool corresponds to the inclination of the at least one part of the construction machine contacting the ground, which also corresponds substantially to the inclination of the surface of the ground at the place of deposit.
- Depositing the tool is a basic maneuver in the case of many construction machines.
- the depositing of the tool is at least partially automated.
- depositing of the tool may be triggered by the operator, by the pressing of a button.
- the automation of this particular maneuver may be performed independently of an autonomous control.
- an autonomous control of the construction machine may make use of this automated depositing of the tool according to the method.
- the automated depositing of the tool offers, inter alia, the following advantages: if an operator's view of the tool is obstructed, for example by the construction machine itself, manual control for depositing the tool is often difficult and can only be executed by skilled operators.
- the automated depositing of the tool according to the method therefore facilitates operation, especially for inexperienced operators. If a work sequence in which the tool is deposited is repeated continuously, which is the case, for example, with a so-called Y-cycle for loading and unloading, e.g. in the case of a wheel loader, the automation simplifies the operation.
- the tool can be deposited automatically in order to increase safety. In this case, however, it must be ensured that the tool can actually be put down safely at this place and time without causing damage.
- An ambient sensor system may be provided on the construction machine to sense the surroundings of the construction machine. This is often able to sense the orientation and level of the ground in the surroundings. Consequently, with the aid of the ambient sensor system, it is possible to detect ledges.
- the data from the ambient sensor system may be taken into account in the closed-loop control of the movement of the tool. In general, however, this method also makes it possible to dispense with the ambient sensor system.
- a further advantage is that the depositing of the tool can be controlled, by closed-loop control, more precisely by this method than by a method based only on the ambient sensor system or by a method in which a change in the hydraulic pressure is evaluated.
- the computer program is configured to perform each step of the method, in particular when executed on a computing device or control device. It enables the method to be implemented in a conventional electronic control device without the necessity of making structural changes to it. For this purpose, it is stored on the machine-readable storage medium.
- the electronic control device obtained is a device configured to control the depositing of the tool by closed-loop control.
- FIG. 1 shows a schematic representation of a construction machine in which, by means of the method according to the invention, a tool, from an initial state (a), is deposited on the ground (b).
- FIG. 2 shows a flow diagram of the method according to the invention.
- FIG. 1 shows a schematic representation of a construction machine 1 in the form of a wheel loader, having a tool 2 realized as a shovel.
- the tool 2 is connected to the construction machine 1 via a working arm 3 , there being a respective joint 4 arranged between the construction machine 1 and the working arm 3 , and between the tool 2 and the working arm 3 , which movably connects the respective components.
- the working arm may also be of a multi-link design, in which case there is also a joint arranged between each of the individual links.
- the construction machine 1 , the working arm 3 and the tool 2 form a kinematic chain.
- the inertial sensor 5 , 5 ′ of an inertial measurement unit arranged on each link of the kinematic chain, i.e. on the construction machine 1 , the working arm 3 and the tool 2 .
- the inertial sensor 5 ′ arranged on the construction machine 1 has a special significance in this case (see below) and is therefore denoted by a dash (′).
- the inertial sensors 5 , 5 ′ are connected to an electronic control device 6 of the construction machine 1 .
- the construction machine 1 in the form of the wheel loader has wheels 7 that are connected to the construction machine 1 via axles (not shown) and contact the ground 8 .
- the construction machine 1 is realized, for example, in the form of a bulldozer, in which, instead of the wheels, a track chain contacts the ground.
- the construction machine 1 may contact the ground with a support or a foot, for example when the construction machine 1 is a stationary construction machine 1 or is supported in a working mode.
- FIG. 1 Represented in FIG. 1 are two states a) and b), which were recorded at different times.
- the initial state a the tool 2 is still raised.
- the final state b the tool 2 is at the same level as the underside of the wheels 7 , and the orientation of the tool 2 corresponds to the orientation of the ground 8 , such that the tool 2 is deposited on the ground 8 .
- the joints 4 are oriented differently in the two states.
- FIG. 2 Represented in FIG. 2 is a flow diagram of an exemplary embodiment of the method according to the invention.
- the orientation, in particular the inclination, and the position of the tool 2 and of the working arm 3 relative to the construction machine 1 or to the earth's gravity are determined, by means of the inertial sensors 5 , 5 ′ on the construction machine 1 , the working arm 3 and the tool 5 , by use of an algorithm for determining the kinematic chain 10 .
- the sensor data from the inertial sensors 5 , 5 ′ along the kinematic chain are used.
- the orientation of the inertial sensor 5 ′ arranged on the construction machine 1 may be determined by means of a part of the same algorithm for determining the kinematic chain, using only the sensor data of this inertial sensor 5 ′.
- the depositing of the tool 2 is activated by an operator 30 , for example by pressing a button provided for this purpose, the orientation of the tool 2 in the inertial system, i.e. the inclination with respect to the earth's gravity, is ascertained 40 . Then target joint angles ⁇ target are ascertained 41 from the orientation of the tool 2 in the inertial system and the contact points of the wheels 7 .
- trajectories of movement for the tool 2 are ascertained.
- trajectories are described in the coordinates of a solid coordinate system.
- the position of the tool 2 is specified in the coordinates of the construction machine 1 .
- Target joint angles ⁇ target are then ascertained from these trajectories of movement.
- a closed-loop control 50 is provided for depositing the tool 2 on the ground 8 , in which the actual joint angles ⁇ actual are controlled to the target joint angles ⁇ target , such that the underside of the tool 2 is brought to the same level, i.e. the same height, as the plane of the contact points of the wheels 7 , parallel to the plane of the contact points of the wheels 7 and thus parallel to the ground 8 , therefore horizontal in this exemplary embodiment.
Abstract
A method is for putting down a tool of a construction machine. A position and an orientation of the tool relative to the construction machine or to a direction of Earth's gravity is determined by one or more of the following sensors including: an inertial measuring unit, an angle sensor, a linear sensor, and/or by an algorithm for determining a kinematic chain of the construction machine. Moreover, an orientation of at least one part of the construction machine, which part touches the ground, and which orientation characterizes an orientation of the construction machine relative to the ground, is determined relative to Earth's gravity. Based on this determination, movement of the tool is controlled, in order to bring a lower face of the tool to the same level and in the same orientation as the at least one part touching the ground, for putting down the tool.
Description
- The present invention relates to a method for depositing a tool of a construction machine on the ground with the aid of tool center point estimation. Further, the invention relates to a computer program, which performs each step of the method when executed on a computing device, and to a machine-readable storage medium that stores the computer program. Finally, the invention relates to an electronic control device that is configured to execute the method according to the invention.
- One of the basic maneuvers of many construction machines such as, for example, excavators, wheel loaders, bulldozers and the like, is to deposit the tool of the construction machine on the ground. The tool in this case must be placed on the ground safely, i.e. without tipping or slipping (off), and with as little impact force as possible. This maneuver is often difficult, especially for inexperienced operators, in particular if the view of the tool and/or of the ground is obstructed.
- Algorithms for determining the kinematic chain are known. For this purpose, one or more of the following sensors are arranged on each link of the tool arm, inertial measurement unit (IMU), angle sensors, linear sensors, which send sensor data to a computing device. The sensor data thus ascertained are filtered individually for each sensor and are fused for the purpose of estimating the state of the orientation of the respective sensor relative to a stationary inertial coordinate system. Such an algorithm is used, for example, in tool center point estimation. Tool center point estimation is an algorithm for estimating the state of orientation and position of an end effector. In particular, the end effector is a tool or a part of a tool that has a tool arm having a plurality of links connected by joints.
- Typically used methods are described in the paper by Nikolas Trawny and Stergios I. Roumeliotis, “Indirect Kalman filter for 3D attitude estimation”, University of Minnesota, Dept. of Comp. Sei. & Eng, Tech. Rep 2 (2005), in the paper by Robert Mahony, Tarek Hamei, and Jean-Michel Pflimlin, “Nonlinear complementary filters on the special orthogonal group”, IEEE Transactions on automatic control 53.5 (2008): 1203-1218, and in the paper by Sebastian Madgwick, “An efficient Orientation filter for inertial and inertial/magnetic sensor arrays”, Report x-io and University of Bristol (UK) 25 (2010), to which reference is made in this respect.
- From the orientation of the sensor estimated in this way, the orientation of the link on which the sensor is located is first determined. This is done for all links of the tool arm. From the relative orientation of two successive links, the joint angle of the joint connecting the two links can be calculated if the kinematics are known (for example, if the Denavit-Hartenberg parameters are known). Finally, if all joint angles and the dimensions of the links are known, the entire configuration of the tool arm follows directly from the forward kinematics, and hence the orientation and position of the end effector.
- For a detailed description, reference is made to the paper by Mark W. Spong, Seth Hutchinson and Mathukumalli Vidyasagar, “Robot modeling and control”, Vol. 3. New York: Wiley, 2006.
- A method for depositing a tool of a construction machine on the ground is proposed. “Depositing” is understood here as the process of guiding the tool to the ground until the underside of the tool rests securely on the ground.
- Throughout the method, the position and orientation of the links of the kinematic chain, including the tool, relative to the construction machine or to the earth's gravity are determined by means of one or more of the following sensors, inertial measurement unit, angle sensor, linear sensor, by use of an algorithm for determining the kinematic chain. The algorithm for determining the kinematic chain is based on sensor signals from the sensors arranged on at least the at least one part of the tool, and preferably arranged on each link of the kinematic chain between the construction machine and the tool. Inertial measurement units can be easily and inexpensively retrofitted and can be used for other methods.
- In addition, the orientation of at least one part of the construction machine contacting the ground, that characterizes the orientation of the construction machine relative to the ground, is determined relative to the earth's gravity. The orientation between the at least one part of the construction machine contacting the ground and a part of the construction machine indicating the orientation of the construction machine is known, or can at least be ascertained. Due to the direct contact between the at least one part contacting the ground and the surface of the ground, the two orientations correspond, at least at the point of contact. Since the orientation of the surface typically changes only slightly over a distance corresponding to the distance between the at least one part contacting the ground and the tool—provided the construction machine is not directly on a ledge—the orientation of the surface of the ground at the place where the tool is deposited can be estimated from the orientation of the surface of the ground at the point of contact, and thus substantially corresponds to the orientation of the at least one part of the construction machine contacting the ground.
- Preferably, the orientation of the at least one part of the construction machine contacting the ground is determined via the inertial measurement unit, and particularly preferably by the previously mentioned algorithm for determining the kinematic chain. For this purpose, a sensor signal of an inertial sensor of the inertial measurement unit on the construction machine is used. In this case, the inertial sensor is arranged on the construction machine in such a manner that the orientation between this inertial sensor and the at least one part of the construction machine contacting the ground is known from the design of the construction machine, or can at least be ascertained. Optionally, the orientation of the vertical axis of the construction machine relative to the earth's gravity can be determined in order to determine the orientation of the at least one part of the construction machine contacting the ground.
- In particular, the at least one part of the construction machine contacting the ground is realized by wheels or a track chain, i.e. elements that contact the ground to move the construction machine. Generally, the construction machine may also stand on the ground with the at least one part contacting the ground; examples of this are a support or a foot.
- If the tool is now to be deposited on the basis of a command from an operator or on the basis of automatic control of the construction machine, the movement of the tool is controlled by closed-loop control, taking into account the position and orientation of the tool and the orientation of the at least one part of the construction machine contacting the ground. The closed-loop control of the movement of the tool as the tool is being deposited is executed in such a manner that the underside of the tool, which is to rest on the ground after being deposited, is brought to the same level, hence in particular to the same height, and to the same orientation as the at least one part contacting the ground. As already described, the orientation of the at least one part of the construction machine contacting the ground corresponds substantially to the orientation of the surface of the ground at the place of deposit.
- Advantageously, in the determination of the orientation of the tool, the inclination of the tool is determined and, in the determination of the orientation of the at least one part of the construction machine contacting the ground, the inclination of this part is determined. In this case, in the closed-loop control, at least one joint angle of a joint between the tool and the construction machine may be controlled by closed-loop control such that the underside of the tool is deposited horizontally and/or—even if the ground is not horizontal—parallel to the ground. In other words, the joint angle is controlled by closed-loop control such that the inclination of the underside of the tool corresponds to the inclination of the at least one part of the construction machine contacting the ground, which also corresponds substantially to the inclination of the surface of the ground at the place of deposit.
- Depositing the tool is a basic maneuver in the case of many construction machines. As a result of the closed-loop control according to the method according to the invention, the depositing of the tool is at least partially automated. For example, depositing of the tool may be triggered by the operator, by the pressing of a button. The automation of this particular maneuver may be performed independently of an autonomous control. However, an autonomous control of the construction machine may make use of this automated depositing of the tool according to the method.
- For the operator, the automated depositing of the tool offers, inter alia, the following advantages: if an operator's view of the tool is obstructed, for example by the construction machine itself, manual control for depositing the tool is often difficult and can only be executed by skilled operators. The automated depositing of the tool according to the method therefore facilitates operation, especially for inexperienced operators. If a work sequence in which the tool is deposited is repeated continuously, which is the case, for example, with a so-called Y-cycle for loading and unloading, e.g. in the case of a wheel loader, the automation simplifies the operation. When the operator parks and leaves the vehicle, the tool can be deposited automatically in order to increase safety. In this case, however, it must be ensured that the tool can actually be put down safely at this place and time without causing damage.
- An ambient sensor system may be provided on the construction machine to sense the surroundings of the construction machine. This is often able to sense the orientation and level of the ground in the surroundings. Consequently, with the aid of the ambient sensor system, it is possible to detect ledges. The data from the ambient sensor system may be taken into account in the closed-loop control of the movement of the tool. In general, however, this method also makes it possible to dispense with the ambient sensor system.
- A further advantage is that the depositing of the tool can be controlled, by closed-loop control, more precisely by this method than by a method based only on the ambient sensor system or by a method in which a change in the hydraulic pressure is evaluated.
- The computer program is configured to perform each step of the method, in particular when executed on a computing device or control device. It enables the method to be implemented in a conventional electronic control device without the necessity of making structural changes to it. For this purpose, it is stored on the machine-readable storage medium.
- As a result of the computer program being uploaded to a conventional electronic control device, the electronic control device obtained is a device configured to control the depositing of the tool by closed-loop control.
- Exemplary embodiments of the invention are represented in the drawings and explained in more detail in the description that follows.
-
FIG. 1 shows a schematic representation of a construction machine in which, by means of the method according to the invention, a tool, from an initial state (a), is deposited on the ground (b). -
FIG. 2 shows a flow diagram of the method according to the invention. -
FIG. 1 shows a schematic representation of a construction machine 1 in the form of a wheel loader, having atool 2 realized as a shovel. Thetool 2 is connected to the construction machine 1 via a workingarm 3, there being a respective joint 4 arranged between the construction machine 1 and the workingarm 3, and between thetool 2 and the workingarm 3, which movably connects the respective components. In further exemplary embodiments that are not shown, the working arm may also be of a multi-link design, in which case there is also a joint arranged between each of the individual links. The construction machine 1, the workingarm 3 and thetool 2 form a kinematic chain. There is a respectiveinertial sensor arm 3 and thetool 2. Theinertial sensor 5′ arranged on the construction machine 1 has a special significance in this case (see below) and is therefore denoted by a dash (′). Theinertial sensors electronic control device 6 of the construction machine 1. The construction machine 1 in the form of the wheel loader haswheels 7 that are connected to the construction machine 1 via axles (not shown) and contact theground 8. - In further embodiments, not shown here, the construction machine 1 is realized, for example, in the form of a bulldozer, in which, instead of the wheels, a track chain contacts the ground. In still further embodiments, the construction machine 1 may contact the ground with a support or a foot, for example when the construction machine 1 is a stationary construction machine 1 or is supported in a working mode.
- Represented in
FIG. 1 are two states a) and b), which were recorded at different times. In the initial state a), thetool 2 is still raised. In the final state b), thetool 2 is at the same level as the underside of thewheels 7, and the orientation of thetool 2 corresponds to the orientation of theground 8, such that thetool 2 is deposited on theground 8. Thejoints 4 are oriented differently in the two states. - Represented in
FIG. 2 is a flow diagram of an exemplary embodiment of the method according to the invention. At the beginning and throughout the method, the orientation, in particular the inclination, and the position of thetool 2 and of the workingarm 3 relative to the construction machine 1 or to the earth's gravity are determined, by means of theinertial sensors arm 3 and thetool 5, by use of an algorithm for determining thekinematic chain 10. For this purpose, the sensor data from theinertial sensors tool 2 and of the workingarm 3, current actual joint angles θactual for thejoints 4 are then determined 11 by means of so-called Denavit-Hartenberg parameters (see, for example, Spong et al. “Robot modeling and control”, Vol. 3. New York: Wiley, 2006). Also determined 20 at the beginning are the contact points of thewheels 7 relative to the earth's gravity, which substantially represent the orientation of the surface of theground 8. Preferably, the orientation of theinertial sensor 5′ arranged on the construction machine 1 may be determined by means of a part of the same algorithm for determining the kinematic chain, using only the sensor data of thisinertial sensor 5′. In the case of the wheel loader shown here, there is a fixed relationship between the contact points of thewheels 7 and the orientation of thisinertial sensor 5′, such that the contact points of thewheels 7, and thus the orientation of theground 8, can be inferred from the orientation of theinertial sensor 5′. - If the depositing of the
tool 2 is activated by anoperator 30, for example by pressing a button provided for this purpose, the orientation of thetool 2 in the inertial system, i.e. the inclination with respect to the earth's gravity, is ascertained 40. Then target joint angles θtarget are ascertained 41 from the orientation of thetool 2 in the inertial system and the contact points of thewheels 7. - In a further exemplary embodiment, not shown, when the depositing of the
tool 2 is activated by anoperator 30, trajectories of movement for thetool 2 are ascertained. In the trajectories of movement, trajectories are described in the coordinates of a solid coordinate system. For this purpose, the position of thetool 2 is specified in the coordinates of the construction machine 1. Target joint angles θtarget are then ascertained from these trajectories of movement. - Finally, a closed-
loop control 50 is provided for depositing thetool 2 on theground 8, in which the actual joint angles θactual are controlled to the target joint angles θtarget, such that the underside of thetool 2 is brought to the same level, i.e. the same height, as the plane of the contact points of thewheels 7, parallel to the plane of the contact points of thewheels 7 and thus parallel to theground 8, therefore horizontal in this exemplary embodiment.
Claims (8)
1. A method for depositing a tool of a construction machine on the ground, comprising:
determining a position and an orientation of the tool relative to the construction machine or to a direction of Earth's gravity using one or more of an inertial measurement unit, an angle sensor, a linear sensor, and/or by use of an algorithm for determining a kinematic chain of the construction machine;
determining, relative to Earth's gravity, an orientation of at least one part of the construction machine contacting the ground that characterizes an orientation of the construction machine relative to the ground; and
controlling a movement of the tool by closed-loop control in order to bring an underside of the tool to a same level and to the same orientation as the at least one part of the construction machine contacting the ground, for depositing the tool on the ground.
2. The method as claimed in claim 1 , wherein:
the orientation of the at least one part of the construction machine contacting the ground is determined with the inertial measurement unit, and
a sensor signal of an inertial sensor of the inertial measurement unit located on the construction machine is used to determine the orientation of the at least one part of the construction machine contacting the ground.
3. The method as claimed in claim 1 , wherein:
determining the orientation of the tool includes determining an inclination of the tool, and
determining the orientation of the at least one part of the construction machine contacting the ground includes determining an inclination of the at least one part of the construction machine contracting ground.
4. The method as claimed in claim 3 , wherein, in controlling the movement of the tool by closed-loop control, at least one joint angle of at least one joint between the tool and the construction machine is controlled by closed loop control, such that the underside of the tool is deposited horizontally and/or parallel to the ground.
5. The method as claimed in claim 1 , wherein the at least one part of the construction machine contacting the ground includes one or more wheels and/or a drive chain.
6. The method as claimed in claim 1 , wherein a computer program is configured to perform the method.
7. The method as claimed in claim 6 , wherein the computer program is stored on a non-transitory machine-readable storage medium.
8. The method as claimed in claim 1 , wherein an electronic control device is configured to deposit the tool using the method.
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE102019207164.3A DE102019207164A1 (en) | 2019-05-16 | 2019-05-16 | Method for depositing a tool on a construction machine |
DE102019207164.3 | 2019-05-16 | ||
PCT/EP2020/062643 WO2020229277A1 (en) | 2019-05-16 | 2020-05-07 | Method for putting down a tool of a construction machine |
Publications (1)
Publication Number | Publication Date |
---|---|
US20220195705A1 true US20220195705A1 (en) | 2022-06-23 |
Family
ID=70681799
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
US17/595,355 Pending US20220195705A1 (en) | 2019-05-16 | 2020-05-07 | Method for putting down a tool of a construction machine |
Country Status (6)
Country | Link |
---|---|
US (1) | US20220195705A1 (en) |
EP (1) | EP3969674B1 (en) |
JP (1) | JP2022532756A (en) |
CN (1) | CN113795635A (en) |
DE (1) | DE102019207164A1 (en) |
WO (1) | WO2020229277A1 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20220074168A1 (en) * | 2019-03-05 | 2022-03-10 | Hitachi Construction Machinery Co., Ltd. | Automatic Operation Work Machine |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130066527A1 (en) * | 2010-05-24 | 2013-03-14 | Mariko Mizuochi | Work machine safety device |
US20150315765A1 (en) * | 2014-05-01 | 2015-11-05 | Caterpillar Inc. | Excavation system providing linkage placement training |
US20180179719A1 (en) * | 2016-12-23 | 2018-06-28 | Caterpillar Sarl | Method of determining the compaction of a terrain of a worksite |
US20200165799A1 (en) * | 2017-07-31 | 2020-05-28 | Sumitomo Heavy Industries, Ltd. | Excavator |
US20210010229A1 (en) * | 2018-03-31 | 2021-01-14 | Sumitomo Heavy Industries, Ltd. | Shovel |
US20210115644A1 (en) * | 2017-01-23 | 2021-04-22 | Built Robotics Inc. | Excavating earth from a dig site using an excavation vehicle |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB2186999B (en) * | 1986-02-12 | 1989-12-28 | Kubota Ltd | Control apparatus and proportional solenoid valve control circuit for boom-equipped working implement |
WO2015181990A1 (en) * | 2014-05-30 | 2015-12-03 | 株式会社小松製作所 | Work-machine control system, work machine, hydraulic-shovel control system, and work-machine control method |
AR104232A1 (en) * | 2015-04-13 | 2017-07-05 | Leica Geosystems Pty Ltd | DYNAMIC MOVEMENT COMPENSATION IN MACHINERY |
US10289097B2 (en) * | 2016-04-13 | 2019-05-14 | Caterpillar Sarl | Data system and method for work tool of machine |
CN106460360B (en) * | 2016-05-31 | 2018-06-12 | 株式会社小松制作所 | The control method of the control system of engineering machinery, engineering machinery and engineering machinery |
US9976285B2 (en) * | 2016-07-27 | 2018-05-22 | Caterpillar Trimble Control Technologies Llc | Excavating implement heading control |
JP6989255B2 (en) * | 2016-11-30 | 2022-01-05 | 株式会社小松製作所 | Work equipment control device and work machine |
WO2019012701A1 (en) * | 2017-07-14 | 2019-01-17 | 株式会社小松製作所 | Work machine and control method of work machine |
US11591768B2 (en) * | 2017-08-31 | 2023-02-28 | Komatsu Ltd. | Control system of work machine and method for controlling work machine |
CN110945187B (en) * | 2017-09-08 | 2022-08-16 | 住友重机械工业株式会社 | Excavator |
-
2019
- 2019-05-16 DE DE102019207164.3A patent/DE102019207164A1/en active Pending
-
2020
- 2020-05-07 EP EP20725462.4A patent/EP3969674B1/en active Active
- 2020-05-07 CN CN202080036195.9A patent/CN113795635A/en active Pending
- 2020-05-07 WO PCT/EP2020/062643 patent/WO2020229277A1/en active Application Filing
- 2020-05-07 JP JP2021568397A patent/JP2022532756A/en not_active Withdrawn
- 2020-05-07 US US17/595,355 patent/US20220195705A1/en active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130066527A1 (en) * | 2010-05-24 | 2013-03-14 | Mariko Mizuochi | Work machine safety device |
US20150315765A1 (en) * | 2014-05-01 | 2015-11-05 | Caterpillar Inc. | Excavation system providing linkage placement training |
US20180179719A1 (en) * | 2016-12-23 | 2018-06-28 | Caterpillar Sarl | Method of determining the compaction of a terrain of a worksite |
US20210115644A1 (en) * | 2017-01-23 | 2021-04-22 | Built Robotics Inc. | Excavating earth from a dig site using an excavation vehicle |
US20200165799A1 (en) * | 2017-07-31 | 2020-05-28 | Sumitomo Heavy Industries, Ltd. | Excavator |
US20210010229A1 (en) * | 2018-03-31 | 2021-01-14 | Sumitomo Heavy Industries, Ltd. | Shovel |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20220074168A1 (en) * | 2019-03-05 | 2022-03-10 | Hitachi Construction Machinery Co., Ltd. | Automatic Operation Work Machine |
US11891776B2 (en) * | 2019-03-05 | 2024-02-06 | Hitachi Construction Machinery Co., Ltd. | Automatic operation work machine |
Also Published As
Publication number | Publication date |
---|---|
WO2020229277A1 (en) | 2020-11-19 |
JP2022532756A (en) | 2022-07-19 |
DE102019207164A1 (en) | 2020-11-19 |
CN113795635A (en) | 2021-12-14 |
EP3969674A1 (en) | 2022-03-23 |
EP3969674B1 (en) | 2023-07-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6807293B2 (en) | Work machine | |
US11340611B2 (en) | Autonomous body system and control method thereof | |
JP6618072B2 (en) | Work machine | |
JPH10217170A (en) | Method and system to control motion | |
EP3885494B1 (en) | Automatic operation work machine | |
US11879234B2 (en) | Work vehicle | |
CN112859833A (en) | Unmanned transfer robot system | |
JP2000192514A (en) | Automatically operating construction machine and operating method thereof | |
CN110167336B (en) | Method and arrangement for controlling the operation of a timber-handling device in a working machine, and forestry machine | |
US20220195705A1 (en) | Method for putting down a tool of a construction machine | |
US10385541B2 (en) | Work vehicle with improved loader/implement return position control | |
US20110190942A1 (en) | Lift arm and implement control system | |
JP7120332B2 (en) | Trajectory tracking system, trajectory tracking method, and program | |
US9903100B2 (en) | Excavation system providing automated tool linkage calibration | |
CN115217174A (en) | Method for controlled loading with a self-propelled working vehicle and self-propelled working vehicle | |
EP2939529B1 (en) | A method and a system for controlling the crane of a forest machine | |
CN115680057A (en) | Method for monitoring and/or executing a movement of a work apparatus, work apparatus and computer program product | |
US20220205223A1 (en) | Method for Calculating an Excavation Volume | |
US20230068920A1 (en) | Work vehicle fork alignment system and method | |
JPH01223225A (en) | Controller for hydraulic machinery | |
CN114423905B (en) | Engineering machinery | |
JPH11293708A (en) | Automatic operating construction machinery | |
JP2511936B2 (en) | Blade tilt control device | |
CN113631778A (en) | Construction machine | |
JPS6210339A (en) | Flexible structure working machine |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
STPP | Information on status: patent application and granting procedure in general |
Free format text: APPLICATION UNDERGOING PREEXAM PROCESSING |
|
AS | Assignment |
Owner name: ROBERT BOSCH GMBH, GERMANY Free format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNORS:KRAUSE, CHRISTIAN;LIU, KAI;WAGNER, HORST;AND OTHERS;SIGNING DATES FROM 20220209 TO 20220218;REEL/FRAME:059381/0296 |
|
STPP | Information on status: patent application and granting procedure in general |
Free format text: DOCKETED NEW CASE - READY FOR EXAMINATION |
|
STPP | Information on status: patent application and granting procedure in general |
Free format text: NON FINAL ACTION MAILED |