WO2019180894A1 - 作業機械 - Google Patents
作業機械 Download PDFInfo
- Publication number
- WO2019180894A1 WO2019180894A1 PCT/JP2018/011513 JP2018011513W WO2019180894A1 WO 2019180894 A1 WO2019180894 A1 WO 2019180894A1 JP 2018011513 W JP2018011513 W JP 2018011513W WO 2019180894 A1 WO2019180894 A1 WO 2019180894A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- target
- speed
- arm
- boom
- work
- Prior art date
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
- 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
-
- 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/2203—Arrangements for controlling the attitude of actuators, e.g. speed, floating function
-
- 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/2221—Control of flow rate; Load sensing arrangements
- E02F9/2232—Control of flow rate; Load sensing arrangements using one or more variable displacement pumps
- E02F9/2235—Control of flow rate; Load sensing arrangements using one or more variable displacement pumps including an electronic controller
-
- 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/2221—Control of flow rate; Load sensing arrangements
- E02F9/2239—Control of flow rate; Load sensing arrangements using two or more pumps with cross-assistance
- E02F9/2242—Control of flow rate; Load sensing arrangements using two or more pumps with cross-assistance including an electronic controller
-
- 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/2264—Arrangements or adaptations of elements for hydraulic drives
- E02F9/2271—Actuators and supports therefor and protection therefor
-
- 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
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B11/00—Servomotor systems without provision for follow-up action; Circuits therefor
- F15B11/02—Systems essentially incorporating special features for controlling the speed or actuating force of an output member
- F15B11/04—Systems essentially incorporating special features for controlling the speed or actuating force of an output member for controlling the speed
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B21/00—Common features of fluid actuator systems; Fluid-pressure actuator systems or details thereof, not covered by any other group of this subclass
- F15B21/08—Servomotor systems incorporating electrically operated control means
- F15B21/087—Control strategy, e.g. with block diagram
-
- 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/30—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 with a dipper-arm pivoted on a cantilever beam, i.e. boom
- E02F3/32—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 with a dipper-arm pivoted on a cantilever beam, i.e. boom working downwardly and towards the machine, e.g. with backhoes
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B11/00—Servomotor systems without provision for follow-up action; Circuits therefor
- F15B11/16—Servomotor systems without provision for follow-up action; Circuits therefor with two or more servomotors
- F15B11/17—Servomotor systems without provision for follow-up action; Circuits therefor with two or more servomotors using two or more pumps
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
- F15B2211/20—Fluid pressure source, e.g. accumulator or variable axial piston pump
- F15B2211/205—Systems with pumps
- F15B2211/2053—Type of pump
- F15B2211/20546—Type of pump variable capacity
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
- F15B2211/20—Fluid pressure source, e.g. accumulator or variable axial piston pump
- F15B2211/205—Systems with pumps
- F15B2211/20576—Systems with pumps with multiple pumps
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
- F15B2211/30—Directional control
- F15B2211/305—Directional control characterised by the type of valves
- F15B2211/3056—Assemblies of multiple valves
- F15B2211/30565—Assemblies of multiple valves having multiple valves for a single output member, e.g. for creating higher valve function by use of multiple valves like two 2/2-valves replacing a 5/3-valve
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
- F15B2211/30—Directional control
- F15B2211/31—Directional control characterised by the positions of the valve element
- F15B2211/3105—Neutral or centre positions
- F15B2211/3116—Neutral or centre positions the pump port being open in the centre position, e.g. so-called open centre
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
- F15B2211/30—Directional control
- F15B2211/315—Directional control characterised by the connections of the valve or valves in the circuit
- F15B2211/31523—Directional control characterised by the connections of the valve or valves in the circuit being connected to a pressure source and an output member
- F15B2211/31535—Directional control characterised by the connections of the valve or valves in the circuit being connected to a pressure source and an output member having multiple pressure sources and a single output member
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
- F15B2211/30—Directional control
- F15B2211/315—Directional control characterised by the connections of the valve or valves in the circuit
- F15B2211/3157—Directional control characterised by the connections of the valve or valves in the circuit being connected to a pressure source, an output member and a return line
- F15B2211/31582—Directional control characterised by the connections of the valve or valves in the circuit being connected to a pressure source, an output member and a return line having multiple pressure sources and a single output member
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
- F15B2211/30—Directional control
- F15B2211/32—Directional control characterised by the type of actuation
- F15B2211/327—Directional control characterised by the type of actuation electrically or electronically
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
- F15B2211/30—Directional control
- F15B2211/32—Directional control characterised by the type of actuation
- F15B2211/329—Directional control characterised by the type of actuation actuated by fluid pressure
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
- F15B2211/30—Directional control
- F15B2211/35—Directional control combined with flow control
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
- F15B2211/60—Circuit components or control therefor
- F15B2211/63—Electronic controllers
- F15B2211/6303—Electronic controllers using input signals
- F15B2211/6336—Electronic controllers using input signals representing a state of the output member, e.g. position, speed or acceleration
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
- F15B2211/60—Circuit components or control therefor
- F15B2211/63—Electronic controllers
- F15B2211/6303—Electronic controllers using input signals
- F15B2211/6346—Electronic controllers using input signals representing a state of input means, e.g. joystick position
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
- F15B2211/60—Circuit components or control therefor
- F15B2211/665—Methods of control using electronic components
- F15B2211/6654—Flow rate control
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
- F15B2211/60—Circuit components or control therefor
- F15B2211/665—Methods of control using electronic components
- F15B2211/6656—Closed loop control, i.e. control using feedback
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
- F15B2211/70—Output members, e.g. hydraulic motors or cylinders or control therefor
- F15B2211/71—Multiple output members, e.g. multiple hydraulic motors or cylinders
- F15B2211/7142—Multiple output members, e.g. multiple hydraulic motors or cylinders the output members being arranged in multiple groups
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
- F15B2211/70—Output members, e.g. hydraulic motors or cylinders or control therefor
- F15B2211/75—Control of speed of the output member
Definitions
- the present invention relates to a work machine such as a hydraulic excavator.
- MC machine control
- a work machine for example, a hydraulic excavator
- a work device for example, a front work device driven by a hydraulic actuator.
- MC is a technology for assisting an operator's operation by executing semi-automatic control for operating a working device according to a predetermined condition when the operating device is operated by an operator.
- the front work device is controlled so as to prevent a control point (for example, bucket toe) of the front work device from entering a target surface (also referred to as a design surface).
- a control point for example, bucket toe
- a target surface also referred to as a design surface
- Semi-automatic excavation molding control also referred to as “region restriction control” in the sense of controlling the movement region of the front working device to be above the target surface
- the work machine control system disclosed in Patent Document 1 performs a molding operation in which a bucket is moved along a target surface when an arm operation signal is included in an operation signal output in response to an operation of an operator on a front work device. Judge that you are going.
- the boom is automatically operated so as to cancel the speed of the bucket tip generated in the direction perpendicular to the target surface by the arm operation (hereinafter referred to as the vertical speed), thereby moving the bucket along the target surface semi-automatically.
- the vertical speed the speed of the bucket tip generated in the direction perpendicular to the target surface by the arm operation
- the operator can excavate and mold the target surface only by operating the arm.
- the operator can adjust the bucket tip speed (hereinafter, excavation speed) generated in a direction parallel to the target surface according to the operation amount of the arm, so that the operator can perform the horizontal pulling operation at an intended speed.
- excavation speed the bucket tip speed generated in a direction parallel to the target surface according to the operation amount of the arm.
- the boom raising speed cannot be increased in time, and the bucket tip may move horizontally for a long distance while being located below the target surface. Or there is a possibility that the boom raising speed will not be restrained in time when the bucket tip reaches the target surface, and the bucket tip will rise from the target surface. That is, if the arm operation is at a high speed, it is difficult to perform stable semi-automatic excavation molding control, and the excavation molding accuracy may be impaired. This occurs because the inertia load of the boom is larger than that of the arm, and the delay of the actual speed change is large with respect to the speed change of the boom cylinder required by the control system.
- the present invention has been made in view of the above problems, and it is an object of the present invention to provide a work machine capable of accurately performing semi-automatic excavation molding control even when the excavation speed is high.
- the present invention provides a working device having a plurality of front members, a plurality of hydraulic actuators for driving the plurality of front members, and the operations of the plurality of hydraulic actuators according to an operator's operation.
- An operating device for instructing, and a controller having a target speed calculation unit for calculating a target speed of each of the plurality of front members so that the working device is restricted above a predetermined target surface when the operating device is operated.
- the controller includes a signal separation unit that separates a target speed signal of the plurality of front members into a low-frequency component having a frequency lower than a predetermined threshold and a high-frequency component having a frequency higher than the threshold, and the signal The high-frequency component separated by the separation unit is a Freon having a relatively small inertia load among the plurality of front members.
- a high fluctuation target speed calculation unit that preferentially assigns to a member and calculates a high fluctuation target speed of each of the plurality of front members, and a high fluctuation target speed of the plurality of front members calculated by the high fluctuation target speed calculation unit
- a high fluctuation target actuator speed calculation unit for calculating a high fluctuation target speed of each of the plurality of actuators based on posture information of the plurality of front members, the low frequency component separated by the signal separation unit, and the plurality of
- a low-variation target actuator speed calculation unit that calculates low-variation target speeds of the plurality of actuators based on the posture information of the front member, a calculation result of the high-variation target actuator speed calculation unit, and the low-variation target actuator speed Based on the value obtained by adding the calculation results of the calculation unit for each of the plurality of actuators, the plurality of actuators.
- an actuator control unit for controlling the Chueta respectively.
- FIG. 1 is a side view of a hydraulic excavator 1 that is an example of a work machine according to an embodiment of the present invention.
- the side view of the hydraulic excavator 1 in a global coordinate system and a local coordinate system.
- FIG. 2 is a schematic diagram of a hardware configuration of a controller 25.
- FIG. FIG. 2 is a schematic diagram of a hydraulic circuit 27 of the excavator 1.
- the functional block diagram of the controller 25 which concerns on 1st Embodiment.
- the functional block diagram of the target actuator speed calculating part 100 which concerns on 1st Embodiment.
- the graph showing the relationship between the distance D of the bucket tip P4 and the target surface 60, and the speed correction coefficient k.
- FIG. 11 is a diagram in which an example of the target speed signal and target actuator speed of each front member is superimposed on FIG.
- a hydraulic excavator including the bucket 10 is illustrated as a work tool (attachment) at the tip of the working device, but the present invention may be applied to a working machine including an attachment other than the bucket. Furthermore, the present invention can be applied to a working machine other than a hydraulic excavator as long as it has an articulated working device configured by connecting a plurality of front members (attachment, arm, boom, etc.).
- FIG. 1 is a side view of a hydraulic excavator 1 which is an example of a work machine according to an embodiment of the present invention.
- the hydraulic excavator 1 includes a traveling body (lower traveling body) 2 that travels by driving a crawler belt provided on each of the left and right sides by a hydraulic motor (not shown), and a revolving body that is provided on the traveling body 2 so as to be able to turn. (Upper turning body) 3.
- the swivel body 3 has a cab 4, a machine room 5, and a counterweight 6.
- the cab 4 is provided on the left side of the front part of the swivel body 3.
- the machine room 5 is provided behind the cab 4.
- the counterweight is provided behind the machine room 5, that is, at the rear end of the swing body 3.
- the revolving unit 3 is equipped with an articulated work device (front work device) 7.
- the work device 7 is provided on the right side of the cab 4 at the front of the revolving unit 3, that is, at the substantially central portion of the front of the revolving unit 3.
- the working device 7 includes a boom 8, an arm 9, a bucket (working tool) 10, a boom cylinder 11, an arm cylinder 12, and a bucket cylinder 13.
- the base end portion of the boom 8 is rotatably attached to the front portion of the revolving structure 3 via a boom pin P1 (see FIG. 2).
- the base end portion of the arm 9 is rotatably attached to the distal end portion of the boom 8 via an arm pin P2 (see FIG. 2).
- the proximal end portion of the bucket 10 is rotatably attached to the distal end portion of the arm 9 via a bucket pin P3 (see FIG. 2).
- the boom cylinder 11, the arm cylinder 12, and the bucket cylinder 13 are hydraulic cylinders that are driven by hydraulic oil.
- the boom cylinder 11 extends and contracts to drive the boom 8
- the arm cylinder 12 drives the extendable arm 9,
- the bucket cylinder 13 extends and contracts to drive the bucket 10.
- the boom 8, the arm 9, and the bucket (work tool) 10 may be referred to as front members.
- variable displacement first hydraulic pump 14 and a second hydraulic pump 15 Inside the machine room 5 are a variable displacement first hydraulic pump 14 and a second hydraulic pump 15 (see FIG. 3), and an engine (prime mover) 16 (see FIG. 3) for driving the first hydraulic pump 14 and the second hydraulic pump 15. 3) is installed.
- a vehicle body tilt sensor 17 Inside the cab 4 are mounted a vehicle body tilt sensor 17, a boom 8 has a boom tilt sensor 18, an arm 9 has an arm tilt sensor 19, and a bucket 10 has a bucket tilt sensor 20.
- the vehicle body tilt sensor 17, the boom tilt sensor 18, the arm tilt sensor 19, and the bucket tilt sensor 20 are IMUs (Internal Measurement Units).
- the vehicle body tilt sensor 17 is the angle (ground angle) of the upper swing body (vehicle body) 3 with respect to the horizontal plane
- the boom tilt sensor 18 is the boom ground angle
- the arm tilt sensor 19 is the arm 9 ground angle
- the bucket tilt sensor. 20 measures the ground angle of the bucket 10.
- the first GNSS antenna 21 and the second GNSS antenna 22 are attached to the left and right of the rear part of the revolving unit 3.
- GNSS is an abbreviation for Global Navigation Satellite System (Global Positioning Satellite System).
- First two GNSS antennas 21 and two second GNSS antennas 22 respectively receive predetermined two points in the global coordinate system (for example, the base ends of antennas 21 and 22) from navigation signals received from a plurality of navigation satellites (preferably four or more navigation satellites). Position information) can be calculated. Based on the position information (coordinate values) of the calculated two points in the global coordinate system, the coordinate values in the global coordinate system of the origin P0 (see FIG.
- FIG. 2 is a side view of the excavator 1.
- the length of the boom 8, that is, the length from the boom pin P1 to the arm pin P2 is L1.
- the length of the arm 9, that is, the length from the arm pin P2 to the bucket pin P3 is L2.
- the length of the bucket 10, that is, the length from the bucket pin P3 to the bucket tip (the tip of the bucket 10) P4 is L3.
- the inclination of the revolving structure 3 with respect to the global coordinate system that is, the angle formed between the vertical direction in the horizontal plane (direction perpendicular to the horizontal plane) and the vertical direction of the vehicle body (in the direction of the turning center axis of the revolving structure 3) is ⁇ 4.
- the vehicle body front-rear inclination angle ⁇ 4 is referred to.
- the angle between the line segment connecting the boom pin P1 and the arm pin P2 and the vertical direction of the vehicle body is defined as ⁇ 1, and hereinafter referred to as the boom angle ⁇ 1.
- An angle formed by a line segment connecting the arm pin P2 and the bucket pin P3 and a straight line composed of the boom pin P1 and the arm pin P2 is defined as ⁇ 2, and hereinafter referred to as an arm angle ⁇ 2.
- An angle formed by a line segment connecting the bucket pin P3 and the bucket tip P4 and a straight line formed by the arm pin P2 and the bucket pin P3 is defined as ⁇ 3, and hereinafter referred to as a bucket angle ⁇ 3.
- FIG. 3 is a configuration diagram of the vehicle body control system 23 of the excavator 1.
- the vehicle body control system 23 includes an operating device 24 for operating the work device 7, an engine 16 for driving the first and second hydraulic pumps 14 and 15, and the boom cylinder 11 from the first and second hydraulic pumps 14 and 15. , A flow control valve device 26 that controls the flow rate and direction of hydraulic oil supplied to the arm cylinder 12 and the bucket cylinder 13, and a controller 25 that is a control device that controls the flow control valve device 26.
- the operating device 24 operates a boom operating lever 24a for operating the boom 8 (boom cylinder 11), an arm operating lever 24b for operating the arm 9 (arm cylinder 12), and the bucket 10 (bucket cylinder 13). And a bucket operating lever 24c.
- each operation lever 24a, 24b, 24c is an electric lever, and outputs a voltage value corresponding to the tilt amount (operation amount) and tilt direction (operation direction) of each lever to the controller 25.
- the boom operation lever 24a outputs the target operation amount of the boom cylinder 11 as a voltage value corresponding to the operation amount of the boom operation lever 24a (hereinafter referred to as a boom operation amount).
- the arm operation lever 24b outputs the target operation amount of the arm cylinder 12 as a voltage value corresponding to the operation amount of the arm operation lever 24b (hereinafter referred to as an arm operation amount).
- the bucket operation lever 24c outputs the target operation amount of the bucket cylinder 13 as a voltage value corresponding to the bucket operation lever 24c (hereinafter referred to as a bucket operation amount).
- the operation levers 24a, 24b, 24c are hydraulic pilot levers, and the pilot pressure generated according to the tilting amount of each lever 24a, 24b, 24c is converted into a voltage value by a pressure sensor (not shown) to be a controller. Each operation amount may be detected by outputting to 25.
- the controller 25 stores the operation amount output from the operation device 24, the position information (control point position information) of the bucket tip P4, which is a predetermined control point set in advance in the work device 7, and stored in the controller 25 in advance.
- a control command is calculated based on the position information (target surface information) of the target surface 60 (see FIG. 2), and the control command is output to the flow control valve device 26.
- the controller 25 according to the present embodiment sets the target speed of the hydraulic cylinders 11, 12, and 13 to the bucket tip P ⁇ b> 4 (when the operation device 24 is operated, so that the operation range of the work device 7 is limited on and above the target surface 60. It is calculated according to the distance (target surface distance) D (see FIG. 2) between the control point) and the target surface 60.
- the bucket tip P4 (the tip of the bucket 10) is set as the control point of the work device 7.
- any point on the work device 7 can be set as the control point.
- the point closest to the target surface 60 in the previous portion may be set as the control point.
- FIG. 4 is a schematic diagram of the hardware configuration of the controller 25.
- the controller 25 includes an input interface 91, a central processing unit (CPU) 92 that is a processor, a read-only memory (ROM) 93 and a random access memory (RAM) 94 that are storage devices, and an output interface 95.
- CPU central processing unit
- ROM read-only memory
- RAM random access memory
- the input interface 91 includes signals from the inclination sensors 17, 18, 19, and 20, which are the work device posture detection devices 50 that detect the posture of the work device 7, the operation amounts and operation directions of the operation levers 24 a, 24 b, and 24 c. , A voltage value (operation signal) from the operation device 24, a signal from the target surface setting device 51 which is a device for setting a target surface 60 which is a reference for excavation work and banking work by the work device 7, and a boom 8, the signal from the inertia information setting device 41, which is a device for setting inertia information such as the mass and moment of inertia of the arm 9 and the bucket 10, is inputted and converted so that the CPU 92 can calculate it.
- a voltage value (operation signal) from the operation device 24, a signal from the target surface setting device 51 which is a device for setting a target surface 60 which is a reference for excavation work and banking work by the work device 7, and a boom 8 the signal from the inertia information setting device 41, which is a
- the ROM 93 is a recording medium that stores a control program for the controller 25 to execute various control processes including processes related to flowcharts to be described later, and various information necessary for executing the various control processes.
- the CPU 92 performs predetermined arithmetic processing on signals taken from the input interface 91, the ROM 93, and the RAM 94 in accordance with a control program stored in the ROM 93.
- the output interface 95 creates and outputs an output signal corresponding to the calculation result in the CPU 92.
- As an output signal of the output interface 95 there is a control command for the solenoid valves 32, 33, 34, and 35 (see FIG. 5), and the solenoid valves 32, 33, 34, and 35 operate according to the control command and are hydraulically operated.
- the cylinders 11, 12, and 13 are controlled.
- the controller 25 shown in FIG. 4 includes semiconductor memories such as ROM 93 and RAM 94 as storage devices. However, the storage device can be replaced with any other storage device such as a hard disk drive
- the flow control valve device 26 has a plurality of spools that can be electromagnetically driven. By changing the opening area (throttle opening) of each spool based on the control command output by the controller 25, the hydraulic cylinder 11, A plurality of hydraulic actuators mounted on the hydraulic excavator 1 including 12 and 13 are driven.
- FIG. 5 is a schematic diagram of the hydraulic circuit 27 of the excavator 1.
- the hydraulic circuit 27 includes a first hydraulic pump 14, a second hydraulic pump 15, a flow control valve device 26, and hydraulic oil tanks 36a and 36b.
- the flow control valve device 26 is supplied to the arm cylinder 12 from the first arm spool 28 that is a first flow control valve that controls the flow rate of the hydraulic oil supplied from the first hydraulic pump 14 to the arm cylinder 12 and from the second pump 15.
- a second arm spool 29 that is a third flow rate control valve for controlling the flow rate of the working oil
- a bucket spool 30 that controls the flow rate of the working oil supplied from the first hydraulic pump 14 to the bucket cylinder 13, and a second hydraulic pump.
- a boom spool (first boom spool) 31 that is a second flow rate control valve that controls the flow rate of hydraulic oil supplied from 15 to the boom cylinder 11, and a first arm spool that generates pilot pressure that drives the first arm spool 28.
- the first arm spool 28 and the bucket spool 30 are connected in parallel to the first hydraulic pump 14, and the second arm spool 29 and the boom spool 31 are connected in parallel to the second hydraulic pump 15.
- the flow control valve device 26 is a so-called open center type (center bypass type).
- Each spool 28, 29, 30, 31 has a center bypass section 28 a, which is a flow path that guides hydraulic oil discharged from the hydraulic pumps 14, 15 to the hydraulic oil tanks 36 a, 36 b until reaching a predetermined spool position from the neutral position. 29a, 30a, 31a.
- the first hydraulic pump 14, the center bypass portion 28a of the first arm spool 28, the center bypass portion 30a of the bucket spool 30, and the tank 36a are connected in series in this order, and the center bypass portion 28a and the center bypass part 30a constitute a center bypass flow path for guiding the hydraulic oil discharged from the first hydraulic pump 14 to the tank 36a.
- the second hydraulic pump 15, the center bypass portion 29a of the second arm spool 29, the center bypass portion 31a of the boom spool 31, and the tank 36b are connected in series in this order, and the center bypass portion 29a and the center bypass portion 29a are connected in series.
- the bypass portion 31a constitutes a center bypass passage that guides hydraulic oil discharged from the second hydraulic pump 15 to the tank 36b.
- Each solenoid valve 32, 33, 34, 35 operates appropriately based on a control command from the controller 25 to apply pressure oil (pilot pressure) from the pilot pump to the drive portions of the spools 28, 29, 30, 31. As a result, the spools 28, 29, 30, 31 are driven, and the hydraulic cylinders 11, 12, 13 operate.
- the command is output to the first arm spool drive solenoid valve 32a and the second arm spool drive solenoid valve 33a.
- the command is output to the first arm spool drive solenoid valve 32b and the second arm spool drive solenoid valve 33b.
- a command is issued in the extension direction of the bucket cylinder 13 .
- a command is output to the bucket spool drive electromagnetic valve 34a.
- a command is output to the bucket spool drive electromagnetic valve 34b. Is done.
- FIG. 6 shows a functional block diagram in which the processing executed by the controller 25 according to the present embodiment is classified into a plurality of blocks from the functional side.
- the controller 25 calculates a target actuator speed calculation unit 100 that calculates a target speed (target actuator speed) of each hydraulic cylinder 11, 12, and 13, and calculates a solenoid valve drive signal based on the target actuator speed.
- Function as an actuator control unit 200 that outputs the electromagnetic valve drive signal to the corresponding electromagnetic valves 32, 33, 34, and 35.
- the target actuator speed calculation unit 100 is the operation device 7 (front member) obtained from the operation amount information obtained from the operation signals (voltage values) of the operation devices 24a-24c and the detection signals of the inclination sensors 13a-13d as the posture detection device 50. 8, 9, 10) and the posture information of the swing body 3, the position information (target surface information) of the target surface 60 defined based on the input from the target surface setting device 51, and the input from the inertia information setting device 41. Based on the inertia information of the front members 8, 9, 10 defined on the basis, the target speeds of the boom cylinder 11, arm cylinder 12, and bucket cylinder 13 are calculated as target actuator speeds.
- FIG. 7 is a functional block diagram of the target actuator speed calculation unit 100.
- the target actuator speed calculation unit 100 includes a control point position calculation unit 53, a target plane storage unit 54, a distance calculation unit 37, a target speed calculation unit 38, an actuator speed calculation unit 130, and a correction speed calculation unit 140. I have.
- the control point position calculation unit 53 calculates the position of the bucket tip P4, which is the control point of this embodiment in the global coordinate system, and the attitude of each front member 8, 9, 10 of the work device 7 in the global coordinate system.
- the calculation may be based on a known method. For example, first, from the navigation signals received by the first and second GNSS antennas 21 and 22, the origin P0 (see FIG. 2) of the local coordinate system (vehicle body reference coordinate system) is obtained. The coordinate values in the global coordinate system and the posture information / azimuth information of the traveling body 2 and the turning body 3 in the global coordinate system are calculated.
- the calculation result, information on the inclination angles ⁇ 1, ⁇ 2, ⁇ 3, ⁇ 4 from the work device attitude detection device 50, the coordinate value of the boom foot pin P1 in the local coordinate system, the boom length L1, and the arm length L2 And the bucket length L3 are used to calculate the position of the bucket tip P4, which is the control point of the present embodiment in the global coordinate system, and the posture of each front member 8, 9, 10 of the work device 7 in the global coordinate system.
- the coordinate value of the control point of the working device 7 may be measured by an external measurement device such as a laser survey meter and acquired by communication with the external measurement device.
- the target surface storage unit 54 stores position information (target surface data) in the global coordinate system of the target surface 60 calculated based on information from the target surface setting device 51 in the cab 4.
- position information target surface data
- the cross-sectional shape obtained by cutting the three-dimensional data of the target surface on the plane on which the front members 8, 9, and 10 of the work device 7 operate (operation plane of the working machine) is used as the target surface.
- 60 two-dimensional target surface
- the position information of the target surface 60 is obtained by communicating the position information of the target surface 60 around the excavator 1 by communication from an external server based on the position information of the control points of the work device 7 in the global coordinate system. You may memorize
- the distance calculation unit 37 calculates the control point of the work device 7 from the position information of the control point of the work device 7 calculated by the control point position calculation unit 53 and the position information of the target surface 60 acquired from the target surface storage unit 54. A distance D (see FIG. 2) from the target surface 60 is calculated.
- the target speed calculation unit 38 is configured to set the target speeds (boom target speed, arm) of the front members 8, 9, and 10 so that the operation range of the work device 7 is limited on and above the target surface 60 when the operating device 24 is operated. (Target speed, bucket target speed) is calculated according to the distance D. In the present embodiment, the following calculation is performed.
- the target speed calculation unit 38 calculates the required speed (boom cylinder required speed) to the boom cylinder 11 from the voltage value (boom operation amount) input from the operation lever 24a, and the voltage value input from the operation lever 24b.
- the required speed to the arm cylinder 12 (arm cylinder required speed) is calculated from the (arm operation amount), and the required speed to the bucket cylinder 13 (bucket cylinder required speed) from the voltage value (bucket operation amount) input from the operation lever 24c. ).
- the three required speed vectors are generated at the bucket tip P4 by the three cylinder required speeds.
- the sum of the three speed vectors is defined as a speed vector (requested speed vector) V0 of the working device 7 at the bucket tip P4. Then, the velocity component V0z in the target plane vertical direction and the velocity component V0x in the target plane horizontal direction of the velocity vector V0 are also calculated.
- FIG. 8 is a graph showing the relationship between the distance D between the bucket tip P4 and the target surface 60 and the speed correction coefficient k.
- the distance D when the bucket toe coordinate P4 (control point of the working device 7) is located above the target surface 60 is positive and the distance when the bucket tip coordinate P4 (the control point of the working device 7) is located below the target surface 60 is negative.
- a positive correction coefficient is output, and when the distance D is negative, a negative correction coefficient is output as a value of 1 or less.
- the velocity vector is positive in the direction approaching the target surface 60 from above the target surface 60.
- the target speed calculator 38 calculates the speed component V1z by multiplying the correction coefficient k determined according to the distance D by the speed component V0z in the target surface vertical direction of the speed vector V0.
- a synthesized velocity vector (target velocity vector) V1 is calculated by synthesizing this velocity component V1z and the velocity component V0x of the velocity vector V0 in the target plane horizontal direction. Then, in order to generate this combined speed vector V1 at the bucket tip P4 by the operation of the three hydraulic cylinders 11, 12, 13, the speed vector that the three hydraulic cylinders 11, 12, 13 should generate at the bucket tip P4 is 3 Calculation is made as the target speeds of the front members 8, 9, and 10 corresponding to the two hydraulic cylinders.
- the target speeds of the front members 8, 9, and 10 are speed vectors starting from the bucket tip P4. Specifically, the speed of the boom 8 driven by the boom cylinder 11 is generated at the bucket tip P4 ( The target speed (boom target speed) of the bucket tip speed), the target speed (arm target speed) generated by the operation of the arm 9 driven by the arm cylinder 12 at the bucket tip P4, and the bucket 10 driven by the bucket cylinder 13 is the bucket. There are three target speeds (bucket target speeds) generated at the tip P4.
- the target speed calculation unit 38 calculates the boom target speed, the arm target speed, and the bucket target speed from moment to moment, and sets the time series as a target speed signal for the front members 8, 9, and 10 as an actuator. The result is output to the speed calculation unit 130 and the corrected speed calculation unit 140.
- FIG. 9 is a schematic diagram showing velocity vectors before and after correction according to the distance D at the bucket tip P4.
- the arm cylinder required speed and the bucket cylinder required speed are respectively
- the speed vector generated at the bucket tip P4 is set as the arm target speed and the bucket target speed
- the sum of the arm target speed and the bucket target speed is subtracted from the combined speed vector V1
- the speed vector obtained thereby is set as the boom target speed.
- this calculation is only an example, and other calculation methods may be used as long as the resultant velocity vector V1 can be obtained as a result.
- the actuator speed calculation unit 130 is based on the target speeds (boom target speed, arm target speed, bucket target speed) of the front members 8, 9, 10 input from the target speed calculation unit 38 and the posture information from the posture detection device 50.
- the speed of each hydraulic cylinder 11, 12, 13 (boom cylinder speed, arm cylinder speed, bucket cylinder speed (actuator speed)) required for generating the target speed of the front members 8, 9, 10 is geometrically determined. Is calculated and output.
- the correction speed calculation unit 140 is based on attitude information from the attitude detection device 50, information on the target speed of the front members 8, 9, 10 from the target speed calculation unit 38, and inertia information from the inertia information setting device 41.
- correction speeds boost speed, arm cylinder correction
- the target actuator speed is calculated by adding the correction speed to the speed of each hydraulic cylinder 11, 12, 13 calculated by the actuator speed calculation unit 130, but the correction method is not limited to this.
- FIG. 10 is a functional block diagram of the correction speed calculation unit 140.
- the correction speed calculation unit 140 includes a signal separation unit 150, a high fluctuation target speed calculation part 143, a pre-correction target actuator speed calculation part 141a, a low fluctuation target actuator speed calculation part 141b, and a high fluctuation. And a target actuator speed calculation unit 141c.
- the signal separation unit 150 receives signals of target speeds (boom target speed, arm target speed, bucket target speed) of the three front members 8, 9, and 10 input from the target speed calculation unit 38 (see balloon A in FIG. 11). Are separated into a low frequency component (see balloon B in FIG. 11) having a frequency lower than a predetermined threshold (shielding frequency) and a high frequency component (see balloon C in FIG. 11) having a frequency higher than the threshold.
- the signal separation unit 150 of this embodiment includes a low-pass filter unit 142 that separates a low-frequency component from a target speed, and a high-frequency component separation unit (high-pass filter unit) 151 that separates a high-frequency component from the target speed.
- the shielding frequency can be determined in consideration of the response limit of the boom 8 and the arm 9 having a relatively large inertia load.
- the low-pass filter unit 142 passes a component (low frequency component) having a frequency lower than a predetermined threshold (shielding frequency) among signals of the target speed of the front members 8, 9, and 10 while having a frequency higher than the threshold.
- a predetermined threshold shielding frequency
- the low frequency component see balloon B in FIG. 11
- the separated low frequency components exist for each of the front members 8, 9, and 10 in the same manner as the target speed, and they are output to the high frequency component separation unit 151 and the low fluctuation target actuator speed calculation unit 141b.
- the high-frequency component separation unit 151 subtracts the low-frequency component from the low-pass filter unit 142 from the target speed signals of the three front members 8, 9, and 10 input from the target speed calculation unit 38, thereby remaining the front members 8 and 9 remaining. , 10 are output as high-frequency components (see balloon C in FIG. 11). This high frequency component is output to the high fluctuation target speed calculator 143.
- the high-frequency component separation unit 151 passes a component (high-frequency component) having a frequency higher than the threshold value (shielding frequency) of the low-pass filter unit 142 among the target speed signals of the front members 8, 9, and 10, while exceeding the threshold value.
- a high-pass filter that separates high-frequency components from each target speed signal by gradually decreasing low-frequency components may be used.
- the target speed component obtained by subtracting the low-frequency component output from the low-pass filter unit 142 from the target speed signal output from the target speed calculation unit 38 as in the present embodiment is a high-frequency component
- the signal separation unit 150 Since the sum of the low-frequency component and the high-frequency component output from can be maintained at the original target speed, it is possible to prevent the target speed from changing before and after passing through the signal separation unit 150.
- the high fluctuation target speed calculation unit 143 refers to the inertia information obtained from the inertia information setting device 41, and converts the high frequency component separated by the signal separation unit 150 to the relative load of the inertia among the three front members 8, 9, and 10. Therefore, the high fluctuation target speeds of the three front members are respectively calculated by preferentially assigning to the smaller front member.
- all the high frequency components are assigned to the bucket 10 having the smallest inertia load among the three front members 8, 9, and 10 (see the balloon D in FIG. 11), and the high fluctuation target speeds of the boom 8 and the arm 9 are assigned. Is zero.
- velocity components perpendicular to the target surface 60 are calculated for the target velocity defined by the high frequency components of the three front members 8, 9, and 10 separated by the signal separation unit 150, and the three vertical components are calculated.
- the sum of the speed components is set as the high fluctuation target speed of the bucket 10.
- the horizontal component V0x (right side in FIG. 9) of the combined speed vector V1 may change due to the speed correction of the correction speed calculation unit 140, but the vertical component V1z. (Right side of FIG. 9) is held. Therefore, the geometrical transformation of the velocity vector is facilitated while preventing the bucket tip P4 from entering the target surface 60 below.
- the pre-correction target actuator speed calculation unit 141a receives signals of the target speeds (boom target speed, arm target speed, bucket target speed) of the three front members 8, 9, and 10 input from the target speed calculation unit 38 and at that time. Using the geometrical transformation from the posture information, the speeds (actuator speeds) of the boom cylinder 11, the arm cylinder 12 and the bucket cylinder 13 necessary for generating the three target speeds (bucket tip speeds) are calculated. These actuator speeds have the same values as those output by the actuator speed calculation unit 130 and may be referred to as “target actuator speeds before correction”.
- the low fluctuation target actuator speed calculation unit 141b uses geometric conversion from the low frequency components of the target speed signals of the three front members 8, 9, and 10 input from the signal separation unit 150 and the posture information at that time. , The actuator speed required to generate the three low-frequency components, that is, the speed of the boom cylinder 11 (see the balloon E in FIG. 11), the speed of the arm cylinder 12 (see the balloon F in FIG. 11), and the bucket cylinder 13 Respectively (see the balloon G in FIG. 11). These actuator speeds may be referred to as “low fluctuation target actuator speeds”.
- the high fluctuation target actuator speed calculation unit 141c uses geometric conversion from the high frequency components of the target speed signals of the three front members 8, 9, and 10 input from the high fluctuation target speed calculation unit 143 and the posture information at that time. Then, the speeds (actuator speeds) of the boom cylinder 11, the arm cylinder 12 and the bucket cylinder 13 necessary for generating the three high-frequency components are calculated. These actuator speeds are sometimes referred to as “highly variable target actuator speeds”. However, in this embodiment, since the high frequency components of the target speed signals of the boom 8 and the arm 9 inputted from the high fluctuation target speed calculation unit 143 are zero as described above, the speed of the bucket cylinder 13 (as shown in FIG. Only the balloon H is calculated).
- the correction speed calculation unit 140 outputs the correction speed for each of the hydraulic cylinders 11, 12, and 13.
- the pre-correction target actuator speed calculated by the pre-correction target actuator speed calculation section 141a is calculated from the low fluctuation target actuator speed calculation section 141b.
- the subtraction is output.
- the bucket cylinder correction speed is obtained by adding the low fluctuation target actuator speed calculated by the low fluctuation target actuator speed calculation section 141b and the high fluctuation target actuator speed calculated by the high fluctuation target actuator speed calculation section 141c to the target before correction.
- a value obtained by subtracting the pre-correction target actuator speed calculated by the actuator speed calculation unit 141a is output.
- the corrected speed of each actuator thus obtained is added to the speed of each hydraulic cylinder 11, 12, 13 output from the actuator speed calculation unit 130 shown in FIG. (Boom cylinder speed, target arm cylinder speed, target bucket cylinder speed) are output to the actuator controller 200 (see FIG. 6). Since the calculated values of the actuator speed calculation unit 130 and the pre-correction target actuator speed calculation unit 141a are the same value, as a result, the target boom cylinder speed output from the target actuator speed calculation unit 100 is a low fluctuation target actuator speed (FIG. 11).
- the target arm cylinder speed is the low fluctuation target actuator speed (see balloon F in FIG. 11), and the target bucket cylinder speed is the speed obtained by adding the high fluctuation target actuator speed to the low fluctuation target actuator speed (FIG. 11). (See balloon I).
- the actuator control unit 200 calculates the target speed (target boom cylinder speed, target arm cylinder speed) of each hydraulic cylinder 11, 12, 13 when calculating the solenoid valve drive signal of the solenoid valves 32, 33, 34, 35. , Target bucket cylinder speed) and spool drive solenoid valves 35a, 35b, 32a, 32b, 33a, 33b, 34a, 34b for operating the spools 31, 28, 29, 30 corresponding to the respective hydraulic cylinders 11, 12, 13
- a table having a one-to-one correlation with the solenoid valve drive signal is used.
- the table includes a table for the boom spool drive electromagnetic valve 35a used when the boom cylinder 11 is extended, and a table for the boom spool drive electromagnetic valve 35b used when the arm cylinder 12 is shortened. is there. Further, as the two tables used when the arm cylinder 12 is extended, there are a table for the first arm spool drive electromagnetic valve 32a and a table for the second arm spool drive electromagnetic valve 33a. In addition, as two tables used when the arm cylinder 12 is contracted, there are a table for the first arm spool drive electromagnetic valve 32b and a table for the second arm spool drive electromagnetic valve 33b.
- the bucket spool drive electromagnetic valve 34a used when the bucket cylinder 13 is extended
- a table for the bucket spool drive electromagnetic valve 34b used when the bucket cylinder 13 is shortened.
- These eight tables are based on the relationship between the current values to the solenoid valves 35a, 35b, 32a, 32b, 33a, 33b, 34a, and 34b and the actual speeds of the hydraulic cylinders 11, 12, and 13 obtained in advance through experiments and simulations.
- the current value to the solenoid valves 35a, 35b, 32a, 32b, 33a, 33b, 34a, 34b monotonously increases as the target speed (target actuator speed) of each hydraulic cylinder 11, 12, 13 increases.
- the correlation between the target speed and the current value is defined.
- the actuator control unit 200 when there are commands for the target arm cylinder speed and the target boom cylinder speed, the actuator control unit 200 generates control commands for the electromagnetic valves 32, 33, and 35, and the first arm spool 28 and the second arm spool 29. And the boom spool 31 are driven. Thereby, the arm cylinder 12 and the boom cylinder 11 operate based on the target arm cylinder speed and the target boom cylinder speed.
- FIG. 12 is a flowchart showing a control flow by the controller 25.
- the controller 25 starts the processing of FIG. 12 when the operating device 24 is operated by the operator, and the control point position calculation unit 53 receives information on the inclination angles ⁇ 1, ⁇ 2, ⁇ 3, ⁇ 4, GNSS from the work device attitude detecting device 50.
- Global coordinates based on the position information, attitude information (angle information) and direction information of the hydraulic excavator 1 calculated from the navigation signals of the antennas 21 and 22 and the dimension information L1, L2, L3 of each front member stored in advance
- the position information of the bucket tip P4 (control point) in the system is calculated (procedure S1).
- step S2 the distance calculation unit 37 uses the position information of the bucket tip P4 in the global coordinate system calculated by the control point position calculation unit 53 (the position information of the excavator 1 may be used) as a reference range.
- the position information (target surface data) of the target surface included in is extracted and acquired from the target surface storage unit 54. Then, the target surface located closest to the bucket tip P4 is set as the target surface 60 to be controlled, that is, the target surface 60 for calculating the distance D.
- step S3 the distance calculation unit 37 calculates the distance D based on the position information of the bucket tip P4 calculated in step S1 and the position information of the target surface 60 set in step S2.
- step S4 the target speed calculation unit 38 operates the work device 7 based on the distance D calculated in step S3 and the operation amount (voltage value) of each operation lever input from the operation device 24.
- the target speeds of the front members 8, 9, and 10 are calculated so that the bucket tip P4 is held on or above the target surface 60.
- step S5 the actuator speed calculation unit 130 in step S4 based on the target speeds of the front members 8, 9, and 10 calculated in step S4 and the posture information of the work device 7 obtained from the posture detection device 50.
- the speeds (actuator speeds) of the boom cylinder 11, the arm cylinder 12 and the bucket cylinder 13 necessary for generating the calculated target speeds of the front members 8, 9, 10 are calculated.
- step S6 the pre-correction target actuator speed calculation unit 141a is based on the target speeds of the front members 8, 9, and 10 calculated in step S4 and the posture information of the working device 7 obtained from the posture detection device 50.
- the speeds (target actuator speeds before correction) of the boom cylinder 11, the arm cylinder 12 and the bucket cylinder 13 necessary for generating the target speeds of the front members 8, 9, and 10 calculated in step S4 are calculated.
- the target actuator speed before correction calculated here is the same value as the actuator speed calculated in step S5.
- the signal separation unit 150 separates the target speed signals of the front members 8, 9, and 10 calculated in step S4 into a high frequency component and a low frequency component.
- the target speed of the balloon A is a low frequency component (low fluctuation component) of the balloon B with relatively small speed fluctuation per time and a balloon with relatively large speed fluctuation per time. It is separated into C high frequency components (high fluctuation components).
- step S8 the low fluctuation target actuator speed calculation unit 141b obtains the low-frequency component of the target speed signal of each front member 8, 9, 10 separated in step S7, and the posture information of the work device 7 obtained from the posture detection device 50. Based on the above, the speeds of the boom cylinder 11, the arm cylinder 12 and the bucket cylinder 13 necessary for generating the low frequency components of the target speed signals of the front members 8, 9, 10 separated in step S7 (low fluctuation target Actuator speed) is calculated.
- step S9 the high fluctuation target speed calculation unit 143 calculates components perpendicular to the target surface 60 among the high frequency components of the target speed signals of the front members 8, 9, and 10 separated in step S7, and all of them are calculated. The sum is output as a high frequency component of the target speed signal of the bucket 10 to the high fluctuation target actuator speed calculation unit 141c.
- step S10 the highly variable target actuator speed calculation unit 141c performs step S9 based on the high-frequency component of the target speed signal of the bucket 10 calculated in step S9 and the posture information of the working device 7 obtained from the posture detection device 50.
- the speed of the bucket cylinder 13 (high fluctuation target actuator speed) necessary for generating the high frequency component of the target speed signal of the bucket 10 calculated in step S is calculated.
- the correction speed calculation unit 140 calculates the correction speeds of the actuators 11, 12, and 13.
- the correction speeds of the actuators 11, 12, and 13 are changed from those obtained by adding the high fluctuation target actuator speed (procedure S9) to the low fluctuation target actuator speed (procedure S8) as shown in FIG.
- the target actuator speed (procedure S6) is subtracted. This is calculated for each of the actuators 11, 12, and 13 to obtain a correction speed.
- the correction speed calculation unit 140 calculates the boom cylinder speed (step S6) calculated by the pre-correction target actuator speed calculation unit 141a from the boom cylinder speed (step S8) calculated by the low fluctuation target actuator speed calculation unit 141b.
- the reduced value is output as the boom cylinder correction speed.
- the value obtained by subtracting the arm cylinder speed (step S6) calculated by the target actuator speed calculation unit 141a before correction from the arm cylinder speed (step S8) calculated by the low fluctuation target actuator speed calculation unit 141b is output as the arm cylinder correction speed.
- the target actuator speed before correction is calculated by adding the bucket cylinder speed (step S9) calculated by the high fluctuation target actuator speed calculation unit 141c to the bucket cylinder speed (step S8) calculated by the low fluctuation target actuator speed calculation unit 141b.
- a value obtained by subtracting the bucket cylinder speed (procedure S6) calculated by the unit 141a is output as the bucket cylinder correction speed.
- the target actuator speed calculation unit 100 calculates target speeds (target actuator speeds) of the actuators 11, 12, and 13.
- the target speeds of the actuators 11, 12, and 13 are set to the speeds of the actuators 11, 12, and 13 calculated in step S5. It is assumed that 13 correction speeds are added. Since the speeds of the actuators 11, 12, and 13 calculated in step S5 are the same value as the target actuator speeds before correction calculated in step S6, the target speeds of the actuators 11, 12, and 13 are consequently low fluctuation target actuator speeds.
- the high fluctuation target actuator speed (procedure S9) calculated by the high fluctuation target actuator speed calculation section 141c is added to the low fluctuation target actuator speed (procedure S8) calculated by the calculation section 141b.
- the target actuator speed calculation unit 100 outputs the boom cylinder speed (step S8) calculated by the low fluctuation target actuator speed calculation unit 141b as the boom cylinder target speed. Further, the arm cylinder speed (step S8) calculated by the low fluctuation target actuator speed calculation unit 141b is output as the arm cylinder delusion speed. Further, the bucket cylinder speed (procedure S9) calculated by the high fluctuation target actuator speed calculator 141c is added to the bucket cylinder speed (procedure S8) calculated by the low fluctuation target actuator speed calculator 141b and output as the bucket cylinder target speed. To do.
- step S13 the actuator control unit 200 calculates a signal for driving the second flow control valve (boom spool) 31 based on the boom cylinder target speed, and outputs the signal to the electromagnetic valve 31a or the electromagnetic valve 31b.
- a signal for driving the first flow rate control valve (first arm spool) 28 and the third flow rate control valve (second arm spool) 29 is calculated based on the arm cylinder target speed, and the signal is converted to the electromagnetic valve 32a and Output to the electromagnetic valve 33a or the electromagnetic valve 32b and the electromagnetic valve 33b.
- a signal for driving the flow control valve (bucket spool) 30 is calculated based on the bucket cylinder target speed, and the signal is output to the electromagnetic valve 34a or the electromagnetic valve 34b.
- step S13 When the process of step S13 is completed, it is confirmed that the operation of the controller device 24 is continued, and the process returns to step S1 and the processes after step S1 are repeated. If the operation of the operation device 24 is completed even in the middle of the flow of FIG. 12, the process is terminated and the process waits until the next operation of the operation device 24 is started.
- the boom 8 and the arm 9 operate according to the target speed signal (low frequency component shown in the balloon B in FIG. 11) with small fluctuations per time, and the target of the boom 8 and the arm 9 is detected.
- the target speed signal (high-frequency component shown in the balloon C in FIG. 11) with large fluctuation per time excluded from the speed signal is added to the target speed signal of the bucket 10 and converted into the operation of the bucket 10. Since the bucket 10 has a relatively small inertial load compared to the boom 8 and the arm 9, it can quickly respond to a target speed signal having a large fluctuation per time.
- the target of each front member 8, 9, 10 is set. Even when the change in the speed signal per time is large enough to exceed the response of the boom 8 or arm 9 with a relatively large inertial load, the operation of the bucket 10 with a relatively small inertial load is used for that amount. To be compensated. As a result, at least the vertical component of the actual velocity vector at the tip of the bucket can be made to coincide with the target velocity, so that the semi-automatic excavation molding control can be performed stably and accurately.
- the high-frequency component of the target speed signal separated by the signal separation unit 150 is assigned only to the bucket 10, but may be assigned only to the arm 9 instead of the bucket 10.
- this case will be described as a second embodiment of the present invention.
- description is abbreviate
- FIG. 13 is a functional block diagram of the correction speed calculation unit 140 in the second embodiment.
- the correction speed calculation unit 140 has the same configuration as that of the first embodiment.
- the high fluctuation target speed calculation unit 143 assigns all high frequency components to the arm 9 among the three front members 8, 9, and 10, and the high fluctuation target speed of the boom 8 and the bucket 10 is zero. It is said.
- the velocity components perpendicular to the target surface 60 are calculated for the target velocity defined by the high frequency components of the three front members 8, 9, 10 separated by the signal separation unit 150, and the three The sum of the vertical velocity components is used as the high fluctuation target velocity of the arm 9.
- the bucket 10 even when the operator is not operating the bucket 10, if a high-frequency component is generated in the target speed signal, the bucket 10 may be operated by the semi-automatic excavation control, and the operator may feel uncomfortable. .
- the high frequency component generated in the target speed signal is assigned to the arm 9, the bucket 10 does not operate unless the bucket 10 is operated. Therefore, it is possible to prevent the front member (bucket 10) that is not operated by the operator from being operated by the semi-automatic excavation control, and the uncomfortable feeling given to the operator can be alleviated.
- the inertia load of the arm 9 is smaller than that of the boom 8, it is possible to perform semi-automatic excavation stably and accurately even when the target speed signal varies greatly per hour.
- the high-frequency component of the target speed signal separated by the signal separation unit 150 is assigned to either the bucket 10 or the arm 9.
- the high-frequency component of the target speed signal is distributed to each front member 8, 9, 10 at an appropriate ratio (distribution ratio) determined in consideration of the inertia load of each front member 8, 9, 10. Thus, it is added to the low fluctuation target actuator speed of the boom 8, the arm 9 and the bucket 10.
- FIG. 14 is a functional block diagram of the correction speed calculation unit 140 in the third embodiment.
- the high fluctuation target speed calculation unit 143 of the present embodiment preferentially assigns the high frequency component separated by the signal separation unit 150 to a front member having a relatively small inertia load among the three front members 8, 9, and 10.
- the high fluctuation target speeds of the three front members 8, 9, 10 are respectively calculated.
- the high-frequency component of the target speed signal is distributed to each front member 8, 9, 10 at a ratio determined in consideration of the inertia load of each front member 8, 9, 10.
- the inertia loads of the boom 8, the arm 9, and the bucket 10 are reduced in this order. Therefore, it is preferable to increase the distribution ratio in this order from the viewpoint of ensuring responsiveness.
- the distribution ratio can be obtained by quantifying the inertia loads of the boom 8, the arm 9 and the bucket 10 based on the inertia information, and using the reciprocal ratio (that is, the inverse ratio) of the numerical values. Also good.
- a configuration in which the distribution ratio is corrected according to the posture information of each front member 8, 9, 10 may be used.
- the output of the high variation target actuator speed calculation unit 141c is added to all three outputs from the low variation target actuator speed calculation unit 141b. That is, all three outputs from the correction speed calculation unit 140 are obtained by calculating the output of the pre-correction target actuator speed calculation unit 141a from the sum of the output of the low fluctuation target actuator speed calculation unit 141b and the output of the high fluctuation target actuator speed calculation unit 141c. It has been reduced.
- the highly variable target actuator speed is applied not only to the bucket 10 and the arm 9 but also to the front members 8, 9, 10 according to the distribution ratio determined based on the inertia information. For example, when the high fluctuation target speed is excessive and exceeds the maximum operating speed of the bucket 10, the remainder can be dealt with by allocating it to the arm 9. And even if it distributes to the bucket 10 and the arm 9, if it cannot cover, the boom 8 can be partly borne. This makes it possible to perform semi-automatic excavation stably and accurately even when the high fluctuation target speed is excessive.
- the arm 9 and the bucket 10 have postures in which straight lines connecting the respective rotation shafts and the bucket tip P 4 are perpendicular to the target surface 60 (in this paper, such postures are used). (Referred to as “unique posture”).
- FIG. 15 is an explanatory diagram of a situation where the bucket 10 takes a peculiar posture
- FIG. 16 is an explanatory diagram of a situation where the arm 9 takes a peculiar posture.
- FIG. 17 is a functional block diagram of the correction speed calculation unit 140 in the fourth embodiment. This embodiment corresponds to a configuration in which an attitude determination unit 144 is added to the third embodiment and an output thereof is input to the low-pass filter unit 142.
- the posture determination unit 144 determines whether or not a first straight line L1 (see FIG. 16) connecting the bucket tip and the rotation center of the arm 9 on the operation plane of the work device 7 is orthogonal to the target surface 60. Based on the posture information of the working device 7 and the position information of the target surface, whether or not the second straight line L2 (see FIG. 15) connecting the bucket tip and the rotation center of the bucket 10 on the operation plane is orthogonal to the target surface 60. The determination result is output to the low-pass filter unit 142. Specifically, when it is determined that one of the first straight line L1 and the second straight line L2 is orthogonal to the target surface 60, the posture determination unit 144 outputs a reset signal.
- a first straight line L1 see FIG. 16
- the low-pass filter unit 142 (signal separation unit 150) is determined when the posture determination unit 144 determines that one of the first straight line L1 and the second straight line L2 is orthogonal to the target plane 60 (that is, when a reset signal is output). ), The process of separating the target speed signals of the three front members 8, 9, 10 into a low frequency component having a frequency lower than the threshold value (shielding frequency) and a high frequency component having a frequency higher than the threshold value, respectively, The target speed signals of the three front members 8, 9, and 10 are output as they are to the low fluctuation target actuator speed calculator 141b. That is, when the reset signal is input from the posture determination unit 144, the low-pass filter unit 142 temporarily stops the function of the filter, and the target speed signals of the front members 8, 9, and 10 input from the target speed calculation unit 38 are used as they are. Output.
- the corrected speed calculation unit 140 When the corrected speed calculation unit 140 is configured as described above, when either one of the arm 9 and the bucket 10 is in a specific posture, the high-frequency component output from the signal separation unit 150 to the high fluctuation target speed calculation unit 143 is reduced. Since the output of the pre-correction target actuator speed calculation unit 141a and the output of the low fluctuation target actuator speed calculation unit 141b always match, the correction speed output from the correction speed calculation unit 140 is all zero as a result. Become. That is, the conventional semi-automatic excavation control is performed by the output of only the actuator speed calculation unit 130. Therefore, according to the present embodiment, it is possible to prevent an unstable operation from occurring in the semi-automatic excavation control when either one of the arm 9 and the bucket 10 takes a peculiar posture.
- FIG. 18 is a functional block diagram of the correction speed calculation unit 140 in the fifth embodiment. This embodiment corresponds to a configuration in which an attitude determination unit 144 is added to the third embodiment and an output thereof is input to the high fluctuation target speed calculation unit 143.
- the posture determination unit 144 performs the same determination as that of the fourth embodiment, and outputs the determination result to the low-pass filter unit 142. Specifically, when it is determined that one of the first straight line L1 and the second straight line L2 is orthogonal to the target surface 60, the posture determination unit 144 outputs a reset signal.
- the reset signal of the present embodiment includes information indicating which front member of the arm 9 and the bucket 10 has a specific posture.
- the high fluctuation target speed calculation unit 143 sets the target speed signals of the boom 8, arm 9, and bucket 10 separated by the signal separation unit 150.
- the arm 9 and the bucket 10 are distributed to the front members excluding the arm 9 (ie, the boom 8 and the bucket 10) to calculate the high fluctuation target speeds of the boom 8, the arm 9 and the bucket 10, respectively. .
- the posture determination unit 144 determines that the second straight line L2 is orthogonal to the target surface 60
- the high-frequency components of the target speed signals of the boom 8, the arm 9, and the bucket 10 separated by the signal separation unit 150 are The arm 9 and the bucket 10 are distributed to the front members excluding the bucket 10 (that is, the boom 8 and the arm 9), and the high fluctuation target speeds of the boom 8, the arm 9 and the bucket 10 are calculated.
- the distribution ratio to the boom 8 may be zero from the viewpoint of inertial load.
- the high fluctuation target speed is calculated by distributing the high frequency component only to the boom 8.
- the correction speed calculation unit 140 is configured in this way, when the arm 9 or the bucket 10 takes a singular posture, the high fluctuation target speed of the front member taking the singular posture is always zero, and the target before correction Since the output of the actuator speed calculation unit 141a and the output of the low fluctuation target actuator speed calculation unit 141b always match, the correction speed related to the actuator of the front member output from the correction speed calculation unit 140 is zero as a result. That is, the conventional semi-automatic excavation control is performed on the front member taking a specific posture by the output of only the actuator speed calculation unit 130. Therefore, according to the present embodiment, it is possible to prevent an unstable operation from occurring in the semi-automatic excavation control when the arm 9 or the bucket 10 is in a specific posture.
- the high fluctuation target actuator speed for all front members are set to zero when the reset signal is output, the high fluctuation target actuator speed is not applied to the front member that does not take a specific posture in this embodiment. Therefore, semi-automatic excavation with higher accuracy than that of the fourth embodiment can be stably performed.
- the present invention is not limited to the above-described embodiment, and includes various modifications within the scope not departing from the gist of the present invention.
- the present invention is not limited to the one having all the configurations described in the above embodiments, and includes a configuration in which a part of the configuration is deleted.
- part of the configuration according to one embodiment can be added to or replaced with the configuration according to another embodiment.
- the actuator speed calculation unit 130 and the correction speed calculation unit 140 are different calculation parts, but they may be integrated into one calculation part having an equivalent function.
- the actuator speed calculation unit 130 and the pre-correction target actuator speed calculation unit 141a are provided.
- the target speeds of the actuators 11, 12, and 13 are low fluctuations. This is the sum of the target actuator speed and the highly variable target actuator speed. Therefore, the actuator speed calculator 130 and the pre-correction target actuator speed calculator 141a are omitted, and the sum of the output of the low fluctuation target actuator speed calculator 141b and the output of the high fluctuation target actuator speed calculator 141c is used as the target actuator speed.
- the controller 25 may be configured to output to the control unit 200.
- Each configuration related to the controller 25 and the functions and execution processes of the respective configurations may be realized by hardware (for example, logic for executing each function is designed by an integrated circuit). good.
- the configuration related to the controller 25 may be a program (software) that realizes each function related to the configuration of the controller 25 by being read and executed by an arithmetic processing device (for example, a CPU).
- Information related to the program can be stored in, for example, a semiconductor memory (flash memory, SSD, etc.), a magnetic storage device (hard disk drive, etc.), a recording medium (magnetic disk, optical disc, etc.), and the like.
- SYMBOLS 1 Hydraulic excavator (work machine), 2 ... Running body, 3 ... Revolving body, 4 ... Driver's cab, 5 ... Machine room, 6 ... Counterweight, 7 ... Working device, 8 ... Boom, 9 ... Arm, 10 ... Bucket , 11 ... boom cylinder, 12 ... arm cylinder, 13 ... bucket cylinder, 14 ... first hydraulic pump, 15 ... second hydraulic pump, 16 ... engine (prime mover), 17 ... vehicle body tilt sensor, 18 ... boom tilt sensor, 19 DESCRIPTION OF SYMBOLS ... Arm inclination sensor, 20 ... Bucket inclination sensor, 21 ... 1st GNSS antenna, 22 ...
- 2nd GNSS antenna 23 ... Vehicle body control system, 24 ... Operation apparatus, 25 ... Controller, 26 ... Flow control valve apparatus, 27 ... Hydraulic circuit, 28 ... first arm spool (first flow control valve), 29 ... second arm spool (third flow control valve), 30 ... bucket spool, 31 ... boo Spool (second flow control valve), 32a, 32b ... first arm spool drive solenoid valve, 33a, 33b ... second arm spool drive solenoid valve, 34a, 34b ... bucket spool drive solenoid valve, 35a, 35b ... boom spool drive Solenoid valve, 36a, 36b ... hydraulic oil tank, 37 ... distance calculation unit, 38 ...
- target speed calculation unit 41 ... inertia information setting device, 42 ... second boom spool (fourth flow rate control valve), 43a, 43b ... first 2-boom spool drive solenoid valve, 44 ... hydraulic oil tank, 50 ... work device attitude detection device, 51 ... target surface setting device, 53 ... control point position calculation unit, 54 ... target surface storage unit, 60 ... target surface, 100 ... Target actuator speed calculation unit, 130 ... Actuator speed calculation unit, 140 ... Correction speed calculation unit, 141a ...
- Pre-correction target actuator speed calculation unit 14 b: Low fluctuation target actuator speed calculation section, 141c: High fluctuation target actuator speed calculation section, 142: Low pass filter section, 143: High fluctuation target speed calculation section, 144: Attitude determination section, 150 ... Signal separation section, 151: High frequency Component separation unit, 200 ... Actuator control unit
Landscapes
- Engineering & Computer Science (AREA)
- General Engineering & Computer Science (AREA)
- Mining & Mineral Resources (AREA)
- Civil Engineering (AREA)
- Structural Engineering (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Fluid Mechanics (AREA)
- Chemical & Material Sciences (AREA)
- Analytical Chemistry (AREA)
- Life Sciences & Earth Sciences (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Paleontology (AREA)
- Operation Control Of Excavators (AREA)
Abstract
Description
図1は本発明の実施形態に係る作業機械の一例である油圧ショベル1の側面図である。油圧ショベル1は,左右側部のそれぞれに設けられる履帯を油圧モータ(図示せず)により駆動させて走行する走行体(下部走行体)2と,走行体2上に旋回可能に設けられる旋回体(上部旋回体)3とを備えている。
上記の第1実施形態では,信号分離部150で分離された目標速度信号の高周波成分をバケット10のみに割り当てたが,バケット10に代えてアーム9のみに割り当てても良い。ここではこの場合を本発明の第2実施形態として説明する。なお,先の実施形態と同じ部分については説明を省略する(後の実施形態でも同様とする)。
上記の2つの実施形態では,信号分離部150で分離された目標速度信号の高周波成分をバケット10とアーム9のいずれか一方に割り当てた。しかし,本実施形態では,目標速度信号の高周波成分を各フロント部材8,9,10の慣性負荷を考慮して決定した適当な比率(分配比率)で各フロント部材8,9,10に分配して,ブーム8,アーム9,バケット10の低変動目標アクチュエータ速度に加算するようにしている。
3つのフロント部材8,9,10のうちアーム9やバケット10には,それぞれの回動軸とバケット先端P4を繋ぐ直線が目標面60に対して垂直となる姿勢(本稿ではこのような姿勢を「特異姿勢」と称する)をとる可能性がある。図15はバケット10が特異姿勢をとっている状況の説明図であり,図16はアーム9が特異姿勢をとっている状況の説明図である。アーム9やバケット10が特異姿勢をとった場合,そのフロント部材9,10に係る油圧シリンダ12,13が動作しても,バケット先端P4に垂直速度成分を発生させることができない。このような状況にあるフロント部材9,10に高変動速度を割り当てると,動作不可能な指令が油圧シリンダ12,13に与えられることになり不安定な動作を招き得る。そこで本実施形態ではアーム9とバケット10の少なくとも一方が特異姿勢をとった場合には目標速度の配分の実施を中断することとした。
図18は第5実施形態における補正速度演算部140の機能ブロック図である。本実施形態は,第3実施形態に姿勢判定部144を追加し,その出力を高変動目標速度演算部143に入力したものに相当する。
本発明は,上記の実施の形態に限定されるものではなく,その要旨を逸脱しない範囲内の様々な変形例が含まれる。例えば,本発明は,上記の実施の形態で説明した全ての構成を備えるものに限定されず,その構成の一部を削除したものも含まれる。また,ある実施の形態に係る構成の一部を,他の実施の形態に係る構成に追加又は置換することが可能である。
Claims (6)
- 複数のフロント部材を有する作業装置と,
前記複数のフロント部材を駆動する複数の油圧アクチュエータと,
オペレータの操作に応じて前記複数の油圧アクチュエータの動作を指示する操作装置と,
前記操作装置の操作時に前記作業装置が所定の目標面の上方に制限されるように,前記複数のフロント部材の目標速度をそれぞれ演算する目標速度演算部を有するコントローラとを備える作業機械において,
前記コントローラは,
前記複数のフロント部材の目標速度の信号をそれぞれ所定の閾値より周波数の低い低周波成分と前記閾値より周波数の高い高周波成分に分離する信号分離部と,
前記信号分離部で分離された前記高周波成分を前記複数のフロント部材のうち慣性負荷が相対的に小さいフロント部材に優先的に割り当てて前記複数のフロント部材の高変動目標速度をそれぞれ演算する高変動目標速度演算部と,
前記高変動目標速度演算部で演算された前記複数のフロント部材の高変動目標速度と前記複数のフロント部材の姿勢情報に基づいて,前記複数のアクチュエータの高変動目標速度をそれぞれ演算する高変動目標アクチュエータ速度演算部と,
前記信号分離部で分離された前記低周波成分と前記複数のフロント部材の姿勢情報に基づいて,前記複数のアクチュエータの低変動目標速度をそれぞれ演算する低変動目標アクチュエータ速度演算部と,
前記高変動目標アクチュエータ速度演算部の演算結果と前記低変動目標アクチュエータ速度演算部の演算結果を前記複数のアクチュエータごとに加算した値に基づいて前記複数のアクチュエータをそれぞれ制御するアクチュエータ制御部とを備えることを特徴とする作業機械。 - 請求項1の作業機械において,
前記作業装置は,ブーム,アーム及び作業具を有し,
前記高変動目標速度演算部は,前記信号分離部で分離された前記ブーム,アーム及び作業具の目標速度の高周波成分を前記作業具のみに割り当てて前記ブーム,アーム及び作業具の高変動目標速度をそれぞれ演算することを特徴とする作業機械。 - 請求項1の作業機械において,
前記作業装置は,ブーム,アーム及び作業具を有し,
前記高変動目標速度演算部は,前記信号分離部で分離された前記ブーム,アーム及び作業具の目標速度の高周波成分を前記アームのみに割り当てて前記ブーム,アーム及び作業具の高変動目標速度をそれぞれ演算することを特徴とする作業機械。 - 請求項1の作業機械において,
前記作業装置は,ブーム,アーム及び作業具を有し,
前記コントローラは,前記作業装置の動作平面上で前記作業具の先端と前記アームの回動中心を結ぶ第1直線が前記目標面と直交するか否かと,前記作業装置の動作平面上で前記作業具の先端と前記作業具の回動中心を結ぶ第2直線が前記目標面と直交するか否かを前記作業装置の姿勢情報に基づいて判定する姿勢判定部を備え,
前記信号分離部は,前記姿勢判定部により前記第1直線及び前記第2直線のいずれか一方が前記目標面と直交すると判定された場合,前記複数のフロント部材の目標速度の信号をそれぞれ前記閾値より周波数の低い低周波成分と前記閾値より周波数の高い高周波成分に分離する処理を実行せず,前記複数のフロント部材の目標速度の信号をそのまま前記低変動目標アクチュエータ速度演算部に出力することを特徴とする作業機械。 - 請求項1の作業機械において,
前記作業装置は,ブーム,アーム及び作業具を有し,
前記コントローラは,前記作業装置の動作平面上で前記作業具の先端と前記アームの回動中心を結ぶ第1直線が前記目標面と直交するか否かと,前記作業装置の動作平面上で前記作業具の先端と前記作業具の回動中心を結ぶ第2直線が前記目標面と直交するか否かを前記作業装置の姿勢情報に基づいて判定する姿勢判定部を備え,
前記高変動目標速度演算部は,
前記姿勢判定部により前記第1直線が前記目標面と直交すると判定された場合,前記信号分離部で分離された前記ブーム,アーム及び作業具の目標速度の高周波成分を前記複数のフロント部材のうち前記アームを除くフロント部材に分配して前記ブーム,アーム及び作業具の高変動目標速度をそれぞれ演算し,
前記姿勢判定部により前記第2直線が前記目標面と直交すると判定された場合,前記信号分離部で分離された前記ブーム,アーム及び作業具の目標速度の高周波成分を前記複数のフロント部材のうち前記作業具を除くフロント部材に分配して前記ブーム,アーム及び作業具の高変動目標速度をそれぞれ演算することを特徴とする作業機械。 - 請求項1の作業機械において,
前記高変動目標速度演算部は,
前記信号分離部で分離された前記高周波成分のうち前記目標面に垂直な成分の合計を算出し,その合計を前記複数のフロント部材のうち慣性負荷が相対的に小さいフロント部材に優先的に分配して前記複数のフロント部材の高変動目標速度をそれぞれ演算することを特徴とする作業機械。
Priority Applications (6)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
EP18908276.1A EP3770332B1 (en) | 2018-03-22 | 2018-03-22 | Working machine |
CN201880013906.3A CN110520575B (zh) | 2018-03-22 | 2018-03-22 | 作业机械 |
JP2019546415A JP6731557B2 (ja) | 2018-03-22 | 2018-03-22 | 作業機械 |
US16/492,363 US11384509B2 (en) | 2018-03-22 | 2018-03-22 | Work machine |
PCT/JP2018/011513 WO2019180894A1 (ja) | 2018-03-22 | 2018-03-22 | 作業機械 |
KR1020197024499A KR102225940B1 (ko) | 2018-03-22 | 2018-03-22 | 작업 기계 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2018/011513 WO2019180894A1 (ja) | 2018-03-22 | 2018-03-22 | 作業機械 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2019180894A1 true WO2019180894A1 (ja) | 2019-09-26 |
Family
ID=67988416
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2018/011513 WO2019180894A1 (ja) | 2018-03-22 | 2018-03-22 | 作業機械 |
Country Status (6)
Country | Link |
---|---|
US (1) | US11384509B2 (ja) |
EP (1) | EP3770332B1 (ja) |
JP (1) | JP6731557B2 (ja) |
KR (1) | KR102225940B1 (ja) |
CN (1) | CN110520575B (ja) |
WO (1) | WO2019180894A1 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2021121717A (ja) * | 2020-01-31 | 2021-08-26 | 国立大学法人広島大学 | 位置制御装置及び位置制御方法 |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7141899B2 (ja) * | 2018-09-13 | 2022-09-26 | 日立建機株式会社 | 作業機械 |
CN111761574B (zh) * | 2020-05-28 | 2022-08-02 | 中联重科股份有限公司 | 判断臂架可进行的操作的安全性的方法和装置及工程机械 |
KR20230032293A (ko) * | 2021-08-30 | 2023-03-07 | 볼보 컨스트럭션 이큅먼트 에이비 | 건설기계 |
KR20230033461A (ko) * | 2021-09-01 | 2023-03-08 | 볼보 컨스트럭션 이큅먼트 에이비 | 건설기계 |
KR20230061909A (ko) * | 2021-10-29 | 2023-05-09 | 볼보 컨스트럭션 이큅먼트 에이비 | 건설기계 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0380310A (ja) * | 1989-08-23 | 1991-04-05 | Fujitsu Ltd | マニピュレータ制御装置 |
JPH05321297A (ja) * | 1992-05-21 | 1993-12-07 | Hitachi Constr Mach Co Ltd | 油圧作業機械における作業装置の振動抑制制御装置 |
JP2011224694A (ja) * | 2010-04-19 | 2011-11-10 | Panasonic Corp | 多関節型ロボットの速度指令プロファイルの生成方法 |
JP2012172382A (ja) * | 2011-02-21 | 2012-09-10 | Sumitomo Heavy Ind Ltd | 掘削機 |
WO2012127912A1 (ja) | 2011-03-24 | 2012-09-27 | 株式会社小松製作所 | 作業機制御システム、建設機械及び作業機制御方法 |
WO2015181990A1 (ja) * | 2014-05-30 | 2015-12-03 | 株式会社小松製作所 | 作業機械の制御システム、作業機械、油圧ショベルの制御システム及び作業機械の制御方法 |
Family Cites Families (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0707118B1 (en) * | 1994-04-28 | 1999-07-28 | Hitachi Construction Machinery Co., Ltd. | Aera limiting digging control device for a building machine |
KR0173835B1 (ko) * | 1994-06-01 | 1999-02-18 | 오까다 하지모 | 건설기계의 영역제한 굴삭제어장치 |
JP3306301B2 (ja) * | 1996-06-26 | 2002-07-24 | 日立建機株式会社 | 建設機械のフロント制御装置 |
JP3868112B2 (ja) * | 1998-05-22 | 2007-01-17 | 株式会社小松製作所 | 油圧駆動機械の制御装置 |
JP2010101095A (ja) * | 2008-10-24 | 2010-05-06 | Kobelco Contstruction Machinery Ltd | 作業機械の油圧制御装置 |
JP5341134B2 (ja) * | 2011-05-25 | 2013-11-13 | 日立建機株式会社 | 油圧作業機械 |
US9348327B2 (en) * | 2011-06-10 | 2016-05-24 | Hitachi Construction Machinery Co., Ltd. | Work machine |
JP5752531B2 (ja) * | 2011-08-31 | 2015-07-22 | 日立建機株式会社 | 建設機械 |
JP6053714B2 (ja) * | 2014-03-31 | 2016-12-27 | 日立建機株式会社 | 油圧ショベル |
CN105517645B (zh) * | 2014-05-19 | 2019-05-03 | 株式会社小松制作所 | 作业机械及液压挖掘机的姿势运算装置以及作业机械 |
KR101751164B1 (ko) * | 2014-05-30 | 2017-06-26 | 가부시키가이샤 고마쓰 세이사쿠쇼 | 작업 기계의 제어 시스템, 작업 기계 및 작업 기계의 제어 방법 |
DE112014000134B4 (de) * | 2014-06-04 | 2016-09-22 | Komatsu Ltd. | Stellungsberechnungsvorrichtung für eine Arbeitsmaschine, Arbeitsmaschine und Stellungsberechnungsverfahren für eine Arbeitsmaschine |
US9834905B2 (en) * | 2015-09-25 | 2017-12-05 | Komatsu Ltd. | Work machine control device, work machine, and work machine control method |
US10787788B2 (en) * | 2017-07-14 | 2020-09-29 | Komatsu Ltd. | Work machine and control method for work machine |
-
2018
- 2018-03-22 WO PCT/JP2018/011513 patent/WO2019180894A1/ja active Application Filing
- 2018-03-22 US US16/492,363 patent/US11384509B2/en active Active
- 2018-03-22 EP EP18908276.1A patent/EP3770332B1/en active Active
- 2018-03-22 JP JP2019546415A patent/JP6731557B2/ja active Active
- 2018-03-22 CN CN201880013906.3A patent/CN110520575B/zh active Active
- 2018-03-22 KR KR1020197024499A patent/KR102225940B1/ko active IP Right Grant
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0380310A (ja) * | 1989-08-23 | 1991-04-05 | Fujitsu Ltd | マニピュレータ制御装置 |
JPH05321297A (ja) * | 1992-05-21 | 1993-12-07 | Hitachi Constr Mach Co Ltd | 油圧作業機械における作業装置の振動抑制制御装置 |
JP2011224694A (ja) * | 2010-04-19 | 2011-11-10 | Panasonic Corp | 多関節型ロボットの速度指令プロファイルの生成方法 |
JP2012172382A (ja) * | 2011-02-21 | 2012-09-10 | Sumitomo Heavy Ind Ltd | 掘削機 |
WO2012127912A1 (ja) | 2011-03-24 | 2012-09-27 | 株式会社小松製作所 | 作業機制御システム、建設機械及び作業機制御方法 |
WO2015181990A1 (ja) * | 2014-05-30 | 2015-12-03 | 株式会社小松製作所 | 作業機械の制御システム、作業機械、油圧ショベルの制御システム及び作業機械の制御方法 |
Non-Patent Citations (1)
Title |
---|
See also references of EP3770332A4 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2021121717A (ja) * | 2020-01-31 | 2021-08-26 | 国立大学法人広島大学 | 位置制御装置及び位置制御方法 |
JP7313633B2 (ja) | 2020-01-31 | 2023-07-25 | 国立大学法人広島大学 | 位置制御装置及び位置制御方法 |
Also Published As
Publication number | Publication date |
---|---|
JPWO2019180894A1 (ja) | 2020-04-30 |
CN110520575A (zh) | 2019-11-29 |
EP3770332A1 (en) | 2021-01-27 |
EP3770332A4 (en) | 2021-12-01 |
US20200232186A1 (en) | 2020-07-23 |
KR102225940B1 (ko) | 2021-03-10 |
EP3770332B1 (en) | 2024-01-03 |
US11384509B2 (en) | 2022-07-12 |
JP6731557B2 (ja) | 2020-07-29 |
CN110520575B (zh) | 2021-11-02 |
KR20190112024A (ko) | 2019-10-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2019180894A1 (ja) | 作業機械 | |
US10401176B2 (en) | System and method for determining machine state using sensor fusion | |
US10521703B2 (en) | System and method for controlling machine pose using sensor fusion | |
CN109757113B (zh) | 作业机械 | |
KR102024701B1 (ko) | 작업 기계 | |
US11530920B2 (en) | Controlling movement of a machine using sensor fusion | |
WO2018008188A1 (ja) | 作業機械 | |
US10459462B2 (en) | Sensor fusion feedback for controlling fluid pressures in a machine | |
JPWO2018051511A1 (ja) | 作業機械 | |
JP6817457B2 (ja) | 作業機械 | |
EP3845714B1 (en) | Work machinery | |
KR102588223B1 (ko) | 작업 기계 | |
WO2018101319A1 (ja) | 作業機制御装置および作業機械 | |
KR20210114024A (ko) | 작업 기계 | |
JP7269301B2 (ja) | 作業機械 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
ENP | Entry into the national phase |
Ref document number: 20197024499 Country of ref document: KR Kind code of ref document: A |
|
ENP | Entry into the national phase |
Ref document number: 2019546415 Country of ref document: JP Kind code of ref document: A |
|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 18908276 Country of ref document: EP Kind code of ref document: A1 |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
WWE | Wipo information: entry into national phase |
Ref document number: 2018908276 Country of ref document: EP |
|
ENP | Entry into the national phase |
Ref document number: 2018908276 Country of ref document: EP Effective date: 20201022 |