1. Field of the Invention
The present invention relates to a control system for a construction machine and a control method.
2. Background Information
Conventionally, a method is known for excavating in a region by moving a bucket along a design plane in a construction machine that is equipped with a work implement. A design plane is a plane that indicates a target shape to be excavated, and a position on the design plane and a position of the bucket are recognized by a controller provided in the construction machine.
For example, an operator sets an entry prohibition zone for the work implement in a control system described in Japanese Laid-open Patent Publication No. H4-136324. The control system reduces command values of lever signals on the work implement in response to the distance from the bucket to a boundary line of an entry prohibition zone. As a result, the bucket is automatically stopped at the boundary line even if the operator mistakenly moves the blade tip into the entry prohibition zone. Further, the operator is able to determine if the blade tip is approaching the entry prohibition zone due to a reduction in the velocity of the work implement.
However, the control system in Japanese Laid-open Patent Publication No. H4-136324 applies a limit to all the shafts of the work implement or to the shaft being manipulated in the direction approaching the boundary. Further, the work implement stops when the bucket reaches the boundary line. As a result, the operator may feel great discomfort in the operation.
Conversely, in order to reduce the sense of discomfort by the operator, a limit applied to the work implement in response to the operation by the operator is preferably reduced. During excavation, intended operations by the operator are strongly felt when operating the arm. Thus, when the control system applies a limit to the arm as described in Japanese Laid-open Patent Publication No. H4-136324, the operator easily feels a sense of discomfort.
An object of the present invention is to prevent the bucket from entering the design plane while reducing the discomfort felt by the operator in a construction machine.
A control system according to a first aspect of the present invention is a device for controlling a construction machine. The construction machine is equipped with a work implement and an operating device. The work implement has a boom, an arm, and a bucket. The operating device is a device for operating the work implement.
The control system is provided with a design plane setting unit, a target velocity determining unit, a distance obtaining unit, a limit velocity determining unit, a first limit determining unit, and a work implement control unit. The design plane setting unit sets a design plane for indicating a target shape to be excavated. The target velocity determining unit determines a boom target velocity in accordance with an operation amount of the operating device for operating the boom, an arm target velocity in accordance with an operation amount of the operating device for operating the arm, and a bucket target velocity in accordance with an operation amount of the operating device for operating the bucket. The distance obtaining unit obtains a distance between a blade tip of the bucket and the design plane. The limit velocity determining unit determines a limit velocity of the entire work implement on the basis of the distance. The first limit determining unit determines whether a first limit condition is satisfied. The work implement control unit controls the work implement.
The limit velocity determining unit determines a limit velocity of the boom from the limit velocity of the entire work implement, the arm target velocity, and the bucket target velocity. When the distance when the blade tip of the bucket is positioned outside of the design plane is a positive value and a velocity in a direction from the inside of the design plane toward the outside thereof is a positive value, the first limit condition includes a condition that the limit velocity of the boom is greater than the boom target velocity. When the first limit condition is satisfied, the work implement control unit controls the boom to match the limit velocity of the boom and controls the arm to match the arm target velocity.
When the first limit condition is satisfied in the control system of the construction machine according to the present aspect, the boom is controlled to match the limit velocity and the arm is controlled to match the arm target velocity. That is, only boom limitation is performed and arm limitation is not performed. Therefore, the arm target velocity changes directly in response to an operation by the operator. As a result, the bucket is prevented from entering the design plane while reducing the discomfort felt by the operator.
The first limit condition preferably further includes a condition that the distance is less than a first predetermined value. In this case, the boom limitation is performed when the blade tip of the bucket is moved to a position closer to the design plane than a position that is a distance equal to the first predetermined value away from the design plane.
The control system preferably is further provided with a second limit determining unit. The second limit determining unit determines whether a second limit condition is satisfied. The second limit condition includes a condition that the distance is smaller than a second predetermined value. The second predetermined value is smaller than the first predetermined value. When the second limit condition is satisfied, the work implement control unit controls the boom to match the limit velocity of the boom and controls the arm to match an arm limit velocity. An absolute value of the arm limit velocity is smaller than an absolute value of the arm target velocity.
In this case, when the second limit condition is satisfied, the boom is controlled to match the limit velocity of the boom, and the arm is controlled to match the arm limit velocity. Therefore, limitation of both the boom and the arm is performed when the distance between the blade tip of the bucket and the design plane is less than the second predetermined value. As a result, even if the bucket enters the design plane, an increase of the entry can be quickly suppressed.
The second predetermined value is preferably 0. In this case, only the boom limitation is performed and the arm limitation is not performed until the blade tip of the boom reaches the design plane. Then, when the blade tip of the boom crosses the design plane, both the boom limitation and the arm limitation are performed.
The second predetermined value is preferably larger than 0. In this case, both the boom limitation and the arm limitation are performed before the blade tip of the boom reaches the design plane. As a result, both the boom limitation and the arm limitation can be performed when the blade tip of the bucket is about to cross the design plane even before the blade tip of the bucket reaches the design plane.
The distance obtaining unit preferably obtains a deviation amount of the blade tip of the bucket at predetermined time periods. The deviation amount is an absolute value of a distance between the blade tip of the bucket and the design plane inside the design plane. The second limit condition further includes a condition that a current deviation amount is larger than a previous deviation amount. In this case, both the limitation of the boom and the limitation of the arm can be performed when the entry into the design plane by the bucket is about to increase.
The limit velocity determining unit preferably determines an arm deceleration coefficient on the basis of the current deviation amount and a displacement amount between a previous position and a current position of the blade tip of the bucket. The arm deceleration coefficient is a value greater than 0 and smaller than 1. The limit velocity determining unit determines the arm limit velocity by multiplying the arm target velocity by the arm deceleration coefficient. In this case, the velocity of the arm can be greatly reduced when the entry into the design plane by the bucket is about to increase.
When the first limit condition or the second limit condition is satisfied and the limit velocity of the entire work implement is smaller than a sum of the arm target velocity and the bucket target velocity, the work implement control unit preferably reduces the velocity of the boom to a velocity lower than the boom target velocity. In this case, the velocity of the entire work implement can be reduced to the limit velocity by reducing the velocity of the boom. As a result, the bucket is prevented from entering the design plane while reducing the discomfort felt by the operator.
When the first limit condition or the second limit condition is satisfied and the limit velocity of the entire work implement is greater than a sum of the arm target velocity and the bucket target velocity, the work implement control unit preferably moves the boom in the direction from the inside of the design plane toward the outside thereof. In this case, the velocity of the entire work implement can be reduced to the limit velocity by moving the boom in the direction from the inside of the design plane toward the outside thereof. As a result, the bucket can be prevented from entering the design plane.
The control system preferably is further provided with a third limit determining unit. The third limit determining unit determines whether a third limit condition is satisfied. The third limit condition includes a condition that the distance is smaller than the second predetermined value. When the third limit condition is satisfied, the work implement control unit controls the boom to match the limit velocity of the boom and controls the bucket to match the limit velocity of the bucket. An absolute value of the bucket limit velocity is smaller than an absolute value of the bucket target velocity.
A construction machine according to a second aspect of the present invention is provided with the abovementioned control system.
A control method according to a third aspect of the present invention is a method for controlling a construction machine. The construction machine is equipped with a work implement and an operating device. The work implement has a boom, an arm, and a bucket. The operating device is a device for operating the work implement. The method includes the following steps.
In a first step, a design plane is set for indicating a target shape to be excavated. In a second step, a boom target velocity is determined in accordance with an operation amount of the operating device for operating the boom, an arm target velocity is determined in accordance with an operation amount of the operating device for operating the arm, and a bucket target velocity is determined in accordance with an operation amount of the operating device for operating the bucket. In a third step, a distance between a blade tip of the bucket and the design plane is obtained. In a fourth step, a limit velocity of the entire work implement is determined on the basis of the distance. In a fifth step, whether a first limit condition is satisfied is determined. In a sixth step, the work implement is controlled. In the step for determining the limit velocity of the boom, the limit velocity of the boom is determined from the limit velocity of the entire work implement, the arm target velocity, and the bucket target velocity. When the distance when the blade tip of the bucket is positioned outside of the design plane is a positive value and the velocity in a direction from the inside of the design plane toward the outside thereof is a positive value, the first limit condition includes a condition that the limit velocity of the boom is greater than the boom target velocity. When the first limit condition is satisfied, the boom is controlled to match the limit velocity of the boom and the arm is controlled to match the arm target velocity in the step to control the work implement.
When the first limit condition is satisfied in the control method of the construction machine according to the present aspect, the boom is controlled to match the limit velocity and the arm is controlled to match the arm target velocity. That is, only boom limitation is performed and arm limitation is not performed. As a result, the bucket is prevented from entering the design plane while reducing the discomfort felt by the operator.
According to the present invention, the bucket is prevented from entering the design plane while reducing the discomfort felt by the operator in the construction machine.
Herein below, embodiments of the present invention will be described with reference to the accompanying drawings.
The vehicle body 1 has a revolving body 3, an operating cabin 4, and a travel device 5. The revolving body 3 contains devices such as an engine and a hydraulic pump described below. The operating cabin 4 is provided in the front section of the revolving body 3. An operating device described below is provided inside the operating cabin 4. The travel device 5 has crawler belts 5a and 5b, and the hydraulic excavator 100 travels due to the rotation of the crawler belts 5a and 5b.
The work implement 2 is attached to the front section of the vehicle body 1 and includes a boom 6, an arm 7, a bucket 8, a boom cylinder 10, and arm cylinder 11, and a bucket cylinder 12. The proximal end part of the boom 6 is attached in a swingable manner to the revolving body 3 via a boom pin 13. The proximal end part of the arm 7 is attached in a swingable manner to the distal end part of the boom 6 via an arm pin 14. The bucket 8 is attached in a swingable manner to the distal end part of the arm 7 via a bucket pin 15.
The boom cylinder 10, the arm cylinder 11, and the bucket cylinder 12 are all hydraulic cylinders that are driven by hydraulic fluid. The boom cylinder 10 drives the boom 6. The arm cylinder 11 drives the arm 7. The bucket cylinder 12 drives the bucket 8.
While two hydraulic pumps 22 and 23 are illustrated in
The control system 300 is provided with an operating device 25, a controller 26, and a control valve 27. The operating device 25 is a device for operating the work implement 2. The operating device 25 receives commands from an operator for driving the work implement 2 and outputs operation signals in accordance with an operation amount. The operating device 25 has a first operating member 28 and a second operating member 29.
The first operating member 28 is, for example, an operation lever. The first operating member 28 is provided in a manner that allows operation in the four directions of front, back, left, and right. Two of the four operating directions of the first operating member 28 are assigned to a raising operation and a lowering operation of the boom 6. The raising operation of the boom 6 corresponds to an excavation operation. The lowering operation of the boom 6 corresponds to a dump operation. The remaining two operating directions of the first operating member 28 are assigned to a raising operation and a lowering operation of the bucket 8.
The second operating member 29 is, for example, an operation lever. The second operating member 29 is provided in a manner that allows operation in the four directions of front, back, left, and right. Two of the four operating directions of the second operating member 29 are assigned to a raising operation and a lowering operation of the arm 7. The raising operation of the arm 7 corresponds to an excavation operation. The lowering operation of the arm 7 corresponds to a dump operation. The remaining two operating directions of the second operating member 29 are assigned to a right revolving operation and a left revolving operation of the revolving body 3.
The operating device 25 has a boom operating part 31 and a bucket operating part 32. The boom operating part 31 outputs a boom operation signal. The boom operation signal has a voltage value in accordance with an operation amount of the first operating member 28 (hereinbelow referred to as “boom operation amount”) for operating the boom 6. The bucket operating part 32 outputs a bucket operation signal. The bucket operation signal has a voltage value in accordance with an operation amount of the first operating member 28 (hereinbelow referred to as “bucket operation amount”) for operating the bucket 8.
The operating device 25 has an arm operating part 33 and a revolving operating part 34. The arm operating part 33 outputs an arm operation signal. The arm operation signal has a voltage value in accordance with an operation amount of the second operating member 29 for operating the arm 7 (hereinbelow referred to as “arm operation amount”). The revolving operating part 34 outputs a revolving operation signal. The revolving operation signal has a voltage value in accordance with an operation amount of the second operating member 29 for operating the revolution of the revolving body 3.
The controller 26 has a storage unit 34 such as a RAM or a ROM, and a computing unit 25 such as a CPU. The controller 26 obtains boom operation signals, arm operation signals, bucket operation signals, and revolution operation signals from the operating device 25. The controller 26 controls the control valve 27 on the basis of the operation signals.
The control valve 27 is an electromagnetic proportional control valve and is controlled by command signals from the controller 26. The control valve 27 is disposed between the hydraulic pumps 22 and 23 and hydraulic actuators such as the boom cylinder 10, the arm cylinder 11, the bucket cylinder 12, and the revolution motor 24. The control valve 27 controls the flow rate of the hydraulic fluid supplied from the hydraulic pumps 22 and 23 to the boom cylinder 10, the arm cylinder 11, the bucket cylinder 12, and the revolution motor 24.
The control system 300 has a first stroke sensor 16, a second stroke sensor 17, and a third stroke sensor 18. The first stroke sensor 16 detects a stroke length of the boom cylinder 10 (hereinbelow referred to as “boom cylinder length”). The second stroke sensor 17 detects a stroke length of the arm cylinder 11 (hereinbelow referred to as “arm cylinder length”). The third stroke sensor 18 detects a stroke length of the bucket cylinder 12 (hereinbelow referred to as “bucket cylinder length”). An angle sensor may be used for measuring the stroke. The control system 300 has a slope angle sensor 19. The slope angle sensor 19 is disposed on the revolving body 3. The slope angle sensor 19 detects a slope angle with respect to the horizontal direction of the revolving body 3, and a revolution angle of the revolving body 3 with respect to the front direction of the vehicle. The sensors send detection signals to the controller 26. The revolution angle may also be obtained from position information of belowmentioned GNSS antennas 37 and 38.
The control system 300 is provided with a position detecting unit 36. The position detecting unit 36 detects a current position of the hydraulic excavator 100. The position detecting unit 36 has the GNSS antennas 37 and 38, and a three-dimensional position sensor 39. The plurality of the GNSS antennas 37 and 38 are provided on the revolving body 3. The GNSS antennas 37 and 38 are antennas for a Real-time Kinematic-Global Navigation Satellite System. Signals according to GNSS radio waves received by the GNSS antennas 37 and 38 are input into the three-dimensional position sensor 39.
The controller 26 calculates a position of a local coordinate as seen in the global coordinate system on the basis of a detection result from the position detecting unit 36. A local coordinate system is a three-dimensional system based on the hydraulic excavator 100. A reference position P3 in the local coordinate system is, for example, a position on the center of revolution of the revolving body 3. Specifically, the controller 26 calculates a position of the local coordinates as seen in the global coordinate system as described below.
The controller 26 calculates a slope angle θ1 of the boom 6 with respect to the vertical direction in the local coordinate system from the boom cylinder length detected by the first stroke sensor 16. The controller 26 calculates a slope angle θ2 of the arm 7 with respect to the boom 6 from the arm cylinder length detected by the second stroke sensor 17. The controller 26 calculates a slope angle θ3 of the bucket 8 with respect to the arm 7 from the bucket cylinder length detected by the third stroke sensor 18.
The storage unit 34 in the controller 26 stores work implement data. The work implement data includes a length L1 of the boom 6, a length L2 of the arm 7, and a length L3 of the bucket 8. As illustrated in
The controller 26 calculates the position of the blade tip P4 in the local coordinate system from the slope angle θ1 of the boom 6, the slope angle θ2 of the arm 7, the slope angle θ3 of the bucket 8, the length L1 of the boom 6, the length L2 of the arm 7, the length L3 of the bucket 8, and the position information of the boom pin 13. The work implement data includes position information of the installation position P1 of the GNSS antennas 37 and 38 with respect to the reference position P3 in the local coordinate system. The controller 26 converts the position of the blade tip P4 in the local coordinate system to a position of the blade tip P4 in the global coordinate system based on the detection results of the position detecting unit 36 and the position information of the GNSS antennas 37 and 38. As a result, the controller 26 obtains the position information of the blade tip P4 as seen in the global coordinate system.
The storage unit 34 in the controller 26 stores design topography data indicating positions and shapes of a three-dimensional design topography inside the work area. The controller 26 displays the design topography on a display unit 40 on the basis of the design topography and detection results from the abovementioned sensors. The display unit 40 is, for example, a monitor and displays various types of information of the hydraulic excavator 100.
The controller 26 performs control by limiting the movement of the work implement 2 in order to prevent the bucket 8 from entering the design plane 41. The controls performed by the controller 26 are described in detail below.
The design plane setting unit 51 sets the design plane 41 for indicating the target shape to be excavated. Specifically, the design plane setting unit 51 selects a portion of the design planes 41 among the abovementioned plurality of design planes 41 as a target design plane. For example, the design plane setting unit 51 sets an intersection between the design plane 41 and a perpendicular line passing through the current position of the blade tip P4 in the global coordinate system, as position to be excavated. The design plane setting unit 51 selects the design plane 41 including the position to be excavated and the design planes 41 positioned therebefore and thereafter, as a plane to be excavated. The design plane setting unit 51 sets an intersecting line 43 that intersects the plane to be excavated and a flat plane 42 that passes through the current position of the blade tip P4 of the bucket 8, as the target design plane.
In the following explanation, the design plane 41 refers to the target design plane set as described above.
The target velocity determining unit 52 determines a boom target velocity Vc_bm, an arm target velocity Vc_am, and a bucket target velocity Vc_bkt. The boom target velocity Vc_bm is a velocity of the blade tip P4 when only the boom cylinder 10 is being driven. The arm target velocity Vc_am is a velocity of the blade tip P4 when only the arm cylinder 11 is being driven. The bucket target velocity Vc_bkt is a velocity of the blade tip P4 when only the bucket cylinder 12 is being driven. The boom target velocity Vc_bm is calculated in accordance with the boom operation amount. The arm target velocity Vc_am is calculated in accordance with the arm operation amount. The bucket target velocity Vc_bkt is calculated in accordance with the bucket operation amount.
The storage unit 34 stores target velocity information for prescribing a relationship between the boom operation amount and the boom target velocity Vc_bm. The target velocity determining unit 52 determines the boom target velocity Vc_bm corresponding to the boom operation amount by referencing the target velocity information. The target velocity information is, for example, a graph. The target velocity information may be in a format such as a table or an equation. The target velocity information includes information prescribing the relationship between the arm operation amount and the arm target velocity Vc_am. The target velocity information includes information prescribing the relationship between the bucket operation amount and the bucket target velocity Vc_bkt. The target velocity determining unit 52 determines the arm target velocity Vc_am corresponding to the arm operation amount by referencing the target velocity information. The target velocity determining unit 52 determines the bucket target velocity Vc_bkt corresponding to the bucket operation amount by referencing the target velocity information.
As illustrated in
Specifically, the target velocity determining unit 52 first finds the slope of the vertical axis of the local coordinates with respect to the vertical axis of the global coordinates and the slope in the vertical direction of the design plane 41 with respect to the vertical axis of the global coordinates, from the design topography data and the position information of the GNSS antennas 37 and 38, and then, from the slopes, finds the slope θ1 (see
As illustrated in
As illustrated in
The limit velocity determining unit 54 calculates a limit velocity Vcy_lmt of the entire work implement 2 on the basis of the distance d between the blade tip P4 of the bucket 8 and the design plane 41. The limit velocity Vcy_lmt for the entire work implement 2 is an allowable movement velocity of the blade tip P4 in the direction in which the blade tip P4 of the bucket 8 approaches the design plane 41. The storage unit 34 stores the limit velocity information that prescribes the relationship between the distance d and the limit velocity Vcy_lmt.
The velocity when the blade tip P4 moves from the inside toward the outside of the design plane 41 is a positive value, and the velocity when the blade tip P4 moves from the outside toward the inside of the design plane 41 is a negative value. In other words, the velocity when the blade tip P4 moves toward a position above the design plane 41 is a positive value and the velocity when the blade tip P4 moves toward a position below the design plane 41 is a negative value.
In the limit velocity information, the slope of the limit velocity Vcy_lmt when the distance d is between d1 and d2 is smaller than the slopes when the distance d is at or above d1 or at or below d2. d1 is greater than 0. d2 is less than 0. Since the limit velocity is set in more detail for operations near the design plane 41, the slope when the distance d is between d1 and d2 is smaller than the slopes when the distance d is at or above d1 or at or below d2. When the distance d is equal to or greater than d1, the limit velocity Vcy_lmt is a negative value, and the limit velocity Vcy_lmt becomes correspondingly smaller as the distance d increases. In other words, when the distance d is equal to or greater than d1, the velocity toward a position below the design plane 41 becomes correspondingly larger and the absolute value of the limit velocity Vcy_lmt correspondingly increases as the blade tip P4 above the design plane 41 is further away from the design plane 41. When the distance d is equal to or less than 0, the limit velocity Vcy_lmt is a positive value, and the limit velocity Vcy_lmt becomes correspondingly larger as the distance d decreases. In other words, when the distance d when the blade tip P4 of the bucket 8 moves away from the design plane 41 is equal to or less than 0, the velocity heading upward to the design plane 41 becomes correspondingly larger and the absolute value of the limit velocity Vcy_lmt correspondingly increases as the blade tip P4 below the design plane 41 is further away from the design plane 41.
When the distance d is equal to or greater than a first predetermined value dth1, the limit velocity Vcy_lmt becomes Vmin. The first predetermined value dth1 is a positive value and is greater than d1. Vmin is smaller than the minimum value of the target velocity. In other words, when the distance d is equal to or greater than the first predetermined value dth1, limitation of the operation of the work implement 2 is not performed. Therefore, limitation of the operation of the work implement 2 is not performed when the blade tip P4 is far away from the design plane 41 above the design plane 41. In other words, when the distance d is less than the first predetermined value dth1, limitation of the operation of the work implement 2 is performed. Specifically, when the distance d is less than the first predetermined value dth1, the operation of the boom 6 is limited as described below.
The limit velocity determining unit 54 calculates the vertical velocity component (hereinbelow referred to as “boom 6 limit vertical velocity component”) Vcy_bm_lmt of the limit velocity of the boom 6 from the limit velocity Vcy_lmt of the entire work implement 2, the arm target velocity Vc_am, and the bucket target velocity Vc_bkt. As illustrated in
As illustrated in
The first limit determining unit 55 is a unit for determining a condition for limiting the boom 6 and determines whether or not a first limit condition is satisfied. The first limit condition includes the conditions of the distance d being smaller than the abovementioned first predetermined value dth1, the distance d being equal to or greater than a belowmentioned second predetermined value dth2, and the limit velocity Vc_bm_lmt of the boom 6 being larger than the boom target velocity Vc_bm. For example, when lowering the boom 6, when the size of the downward limit velocity Vc_bm_lmt of the boom 6 is smaller than the size of the downward boom target velocity Vc_bm, the first limit determining unit 55 determines the first limit condition to be satisfied. When raising the boom 6, when the size of the upward limit velocity Vc_bm_lmt of the boom 6 is larger than the size of the upward boom target velocity Vc_bm, the first limit determining unit 55 determines the first limit condition to be satisfied.
The second limit determining unit 56 is a unit for determining a condition for limiting the arm 7 and determines whether or not the second limit condition is satisfied. The second limit condition includes the conditions of the distance d between the blade tip P4 and the design plane 41 being smaller than the second predetermined value dth2, and the limit velocity Vc_bm_lmt of the boom 6 being larger than the boom target velocity Vc_bm. The second predetermined value is 0. Therefore, when the blade tip P4 is positioned outside of the design plane 41, the second limit determining unit 56 determines the second limit condition to not be satisfied. That is, when the blade tip P4 is positioned above the design plane 41, the second limit determining unit 56 determines the second limit condition not to be satisfied. When the blade tip P4 is positioned inside of the design plane 41, the second limit determining unit 56 determines the second limit condition to be satisfied. That is, when the blade tip P4 is positioned below the design plane 41, the second limit determining unit 56 determines the second limit condition to be satisfied.
The second limit condition further includes the condition that a current deviation amount is larger than a previous deviation amount. As illustrated in
When the current deviation amount dn is equal to or less than the previous deviation amount dn-1, the second limit determining unit 56 determine the second limit condition not to be satisfied. Therefore, when entry of the blade tip P4 in the design plane 41 is not increasing even when the blade tip P4 is positioned below the design plane 41, the second limit determining unit 56 determines the second limit condition not to be satisfied.
The work implement control unit 57 controls the work implement 2. The work implement control unit 57 controls the boom cylinder 10, the arm cylinder 11, and the bucket cylinder 12 by sending arm command signals, boom command signals, and bucket command signals to the control valve 27. The arm command signals, boom command signals, and bucket command signals have electric current values that respectively correspond to a boom command velocity, an arm command velocity, and a bucket command velocity.
During normal driving when neither the first limit condition nor the second limit condition is satisfied, the work implement control unit 57 selects the boom target velocity Vc_bm, the arm target velocity Vc_am, and the bucket target velocity Vc_bkt respectively as the boom command velocity, the arm command velocity, and the bucket command velocity. That is, during normal driving, the work implement control unit 57 actuates the boom cylinder 10, the arm cylinder 11, and the bucket cylinder 12 in accordance with the boom operation amount, the arm operation amount, and the bucket operation amount respectively. Therefore, the boom cylinder 10 is operated at the boom target velocity Vc_bm, the arm cylinder 11 is operated at the arm target velocity Vc_am, and the bucket cylinder 12 is operated at the bucket target velocity Vc_bkt.
When the first limit condition is satisfied, the work implement control unit 57 actuates the boom 6 at the limit velocity Vc_bm_lmt of the boom 6 and actuates the arm 7 at the arm target velocity Vc_am. The work implement control unit 57 actuates the bucket 8 at the bucket target velocity Vc_bkt.
As described above, the limit vertical velocity component Vcy_bm_lmt of the boom 6 is calculated by subtracting the vertical velocity component Vcy_am of the arm target velocity and the vertical velocity component Vcy_bkt of the bucket target velocity, from the limit velocity Vcy_lmt of the entire work implement 2. Therefore, the limit vertical velocity component Vcy_bm_lmt of the boom 6 becomes a negative value for raising the boom 6 when the limit velocity Vcy_lmt of the entire work implement 2 is smaller than the sum of the vertical velocity component Vcy_am of the arm target velocity and the vertical velocity component Vcy_bkt of the bucket target velocity.
Therefore, the limit velocity Vc_bm_lmt of the boom 6 becomes a negative value. In this case, the work implement control unit 57 reduces the velocity of the lowering of the boom 6 to a velocity below the boom target velocity Vc_bm. As a result, the bucket 8 is prevented from entering the design plane 41 while reducing the discomfort felt by the operator.
The limit vertical velocity component Vcy_bm_lmt of the boom 6 becomes a positive when the limit velocity Vcy_lmt of the entire work implement 2 is greater than the sum of the vertical velocity component Vcy_am of the arm target velocity and the vertical velocity component Vcy_bkt of the bucket target velocity. Therefore, the limit velocity Vc_bm_lmt of the boom 6 becomes a positive value. In this case, the work implement control unit 57 raises the boom 6 even if the operating device 25 is operated in the direction for lowering the boom 6. As a result, an increase of the entry into the design plane 41 can be quickly suppressed.
When the blade tip P4 is positioned above the design plane 41, the absolute value of the limit vertical velocity component Vcy_bm_lmt of the boom 6 becomes correspondingly smaller and an absolute value of a velocity component (hereinbelow referred to as “limit horizontal velocity component”) Vcx_bm_lmt of the limit velocity of the boom 6 in the direction parallel to the design plane 41 becomes correspondingly smaller, as the blade tip P4 moves closer to the design plane 41. Therefore, when the blade tip P4 is positioned above the design plane 41, both the velocity of the boom 6 in the direction perpendicular to the design plane 41 and the velocity of the boom 6 in the direction parallel to the design plane 41, are reduced as the blade tip P4 moves closer to the design plane 41.
The boom 6, the arm 7, and the bucket 8 may be operated at the same time due to the operator operating the first operating member 28 and the second operating member 29 at the same time. The following is a description of the above controls when the respective limit velocities Vc_bm, Vc_am, and Vc_bkt of the boom 6, the arm 7, and the bucket 8 are inputted.
As described above, by not performing the limitation of the arm 7, a change of the arm operation amount corresponding to the intended excavation by the operator is reflected as a velocity change of the blade tip P4 of the bucket 8. As a result, a feeling of discomfort in the operation when the operator is excavating can be suppressed while preventing an increase of the entry into the design plane 41.
When the second limit condition is satisfied, the work implement control unit 57 controls the boom 6 at the limit velocity Vc_bm_lmt of the boom 6, and controls the arm 7 at an arm limit velocity Vc_am_lmt. The limit velocity determining unit 54 calculates the arm limit velocity Vc_am_lmt by multiplying the arm target velocity Vc_am by an arm deceleration coefficient. The limit velocity determining unit 54 calculates the arm deceleration coefficient a using the following equation (1).
a=1+0.001×(Dn+(Dn−Dn-1)×b) Equation (1)
where b is a predetermined constant, Dn is a current excavation amount, and Dn-1 is a previously obtained excavation amount. The absolute value of the excavation amount Dn corresponds to the abovementioned deviation amount dn, and the excavation amount Dn is a negative value inside the design plane 41. The term “Dn−Dn-1” in Equation (1) corresponds to a displacement amount Δd between the previous position and the current position of the blade tip P4 of the bucket 8. Therefore, the limit velocity determining unit 54 calculates the arm deceleration coefficient on the basis of the current deviation amount dn and the displacement amount Δd between the previous position and the current position of the blade tip P4 of the bucket 8.
The arm deceleration coefficient is a value greater than 0 and smaller than 1. Therefore, the absolute value of the arm limit velocity Vc_am_lmt is smaller than the absolute value of the arm target velocity Vc_am. That is, when the second limit condition is satisfied, the work implement control unit 57 reduces the velocity of the arm 7 to a velocity lower than the arm target velocity Vc_am. Therefore, when the second limit condition is satisfied, the work implement control unit 57 reduces the velocity of the boom 6 to a velocity lower than the boom target velocity Vc_bm or raises the boom 6, and reduces the velocity of the arm 7 to a velocity lower than the arm target velocity Vc_am.
The design plane 41 is set in step S1. The boom target velocity Vc_bm, the arm target velocity Vc_am, and the bucket target velocity Vc_bkt are respectively determined from the boom operation amount, the arm operation amount, and the bucket operation amount in step S2. The boom target velocity Vc_bm, the arm target velocity Vc_am, and the bucket target velocity Vc_bkt are each converted to vertical velocity components in step S3.
The distance d between the blade tip P4 of the bucket 8 and the design plane 41 is obtained in step S4. The limit velocity Vcy_lmt of the entire work implement 2 is calculated on the basis of the distance d in step S5. The limit vertical velocity component Vcy_bm_lmt of the boom 6 is calculated from the limit velocity Vcy_lmt of the entire work implement 2, the arm target velocity Vc_am, and the bucket target velocity Vc_bkt in step S6. The limit vertical velocity component Vcy_bm_lmt of the boom 6 is converted to the limit velocity Vc_bm_lmt of the boom 6 in step S7.
Whether or not the limit velocity Vc_bm_lmt of the boom 6 is larger than the boom target velocity Vc_bm is determined in step S8. If the determination in step S8 is Yes and the limit velocity Vc_bm_lmt of the boom 6 is larger than the boom target velocity Vc_bm, the routine advances to step S9. The limit velocity Vc_bm_lmt of the boom 6 is selected as the boom command velocity in step S9.
Whether or not the distance d is smaller than the second predetermined value dth2 is determined in step S10. The second predetermined value dth2 is smaller than the abovementioned first predetermined value dth1. If the distance d is smaller than the second predetermined value dth2, the routine advances to step S11. Whether or not the current deviation amount dn is larger than the previous deviation amount dn-1 is determined in step S11. If the current deviation amount dn is larger than the previous deviation amount dn-1, the routine advances to step S12.
The limit velocity Vc_am_lmt of the arm 7 is selected as the arm command velocity in step S12. If the distance d is determined to be equal to or greater than the second predetermined value dth2 in step S10, the routine advances to step S13. If the current deviation amount dn is equal to or less than the previous deviation amount dn-1 in step S11, the routine advances to step S13. The arm target velocity Vc_am is selected as the arm command velocity in step S13.
Command signals corresponding to the boom command velocity, the arm command velocity, and the bucket command velocity are output to the control valve 27 in step S14. In this case, the boom command velocity is the limit velocity Vc_bm_lmt of the boom 6. The bucket command velocity is the bucket target velocity Vc_bkt. If at least one of the determinations performed in step S10 and step S11 is No, the arm command velocity is the arm target velocity Vc_am. Conversely, if both of the determinations performed in step S10 and step S11 are Yes, the arm command velocity is the limit velocity Vc_am_lmt of the arm 7.
Therefore, when the first limit condition is satisfied, while the boom 6 is limited to the limit velocity Vc_bm_lmt of the boom 6, the arm 7 is not limited and moves in accordance with the arm operation amount. Conversely, when the second limit condition is satisfied, the boom 6 is limited to the limit velocity Vc_bm_lmt of the boom 6, and the arm 7 is limited to the limit velocity Vc_am_lmt of the arm 7.
If the determination in step 8 is No, that is if the limit velocity Vc_bm_lmt of the boom 6 is equal to or less than the boom target velocity Vc_bm, the routine advances to step S15. The boom target velocity Vc_bm is selected as the boom command velocity in step S15. Command signals corresponding to the boom command velocity, the arm command velocity, and the bucket command velocity are output to the control valve 27 in step S16. In this case, the boom command velocity is the boom target velocity Vc_bm. The bucket command velocity is the bucket target velocity Vc_bkt. The arm command velocity is the arm target velocity Vc_am. Therefore, when both the first limit condition and the second limit condition are not satisfied, neither the boom 6 nor the arm 7 are limited and both are respectively operated in accordance with the boom operation amount and the arm operation amount.
Features of the control system 300 according to the present embodiment are described below. When the first limit condition is satisfied, the boom 6 is controlled to match the limit velocity Vc_bm_lmt and the arm 7 is controlled to match the arm target velocity Vc_am. Therefore, only the boom 6 is limited and the arm 7 is not limited when the blade tip P4 of the bucket 8 is above the design plane 41. As a result, the bucket 8 can be prevented from entering the design plane 41 while reducing the discomfort felt by the operator.
When the second limit condition is satisfied, the boom 6 is controlled to match the limit velocity Vc_bm_lmt and the arm 7 is controlled to match the arm limit velocity Vc_am_lmt. Therefore, both the boom 6 and the arm 7 are limited when the blade tip P4 of the bucket 8 enters the design plane 41. As a result, an increase of the entry into the design plane 41 can be quickly suppressed.
The second limit condition includes the condition that a current deviation amount dn is larger than a previous deviation amount dn-1. In this case, both the limitation of the boom 6 and the limitation of the arm 7 can be performed when the entry into the design plane 41 by the bucket 8 is about to increase. In other words, only the limitation of the boom 6 is performed and the limitation of the arm 7 is not performed when the entry into the design plane 41 is not about to increase even if the blade tip P4 of the bucket 8 is below the design plane 41. As a result, a sense of discomfort for the operator can be suppressed.
The arm deceleration coefficient is determined on the basis of the current deviation amount dn and the displacement amount Δd between the previous position and the current position of the blade tip P4 of the bucket 8. Consequently, the velocity of the arm 7 can be greatly reduced when the entry into the design plane 41 by the bucket 8 is about to increase.
Although an embodiment of the present invention has been described so far, the present invention is not limited to the above embodiments and various modifications may be made within the scope of the invention.
While a hydraulic excavator is used as an example of a construction machine in the above embodiment, the construction machine is not limited to a hydraulic excavator and other types of construction machines may be applicable to the present invention.
Obtaining the position of the blade tip P4 is not limited to GNSS and another positioning means may be used. Therefore, obtaining the distance d between the blade tip P4 and the design plane 41 is not limited to GNSS and another positioning means may be used.
The boom operation amount, the arm operation amount, and the bucket operation amount are not limited to electrical signals indicating a position of the operating member and may be obtained from a pilot pressure output in accordance with operation of the operating device 25.
The second limit condition may only be the condition that the distance d is smaller than the second predetermined value dth2. Alternatively, the second limit condition may also include other conditions. While the second limit condition includes the condition that the absolute value of the arm limit velocity Vc_am_lmt is smaller than the absolute value of the arm target velocity Vc_am in the above embodiments, the same condition may be included in the first limit condition. Alternatively, the determination of the second limit condition may not be performed and only the determination of the first limit condition may be performed. The first limit condition may also include other conditions. For example, the first limit condition may also include the condition that the operation amount is 0. Alternatively, the first limit condition may not include the condition that the distance d is smaller than the first predetermined value dth1. For example, the first limit condition may only be the condition that the limit velocity of the boom 6 is larger than the boom target velocity.
The second predetermined value dth2 may be larger than 0 as long as the second predetermined value dth2 is smaller than the first predetermined value dth1. In this case, both the limitation of the boom 6 and the limitation of the arm 7 are performed before the blade tip P4 of the bucket 8 reaches the design plane 41. As a result, both the limitation of the boom 6 and the limitation of the arm 7 can be performed when the blade tip P4 of the bucket 8 is about to cross the design plane 41 even before the blade tip P4 of the bucket 8 reaches the design plane 41.
The arm deceleration coefficient is not limited to the abovementioned method and may be determined by another method. For example, the arm deceleration coefficient may be determined in accordance with the distance d between the blade tip P4 and the design plane 41. Alternatively, the arm deceleration coefficient may be a fixed value.
A limitation of the bucket 8 may be performed instead of the abovementioned limitation of the arm 7. As illustrated in
According to the present invention, the bucket is prevented from entering the design plane while reducing the discomfort felt by the operator in the construction machine.
This application is a U.S. National stage application of International Application No. PCT/JP2013/061094, filed on Apr. 12, 2013.
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2013/061094 | 4/12/2013 | WO | 00 |