The present invention relates to a work machine.
Operation of operation levers by an operator enables a work implement (front work implement) of a work machine typified by a hydraulic excavator configured with the work implement to be driven to shape a terrain profile to be worked into a desired shape. Machine guidance (MG) is known as a technique intended to support such work. The MG is a technique for realizing support of an operator's operation by displaying design surface data indicating the desired shape of a surface to be worked and to be eventually realized and a position relationship of a work implement with the surface to be worked.
JP-2014-101664-A, for example, discloses a display system of an excavating machine which has a work implement having a bucket (work tool) and to which the work implement is attached, the display system including: a work implement condition detection section configured to detect information about a position of a tip end of the bucket; a storage section configured to store positional information about a design surface indicating a design terrain profile and outer shape information about the bucket; and a processing section configured to determine, among a plurality of measurement reference points that are preset along an outer shape of a buttock part of the bucket for measuring a position and that include at least the tip end of the bucket, a measurement reference point closest to the design surface on the basis of the information about the position of the tip end of the bucket and the outer shape information about the bucket. In other words, the display system calculates a shortest distance among distances between the design surface and the bucket. JP-2014-101664-A also describes emitting a warning on the basis of the shortest distance and changing a mode of emitting a sound as the warning.
Patent Document 1: JP-2014-101664-A
In JP-2014-101664-A, the warning for causing an operator to recognize a probability that the distance between the bucket and the design surface is short and that a current terrain profile is excessively excavated (probability of collision of the bucket against the design surface) is emitted only on the basis of the distance between the design surface and the bucket. Owing to this, even when there is no probability of excessively excavating the current terrain profile, the warning is possibly emitted depending on the distance. For example, in a case in which the current terrain profile to be worked (hereinafter, referred to as “current terrain profile”) is below the design surface, that is, in a case of placing fill on the current terrain profile, it is unnecessary to emit a warning related to the probability of excessively excavating the current terrain profile by the bucket. Furthermore, frequent emission of unnecessary warnings during filling work makes the operator feel troublesome. In this way, a respect that it is preferable to provide an object only as needed corresponds to not only the warning but also overall notifications of operation support information related to the current terrain profile and the position of the target surface and including the warning and the display of the distance.
An object of the present invention is to provide a work machine capable of notifying an operator of operation support information related to a current terrain profile and a position of a target surface only as needed.
The present application includes a plurality of means for solving the problems. As an example, there is provided a work machine including: a multijoint type work implement; a plurality of hydraulic actuators that drive the work implement; an operation device that gives instructions on motions of the hydraulic actuators; a notification device that notifies an operator of operation support information; and a controller having a notification control section that exercises control as to whether to notify the operator of the operation support information on the basis of a distance between a predetermined target surface, out of a plurality of discretionally set target surfaces, and the work implement. The work machine further includes a current terrain profile acquisition device that acquires a position of a current terrain profile to be worked by the work implement, the controller includes a target surface comparison section that compares the position of the current terrain profile with a position of the predetermined target surface to determine a vertical position relationship between the current terrain profile and the predetermined target surface, and the notification control section changes content of the operation support information on the basis of a result of determination by the target surface comparison section.
According to the present invention, it is possible to prevent notification of unnecessary operation support information and, therefore, prevent an operator from being annoyed with unnecessary operation support information.
An embodiment of the present invention will be described hereinafter with reference to the drawings. While an example of a hydraulic excavator configured with a bucket 10 as a work tool (attachment) provided on a tip end of a work implement is described below, the present invention may be applied to a work machine configured with an attachment other than the bucket. Furthermore, the present invention is also applicable to a work machine other than a hydraulic excavator as long as the work machine has a multijoint type work implement configured by coupling a plurality of link members (attachment, arm, boom, and the like).
Furthermore, as for meanings of words, “on,” “above,” or “below” used together with a term indicating a certain shape (for example, a target surface, a design surface and the like), it is assumed in the present paper that “on” means a “surface” of the certain shape, “above” means a “position higher than the surface” of the certain shape, and “below” means a “position lower in position than the surface” of the certain shape. Moreover, in the following description, in a case in which a plurality of same constituent elements are present, alphabets are sometimes added to tail ends of reference characters (numbers); however, the plurality of constituent elements are sometimes denoted generically by omitting the alphabets. For example, when three pumps 300a, 300b, and 300c are present, these are sometimes denoted generically by pumps 300.
<Overall Configuration of Hydraulic Excavator>
In
The front work implement 1A is configured by coupling a plurality of driven members (a boom 8, an arm 9, and a bucket 10) each rotating in a vertical direction. A base end of the boom 8 is rotatably supported by a front portion of the upper swing structure 12 via a boom pin. The arm 9 is rotatably coupled to a tip end of the boom 8 via an arm pin and the bucket 10 is rotatably coupled to a tip end of the arm 9 via a bucket pin. The boom 8 is driven by a boom cylinder 5, the arm 9 is driven by an arm cylinder 6, and the bucket 10 is driven by a bucket cylinder 7.
A boom angle sensor 30, an arm angle sensor 31, and a bucket angle sensor 32 are attached to the boom pin, the arm pin, and a bucket link 13, respectively, so that rotation angles α, β, γ (refer to
Within a cabin provided in the upper swing structure 12, there are provided an operation device 47a (
An engine 18 that is a prime mover mounted in the upper swing structure 12 drives a hydraulic pump 2 and a pilot pump 48. The hydraulic pump 2 is a variable displacement hydraulic pump at a capacity controlled by a regulator 2a, while the pilot pump 48 is a fixed displacement hydraulic pump. As depicted in
A pump line 170 that is a delivery pipe of the pilot pump 48 is branched off into a plurality of lines after passing through a lock valve 39, and the branch lines are connected to valves of the operation devices 45, 46, and 47, and the front implement control hydraulic unit 160. The lock valve 39 is a solenoid selector valve in the present example, and a solenoid driving section of the lock valve 39 is electrically connected to a position sensor of a gate lock lever (not depicted) disposed within the cabin of the upper swing structure 12. A position of the gate lock lever is detected by the position sensor, and a signal in response to the position of the gate lock lever is input from the position sensor to the lock valve 39. The lock valve 39 is closed to interrupt the pump line 170 when the position of the gate lock lever is a lock position, and is opened to open the pump line 170 when the position thereof is an unlock position. In other words, in a state of interrupting the pump line 170, operations by the operation devices 45, 46, and 47 are made invalid to prohibit motions such as swing and excavation.
The operation devices 45, 46, and 47 are hydraulic pilot type operation devices, and generate pilot pressures (sometimes referred to as “operating pressures”) in response to operation amounts (for example, lever strokes) and operation directions of the operation levers 1 and 23 operated by an operator on the basis of a pressurized fluid delivered from the pilot pump 48. The pilot pressures generated in this way are supplied to hydraulic drive sections 150a to 155b of corresponding flow control valves 15a to 15f (refer to
A pressurized fluid delivered from the hydraulic pump 2 is supplied to the travel right hydraulic motor 3a, the travel left hydraulic motor 3b, the swing hydraulic motor 4, the boom cylinder 5, the arm cylinder 6, and the bucket cylinder 7 via the flow control valves 15a, 15b, 15c, 15d, 15e, and 15f (refer to
The posture of the work implement 1A can be defined on the basis of excavator reference coordinates of
Xbk=L1 cos(α)+L2 cos(α+β)+L3 cos(α+β+γ) [Equation 1]
Zbk=L1 sin(α)+L2 sin(α+β)+L3 sin(α+β+γ) [Equation 2]
Furthermore, the upper swing structure 12 of the hydraulic excavator 1 is configured with a pair of GNSS (Global Navigation Sattelite System) antennas 14A and 14B. A position of the hydraulic excavator 1 and a position of the bucket 10 in a global coordinate system can be calculated on the basis of information from the GNSS antennas 14.
As the MG of the front work implement 1A, the notification device 53 notifies the operator of the position relationship between the target surface 700 (refer to
As the MC over the front work implement 1A, in a case in which an excavating operation (specifically, an instruction to perform at least one of arm crowding, bucket crowding, and bucket dumping) is input via the operation device 45b or 46a, the MG/MC system outputs, to the relevant flow control valve 15a, 15b, or 15c, a control signal to forcibly actuate at least one of the hydraulic actuators 5, 6, and 7 (for example, to expand the boom cylinder 5 to force the boom cylinder 5 to perform a boom raising motion) so that the position of the tip end of the work implement 1A (assumed as the claw tip of the bucket 10 in the present embodiment) can be kept in an area on and above the target surface 700 on the basis of the position relationship between the target surface 700 (refer to
Since this MC prevents the claw tip of the bucket 10 from entering an area below the target surface 700, it is possible to perform excavation along the target surface 700 regardless of a degree of an operator's skill. It is noted that a control point over the front work implement 1A at the time of the MC is set to the claw tip of the bucket 10 of the hydraulic excavator (tip end of the work implement 1A) in the present embodiment; however, the control point can be changed to a point other than the bucket claw tip as long as the point is present in the tip end portion of the work implement 1A.
The system of
The work implement posture sensor 50 is configured with the boom inclination sensor 30, the arm angle sensor 31, the bucket angle sensor 32, and the machine body inclination angle sensor 33. These angle sensors 30, 31, 32, and 33 function as posture sensors for the work implement 1A.
The target surface setting device 51 is an interface to which information about the target surface 700 (containing position information about each target surface and inclination angle information) can be input. The target surface setting device 51 is connected to an external terminal (not depicted) that stores three-dimensional data about the target surface specified in a global coordinate system (absolute coordinate system). It is noted that an operator may manually input the target surface via the target surface setting device 51.
The operator's operation sensor 52a is configured from pressure sensors 70a, 70b, 71a, 71b, 72a, and 72b that acquire operating pressures (first control signals) generated in the pilot lines 144, 145, and 146 by operation of the operation levers 1a and 1b (operation devices 45a, 45b, and 46a) by an operator. In other words, the operator's operation sensor 52a detects operations on the hydraulic cylinders 5, 6, and 7 related to the work implement 1A.
As the current terrain profile acquisition device 96, a stereo camera, a laser scanner, or an ultrasonic sensor, for example, provided in the excavator 1 can be used. Each of these devices measures a distance from the excavator 1 to a point on the current terrain profile, and the current terrain profile acquired by the current terrain profile acquisition device 96 is defined by position data about a point group of an enormous amount. It is noted that the current terrain profile acquisition device 96 may be configured to acquire, in advance, three-dimensional data about the current terrain profile by a drone or the like that mounts therein the stereo camera, the laser scanner, the ultrasonic sensor, or the like, and to function as an interface for capturing the three-dimensional data into a controller 40.
<Front Implement Control Hydraulic Unit 160>
As depicted in
Furthermore, the front implement control hydraulic unit 160 is configured with the pressure sensors 71a and 71b that are installed in the pilot lines 145a and 145b for the arm 9, that detect pilot pressures (first control signals) as operation amounts of the operation lever 1b and that output the detected pilot pressures to the controller 40, a solenoid proportional valve 55b that is installed in the pilot line 145b and that reduces the pilot pressure (first control signal) on the basis of the control signal from the controller 40 to output the reduced pilot pressure, and solenoid proportional valve 55a that is installed in the pilot line 145a and that reduces the pilot pressure (first control signal) in the pilot line 145b on the basis of the control signal from the controller 40 to output the reduced pilot pressure.
Moreover, the front implement control hydraulic unit 160 is configured with the pressure sensors 72a and 72b that are installed in the pilot lines 146a and 146b for the bucket 10, that detect pilot pressures (first control signals) as operation amounts of the operation lever 1a, and that output the detected pilot pressures to the controller 40, solenoid proportional valves 56a and 56b that reduce the pilot pressures (first control signals) on the basis of a control signal from the controller 40 to output the reduced pilot pressures, solenoid proportional valves 56c and 56d that have primary port sides connected to the pilot pump 48 and that reduce the pilot pressure from the pilot pump 48 to output the reduced pilot pressure, and shuttle valves 83a and 83b each of which selects a higher pressure out of the pilot pressure in the pilot line 146a or 146b and a control pressure output from the solenoid proportional valve 56c or 56d and each of which guides the selected pressure to the hydraulic drive section 152a or 152b of the flow control valve 15c. It is noted that connection lines between the pressure sensors 70, 71, and 72 and the controller 40 are omitted in
Opening degrees of the solenoid proportional valves 54b, 55a, 55b, 56a, and 56b are maximum when currents are not carried, and become smaller as the currents that are the control signals from the controller 40 are increased. On the other hand, opening degrees of the solenoid proportional valves 54a, 56c, and 56d are zero when currents are not carried, are not zero when currents are carried, and become larger as the currents (control signals) from the controller 40 are increased. In this way, the opening degrees 54, 55, and 56 of the solenoid proportional valves are in response to the control signals from the controller 40.
In the control hydraulic unit 160 configured as described above, when the controller 40 outputs the control signals to drive the solenoid proportional valves 54a, 56c, and 56d, pilot pressures (second control signals) can be generated even without operator's operation of the corresponding operation devices 45a and 46a; thus, it is possible to forcibly generate a boom raising motion, a bucket crowding motion, or a bucket dumping motion. Likewise, when the controller 40 drives the solenoid proportional valves 54b, 55a, 55b, 56a, and 56b, pilot pressures (second control signals) can be generated by reducing the pilot pressures (first control signals) generated by operator's operation of the operation devices 45a, 45b, and 46a; thus, it is possible to forcibly reduce a velocity of a boom lowering motion, an arm crowding/dumping motion, or a bucket crowding/dumping motion from an operator's operation value.
In the present paper, among the control signals for the flow control valves 15a to 15c, the pilot pressures generated by operating the operation devices 45a, 45b, and 46a will be referred to as “first control signals.” In addition, among the control signals for the flow control valves 15a to 15c, the pilot pressures generated by correcting (reducing) the first control signals by causing the controller 40 to drive the solenoid proportional valves 54b, 55a, 55b, 56a, and 56b, and the pilot pressures newly generated independently of the first control signals by causing the controller 40 to drive the solenoid proportional valves 54a, 56c, and 56d will be referred to as “second control signals.”
The second control signals are generated when a velocity vector of the control point over the work implement 1A generated by the first control signals is against a predetermined condition, and are generated as control signals for generating a velocity vector of the control point over the work implement 1A that is not against the predetermined condition. In a case in which the first control signal is generated for one of the hydraulic drive sections of any of the flow control valves 15a to 15c and the second control signal is generated for the other hydraulic drive section, it is assumed that the second control signal is allowed to preferentially act on the hydraulic drive section, the first control signal is interrupted by the solenoid proportional valve, and the second control signal is input to the other hydraulic drive section. Therefore, among the flow control valves 15a to 15c, each of those for which the second control signals are computed is controlled on the basis of the second control signal, each of those for which the second control signals are not computed is controlled on the basis of the first control signal, and each of those for which neither the first control signals nor the second control signals are not generated is not controlled (driven). In a case of defining the first control signals and the second control signals as described above, it can also be said that the MC is control over the flow control valves 15a to 15c on the basis of the second control signals.
<Controller 40>
In
While the controller 40 of
The notification control section 374 is a part that controls content of the operation support information (hereinafter, often referred to as “notification content”) of which an operator is notified by the notification device 53 on the basis of information output from the MG/MC control section 43 (for example, information about a work implement posture and the target surface, and the like). The notification control section 374 is configured with a display ROM that stores a great deal of display-associated data containing images and icons of the work implement 1A, and the notification control section 374 reads a predetermined program on the basis of flags (for example, a notification content change flag depicted in
<MG/MC Control Section 43>
The operation amount computing section 43a calculates operation amounts of the operation devices 45a, 45b, and 46a (operation levers 1a and 1b) on the basis of inputs from the operator's operation sensor 52a. The operation amount computing section 43a can calculate the operation amounts of the operation devices 45a, 45b, and 46a from detection values of the pressure sensors 70, 71, and 72.
It is noted that the calculation of the operation amounts by the pressure sensors 70, 71, and 72 is given as an example and that operation amounts of the operation levers of the operation devices 45a, 45b, and 46a may, for example, be detected by position sensors (for example, rotary encoders) detecting rotation displacements of the operation levers thereof. Furthermore, as an alternative to the configuration of calculating motion velocities from the operation amounts, a configuration such that stroke sensors that detect expansion/contraction amounts of the hydraulic cylinders 5, 6, and 7 are attached and the motion velocities of the cylinders are calculated on the basis of changes in the detected expansion/contraction amounts over time is also applicable.
The posture computing section 43b computes the posture of the front work implement 1A and the position of the claw tip of the bucket 10 in a local coordinate system (excavator reference coordinate system) on the basis of the information from the work implement posture sensor 50. As already described, the claw tip position of the bucket 10 (Xbk,Zbk) can be computed by Equations (1) and (2).
The target surface computing section 43c computes position information about the target surface 700 on the basis of the information from the target surface setting device 51 and stores this position information in the RAM 94. As depicted in
While the number of target surfaces 700 is one in an example of
The actuator control section 81 controls at least one of the plurality of hydraulic actuators 5, 6, and 7 in accordance with a preset condition when the operation devices 45a, 45b, and 46a are operated. The actuator control section 81 in the present embodiment executes the MC to control the motion of the boom cylinder 5 (boom 8) in such a manner that the claw tip of the bucket 10 (control point) is located on or above the target surface 700, on the basis of the position of the target surface 700, the posture of the work implement 1A, the position of the claw tip of the bucket 10, and the operation amounts of the operation devices 45a, 45b, and 46b, when the operation devices 45a, 45b, and 46a are operated, as depicted in
The target surface comparison section 62 is a part that compares the position of the current terrain profile 800 with the position of the predetermined target surface 700 to determine a vertical position relationship between the current terrain profile 800 and the target surface 700. The target surface comparison section 62 outputs a determination result to the actuator control section 81 and the notification control section 374 as flags (for example, the notification content change flag depicted in
The solenoid proportional valve control section 44 computes commands to the solenoid proportional valves 54 to 56 on the basis of the target pilot pressures output from the actuator control section 81 to the flow control valves 15a, 15b, and 15c. It is noted that the corresponding solenoid proportional valves 54 to 56 do not operate since current values (command values) to the corresponding solenoid proportional valves 54 to 56 are zero in a case in which the pilot pressures (first control signals) based on the operator's operation match the target pilot pressures calculated by the actuator control section 81.
The notification control section 374 exercises control as to how to notify the operator of posture information computed by the posture computing section 43b and target surface information computed by the target surface computing section 43c on the basis of a result of comparison by the target surface comparison section 62.
<Target Surface Comparison Section 62>
Details of processes performed by the target surface comparison section 62 will next be described. The target surface comparison section 62 determines the vertical position relationship between the current terrain profile 800 and the target surface 700, and outputs the notification content change flag and the MG target surface change flag based on the determination result to the actuator control section 81 and the notification control section 374. Before describing an output process for outputting the notification content change flag and the MG target surface change flag, a method of determining the vertical position relationship between the current terrain profile 800 and the target surface 700 will first be described with reference to
As depicted in
The target surface comparison section 62 compares the position of the target surface 700 in the excavator reference coordinates with positions of the straight lines 802 expressing the current terrain profile to determine the position relationship. In the present embodiment, comparison methods (1) to (3) are used as follows. The comparison methods will be described in a situation in which the target surface 700 includes target surfaces 700A, 700B, and 700C and the segments 802 include segments 802A, 802B, and 802C.
(1) In the present embodiment, in principle, a normal of one segment of the target surface 700, on the basis of which the MG and the MC is performed, passing through a given point on one segment of the current terrain profile 800 is created, and the target surface comparison section 62 determines the vertical position relationship between the target surface 700 and the current terrain profile 800 from a direction (sign) of a Z-direction component of the normal. In
(2) Furthermore, in the present embodiment, an intersection point between one segment of the target surface 700 and one segment of the current terrain profile 800 is searched, and a normal passing through a point on the segment of the target surface 700 apart from the intersection point by a predetermined distance in a positive X direction and the segment of the current terrain profile 800 is created, while a normal passing through a point on the segment of the target surface 700 apart from the intersection point by the predetermined distance in a negative X direction and the segment of the current terrain profile 800 is created. The target surface comparison section 62 then determines the vertical position relationship between the target surface 700 and the current terrain profile 800 in a range before and after the intersection point from directions (signs) of Z-direction components of the two normals.
In
(3) Furthermore, in the present embodiment, an inflection point of one segment of the target surface 700 is searched, a normal passing through the inflection point and one segment of the current terrain profile 800 is created, and the target surface comparison section 62 determines the vertical position relationship between the target surface 700 (inflection point) and the current terrain profile 800 from a direction of a Z-direction component of the normal. The inflection point represents a connection point between the target surfaces 700 having different inclinations. For example, the target surfaces 700A and 700B are connected to each other at an inflection point 702A. Since a Z-direction component of a normal 701D that is a normal of the target surface 700A and that passes through the inflection point 702A and the segment 802B is in the negative direction, the target surface comparison section 62 can determine that the inflection point 702A is located above the segment 802B.
A normal 701E of the target surface 700B is created on the basis of the method (1) above in such a manner as to pass through a connection point 801C between the segments 802B and 802C, and a Z-direction component of the normal 701E is in a negative direction. The target surface comparison section 62 can, therefore, determine that the target surface 700B is located above the segment 802B.
Next, the target surface comparison section 62 can determine that the target surface 700B and the segment 802C intersect each other at an intersection point 803B. Therefore, among normals of the segment 700B, a normal starting at a more positive position than the intersection point 803B in the X direction as a starting point and passing through the segment 802C is calculated as a normal 701F, and a normal starting at a more negative position than the intersection point 803B as a starting point and passing through the segment 802C is calculated as a normal 701G, on the basis of the method (2) above. Here, since a Z-direction component of the normal 701F is in the negative direction, the target surface comparison section 62 can determine that the segment 802C is located below the target surface 700B at the more positive position than the intersection point 803B in the X direction. In addition, since a Z-direction component of the normal 71G is in the negative direction, the target surface comparison section 62 can determine that the segment 802C is located above the target surface 700B at the more positive position than the intersection point 803B in the X direction.
Next, the target surfaces 700B and 700C are connected to each other at an inflection point 702B. Therefore, a normal 701H passing through the inflection point 702B and the segment 802C is created on the basis of the method (3) above. Since a Z-direction component of the normal 701H is in the positive direction, the target surface comparison section 62 can determine that the inflection point 702B is located below the segment 802C.
Furthermore, a normal 701I of the target surface 700C passing through a given point of the segment 802C is created on the basis of the method (1) above. Since a Z-direction component of this normal 701I is in the positive direction, the target surface comparison section 62 can determine that the target surface 700C is located below the segment 802C.
In the situation of
<Use of Movable Range Information about Work Implement 1A>
The target surface comparison section 62 in the present embodiment limits a range of comparing the position relationship between the target surface 700 and the current terrain profile 800 using movable range information about the work implement 1A at a time of comparing the position relationship between the target surface 700 and the current terrain profile 800 as described with reference to
In the present paper, it is assumed that the range in which the claw tip of the bucket 10 is movable is the “movable range” regardless of whether the work implement 1A can perform the excavation work. The movable range can be divided into a range in which the work implement 1A can perform the excavation work (workable range) and a range in which the work implement 1A is unable to perform the excavation work (unworkable range). The unworkable range is a range in which the work implement 1A is unable to perform the excavation work in a state in which the boom 8 is raised to a maximum degree (boom angle α is a minimum value). In a portion of the workable range adjoining the unworkable range, a range in which the work implement 1A can perform the excavation work in the state in which the boom 8 is raised to the maximum degree (boom angle α is the minimum value) (referred to as “boom-maximum-raising workable range”) is present.
In the present embodiment, the “movable range” is specified as the area delimited by circular arcs 439a, 439b, 438a, 438b, and 438c. The circular arc 439a is a locus drawn by the tip end of the bucket 10 when the boom angle α is changed between the minimum value and a maximum value at postures of the arm 9 and the bucket 10 at which a length of the work implement 1A is maximum (maximum excavation radius) Lmax (such postures are sometimes referred to as “maximum reach postures”). It is noted that the bucket angle γ at the maximum reach postures is sometimes referred to as “maximum reach angle.” The circular arc 439b is a locus drawn by the tip end of the bucket 10 when the arm angle β is changed between a minimum value and a maximum value in a state in which the boom angle α is the maximum value at the maximum reach postures. The circular arc 438a is a locus drawn by the tip end of the bucket 10 when a bucket cylinder length is changed between a minimum value and a maximum value in a state of setting the boom angle α to the minimum value and the arm angle β to the minimum value. The circular arc 438b is a locus drawn by the tip end of the bucket 10 when the arm angle β is changed between the minimum value and the maximum value in a state of setting the boom angle α to the minimum value and the bucket cylinder length to the maximum value. The circular arc 438c is a locus drawn by the tip end of the bucket 10 when the bucket cylinder length is changed between the minimum value and the maximum value in a state of setting the boom angle α to the minimum value and the arm angle β to the maximum value.
In the present embodiment, the “movable range” is divided into the “workable range D” and the “unworkable range F” by a circular arc E. In other words, a boundary between these two ranges D and F is the circular arc E. In
The “workable range D” is specified as an area delimited by the circular arcs 439a and 439b located relatively apart from the upper swing structure 12 and the circular arc E located relatively close to the upper swing structure 12.
The target surface comparison section 62 in the present embodiment compares the position relationship between the target surface 700 and the current terrain profile 800 only within the workable range D defined as described above, which will also be obvious from
It is noted that the target surface comparison section 62 may determine the vertical position relationship between the target surface 700 and the current terrain profile 800 using the movable range as an alternative to the workable range D. Furthermore, use of the movable range information about the work implement 1A is not always essential at the time of determination of the vertical position relationship between the target surface 700 and the current terrain profile 800, and the target surface comparison section 62 may compare the position of the target surface 700 with the position of the current terrain profile 800 in overlapping ranges of ranges of acquiring the target surface 700 and the current terrain profile 800.
<Notification Content Change Flag>
The output process for outputting the notification content change flag by the target surface comparison section 62 will next be described with reference to
First, in Step SC100, the target surface comparison section 62 acquires the position information about the current terrain profile 800 around the hydraulic excavator 1 from the current terrain profile acquisition device 96.
Next, in Step SC101, the target surface comparison section 62 determines whether an excavating operation is being performed by the operator. By performing this determination, the notification content change flag does not change during excavation and notification content is not changed over during the excavation; thus, it is possible to prevent the operator from having a feeling of strangeness. Whether the excavating operation is being performed can be determined on the basis of cylinder velocities and a velocity of the tip end portion of the bucket 10 computed by the actuator control section 81. Alternatively, the target surface comparison section 62 may determine whether the excavating operation is being performed by the arm 9 or the bucket 10 on the basis of the information from the operator's operation sensor 52a. It is noted that a flow may be configured such that the target surface comparison section 62 omits determination in Step SC101 and goes to Step SC103 after Step S100.
In a case of determining in Step SC101 that the excavating operation is not being performed, the target surface comparison section 62 goes to Step SC103. Conversely, in a case of determining that the excavating operation is being performed, the target surface comparison section 62 goes to Step SC110 and holds the notification content change flag to a previous value without performing a comparison process.
In Step SC103, the target surface comparison section 62 determines whether at least part of the current terrain profile 800 is present within the workable range D. In a case of determining that at least part of the current terrain profile 800 is present within the workable range D, the target surface comparison section 62 goes to Step SC104. In a case of determining that no part of the current terrain profile 800 is present within the workable range D, the target surface comparison section 62 goes to Step SC108.
In Step SC104, the target surface comparison section 62 determines whether at least part of the target surface 700 is present within the workable range D. In a case of determining that at least part of the target surface 700 is present within the workable range D, the target surface comparison section 62 goes to Step SC105. In a case of determining that no part of the target surface 700 is present within the workable range D, the target surface comparison section 62 goes to Step SC109.
In Step SC105, the target surface comparison section 62 determines whether an area where the current terrain profile 800 is located below the target surface 700 is present with respect to the current terrain profile 800 and the target surface 700 present within the workable range D. The determination of the vertical position relationship between the current terrain profile 800 and the target surface 700 is based on the methods described with reference to
In Step SC106, the target surface comparison section 62 determines whether the target surface 700 closest to the tip end portion of the bucket 10 (that is, work implement 1A) is present in the area where it is determined in Step SC105 that the current terrain profile 800 is located below the target surface 700. In a case of determining that the target surface 700 closest to the bucket 10 is located below the current terrain profile 800, the target surface comparison section 62 goes to Step SC107. Otherwise (in a case in which the target surface 700 closest to the bucket is not located below the current terrain profile 800), the target surface comparison section 62 goes to Step SC109.
In Step SC107, the target surface comparison section 62 determines that the current terrain profile 800 is located below the target surface 700 (that is, filling work is under way), raises the notification content change flag, and outputs a result of the notification content change flag to the notification control section 374, the actuator control section 81, and the like. While a case in which the notification content change flag is raised has a total of two patterns in which the target surface comparison section 62 goes through either Step SC106 or SC108, it is assumed that an indication whether the target surface comparison section 62 has gone through Step SC106 or SC108 is added to information about the notification content change flag output by the target surface comparison section 62.
In Step SC109, the target surface comparison section 62 does not raise the notification content change flag (or lowers the notification content change flag in a case where the notification content change flag has already been raised), and outputs a result of not raising the notification content change flag to the notification control section 374, the actuator control section 81, and the like.
Meanwhile, in Step SC108, the target surface comparison section 62 determines whether at least part of the target surface 700 is present within the workable range D. In a case in which a determination result is YES, the target surface comparison section 62 goes to Step SC107. In a case in which the determination result is NO, the target surface comparison section 62 goes to Step SC109.
In a case of performing a process based on the flow of
<MG Target Surface Change Flag>
The output process for outputting the MG target surface change flag by the target surface comparison section 62 will next be described with reference to
First, in Step SD100, the target surface comparison section 62 determines whether the notification content change flag for which the target surface comparison section 62 goes through Step SC106 in the flowchart of
In Step SD101, the target surface comparison section 62 determines whether the target surface present in a direction of a velocity vector of the tip end of the bucket 10 (that is, motion direction of the bucket 10) out of the two target surfaces adjacent to the target surface closest to the bucket 10 present within the workable range D is located below the current terrain profile 800. The target surface to be determined will be rephrased herein by another expression. In a case in which the velocity vector of the bucket tip end is toward the machine body 1B, the target surface closer to the machine body 1B out of the two target surfaces adjacent to the target surface closest to the bucket 10 is to be determined. In a case in which the velocity vector of the bucket tip end is in a direction in which the velocity vector is apart from the machine body 1B, the target surface farther from the machine body out of the two target surfaces is to be determined. In a case of determining that the target surface to be determined is located below the current terrain profile 800, the target surface comparison section 62 goes to Step SD102; otherwise, the target surface comparison section 62 goes to Step SD103.
In Step SD102, since the target surface in the motion direction of the bucket 10 (target surface that possibly becomes the target surface closest to the bucket 10 soon) is located below the current terrain profile 800, the target surface comparison section 62 determines to set the target surface as an MG target in advance and to notify the operator of a warning related to the distance between the target surface and the bucket 10, raises the MG target surface change flag, and outputs a result of raising the MG target surface change flag to the notification control section 374 and the like.
In Step SD103, the target surface comparison section 62 does not raise the MG target surface change flag (or lowers the MG target surface change flag in a case where the MG target surface change flag has already been raised), and outputs a result of not raising the MG target surface change flag to the notification control section 374 and the like.
In
In this way, raising the MG target surface change flag and making changes the target surface as the MG target make it possible to carry out more appropriate MG. In other words, setting, as the MG target, the target surface 700 for which there is a probability that the current terrain profile 800 is excessively excavated if the bucket 10 enters the corresponding area instead of the target surface 700 for which there is no probability that the current terrain profile 800 is excessively excavated even if the bucket 10 enters the corresponding area enables the operator to perform the appropriate MG.
Specifically, as depicted in
<Notification Control Section 374>
Details of a process performed by the notification control section 374 will next be described.
First, in Step SB100, the notification control section 374 determines whether the notification content change flag is input from the target surface comparison section 62. In a case in which the notification content change flag is input, the notification control section 374 goes to Step SB101. In a case in which the notification content change flag is not input, the notification control section 374 goes to Step SB108.
In Step SB101, the notification control section 374 determines whether the MG target surface change flag is input from the target surface comparison section 62. In a case in which the MG target surface change flag is input, the notification control section 374 goes to Step SB102. In a case in which the MG target surface change flag is not input, the notification control section 374 goes to Step SB105.
Next, the process will be described with respect to three cases in which the notification control section 374 goes to Steps SB102, 105, and 108.
(A) Step SB102
A situation in which the notification control section 374 goes to Step SB102 corresponds to a case in which the target surface closest to the bucket 10 (closest target surface) 700 is located above the current terrain profile 800 (that is, a current circumstance is a circumstance in which filling work is possibly performed) but in which the target surface adjacent to the closest target surface in the motion direction of the bucket 10 (moving destination target surface) is located below the current terrain profile (that is, a case in which it is possibly predicted that the excavation work starts soon). In this case, it is assumed that the notification control section 374 designates the target surface as the MG target as the moving destination target surface and notifies the operator of the warning related to the distance between the moving destination target surface and the bucket 10 via the notification device 53. Specifically, the notification control section 374 executes a warning process in Steps SB102, 103, and 104.
In other words, in Step SB102, the notification control section 374 outputs data about a distance between the moving destination target surface 700 and the claw tip of the bucket 10 designated by the target surface comparison section 62, among the distances between the target surfaces 700 and the claw tip of the bucket 10 output from the target surface computing section 43c, to the notification device 53 (display device) to display the data on the screen of the notification device 53.
In next Step SB103, the notification control section 374 outputs a warning sound command based on the distance between the moving destination target surface 700 and the claw tip of the bucket 10 designated by the target surface comparison section 62, among the distances between the target surfaces 700 and the claw tip of the bucket 10 output from the target surface computing section 43c, to the notification device 53 (audio output device) to produce a warning sound. It is to be noted, however, that a threshold of the distance for which the warning sound is output is determined, and the notification control section 374 is configured to output the warning sound in a case in which the distance between the target surface as the MC target and the bucket 10 is below the threshold.
Furthermore, in Step SB104, the notification control section 374 outputs a light bar command based on the distance between the moving destination target surface 700 and the claw tip of the bucket 10 designated by the target surface comparison section 62, among the distances between the target surfaces 700 and the claw tip of the bucket 10 output from the target surface computing section 43c, to the notification device 53 (display device).
In the symbol display section 531A, the target surface 700B (moving destination target surface) for which there is a probability that the current terrain profile is excessively excavated when the bucket 10 enters the area is displayed by a solid line. On the other hand, the target surface 700A (closest target surface) for which there is no probability that the current terrain profile is excessively excavated even when the bucket 10 enters the area is displayed by a broken line.
In the numerical value display section 531B, the distance between the target surface 700B and the bucket 10 output in Step SB102 (0.20 m) is displayed.
Types of the arrow displayed in the arrow display section 531C include an upward arrow and a downward arrow, the downward arrow indicating that the target surface as the MG target is located below the bucket claw tip, and the upward arrow indicating that the target surface as the MG target is located above the bucket claw tip. In an example of
The light bar display section 531D is lit up in response to the distance between the target surface 700B and the bucket 10. The light bar of
(B) Step SB105
A typical situation in which the notification control section 374 goes to Step SB105 corresponds to a case in which the target surface closest to the bucket 10 (closest target surface) 700 is located above the current terrain profile 800 (that is, a current circumstance is a circumstance in which filling work is possibly performed) and in which the target surface adjacent to the closest target surface in the motion direction of the bucket 10 (moving destination target surface) is also located above the current terrain profile (that is, a case in which the filling work is also predicted in the moving destination). This situation also corresponds to a case in which the closest target surface is located above the current terrain profile but in which the moving destination target surface is not present. In such a case, it is assumed that the notification control section 374 designates the target surface as the MG target as the closest target surface and notifies the operator of the numerical value of the distance between the target surface as the MG target (closest target surface) and the bucket 10 via the notification device 53, but suspends notification related to the warning sound and the light bar. Specifically, the notification control section 374 executes a warning process in Steps SB105, 106, and 107.
In other words, in Step SB105, the notification control section 374 outputs data about the distance between the closest target surface 700 closest to the bucket 10 and the claw tip of the bucket 10, among the distances between the target surfaces 700 and the claw tip of the bucket 10 output from the target surface computing section 43c, to the notification device 53 (display device) to display the data on the screen of the notification device 53.
In next Step SB106, the notification control section 374 outputs an indication to turn off the warning sound command based on the distance between the closest target surface 700 and the claw tip of the bucket 10 to the notification device 53. This suspends production of the warning sound from the notification device 53 (audio output device).
In Step SB107, the notification control section 374 outputs an indication to turn off the light bar command based on the distance between the closest target surface 700 and the claw tip of the bucket 10 to the notification device 53. This suspends lighting-up of all the segments in the light bar on the notification device 53 (display device).
(C) Step SB108
A typical situation in which the notification control section 374 goes to Step SB108 corresponds to a case in which the closest target surface 700 closest to the bucket 10 is located below the current terrain profile 800 (that is, a current circumstance is an ordinary circumstance in which the excavation work is possibly performed). In this case, it is assumed that the notification control section 374 designates the target surface as the MG target as the closest target surface and notifies the operator of the warning related to the distance between the closest target surface and the bucket 10 via the notification device 53. Specifically, the notification control section 374 executes a warning process in Steps SB108, 109, and 110.
In other words, in Step SB108, the notification control section 374 outputs data about the distance between the closest target surface 700 closest to the bucket 10 and the claw tip of the bucket 10, among the distances between the target surfaces 700 and the claw tip of the bucket 10 output from the target surface computing section 43c, to the notification device 53 (display device) to display the data on the screen of the notification device 53.
In next Step SB109, the notification control section 374 outputs the warning sound command based on the distance between the closest target surface 700 and the claw tip of the bucket 10, among the distances between the target surfaces 700 and the claw tip of the bucket 10 output from the target surface computing section 43c, to the notification device 53 (audio output device) to produce the warning sound. The threshold of the distance for which the warning sound is output in this case is assumed to be the same as that in Step SB103.
Furthermore, in Step SB110, the notification control section 374 outputs the light bar command based on the distance between the closest target surface 700 and the claw tip of the bucket 10, among the distances between the target surfaces 700 and the claw tip of the bucket 10 output from the target surface computing section 43c, to the notification device 53 (display device).
<Actuator Control Section 81>
Details of a process performed by the actuator control section 81 will next be described. The actuator control section 81 in the present embodiment executes, as the MC, a motion to prevent entry of the bucket 10 into the target surface 700 by boom raising control.
In S410, the actuator control section 81 computes motion velocities (cylinder velocities) of the hydraulic cylinders 5, 6, and 7 on the basis of the operation amounts computed by the operation amount computing section 43a.
In S420, the actuator control section 81 computes a velocity vector B of the bucket tip end (claw tip) by an operator's operation on the basis of the motion velocities of the hydraulic cylinders 5, 6, and 7 computed in S410 and the posture of the work implement 1A computed by the posture computing section 43b.
In S430, the actuator control section 81 calculates a distance D (refer to
In S440, the actuator control section 81 acquires the vertical component “by” to the target surface 700 in the velocity vector B of the bucket tip end by the operator's operation calculated in S420.
In S450, the actuator control section 81 determines whether the limit value “ay” calculated in S430 is equal to or greater than zero. It is noted that xy coordinates are set as depicted in upper right part of
In S460, the actuator control section 81 determines whether the vertical component “by” in the velocity vector B of the claw tip by the operator's operation is equal to or greater than zero. A case in which the “by” is positive indicates that the vertical component “by” in the velocity vector B is upward, and a case in which the “by” is negative indicates that the vertical component “by” in the velocity vector B is downward. The actuator control section 81 goes to S470 in a case of determining in S460 that the vertical component “by” is equal to or greater than zero (that is, the vertical component “by” is upward), and goes to S500 in a case in which the vertical component “by” is smaller than zero.
In S470, the actuator control section 81 compares an absolute value of the limit value “ay” with an absolute value of the vertical component “by,” and goes to S500 in a case in which the absolute value of the limit value “ay” is equal to or greater than that of the vertical component “by.” On the other hand, the actuator control section 81 goes to S530 in a case in which the absolute value of the limit value “ay” is smaller than that of the vertical component “by.”
In S500, the actuator control section 81 selects “cy=ay−by” as an equation for calculating the vertical component cy to the target surface 700 in a velocity vector C of the bucket tip end to be generated by a motion of the boom 8 under machine control, and calculates the vertical component “cy” on the basis of the equation, the limit value “ay” in S430, and the vertical component “by” in S440. The actuator control section 81 then calculates the velocity vector C capable of outputting the calculated vertical component “cy” and sets a horizontal component in the velocity vector C to the cx (S510).
In S520, the actuator control section 81 calculates a target velocity vector T. Assuming that a vertical component to the target surface 700 in the target velocity vector T is “ty” and a horizontal component therein is “tx,” the vertical component “ty” and the horizontal component “tx” can be expressed as “ty=by +cy, tx=bx+cx,” respectively. By substituting the equation (cy=ay−by) in S500 into the “ty=by +cy, tx=bx+cx,” the target velocity vector T is eventually expressed as “ty=ay, tx=bx+cx.” In other words, the vertical component “ty” in the target velocity vector in a case of going to S520 is limited by the limit value “ay” and forced boom raising under machine control is actuated.
In S480, the actuator control section 81 determines whether the vertical component “by” in the velocity vector B of the claw tip by the operator's operation is equal to or greater than zero. The actuator control section 81 goes to S530 in a case of determining in S480 that the vertical component “by” is equal to or greater than zero (that is, the vertical component “by” is upward), and goes to S490 in a case in which the vertical component “by” is smaller than zero.
In S490, the actuator control section 81 compares the absolute value of the limit value “ay” with the absolute value of the vertical component “by,” and goes to S530 in the case in which the absolute value of the limit value “ay” is equal to or greater than that of the vertical component “by.” On the other hand, the actuator control section 81 goes to S500 in a case in which the absolute value of the limit value “ay” is smaller than that of the vertical component “by.”
In a case of going to S530, a front device control section 81d sets the velocity vector C to zero since it is unnecessary to cause the boom 8 to move under machine control. In this case, the target velocity vector T is expressed as “ty=by, tx=bx” if being on the basis of the equation (ty=by +cy, tx=bx+cx) used in S520, and the target velocity vector T matches the velocity vector B by the operator's operation (S540).
In S550, the actuator control section 81 computes target velocities of the hydraulic cylinders 5, 6, and 7 on the basis of the target velocity vector T (ty, tx) determined in S520 or S540. While it is clear from the above description, the target velocity vector T is realized by adding the velocity vector C generated by the motion of the boom 8 under machine control to the velocity vector B in a case in which the target velocity vector T does not match the velocity vector B in
In S560, the actuator control section 81 computes the target pilot pressures, which are to act on the flow control valves 15a, 15b, and 15c for the hydraulic cylinders 5, 6, and 7, on the basis of the target velocities of the cylinders 5, 6, and 7 calculated in S550.
In S590, the actuator control section 81 outputs target pilot pressures, which are to act on the flow control valves 15a, 15b, and 15c for the hydraulic cylinders 5, 6, and 7, to the solenoid proportional valve control section 44.
The solenoid proportional valve control section 44 controls the solenoid proportional valves 54, 55, and 56 in such a manner that the target pilot pressures act on the flow control valves 15a, 15b, and 15c for the hydraulic cylinders 5, 6, and 7, whereby the work implement 1A performs excavation. For example, in a case where an operator operates the operation device 45b to perform horizontal excavation by an arm crowding motion, then the solenoid proportional valve 55c is controlled in such a manner that the tip end of the bucket 10 does not enter the target surface 700, and a motion of raising the boom 8 is performed automatically.
It is noted that the control executed as the MC is not limited to the automatic control over the boom raising motion described above, and control may be executed in such a manner as, for example, to automatically rotate the bucket 10 and to keep constant an angle formed between the target surface 700 and a bottom portion of the bucket 10.
<Motions Under MG and Effects of MG>
Motions under the MG performed by the notification control section 374 (controller 40) of the hydraulic excavator 1 will next be described with reference to
First, in a case in which the hydraulic excavator 1 performs the excavation work while the target surface 700A and the current terrain profile 802A in the area A of
Next, in a case in which the hydraulic excavator 1 performs filling work while the target surface 700B and the current terrain profile 802B in the area B of
Next, in a case in which the hydraulic excavator 1 performs work near the area B while the target surface 700B and the current terrain profile 802B in the area B and the target surface 700C and the current terrain profile 802C in the area C of
As described above, changing the content of the operation support information of which the operator is notified by the notification device 53 depending on flag information from the target surface comparison section 62 enables the hydraulic excavator in the present embodiment to support the operator's excavating operation without notifying the operator of unnecessary operation support information. For example, in a situation in which filling work is performed on the current terrain profile 800 that is below the target surface 700, production of the warning sound from the notification device 53 and/or lighting-up of the light bar display section 531D possibly causes the operator to feel troublesome. However, according to the present embodiment, it is possible to prevent occurrence of such troublesomeness.
<Motions Under MC and Effects of MC>
Motions under the MC performed by the actuator control section 81 (controller 40) of the hydraulic excavator 1 will next be described.
In the flowchart of
On the other hand, in the case in which the notification content change flag is lowered, that is, in the case in which the target surface comparison section 62 determines that the target surface 700 is located below the current terrain profile 800, the limit value “ay” is set on the basis of
<Others>
The present invention is not limited to the above embodiment but encompasses various modifications without departing from the spirit of the invention. For example, the present invention is not limited to the work machine configured with all the configurations described in the above embodiment and encompasses the work machine from which part of the configurations are deleted.
In Step SB105 of
Moreover, while it has been described above that the notification content is changed on the basis of states of the two flags, that is, the notification content change flag and the MG target surface change flag, as depicted in
Furthermore, the graph of
While the hydraulic excavator performing the MG and the MC using the notification content change flag has been described above, the hydraulic excavator may be configured to perform only one of the MG and the MC.
Number | Date | Country | Kind |
---|---|---|---|
JP2017-179134 | Sep 2017 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2018/024609 | 6/28/2018 | WO | 00 |
Publishing Document | Publishing Date | Country | Kind |
---|---|---|---|
WO2019/058695 | 3/28/2019 | WO | A |
Number | Name | Date | Kind |
---|---|---|---|
7532967 | Fujishima | May 2009 | B2 |
11001992 | Morimoto | May 2021 | B2 |
20030004645 | Kochi | Jan 2003 | A1 |
20030004646 | Kochi | Jan 2003 | A1 |
20050027420 | Fujishima | Feb 2005 | A1 |
20070010925 | Yokoyama | Jan 2007 | A1 |
20130158785 | Fukano et al. | Jun 2013 | A1 |
20140064897 | Montgomery | Mar 2014 | A1 |
20160010312 | Kurihara et al. | Jan 2016 | A1 |
20160024757 | Nomura | Jan 2016 | A1 |
20160076228 | Nau | Mar 2016 | A1 |
20170021769 | Izumikawa | Jan 2017 | A1 |
20170101761 | Wu | Apr 2017 | A1 |
20170275854 | Izumikawa | Sep 2017 | A1 |
20180002899 | Morimoto | Jan 2018 | A1 |
20180030694 | Kanari et al. | Feb 2018 | A1 |
20180202130 | Morimoto | Jul 2018 | A1 |
20190218753 | Morimoto | Jul 2019 | A1 |
20190360178 | Morimoto | Nov 2019 | A1 |
20210140147 | Filla | May 2021 | A1 |
Number | Date | Country |
---|---|---|
2002-352224 | Dec 2002 | JP |
2014-101664 | Jun 2014 | JP |
2014-205655 | Oct 2014 | JP |
2016-204840 | Dec 2016 | JP |
2015194601 | Dec 2015 | WO |
Entry |
---|
International Search Report of PCT/JP2018/024609 dated Aug. 28, 2018. |
International Preliminary Report on Patentability received in corresponding International Application No. PCT/JP2018/024609 dated Apr. 2, 2020. |
Extended European Search Report received in corresponding European Application No. 18858018.7 dated Jun. 11, 2021. |
Number | Date | Country | |
---|---|---|---|
20200141091 A1 | May 2020 | US |