EP0900887A1 - Organe de commande d'engin de construction - Google Patents
Organe de commande d'engin de construction Download PDFInfo
- Publication number
- EP0900887A1 EP0900887A1 EP97913472A EP97913472A EP0900887A1 EP 0900887 A1 EP0900887 A1 EP 0900887A1 EP 97913472 A EP97913472 A EP 97913472A EP 97913472 A EP97913472 A EP 97913472A EP 0900887 A1 EP0900887 A1 EP 0900887A1
- Authority
- EP
- European Patent Office
- Prior art keywords
- bucket
- angle
- boom
- stick
- construction machine
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Withdrawn
Links
Images
Classifications
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/36—Component parts
- E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
- E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
- E02F3/435—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
- E02F3/437—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like providing automatic sequences of movements, e.g. linear excavation, keeping dipper angle constant
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/22—Hydraulic or pneumatic drives
- E02F9/2278—Hydraulic circuits
- E02F9/2285—Pilot-operated systems
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/22—Hydraulic or pneumatic drives
- E02F9/2278—Hydraulic circuits
- E02F9/2292—Systems with two or more pumps
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/22—Hydraulic or pneumatic drives
- E02F9/2278—Hydraulic circuits
- E02F9/2296—Systems with a variable displacement pump
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/26—Indicating devices
Definitions
- This invention relates to a construction machine such as a hydraulic excavator for excavating the ground, and more particularly to a control apparatus for a construction machine of the type mentioned.
- a construction machine such as a hydraulic excavator has a construction wherein it includes, for example, as schematically shown in FIG. 12, an upper revolving unit 100 with an operator cab (cabin) 600 and provided on a lower traveling body 500 having caterpillar members 500A, and further, a joint type arm mechanism composed of a boom 200, a stick 300 and a bucket 400 is provided on the upper revolving unit 100.
- the boom 200, stick 300 and bucket 400 can be driven suitably by hydraulic cylinders 120, 121 and 122, respectively, to perform an excavating operation while keeping the advancing direction of the bucket or the posture of the bucket 400 fixed so that control of the position and the posture of a working member such as the bucket 400 can be performed accurately and stably.
- the present invention has been made in view of such a subject as described above, and it is an object of the present invention to provide a control apparatus for a construction machine by which the position and the posture of a working member can be controlled accurately and stably while suppressing the cost low.
- a control apparatus for a construction machine of the present invention comprises a construction machine body, a joint type arm mechanism mounted at one end portion thereof for pivotal motion on the construction machine body and having a working member at the other end side thereof, the joint type arm mechanism including at least one pair of arm members connected to each other with a joint part interposed therebetween, a cylinder type actuator mechanism having a plurality of cylinder type actuators for performing expansion/contraction operations to drive the arm mechanism, angle detection means for detecting a posture of the arm mechanism in angle information, conversion means for converting the angle information obtained by the angle detection means into corresponding expansion/contraction displacement information of the cylinder type actuators, and controlling means for controlling the cylinder type actuators based on the expansion/contraction information of the cylinder type actuator obtained by the conversion of the conversion means so that the cylinder type actuators may perform predetermined expansion/contraction displacements.
- the joint type arm mechanism may include a boom connected at one end thereof for pivotal motion to the construction machine body, and a stick connected at one end thereof for pivotal motion to the boom with the joint part interposed therebetween, and the working member may be formed as a bucket which is connected at one end thereof for pivotal motion to the stick with a joint part interposed therebetween and can excavate the ground at a tip end thereof and accommodate earth and sand therein.
- the cylinder type actuator mechanism may include a boom hydraulic cylinder interposed between the construction machine body and the boom for pivoting the boom with respect to the construction machine body by expanding or contracting a distance between end portions thereof, a stick hydraulic cylinder interposed between the boom and the stick for pivoting the stick with respect to the boom by expanding or contracting a distance between end portions thereof, and a bucket hydraulic cylinder interposed between the stick and the bucket for pivoting the bucket with respect to the stick by expanding or contracting a distance between end portions thereof.
- the angle detection means may include a first angle sensor for detecting a posture of the boom, a second angle sensor for detecting a posture of the stick, and a third angle sensor for detecting a posture of the bucket.
- the conversion means may include arithmetic means for determining, from the angle information obtained by the angle detection means, expansion/contraction displacement information of the cylinder type actuators corresponding to the angle information by calculation, or may include storage means for storing the expansion/contraction information of the cylinder type actuators corresponding to the angle information obtained by the angle detection means.
- the conversion means may be constructed so as to convert the angle information obtained by the first angle sensor into expansion/contraction displacement information of the boom hydraulic cylinder, convert the angle information obtained by the second angle sensor into expansion/contraction displacement information of the stick hydraulic cylinder, and convert the angle information obtained by the third angle sensor into expansion/contraction displacement information of the bucket hydraulic cylinder.
- angle information detected by the angle detection means described above is converted into expansion/contraction displacement information of the cylinder type actuators which drive the arm mechanism by the conversion means and is inputted to the controlling means, even if an expensive stroke sensor for detecting an expansion/contraction displacement of each actuator as in the prior art is not used, control which employs the expansion/contraction displacements of actuators which are used in a conventional control system can be executed. Accordingly, a system which can control the position and the posture of the working member accurately and stably can be provided while suppressing the cost low.
- a hydraulic excavator as a construction machine includes, for example, as schematically shown in FIG. 1, an upper revolving unit (construction machine body) 100 with an operator cab 600 for revolving movement in a horizontal plane on a lower traveling unit 500 which has caterpillar members 500A on the left and right thereof.
- a boom (arm member) 200 having one end connected for swinging motion is provided on the upper revolving unit 100, and a stick (arm member) 300 connected at one end thereof for swinging motion by a joint part is provided on the boom 200.
- a bucket (working member) 400 which is connected at one end thereof for swinging motion by a joint part and can excavate the ground with a tip thereof and accommodate earth and sand therein is provided on the stick 300.
- a joint type arm mechanism which is mounted at one end portion thereof for pivotal motion on the upper revolving unit 100 and has the bucket 400 on the other end side thereof and further has at least the boom 200 and the stick 300 as a pair of arm members connected to each other by the joint part is composed of the boom 200, stick 300 and bucket 400.
- a boom hydraulic cylinder 120, a stick hydraulic cylinder 121 and a bucket hydraulic cylinder 122 (in the following description, the boom hydraulic cylinder 120 may be referred to as boom cylinder 120 or merely as cylinder 120, the stick hydraulic cylinder 121 may be referred to as stick cylinder 121 or merely as cylinder 121, and the bucket hydraulic cylinder 122 may be referred to as bucket cylinder 122 or merely as cylinder 122) as cylinder type actuators are provided.
- the boom hydraulic cylinder 120 is connected at one end thereof for swinging motion to the upper revolving unit 100 and is connected at the other one end thereof for swinging motion to the boom 200, or in other words, the boom hydraulic cylinder 120 is interposed between the upper revolving unit 100 and the boom 200, such that, as the distance between the opposite end portions is expanded or contracted, the boom 200 can be swung with respect to the upper revolving unit 100.
- the stick hydraulic cylinder 121 is connected at one end thereof for swinging motion to the boom 200 and connected at the other one end thereof for swinging motion to the stick 300, or in other words, the stick hydraulic cylinder 121 is interposed between the boom 200 and the stick 300, such that, as the distance between the opposite end portions is expanded or contracted, the stick 300 can be swung with respect to the boom 200.
- the bucket cylinder 122 is connected at one end thereof for swinging motion to the stick 300 and connected at the other one end thereof for swinging motion to the bucket 400, or in other words, the bucket cylinder 122 is interposed between the stick 300 and the bucket 400, such that, as the distance between the opposite end portions thereof is expanded or contracted, the bucket 400 can be swung with respect to the stick 300. It is to be noted that a linkage 130 is provided at a free end portion of the bucket hydraulic cylinder 122.
- a cylinder type actuator mechanism having a plurality of cylinder type actuators for driving the arm mechanism by performing expanding or contracting operations is composed of the cylinders 120 to 122 described above.
- hydraulic motors for driving the left and right caterpillar members 500A and a revolving motor for driving the upper revolving unit 100 to revolve are provided.
- the hydraulic excavator described above includes a hydraulic circuit for the cylinders 120 to 122, the hydraulic motors and the revolving motor described above, and in addition to pumps 51 and 52 of the variable discharge type which are driven by an engine E such as a Diesel engine, a boom main control valve (control valve) 13, a stick main control valve (control valve) 14, a bucket main control valve (control valve) 15 and so forth are interposed in the hydraulic circuit.
- an engine E such as a Diesel engine
- a boom main control valve (control valve) 13 a stick main control valve (control valve) 14
- a bucket main control valve (control valve) 15 and so forth are interposed in the hydraulic circuit.
- the pumps 51 and 52 of the variable discharge type are each constructed such that the tilt angle thereof is controlled by an engine pump controller 27 which will be hereinafter described so that the discharge of working oil to the hydraulic circuit can be varied.
- an engine pump controller 27 which will be hereinafter described so that the discharge of working oil to the hydraulic circuit can be varied.
- each line which interconnects two components is a solid line in FIG. 2, this represents that this line is an electric system, but where each line which interconnects two components is a broken line, this represents that the line is a hydraulic system.
- a pilot hydraulic circuit is provided, and a pilot pump 50 driven by the engine E, solenoid proportional valves 3A, 3B and 3C, solenoid directional control valves 4A, 4B and 4C, selector valves 18A, 18B and 18C and so forth are interposed in the pilot hydraulic circuit.
- a controller (controlling means) 1 for controlling the main control valves 13, 14 and 15 via the solenoid proportional valves 3A, 3B and 3C to control the boom 200, the stick 300 and the bucket 400 in response to a mode in which they should be controlled so that they may have desired expansion/contraction displacements is provided.
- the controller 1 is composed of a microprocessor, memories such as a ROM and a RAM, suitable input/output interfaces and so forth.
- detection signals including setting signals
- the controller 1 executes the control described above based on the detection signals from the sensors. It is to be noted that such control by the controller 1 is called semiautomatic control, and even during excavation under the semiautomatic control (semiautomatic excavation mode), it is possible to manually effect fine adjustment of the bucket angle and the aimed slope face height.
- a semiautomatic control mode (semiautomatic excavation mode) as described above, a bucket angle control mode (refer to FIG. 7), a slope face excavation mode (bucket tip linear excavation mode or raking mode) (refer to FIG. 8), a smoothing mode which is a combination of the slope face excavation mode and the bucket angle control mode (refer to FIG. 9), a bucket angle automatic return mode (automatic return mode) (refer to FIG. 10) and so forth are available.
- the bucket angle control mode is a mode in which the angle (bucket angle) of the bucket 400 with respect to the horizontal direction (vertical direction) is always kept constant even if the stick 300 and the boom 200 are moved as shown in FIG. 7, and this mode is executed if a bucket angle control switch on a monitor panel 10 which will be hereinafter described is switched ON. It is to be noted that this mode is cancelled when the bucket 400 is moved manually, and a bucket angle at a point of time when the bucket 400 is stopped is stored as a new bucket holding angle.
- the slope face excavation mode is a mode in which a tip 112 (which may sometimes be referred to as bucket tip 112) of the bucket 400 moves linearly as shown in FIG. 8. However, the bucket cylinder 122 does not move. Further, the bucket angle ⁇ varies as the bucket 400 moves.
- the slope face excavation mode + bucket angle control mode is a mode in which the tip 112 of the bucket 400 moves linearly and also the bucket angle ⁇ is kept constant during excavation as shown in FIG. 9.
- the bucket automatic return mode is a mode in which the bucket angle is automatically returned to an angle set in advance as shown in FIG. 10, and the return bucket angle is set by the monitor panel 10. This mode is started when a bucket automatic return start switch 7 on a boom/bucket operation lever 6 is switched ON. This mode is cancelled at a point of time when the bucket 400 returns to the angle set in advance.
- the slope face excavation mode and the smoothing mode described above are entered when a semiautomatic control switch on the monitor panel 10 is switched ON and a slope face excavation switch 9 on a stick operation lever 8 is switched ON and besides both or either one of the stick operation lever 8 and the boom/bucket operation lever 6 is moved. It is to be noted that the aimed slope face angle is set by a switch operation on the monitor panel 10.
- the operation amount of the stick operation lever 8 provides a bucket tip moving velocity in a parallel direction to the aimed slope face angle
- the operation amount of the boom/bucket operation lever 6 provides a bucket tip moving velocity in the perpendicular direction. Accordingly, if the stick operation lever 8 is moved, then the tip 112 of the bucket 400 starts its linear movement along the aimed slope face angle, and fine adjustment of the aimed slope face height by a manual operation can be performed by moving the boom/bucket operation lever 6 during excavation.
- a service mode for performing service maintenance of the entire semiautomatic system is prepared, and this service mode is enabled by connecting an external terminal 2 to the controller 1. And, by this service mode, adjustment of control gains, initialization of various sensors and so forth are performed.
- the engine pump controller 27 receives engine velocity information from an engine rotational speed sensor 23 and controls the tilt angles of the engine E and the pumps 51 and 52 of the variable discharge type described above.
- the engine pump controller 27 can communicate coordination information with the controller 1.
- the pressure sensors 19 are attached to pilot pipes connected from the operation levers 6 and 8 for expansion/contraction of the stick 300 and for upward/downward movement of the boom 200 to the main control valves 13, 14 and 15 and detect pilot hydraulic pressures in the pilot pipes. Since the pilot hydraulic pressures in such pilot pipes are varied by the operation amounts of the operation levers 6 and 8, the operation amounts of the operation levers 6 and 8 can be estimated by measuring the hydraulic pressures.
- the pressure sensors 28A and 28B detect expansion/contraction conditions of the boom cylinder 120 and stick cylinder 121.
- the stick operation lever 8 is used to determine the bucket tip moving velocity in a parallel direction with respect to a set excavation slant face
- the boom/bucket operation lever 6 is used to determine the bucket tip moving velocity in the perpendicular direction with respect to the set slant face. Accordingly, when the stick operation lever 8 and the boom/bucket operation lever 6 are operated simultaneously, the moving direction and the moving velocity of the tip 112 of the bucket 400 are determined by a composite vector in the parallel and perpendicular direction with respect to the set slant face.
- the pressure switches 16 are attached to the pilot pipes for the operation levers 6 and 8 for the boom 200, stick 300 and bucket 400 with selectors 17 or the like interposed therebetween and are used to detect whether or not the operation levers 6 and 8 are in a neutral condition. In particular, when the operation lever 6 or 8 is in the neutral condition, the output of the pressure switch 16 is OFF, but when the operation lever 6 or 8 is used, the output of the pressure switch 16 is ON. It is to be noted that the pressure switches 16 for detection of a neutral condition are used also for detection of an abnormal condition of the pressure sensors 19 and for switching between the manual/semiautomatic modes.
- the resolver 20 is provided at a pivotally mounted portion (joint part) of the boom 200 on the construction machine body 100 at which the posture of the boom 200 can be monitored and functions as a first angle sensor for detecting the posture of the boom 200.
- the resolver 21 is provided at a pivotally mounted portion (joint part) of the stick 300 on the boom 200 at which the posture of the stick 300 can be monitored and functions as a second angle sensor for detecting the posture of the stick 300.
- the resolver 22 is provided at a linkage pivotally mounted portion at which the posture of the bucket 400 can be monitored and functions as a third angle sensor for detecting the posture of the bucket 400.
- a signal converter (conversion means) 26 converts angle information obtained by the resolver 20 into expansion/contraction displacement information of the boom cylinder 120, converts angle information obtained by the resolver 21 into expansion/contraction displacement information of the stick cylinder 121, and converts angle information obtained by the resolver 22 into expansion/contraction displacement information of the bucket cylinder 122, that is, converts angle information obtained by the resolvers 20 to 22 into corresponding expansion/contraction displacement information of the cylinders 120 to 122.
- the signal converter 26 includes an input interface 26A for receiving signals from the resolvers 20 to 22, a memory (storage means) 26B in which a lookup table 26B-1 for storing expansion/contraction displacement information of the cylinders 120 to 122 corresponding to angle information obtained by the resolvers 20 to 22 is held, a main arithmetic unit (CPU) 26C which can calculate the expansion/contraction displacement information of the cylinders 120 to 122 corresponding to angle information obtained by the resolvers 20 to 22 and communicate the cylinder expansion/contraction displacement information with the controller 1, and an output interface 26D for sending out the cylinder expansion/contraction displacement information from the main arithmetic unit (CPU) 26C.
- a memory storage means
- a lookup table 26B-1 for storing expansion/contraction displacement information of the cylinders 120 to 122 corresponding to angle information obtained by the resolvers 20 to 22 is held
- a main arithmetic unit (CPU) 26C which can calculate the expansion/contraction displacement information of the
- L i/j represents a fixed length
- Axbm represents a fixed angle
- the suffix i/j to L has information between the nodes i and j.
- L 101/102 represents the distance between the node 101 and the node 102. It is to be noted that the node 101 is determined as the origin of the xy coordinate system (refer to FIG. 6).
- the expressions above may be calculated by arithmetic means (for example, the CPU 26C).
- the CPU 26C forms the arithmetic means which calculates, from the angle information obtained by the resolvers 20 to 22, expansion/contraction displacement information of the cylinders 120 to 122 corresponding to the angle information by calculation.
- signals obtained by the conversion by the signal converter 26 are utilized not only for feedback control upon semiautomatic control but also to measure coordinates for measurement/indication of the position of the bucket tip 112.
- the position of the bucket tip 112 (the position may be hereinafter referred to as bucket tip position 112) in the semiautomatic system is calculated using a certain point of the upper revolving unit 100 of the hydraulic excavator as the origin.
- the upper revolving unit 100 is inclined in the front linkage direction, it is necessary to rotate the coordinate system for control calculation by an angle by which the vehicle is inclined.
- the vehicle inclination angle sensor 24 is used to correct the coordinate system for an amount of the rotation of the coordinate system.
- solenoid proportional valves 3A to 3C control the hydraulic pressures supplied from the pilot pump 50 in response to electric signals from the controller 1 and the controlled hydraulic pressures are passed through the control valves 4A to 4C or the selector valves 18A to 18C so as to act upon the main control valves 13, 14 and 15 to control the spool positions of the main control valves 13, 14 and 15 so that aimed cylinder velocities may be obtained, if the control valves 4A to 4C are set to the manual mode side, then the cylinders 120 to 122 can be controlled manually.
- a stick confluence control proportional valve 11 adjusts the confluence ratio of the two pumps 51 and 52 in order to obtain an oil amount corresponding to an aimed cylinder velocity.
- the ON-OFF switch (slope face excavation switch) 9 described hereinabove is mounted on the stick operation lever 8, and as an operator operates the switch 9, a semiautomatic mode is selected or not selected. Then, if a semiautomatic mode is selected, then the tip 112 of the bucket 400 can be moved linearly.
- the ON-OFF switch (bucket automatic return start switch) 7 described hereinabove is mounted on the boom/bucket operation lever 6, and as an operator switches on the switch 7, the bucket 400 can be automatically returned to an angle set in advance.
- Safety valves 5 are provided to switch the pilot pressures to be supplied to the solenoid proportional valves 3A to 3C, and only when the safety valves 5 are in an ON state, the pilot pressures are supplied to the solenoid proportional valves 3A to 3C. Accordingly, when some failure occurs or in a like case in the semiautomatic control, automatic control of the linkage can be stopped rapidly by switching the safety valves 5 to an OFF state.
- the rotational velocity of the engine E is different depending upon the position of the engine throttle set by an operator [the position is set by operating a throttle dial (not shown)], and further, even if the engine throttle is fixed, the engine rotational velocity varies depending upon the load. Since the pumps 50, 51 and 52 are directly coupled to the engine E, if the engine rotational velocity varies, then also the pump discharges vary, and consequently, even if the spool positions of the main control valves 13, 14 and 15 are fixed, the cylinder velocities are varied by the variation of the engine rotational velocity. In order to correct this, the engine rotational speed sensor 23 is mounted, and when the engine rotational velocity is low, the aimed moving velocity of the bucket tip 112 is set slow.
- the monitor panel 10 with an aimed slope face angle setting unit (which may sometimes be referred to simply as "monitor panel 10") is not only used as a setting unit for the aimed slope face angle ⁇ (refer to FIGS. 6 and 11) and the bucket return angle, but also used as an indicator for coordinates of the bucket tip 112, the slope face angle measured or the distance between coordinates of two points measured. It is to be noted that the monitor panel 10 is provided in the operator cab 600 together with the operation levers 6 and 8.
- the pressure sensors 19 and the pressure switches 16 are incorporated in conventional pilot hydraulic lines to detect operation amounts of the operation levers 6 and 8 and feedback control is effected using the resolvers 20, 21 and 22 while multiple freedom degree feedback control can be effected independently for each of the cylinders 120, 121 and 122. Consequently, the requirement for addition of an oil unit such as a pressure compensation valve is eliminated. Further, an influence of inclination of the upper revolving unit 100 is corrected using the vehicle inclination angle sensor 24, and the solenoid proportional valves 3A to 3C are utilized in order to drive the cylinders 120, 121 and 122 with electric signals from the controller 1. It is to be noted that an operator can select a mode arbitrarily using the manual/semiautomatic mode change-over switch 9 and besides can set an aimed slope face angle.
- control algorithm of the semiautomatic system performed by the controller 1 is described.
- the control algorithm of the semiautomatic control mode (except the bucket automatic return mode) effected by the controller 1 is substantially such as illustrated in FIG. 4.
- the moving velocity and direction of the bucket tip 122 are first calculated from information of the aimed slope face set angle, the pilot hydraulic pressures for controlling the stick cylinder 121 and the boom cylinder 120, the vehicle inclination angle and the engine rotational velocity. Then, aimed velocities of the hydraulic cylinders 120, 121 and 122 are calculated based on the calculated information (moving velocity and moving direction of the bucket tip 112). In this instance, the information of the engine rotational velocity is required to determine an upper limit to the cylinder velocities.
- controller 1 includes, as shown in FIGS. 3 and 4, control sections 1A, 1B and 1C provided independently of each other for the cylinders 120, 121 and 122, and the controls are constructed as independent control feedback loops as shown in FIG. 4 so that they may not interfere with each other.
- the compensation construction in the closed loop controls shown in FIG. 4 has, in each of the control sections 1A, 1B and 1C, a multiple freedom degree construction including a feedback loop and a feedforward loop with regard to the displacement and the velocity as shown in FIG. 5, and includes feedback loop type compensation means 72 having a variable control gain (control parameter), and feedforward loop type compensation means 73 having a variable control gain (control parameter).
- an aimed velocity processes according to a route wherein a deviation between the aimed velocity and velocity feedback information is multiplied by a predetermined gain Kvp (refer to reference numeral 62), another route wherein the aimed velocity is integrated once (refer to an integration element 61 of FIG.
- a deviation between the aimed velocity integration information and displacement feedback information is multiplied by a predetermined gain Kpp (refer to reference numeral 63) and a further route wherein the deviation between the aimed velocity integration information and the displacement feedback information is multiplied by a predetermined gain Kpi (refer to reference numeral 64) and further integrated (refer to reference numeral 66) are performed by the feedback loop type compensation means 72 while, by the feedforward loop type compensation means 73, a process by a route wherein the aimed velocity is multiplied by a predetermined gain Kf (refer to reference numeral 65) is performed.
- the present apparatus includes, as shown in FIG. 5, operation information detection means 91 for detecting operation information of the cylinders 120 to 122, and the controller 1 receives the detection information from the operation information detection means 91 and aimed operation information (for example, an aimed moving velocity) set by aimed value setting means 80 as input information and sets and outputs control signals so that the arm members such as the boom 200 and the bucket (working member) 400 may exhibit aimed operation conditions.
- the operation information detection means 91 particularly is cylinder position detection means 83 which can detect positions of the cylinders 120 to 122, and in the present embodiment, the cylinder position detection means 83 is composed of the resolvers 20 to 22 and the signal converter 26 described hereinabove.
- the values of the gains Kvp, Kpp, Kpi and Kf can be changed by a gain scheduler 70.
- non-linearity removal table 71 is provided to remove non-linear properties of the solenoid proportional valves 3A to 3C, the main control valves 13 to 15 and so forth, a process in which the non-linearity removal table 71 is used is performed at a high speed by a computer using a table lookup technique.
- such semiautomatic control functions as described above can be realized by an electronic hydraulic system which automatically adjusts the composite moving amount of the boom 200 and the stick 300 in accordance with the excavating velocity in contrast with a conventional system of manual control.
- detection signals are inputted from the various sensors to the controller 1 mounted on the hydraulic excavator, and the controller 1 controls the main control valves 13, 14 and 15 through the solenoid proportional valves 3A, 3B and 3C based on the detection signals from the sensors (including detection signals of the resolvers 20 to 22 received via the signal converter 26) to effect such control that the boom 200, stick 300 and bucket 400 may exhibit desired expansion/contraction displacements to effect such semiautomatic control as described above.
- the moving velocity and direction of the bucket tip 112 are calculated from information of the aimed slope face set angle, the pilot hydraulic pressures which control the stick cylinder 121 and the boom cylinder 120, the vehicle inclination angle and the engine rotational velocity, and aimed velocities of the cylinders 120, 121 and 122 are calculated based on the information.
- the information of the engine rotational velocity is required when an upper limit to the cylinder velocities is determined.
- the controls are performed as the feedback loops independent of each other for the cylinders 120, 121 and 122 and do not interfere with each other.
- the setting of the aimed slope face angle in the semiautomatic system can be performed by a method which is based on inputting of a numerical value by switches on the monitor panel 10, a two point coordinate inputting method, or an inputting method by a bucket angle, and similarly, for the setting of the bucket return angle in the semiautomatic system, a method which is based on inputting of a numerical value by the switches on the monitor panel 10 or a method which is based on bucket movement is performed. For all of them, known techniques are used.
- the semiautomatic control modes described above and the controlling methods are performed in the following manner based on cylinder expansion/contraction displacement information obtained by conversion by the signal converter 26 of the angle information detected by the resolvers 20 to 22.
- the length of the bucket cylinder 122 is controlled so that the angle (bucket angle) ⁇ defined between the bucket 400 and the x axis may be fixed at each arbitrary position.
- the bucket cylinder length ⁇ bk is determined if the boom cylinder length ⁇ bm, the stick cylinder length ⁇ st and the angle ⁇ mentioned above is determined.
- the coordinates of the node 108 in the linkage posture when excavation is started are represented by (x 108 , y 108 ), and the cylinder lengths of the boom cylinder 120 and the stick cylinder 121 in the linkage posture in this instance are calculated and the velocities of the boom 200 and the stick 300 are calculated so that x 108 may move horizontally. It is to be noted that the moving velocity of the node 108 depends upon the operation amount of the stick operation lever 8.
- control similar to that in the smoothing mode may be performed. However, the point which moves is changed from the node 108 to the bucket tip position 112, and further, the control takes it into consideration that the bucket cylinder length is fixed.
- the vehicle inclination angle sensor 24 calculates the front linkage position on the xy coordinate system whose origin is a node 101 of FIG. 6. Accordingly, if the vehicle body is inclined with respect to the xy plane, then the xy coordinates are rotated, and the aimed inclination angle with respect to the ground surface is varied. In order to correct this, the vehicle inclination angle sensor 24 is mounted on the vehicle, and when it is detected by the vehicle inclination angle sensor 24 that the vehicle body is rotated by ⁇ with respect to the xy plane, the aimed inclination angle should be corrected by replacing it with a value obtained by adding ⁇ to it.
- the aimed bucket tip velocity depends upon the positions of the stick operation lever 8 and the boom/bucket operation lever 6 and the engine rotational velocity.
- the hydraulic pumps 51 and 52 are directly coupled to the engine E, when the engine rotational velocity is low, also the pump discharges are small and the cylinder velocities are low. Therefore, the engine rotational velocity is detected, and the aimed bucket tip velocity is calculated so as to conform with the variation of the pump discharges.
- correction is performed taking it into consideration that the aimed cylinder velocities are varied by the posture of the linkage and the aimed slope face inclination angle and that, when the pump discharges decrease as the engine rotational velocity decreases, also the maximum cylinder velocities must be decreased. It is to be noted that, if an aimed cylinder velocity exceeds its maximum cylinder velocity, then the aimed bucket tip velocity is decreased so that the aimed cylinder velocity may not exceed the maximum cylinder velocity.
- control modes and the controlling methods are described above, they all employ a technique wherein they are performed based on cylinder expansion/contraction displacement information, and control contents according to this technique are publicly known.
- control contents according to this technique are publicly known.
- the known controlling technique can be used for later processing.
- the feedback control loops are independent of each other for the cylinders 120, 121 and 122 and the control algorithm is multiple freedom control of the displacement, velocity and feedforward, the control system can be simplified. Further, since the non-linearity of a hydraulic apparatus can be converted into linearity at a high speed by a table lookup technique, the present system contributes also to augmentation of the control accuracy.
- the present system since deterioration of the control accuracy by the position and load variations of the engine throttle is corrected by correcting the influence of the vehicle inclination by the vehicle inclination angle sensor 24 or reading in the engine rotational velocity, the present system contributes to realization of more accurate control.
- the present invention is not limited to this.
- the present invention can be applied similarly to a construction machine such as a tractor, a loader or a bulldozer only if the construction machine has a joint type arm mechanism which is driven by cylinder type actuators, and in any construction machine, similar effects to those described above can be obtained.
- a control apparatus for a construction machine of the present invention since the position and the posture of an arm mechanism of the construction machine can be controlled accurately and stably while suppressing the cost low by executing control which employs expansion/contraction displacement information of actuators which are used by a conventional controlling system as described above, the control apparatus for a construction machine contributes very much to reduction in cost for equipment investment expenses, reduction of the working period and so forth in a desired working site such as a construction site, and it is considered that the usefulness of the control apparatus for a construction machine is very high.
Landscapes
- Engineering & Computer Science (AREA)
- Mining & Mineral Resources (AREA)
- Civil Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Structural Engineering (AREA)
- Mechanical Engineering (AREA)
- Life Sciences & Earth Sciences (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Paleontology (AREA)
- Operation Control Of Excavators (AREA)
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP8323161A JPH10159123A (ja) | 1996-12-03 | 1996-12-03 | 建設機械の制御装置 |
JP323161/96 | 1996-12-03 | ||
PCT/JP1997/004361 WO1998024985A1 (fr) | 1996-12-03 | 1997-11-28 | Organe de commande d'engin de construction |
Publications (2)
Publication Number | Publication Date |
---|---|
EP0900887A1 true EP0900887A1 (fr) | 1999-03-10 |
EP0900887A4 EP0900887A4 (fr) | 2000-05-24 |
Family
ID=18151774
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
EP97913472A Withdrawn EP0900887A4 (fr) | 1996-12-03 | 1997-11-28 | Organe de commande d'engin de construction |
Country Status (6)
Country | Link |
---|---|
EP (1) | EP0900887A4 (fr) |
JP (1) | JPH10159123A (fr) |
KR (1) | KR19990081852A (fr) |
CN (1) | CN1210570A (fr) |
CA (1) | CA2242755A1 (fr) |
WO (1) | WO1998024985A1 (fr) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2011075374A2 (fr) * | 2009-12-18 | 2011-06-23 | Caterpillar Inc. | Système de correction d'angle d'outil et chargeur associé |
US9551129B2 (en) | 2014-05-30 | 2017-01-24 | Komatsu Ltd. | Work machine control system, work machine, excavator control system, and work machine control method |
CN111201350A (zh) * | 2018-09-20 | 2020-05-26 | 日立建机株式会社 | 作业机械 |
CN112424430A (zh) * | 2018-08-31 | 2021-02-26 | 株式会社小松制作所 | 控制装置、装载机械及控制方法 |
Families Citing this family (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3364419B2 (ja) | 1997-10-29 | 2003-01-08 | 新キャタピラー三菱株式会社 | 遠隔無線操縦システム並びに遠隔操縦装置,移動式中継局及び無線移動式作業機械 |
JP3828856B2 (ja) * | 2002-10-21 | 2006-10-04 | ヤンマー株式会社 | スキッドステアローダ |
CN101666105B (zh) * | 2009-07-08 | 2011-08-10 | 北汽福田汽车股份有限公司 | 控制挖掘机动臂上升速度的方法、控制系统及一种挖掘机 |
GB2489663B (en) * | 2011-03-21 | 2015-07-08 | Bamford Excavators Ltd | A working machine hitch arrangement |
US8843282B2 (en) * | 2011-11-02 | 2014-09-23 | Caterpillar Inc. | Machine, control system and method for hovering an implement |
CN102535569B (zh) * | 2012-01-14 | 2014-01-15 | 浙江濠泰机械有限公司 | 工程机械执行机构运动轨迹智能控制系统及其控制方法 |
JP5624101B2 (ja) | 2012-10-05 | 2014-11-12 | 株式会社小松製作所 | 掘削機械の表示システム、掘削機械及び掘削機械の表示用コンピュータプログラム |
CN102912816B (zh) * | 2012-11-19 | 2015-03-18 | 中联重科股份有限公司渭南分公司 | 挖掘机的控制方法和控制装置与挖掘机 |
CN102995679B (zh) * | 2012-12-17 | 2015-10-07 | 潍柴动力股份有限公司 | 一种挖掘机动作控制方法、装置及系统 |
DE102013008169B4 (de) * | 2013-05-13 | 2022-08-04 | Caterpillar Inc. | Mobilbagger mit Verriegelung der Drehdurchführung |
JP5929861B2 (ja) * | 2013-09-27 | 2016-06-08 | ダイキン工業株式会社 | 建設機械 |
EP3015625A1 (fr) * | 2014-10-31 | 2016-05-04 | CIFA SpA | Procédé et appareil pour déplacer un bras articulé |
CN105350595B (zh) * | 2015-08-27 | 2017-08-29 | 中国航空工业集团公司西安飞行自动控制研究所 | 基于位置控制的挖掘机操纵装置 |
CN108286272B (zh) * | 2017-12-27 | 2023-08-29 | 青岛雷沃工程机械有限公司 | 半自动修坡挖掘机 |
JP7141894B2 (ja) * | 2018-09-05 | 2022-09-26 | 日立建機株式会社 | 作業機械 |
KR102705219B1 (ko) * | 2019-04-05 | 2024-09-11 | 볼보 컨스트럭션 이큅먼트 에이비 | 건설기계 |
CN114688004B (zh) * | 2022-03-16 | 2023-10-27 | 三一重机有限公司 | 流量分配方法、装置及作业机械 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5774437A (en) * | 1981-06-01 | 1982-05-10 | Hitachi Constr Mach Co Ltd | Automatic operating device for straight excavation of hydraulic shovel |
EP0293057A2 (fr) * | 1987-05-29 | 1988-11-30 | Hitachi Construction Machinery Co., Ltd. | Dispositif de commande de mouvement du bras d'un véhicule industriel |
JPH01178619A (ja) * | 1987-12-29 | 1989-07-14 | Hitachi Constr Mach Co Ltd | 掘削作業機 |
JPH02232430A (ja) * | 1989-03-03 | 1990-09-14 | Komatsu Ltd | 油圧ショベルの掘削深さ制御装置 |
JPH0414531A (ja) * | 1990-05-01 | 1992-01-20 | Komatsu Ltd | 作業機の制御装置 |
EP0512584A2 (fr) * | 1988-08-02 | 1992-11-11 | Kabushiki Kaisha Komatsu Seisakusho | Procédé et dispositif de commande des parties de travail d'une pelle mécanique |
JPH0681361A (ja) * | 1992-09-01 | 1994-03-22 | Komatsu Ltd | 作業機の制御方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH076212B2 (ja) * | 1985-02-27 | 1995-01-30 | 株式会社小松製作所 | パワ−シヨベルの位置制御装置 |
JPS62185928A (ja) * | 1986-02-13 | 1987-08-14 | Komatsu Ltd | 積込機械の自動掘削方法および装置 |
JPH07197485A (ja) * | 1993-12-28 | 1995-08-01 | Komatsu Ltd | 建設機械の作業機制御装置 |
-
1996
- 1996-12-03 JP JP8323161A patent/JPH10159123A/ja active Pending
-
1997
- 1997-11-28 WO PCT/JP1997/004361 patent/WO1998024985A1/fr not_active Application Discontinuation
- 1997-11-28 KR KR1019980705563A patent/KR19990081852A/ko not_active Application Discontinuation
- 1997-11-28 CN CN97191997A patent/CN1210570A/zh active Pending
- 1997-11-28 CA CA002242755A patent/CA2242755A1/fr not_active Abandoned
- 1997-11-28 EP EP97913472A patent/EP0900887A4/fr not_active Withdrawn
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5774437A (en) * | 1981-06-01 | 1982-05-10 | Hitachi Constr Mach Co Ltd | Automatic operating device for straight excavation of hydraulic shovel |
EP0293057A2 (fr) * | 1987-05-29 | 1988-11-30 | Hitachi Construction Machinery Co., Ltd. | Dispositif de commande de mouvement du bras d'un véhicule industriel |
JPH01178619A (ja) * | 1987-12-29 | 1989-07-14 | Hitachi Constr Mach Co Ltd | 掘削作業機 |
EP0512584A2 (fr) * | 1988-08-02 | 1992-11-11 | Kabushiki Kaisha Komatsu Seisakusho | Procédé et dispositif de commande des parties de travail d'une pelle mécanique |
JPH02232430A (ja) * | 1989-03-03 | 1990-09-14 | Komatsu Ltd | 油圧ショベルの掘削深さ制御装置 |
JPH0414531A (ja) * | 1990-05-01 | 1992-01-20 | Komatsu Ltd | 作業機の制御装置 |
JPH0681361A (ja) * | 1992-09-01 | 1994-03-22 | Komatsu Ltd | 作業機の制御方法 |
Non-Patent Citations (6)
Title |
---|
PATENT ABSTRACTS OF JAPAN vol. 006, no. 157 (M-150), 18 August 1982 (1982-08-18) & JP 57 074437 A (HITACHI CONSTR MACH CO LTD), 10 May 1982 (1982-05-10) * |
PATENT ABSTRACTS OF JAPAN vol. 013, no. 458 (M-880), 17 October 1989 (1989-10-17) & JP 01 178619 A (HITACHI CONSTR MACH CO LTD), 14 July 1989 (1989-07-14) * |
PATENT ABSTRACTS OF JAPAN vol. 014, no. 549 (M-1055), 6 December 1990 (1990-12-06) & JP 02 232430 A (KOMATSU LTD), 14 September 1990 (1990-09-14) * |
PATENT ABSTRACTS OF JAPAN vol. 016, no. 169 (M-1239), 23 April 1992 (1992-04-23) & JP 04 014531 A (KOMATSU LTD), 20 January 1992 (1992-01-20) * |
PATENT ABSTRACTS OF JAPAN vol. 018, no. 338 (M-1628), 27 June 1994 (1994-06-27) & JP 06 081361 A (KOMATSU LTD), 22 March 1994 (1994-03-22) * |
See also references of WO9824985A1 * |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2011075374A2 (fr) * | 2009-12-18 | 2011-06-23 | Caterpillar Inc. | Système de correction d'angle d'outil et chargeur associé |
WO2011075374A3 (fr) * | 2009-12-18 | 2011-10-20 | Caterpillar Inc. | Système de correction d'angle d'outil et chargeur associé |
GB2488490A (en) * | 2009-12-18 | 2012-08-29 | Caterpillar Inc | Implement angle correction system and associated loader |
US8463508B2 (en) | 2009-12-18 | 2013-06-11 | Caterpillar Inc. | Implement angle correction system and associated loader |
US8612103B2 (en) | 2009-12-18 | 2013-12-17 | Caterpillar Inc. | Implement angle correction system and associated loader |
GB2488490B (en) * | 2009-12-18 | 2014-07-16 | Caterpillar Inc | Implement angle correction system and associated loader |
US9551129B2 (en) | 2014-05-30 | 2017-01-24 | Komatsu Ltd. | Work machine control system, work machine, excavator control system, and work machine control method |
CN112424430A (zh) * | 2018-08-31 | 2021-02-26 | 株式会社小松制作所 | 控制装置、装载机械及控制方法 |
CN112424430B (zh) * | 2018-08-31 | 2024-03-05 | 株式会社小松制作所 | 控制装置、装载机械及控制方法 |
CN111201350A (zh) * | 2018-09-20 | 2020-05-26 | 日立建机株式会社 | 作业机械 |
CN111201350B (zh) * | 2018-09-20 | 2022-02-25 | 日立建机株式会社 | 作业机械 |
Also Published As
Publication number | Publication date |
---|---|
JPH10159123A (ja) | 1998-06-16 |
CN1210570A (zh) | 1999-03-10 |
CA2242755A1 (fr) | 1998-06-11 |
KR19990081852A (ko) | 1999-11-15 |
EP0900887A4 (fr) | 2000-05-24 |
WO1998024985A1 (fr) | 1998-06-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP0965698B1 (fr) | Procede et dispositif de commande d'une machine de construction | |
EP0900887A1 (fr) | Organe de commande d'engin de construction | |
US6098322A (en) | Control device of construction machine | |
US5768810A (en) | Method for carrying out automatic surface finishing work with electro-hydraulic excavator vehicle | |
KR0168992B1 (ko) | 굴삭기의 제어방법 | |
US5446981A (en) | Method of selecting automatic operation mode of working machine | |
EP0736634B1 (fr) | Unite de commande de machines de terrassement | |
JP3641096B2 (ja) | 建設機械の制御装置 | |
US9249555B2 (en) | Hydraulic system having fixable multi-actuator relationship | |
JP4619725B2 (ja) | 作業腕の動作制御装置 | |
JP3258891B2 (ja) | 建設機械の作業機制御方法およびその装置 | |
JP3653153B2 (ja) | 建設機械の制御装置 | |
JP3713120B2 (ja) | 建設機械の制御装置 | |
JP3426887B2 (ja) | 建設機械の制御装置 | |
JP2674918B2 (ja) | 油圧ショベル | |
JP3217981B2 (ja) | 建設機械の制御装置 | |
JPH10259618A (ja) | 建設機械の制御装置 | |
JP3580976B2 (ja) | 建設機械の制御装置 | |
JPH10252093A (ja) | 建設機械の制御装置 | |
JP2871890B2 (ja) | 油圧ショベルの掘削制御装置 | |
JPH0480168B2 (fr) | ||
JPH07317097A (ja) | 直線掘削作業装置 | |
KR940000243B1 (ko) | 버켙자세의 자동유지제어장치 | |
JPH06193377A (ja) | 作業機の定速軌跡制御装置 | |
KR20000021951A (ko) | 굴삭기의 작업장치 자동제어시스템 및 제어방법 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PUAI | Public reference made under article 153(3) epc to a published international application that has entered the european phase |
Free format text: ORIGINAL CODE: 0009012 |
|
17P | Request for examination filed |
Effective date: 19980831 |
|
AK | Designated contracting states |
Kind code of ref document: A1 Designated state(s): BE DE FR GB IT |
|
A4 | Supplementary search report drawn up and despatched |
Effective date: 20000410 |
|
AK | Designated contracting states |
Kind code of ref document: A4 Designated state(s): BE DE FR GB IT |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: THE APPLICATION IS DEEMED TO BE WITHDRAWN |
|
18D | Application deemed to be withdrawn |
Effective date: 20020601 |