This application claims priority to Japanese Patent Application No. 2011-066826, filed on Mar. 24, 2011, the disclosure of which is hereby incorporated herein by reference in its entirety.
1. Field of Invention
The present invention relates to an excavation control system configured to impose a limitation on the speed of a working unit.
2. Background Information
For a construction machine equipped with a working unit, a method has been conventionally known that a predetermined region is excavated by moving a bucket along a designed surface indicating a target shape for an excavation object (see PCT International Publication No. WO95/30059).
Specifically, a control device in PCT International Publication No. WO95/30059 is configured to correct an operation signal to be inputted by an operator so that the relative speed of the working unit relative to the designed surface is reduced as an interval is reduced between the cutting edge of the bucket and the designed surface. Thus, an excavation control of automatically moving the cutting edge along the designed surface is executed regardless of an operation by an operator.
However, the excavation control described in PCT International Publication No. WO95/30059 has chances that the surface of an excavation object is excessively excavated by the rear surface of the bucket in scooping. Further, the excavation control described in PCT International Publication No. WO95/30059 has chances that the rear surface of the bucket cannot be controlled on the designed surface in ground level finishing.
The present invention has been produced in view of the aforementioned situation, and is intended to provide an excavation control system capable of appropriately executing an excavation control.
An excavation control system according to a first aspect includes a working unit, a plurality of hydraulic cylinders, a prospective speed obtaining part, a relative speed obtaining part, a speed limit selecting part and a hydraulic cylinder controlling part. The working unit is formed by a plurality of driven members including a bucket, and is rotatably supported by a vehicle main body. The plural hydraulic cylinders are configured to drive the plurality of driven members. The prospective speed obtaining part is configured to obtain a first prospective speed and a second prospective speed, the first prospective speed depends on a first interval between a first monitoring point of the bucket and a designed surface, the second prospective speed depends on a second interval between a second monitoring point of the bucket and the designed surface, the second monitoring point set be differently from the first monitoring point, and the designed surface indicates a target shape of an excavation object The relative speed obtaining part is configured to obtain a first relative speed of the first monitoring point relative to the designed surface and a second relative speed of the second monitoring point relative to the designed surface. The speed limit selecting part is configured to select either of the first prospective speed and the second prospective speed as a speed limit based on a relative relation between the first relative speed and the first prospective speed and a relative relation between the second relative speed and the second prospective speed. The hydraulic cylinder controlling part is configured to limit a relative speed of either one of the first and second monitoring points which is a target of the speed limit to the speed limit by supplying an operating oil to the plurality of hydraulic cylinders, and the relative speed is relevant to the designed surface.
An excavation control system according to a second aspect related to the excavation control system according to the first aspect, and further includes a regulated speed obtaining part. The regulated speed obtaining part is configured to obtain a first regulated speed and a second regulated speed, the first regulated speed indicates a target speed for an extension/contraction speed of each of the plurality of hydraulic cylinders which is required to limit the first relative speed to the first prospective speed, and the second regulated speed indicates a target speed for an extension/contraction speed of each of the plurality of hydraulic cylinders which is required to limit the second relative speed to the second prospective speed. The speed limit selecting part is configured to select the first prospective speed as the speed limit when the first regulated speed is greater than the second regulated speed, and select the second prospective speed as the speed limit when the second regulated speed is greater than the first regulated speed.
It is possible to provide an excavation control system capable of smoothly executing an excavation control.
Explanation will be hereinafter made for an exemplary embodiment of the present invention with reference to the drawings. In the following explanation, a hydraulic excavator will be explained as an example of “construction machine”.
The vehicle main body 1 includes an upper revolving unit 3, a cab 4 and a drive unit 5. The upper revolving unit 3 accommodates an engine, a hydraulic pump and so forth (not illustrated in the figures). A first GNSS antenna 21 and a second GNSS antenna 22 are disposed on the rear end part of the upper revolving unit 3. The first GNSS antenna 21 and the second GNSS antenna 22 are antennas for RTK-GNSS (Real Time Kinematic—GNSS, note GNSS refers to Global Navigation Satellite Systems). The cab 4 is mounted on the front part of the upper revolving unit 3. An operating device 25 to be described is disposed within the cab 4 (see
The working unit 2 is attached to the front part of the vehicle main body 1, and includes a boom 6, an arm 7, a bucket 8, a boom cylinder 10, an arm cylinder 11 and a bucket cylinder 12. The base end of the boom 6 is pivotally attached to the front part of the vehicle main body 1 through a boom pin 13. The base end of the arm 7 is pivotally attached to the tip end of the boom 6 through an arm pin 14. The bucket 8 is pivotally attached to the tip end of the arm 7 through a bucket pin 15.
The boom cylinder 10, the arm cylinder 11 and the bucket cylinder 12 are respectively hydraulic cylinders to be driven by means of an operating oil. The boom cylinder 10 is configured to drive the boom 6. The arm cylinder 11 is configured to drive the arm 7. The bucket cylinder 12 is configured to drive the bucket 8.
Now,
Further, as illustrated in
The vehicle main body 1 is equipped with a position detecting unit 19. The position detecting unit 19 is configured to detect the present position of the hydraulic excavator 100. The position detecting unit 19 includes the aforementioned first and second GNSS antennas 21 and 22, a three-dimensional position sensor 23 and a slant angle sensor 24. The first and second GNSS antennas 21 and 22 are disposed while being separated at a predetermined distance in the vehicle width direction. Signals in accordance with GNSS radio waves received by the first and second GNSS antennas 21 and 22 are configured to be inputted into the three-dimensional position sensor 23. The three-dimensional position sensor 23 is configured to detect the installation positions of the first and second GNSS antennas 21 and 22. As illustrated in
The operating device 25 is configured to receive an operation by an operator to drive the working unit 2 and is configured to output an operation signal in accordance with the operation of the operator. Specifically, the operating device 25 includes a boom operating tool 31, an arm operating tool 32 and a bucket operating tool 33. The boom operating tool 31 includes a boom operating lever 31a and a boom operation detecting part 31b. The boom operating lever 31a receives an operation of the boom 6 by the operator. The boom operation detecting part 31a is configured to output a boom operation signal M1 in response to an operation of the boom operating lever 31a. An arm operating lever 32a receives an operation of the arm 7 by the operator. An arm operation detecting part 32b is configured to output an arm operation signal M2 in response to an operation of the arm operating lever 32a. The bucket operating tool 33 includes a bucket operating lever 33a and a bucket operation detecting part 33b. The bucket operating lever 33a receives an operation of the bucket 8 by the operator. The bucket operation detecting part 33b is configured to output a bucket operation signal M3 in response to an operation of the bucket operating lever 33a.
The working unit controller 26 is configured to obtain the boom operation signal M1, the arm operation signal M2 and the bucket operation signal M3 from the operating device 25. The working unit controller 26 is configured to obtain the boom cylinder length N1, the arm cylinder length N2 and the bucket cylinder length N3 from the first to third stroke sensors 16 to 18, respectively. The working unit controller 26 is configured to output control signals based on the aforementioned various pieces of information to the proportional control valve 27. Accordingly, the working unit controller 26 is configured to execute an excavation control of automatically moving the bucket 8 along designed surfaces 45 (see
The proportional control valve 27 is disposed among the boom cylinder 10, the arm cylinder 11, the bucket cylinder 12 and a hydraulic pump (not illustrated in the figures). The proportional control valve 27 is configured to supply the operating oil at a flow rate set in accordance with the control signal from the working unit controller 26 to each of the boom cylinder 10, the arm cylinder 11 and the bucket cylinder 12.
The display controller 28 includes a storage part 28a (e.g., a RAM, a ROM, etc.) and a computation part 28b (e.g., a CPU, etc.). The storage part 28a stores a set of working unit data that contains the aforementioned lengths, i.e., the length L1 of the boom 6, the length L2 of the arm 7 and the lengths L3a and L3b of the bucket 8. The set of working unit data contains the minimum value and the maximum value for each of the slant angle θ1 of the boom 6, the slant angle θ2 of the arm 7, the slant angle θ3a of the cutting edge 8a and the slant angle θ3b of the rear surface end 8b. The display controller 28 can be communicated with the working unit controller 26 by means of wireless or wired communication means. The storage part 28a of the display controller 28 has preliminarily stored a set of designed landform data indicating the shape and the position of a three-dimensional designed landform within a work area. The display controller 28 is configured to cause the display unit 29 to display the designed landform based on the designed landform, detection results from the aforementioned various sensors, and so forth.
Now,
The target designed surface 45A is a slope positioned laterally to the hydraulic excavator 100. An operator executes excavation along the target designed surface 45A by downwardly moving the bucket 8 from above the target designed surface 45A.
The speed limitation intervening line C defines a region in which speed limitation to be described is executed. As described below, when the bucket 8 enters inside from the speed limitation intervening line C, the excavation control system 200 is configured to execute speed limitation. The speed limitation intervening line C is set to be in a position away from the target designed surface 45A at a line distance h. The line distance h is preferably set to be a distance whereby operational feeding of an operator with respect to the working unit 2 is not deteriorated.
As represented in
As illustrated in
The prospective speed obtaining part 262 is configured to obtain: a first prospective speed P1 set in accordance with the first distance d1; and a second prospective speed P2 set in accordance with the second distance d2. The first prospective speed P1 is herein a speed set in accordance with the first distance d1 in a uniform manner. As represented in
The relative speed obtaining part 263 is configured to calculate a speed Q of the cutting edge 8a and a speed Q′ of the rear surface end 8b based on the boom operation signal M1, the arm operation signal M2 and the bucket operation signal M3, which are obtained from the operating device 25. Further, as illustrated in
The regulated speed obtaining part 264 is configured to obtain the first prospective speed P1 from the prospective speed obtaining part 262, while being configured to obtain the first relative speed Q1 from the relative speed obtaining part 263. The regulated speed obtaining part 264 is configured to obtain a first regulated speed S1 for the extension/contraction speed of the boom cylinder 10, which is required to limit the first relative speed Q1 to the first prospective speed P1.
Now,
Further, the regulated speed obtaining part 264 is configured to obtain the second prospective speed P2 from the prospective speed obtaining part 262, while being configured to obtain the second relative speed Q2 from the relative speed obtaining part 263. The regulated speed obtaining part 264 is configured to obtain a second regulated speed S2 for the extension/contraction speed of the boom cylinder 10, which is required to limit the second relative speed Q2 to the second prospective speed P2.
Now,
In the present exemplary embodiment, the second regulated speed S2 is set to be greater than the first regulated speed S1 as illustrated in
The speed limit selecting part 265 is configured to obtain the first prospective speed P1 and the second prospective speed P2 from the prospective speed obtaining part 262, while being configured to obtain the first regulated speed S1 and the second regulated speed S2 from the regulated speed obtaining part 264. The speed limit selecting part 265 is configured to select either the first prospective speed P1 or the second prospective speed P2 as a speed limit U based on the first regulated speed S1 and the second regulated speed S2. Specifically, the speed limit selecting part 265 is configured to select the first prospective speed P1 as the speed limit U when the first regulated speed S1 is greater than the second regulated speed S2. By contrast, the speed limit selecting part 265 is configured to select the second prospective speed P2 as the speed limit U when the second regulated speed S2 is greater than the first regulated speed S1. In the present exemplary embodiment, the second regulated speed S2 is greater than the first regulated speed S1. Therefore, the speed limit selecting part 265 selects the second prospective speed P2 as the speed limit U.
The hydraulic cylinder controlling part 266 is configured to limit, to the speed limit U (i.e., the second prospective speed P2), the second relative speed Q2 of the rear surface end 8b relevant to the second prospective speed P2 selected as the speed limit U relative to the target designed surface 45A. In the present exemplary embodiment, the hydraulic cylinder controlling part 266 is configured to correct the boom operation signal M1 and is configured to output the corrected boom operation signal M1 to the proportional control valve 27 in order to suppress the second relative speed Q2 to the second prospective speed P2 only by means of deceleration in rotational speed of the boom 6. On the other hand, the working unit controller 26 is configured to output the arm operation signal M2 and the bucket operation signal M3 to the proportional control valve 27 without correcting the signals M2 and M3.
Accordingly, the flow rates of the operating oil to be supplied to the boom cylinder 10, the arm cylinder 11 and the bucket cylinder 12 through the proportional control valve 27 are controlled, and the second relative speed Q2 of the rear surface end 8b is limited to the second prospective speed P2.
In Step S10, the excavation control system 200 obtains the set of designed landform data and the set of present positional data of the hydraulic excavator 100.
In Step S20, the excavation control system 200 obtains the boom cylinder length N1, the arm cylinder length N2 and the bucket cylinder length N3.
In Step S30, the excavation control system 200 calculates the first distance d1 and the second distance d2 based on the set of designed landform data, the set of present positional data, the boom cylinder length N1, the arm cylinder length N2 and the bucket cylinder length N3 (see
In Step S40, the excavation control system 200 obtains: the first prospective speed P1 depending on the first distance d1; and the second prospective speed P2 depending on the second distance d2 (see
In Step S50, the excavation control system 200 calculates the speed Q of the cutting edge 8a and the speed Q′ of the rear surface end 8b based on the boom operation signal M1, the aim operation signal M2 and the bucket operation signal M3 (see
In Step S60, the excavation control system 200 obtains the first relative speed Q1 and the second relative speed Q2 based on the speed Q and the speed Q′ (see
In Step S70, the excavation control system 200 obtains the first regulated speed S1 for the extension/contraction speed of the boom cylinder 10, which is required for limiting the first relative speed Q1 to the first prospective speed P1 (see
In Step S80, the excavation control system 200 obtains the second regulated speed S2 for the extension/contraction speed of the boom cylinder 10, which is required for limiting the second relative speed Q2 to the second prospective speed P2 (see
In Step S90, the excavation control system 200 selects either the first prospective speed P1 or the second prospective speed P2 as the speed limit U based on the first regulated speed S1 and the second regulated speed S2. The excavation control system 200 selects, as the speed limit U, the prospective speed P relevant to the greater one of the first regulated speed S1 and the second regulated speed S2. In the present exemplary embodiment, the second regulated speed S2 is greater than the first regulated speed S1. Therefore, the second prospective speed P2 is selected as the speed limit U.
In Step S100, the excavation control system 200 limits, to the speed limit U (i.e., the second prospective speed P2), the second relative speed Q2 of the rear end surface 8b relevant to the second prospective speed P2 selected as the speed limit U.
(1) The excavation control system 200 according to the present exemplary embodiment is configured to obtain: the first regulated speed S1 for the extension/contraction speed of the boom cylinder 10, which is required to limit the first relative speed Q1 to the first prospective speed P1; and the second regulated speed S2 for the extension/contraction speed of the boom cylinder 10, which is required to limit the second relative speed Q2 to the second prospective speed P2. The excavation control system 200 is configured to select, as the speed limit U, the prospective speed P relevant to the grater one of the first regulated speed S1 and the second regulated speed S2.
Thus, speed limitation is executed based on the regulated speed S for the extension/contraction speed of the boom cylinder 10, regardless of the first interval d1 and the second interval d2. Therefore, speed limitation can be executed based on either one of the cutting edge 8a and the rear surface end 8b, which is relevant to the greater regulated speed S for the extension/contraction speed of the boom cylinder 10.
Here, chances are that regulation for the extension/contraction speed of the boom cylinder 10 is delayed if speed limitation is executed based on the cutting edge 8a relevant to the lesser regulated speed S, and thereafter, speed limitation is executed based on the rear surface end 8b relevant to the greater regulated speed S when the rear surface end 8b approaches the target designed surface 45A. In this case, excavation cannot be executed according to the designed surface when the rear surface end 8b goes beyond the designed surface 45A. Further, shocks inevitably occur due to abrupt driving when regulation of the boom cylinder 10 is forcibly attempted. Therefore, an appropriate excavation control cannot be executed.
By contrast, according to the excavation control system 200 of the present exemplary embodiment, speed limitation is executed based on the rear surface end 8b relevant to the greater regulated speed S as described above. Therefore, the boom cylinder 10 can afford to be regulated. It is thereby possible to inhibit the rear surface end 8b from going beyond the designed surface 45A and inhibit occurrence of shocks due to abrupt driving. Accordingly, an appropriate excavation control can be executed.
(2) The excavation control system 200 according to the present exemplary embodiment is configured to execute speed limitation by regulating the extension/contraction speed of the boom cylinder 10.
Therefore, speed limitation is executed by correcting only the boom operation signal M1 among the operation signals in response to operations by an operator. In other words, among the boom 6, the arm 7 and the bucket 8, only the boom 6 is not driven as operated by an operator. Therefore, it is herein possible to inhibit deterioration of operational feeling of an operator in comparison with the configuration of regulating the extension/contraction speeds of two or more driven members among the boom 6, the arm 7 and the bucket 8.
An exemplary embodiment of the present invention has been explained above. However, the present invention is not limited to the aforementioned exemplary embodiment, and a variety of changes can be made without departing from the scope of the present invention.
(A) In the aforementioned exemplary embodiment, the excavation control system 200 is configured to set the cutting edge 8a and the rear surface end 8b, among portions of the bucket 8, as monitoring points. However, the present invention is not limited to this. The excavation control system 200 may be configured to set two or more monitoring points on the outer periphery of the bucket 8.
(B) In the aforementioned exemplary embodiment, the excavation control system 200 is configured to suppress the relative speed to the speed limit only by deceleration of the rotational speed of the boom 6. However, the present invention is not limited to this. The excavation control system 200 may be configured to regulate the rotational speed of at least one of the arm 7 and the bucket 8 in addition to the rotational speed of the boom 6. It is thereby possible to inhibit the speed of the bucket 8 from being reduced in a direction parallel to the designed surface 45 by means of speed limitation. Accordingly, it is possible to inhibit deterioration of operational feeling of an operator. It should be noted that in this case, addition (sum) of the respective regulated speeds of the boom 6, the arm 7 and the bucket 8 may be calculated as the regulated speed S.
(C) In the aforementioned exemplary embodiment, the excavation control system 200 is configured to calculate the speed Q of the cutting edge 8a and the speed Q′ of the rear surface end 8b based on the operation signals M to be obtained from the operating device 25. However, the present invention is not limited to this. The excavation control system 200 can directly calculate the speed Q and the speed Q′ based on variation per unit time for each of the cylinder lengths N1 to N3 to be obtained from the first to third stroke sensors 16 to 18. In this case, the speed Q and the speed Q′ can be more accurately calculated compared to a configuration of calculating the speed Q and the speed Q′ based on the operation signals M.
(D) In the aforementioned exemplary embodiment, as represented in
According to the illustrated embodiments, it is possible to provide a working unit control system capable of appropriately executing an excavation control. Therefore, the excavation control system according to the illustrated embodiments is useful for the field of construction machines.
Number | Date | Country | Kind |
---|---|---|---|
2011-066826 | Mar 2011 | JP | national |
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/JP2012/052687 | 2/7/2012 | WO | 00 | 8/1/2013 |
Publishing Document | Publishing Date | Country | Kind |
---|---|---|---|
WO2012/127914 | 9/27/2012 | WO | A |
Number | Name | Date | Kind |
---|---|---|---|
5174114 | Aoyagi | Dec 1992 | A |
5701691 | Watanabe et al. | Dec 1997 | A |
5735065 | Yamagata et al. | Apr 1998 | A |
5835874 | Hirata et al. | Nov 1998 | A |
5911506 | Nakamura et al. | Jun 1999 | A |
5957989 | Egawa et al. | Sep 1999 | A |
5960378 | Watanabe et al. | Sep 1999 | A |
6275757 | Watanabe et al. | Aug 2001 | B1 |
6336067 | Watanabe et al. | Jan 2002 | B1 |
7370475 | Nakamura et al. | May 2008 | B2 |
8214110 | Morinaga et al. | Jul 2012 | B2 |
8534264 | Kawaguchi et al. | Sep 2013 | B2 |
20120285157 | Okano et al. | Nov 2012 | A1 |
Number | Date | Country |
---|---|---|
9530059 | Nov 1995 | JP |
8-134949 | May 1996 | JP |
2009-179968 | Aug 2009 | JP |
4493990 | Jun 2010 | JP |
5156312 | Mar 2013 | JP |
1391104 | Apr 2014 | KR |
WO 2005052372 | Jun 2005 | WO |
WO 2009038016 | Mar 2009 | WO |
Entry |
---|
Chondrobot-2: A simple and efficient semi-autonomous tele-robotic lunar excavator ; Rhaman, M.K. ; Hossain, M.J. ; Anik, K.M.R. ; Oyon, M.H. ; Nabia, S.B.N. ; Rahi, N.S. ; Khan, B.A. ; Miran, M.M.R. ; Bhuian, B.H. ; Rahman, M.M;Computer and Information Technology (ICCIT), 2012 15th International Conference on; DOI: 10.1109/ICCITechn.2012.6509787. |
An experimental study on Cartesian tracking control of automated excavator system using TDC-based robust control design Soo-Jin Lee ; Pyung Hun Chang ; Young-Min Kwon; American Control Conference, 1999. Proceedings of the 1999 vol. 5; DOI: 10.1109/ACC.1999.782351; Publication Year: 1999 , pp. 3180-3185 vol. 5. |
Soil cutting experiments and evaluation of an earth auger for a planetary subsurface explorer; Omori, H. ; Kitamoto, H. ; Mizushina, A. ; Nakamura, T. ; Osumi, H. ; Kubota, T.; Recent Advances in Space Technologies (RAST), 2013 6th International Conference on DOI: 10.1109/RAST.2013.6581350; Publication Year: 2013 , pp. 941-947. |
Hybrid model in a real-time soil parameter identification scheme for autonomous excavation; Choopar Tan ; Zweiri, Y.H. ; Althoefer, K. ; Seneviratne, L.D.; Robotics and Automation, 2004. Proceedings. ICRA '04. 2004 IEEE International Conference on; vol. 5 DOI: 10.1109/ROBOT.2004.1302554; Publication Year: 2004 , pp. 5268-5273. |
International Search Report for PCT/JP2012/052687, issued on May 15, 2012. |
Number | Date | Country | |
---|---|---|---|
20130315699 A1 | Nov 2013 | US |