EP4403704A1 - Automatic driving system for work machine - Google Patents
Automatic driving system for work machine Download PDFInfo
- Publication number
- EP4403704A1 EP4403704A1 EP22889738.5A EP22889738A EP4403704A1 EP 4403704 A1 EP4403704 A1 EP 4403704A1 EP 22889738 A EP22889738 A EP 22889738A EP 4403704 A1 EP4403704 A1 EP 4403704A1
- Authority
- EP
- European Patent Office
- Prior art keywords
- map
- work
- manipulated variable
- motion
- speed
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 230000033001 locomotion Effects 0.000 claims abstract description 226
- 238000001514 detection method Methods 0.000 claims abstract description 32
- 230000000630 rising effect Effects 0.000 claims description 24
- 230000000295 complement effect Effects 0.000 claims description 15
- 230000036544 posture Effects 0.000 description 22
- 102100028379 Methionine aminopeptidase 1 Human genes 0.000 description 8
- 101710161855 Methionine aminopeptidase 1 Proteins 0.000 description 8
- 102100023174 Methionine aminopeptidase 2 Human genes 0.000 description 8
- 108090000192 Methionyl aminopeptidases Proteins 0.000 description 8
- 239000012530 fluid Substances 0.000 description 8
- 239000002131 composite material Substances 0.000 description 6
- 230000001133 acceleration Effects 0.000 description 3
- 238000013459 approach Methods 0.000 description 3
- 230000008602 contraction Effects 0.000 description 3
- 238000000034 method Methods 0.000 description 3
- 239000002689 soil Substances 0.000 description 3
- 238000010276 construction Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 239000004576 sand Substances 0.000 description 2
- 239000013049 sediment Substances 0.000 description 2
- 238000009412 basement excavation Methods 0.000 description 1
- 230000001934 delay Effects 0.000 description 1
- 238000007599 discharging Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
- 239000002699 waste material Substances 0.000 description 1
- 239000002023 wood Substances 0.000 description 1
Images
Classifications
-
- 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
-
- 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
-
- 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
Definitions
- the present invention relates to a system for performing an automatic operation of a work machine.
- Patent Document 1 an apparatus for performing an automatic operation of a hydraulic work machine.
- the apparatus includes a mode selection means of switching the driving mode between a teaching mode and an automatic operation mode.
- the teaching mode the supply flow rate to the hydraulic driving device is stored in time series.
- the automatic operation mode the opening degree of the control valve to provide a target value, which is the supply flow rate stored in time series, is calculated, and a command with respect to the opening degree is input to the control valve.
- the manipulated variable (opening command in the above document 1) is calculated by use of the supply flow rate stored in time series as the target value
- This problem may occur also when a manipulated variable is input to an element other than the control valve.
- Patent Literature 1 Japanese Unexamined Patent Publication No. Hei 11-181820
- a system for performing an automatic operation of a work machine that includes a machine body, a work device, an operation part, and a driving device.
- the system includes a manipulated-variable detection device, a speed information acquisition device, a map generation part, a map complementation part, a target speed generation part, and a manipulated-variable input part.
- the work device is attached to the machine body capably of performing a work motion.
- the driving device allows a manipulated variable to be input to the driving device, and makes the work device perform the work motion in accordance with the manipulated variable.
- the operation part allows a work operation for operating the work device to be applied to the operation part, and inputs the manipulated variable corresponding to the work operation to the driving device.
- the manipulated-variable detection device detects the manipulated variable that is input from the operation part to the driving device.
- the speed information acquisition device acquires speed information on a motion speed of the work device.
- the map generation part generates a map based on the manipulated variable detected by the manipulated-variable detection device and the speed information acquired by the speed information acquisition device.
- the map defines a relationship between the manipulated variable and the motion speed of the work device.
- the target speed generation part generates a target speed that is a target value of the motion speed for an automatic operation of the work machine.
- the manipulated-variable input part generates the manipulated variable for making the work device perform the work motion at the target speed based on the target speed generated by the target speed generation part and the map complemented by the map complementation part, and inputs the manipulated variable to the driving device.
- FIGS. 1 to 6 A preferred embodiment of the present invention will be described with reference to FIGS. 1 to 6 .
- FIG. 1 shows a work machine 10 according to the embodiment.
- the work machine 10 is a machine for performing work, and an automatic operation of the work machine 10 can be performed by an automatic operation system shown in FIG. 2 . As well as the automatic operation, the work machine 10 can be also manually operated by an operator's operation. The work machine 10 may be either operated by an operator getting on the work machine 10 or remotely controlled from the outside of the work machine 10.
- the work machine 10 is, for example, a construction machine for performing construction work.
- the work machine 10 shown in FIG. 1 is an excavator.
- the work machine to which the automatic operation system according to the present invention is applied may be a work machine other than an excavator, such as a crane.
- the work machine 10 includes a machine body 12, an attachment 15, a driving device and an operation part 21, the driving device including a plurality of actuators 17 and a drive control part 19 shown in FIG. 2 .
- the machine body 12 is the main body of the work machine 10.
- the machine body 12 includes a lower traveling body 11 and an upper turning body 13.
- the lower traveling body 11 is capable of performing a traveling motion, which causes the work machine 10 to travel on the ground.
- the lower traveling body 11 includes a traveling device, for example, a pair of crawlers.
- the upper turning body 13 is mounted on the lower traveling body 11 capably of turning.
- the upper turning body 13 includes a cab 13a.
- the cab 13a allows an operator to make operations for the work machine 10 in the cab 13a.
- the attachment 15 is a work device capable of performing work motions.
- the attachment 15 shown in FIG. 1 includes a boom 15b, an arm 15c, and a tip attachment 15d.
- the boom 15b is attached to the upper turning body 13 capably of performing a rising and falling motions, that is, vertically rotational movement, with respect to the upper turning body 13.
- the arm 15c is connected to the boom 15b capably of vertically rotational movement with respect to the boom 15b.
- the tip attachment 15d is attached to the arm 15c capably of vertically rotational movement to form the tip of the attachment 15.
- the tip attachment 15d shown in FIG. 1 is a bucket that scoops earth and sand.
- the tip attachment 15d may be either a device that pinches objects, such as a grapple, or a device that crushes objects, such as a breaker. Any part of the attachment 15, which is the work device, can be specified as the control target part 15e. According to the example shown in FIG. 1 , the tip of the tip attachment 15d, that is, the tip of the bucket, is specified as the control target part 15e.
- the control target part 15e may be another part, for example, the tip of the arm 15c.
- the attachment 15 is capable of performing a plurality of types of motions as the work motions.
- the plurality of types of motions include rotational movement of the boom 15b with respect to the upper turning body 13, specifically, a boom rising motion and a boom falling motion.
- the boom rising motion is an upward (clockwise direction in FIG. 1 ) rotational movement of the boom 15b with respect to the upper turning body 13, and the boom falling motion is a downward (counterclockwise in FIG. 1 ) rotational movement of the boom 15b with respect to the upper turning body 13.
- the plurality of types of motions include vertically rotational movement of the arm 15c with respect to the boom 15b, specifically, an arm crowd motion and an arm damp motion.
- the arm crowd motion is a rotational movement of the arm 15c with respect to the boom 15b in a direction in which the tip of the arm 15c approaches the boom 15b (counterclockwise in FIG. 1 )
- the arm damp motion is a rotational movement of the arm 15c with respect to the boom 15b in a direction in which the tip of the arm 15c approaches the boom 15b (clockwise in FIG. 1 ).
- the plurality of motions include a vertically rotational movement of the tip attachment 15d with respect to the arm 15c, specifically, a first tip attachment motion and a second tip attachment motion.
- the first tip attachment motion is a rotational movement of the tip attachment 15d with respect to the arm 15c in a direction in which the tip of the tip attachment 15d approaches the arm 15c (counterclockwise in FIG. 1 )
- the second tip attachment motion is a rotational movement of the tip attachment 15d with respect to the arm 15c in a direction in which the tip of the tip attachment 15d goes away from the arm 15c (counterclockwise in FIG. 1 ).
- the tip attachment 15d illustrated in FIG. 1 is the bucket
- the first and second tip attachment motions are also referred to as a bucket excavation motion and a bucket dump motion, respectively.
- the plurality of types of motions include turning motions of turning integrally with the upper turning body 13 with respect to the lower traveling body 11, specifically, a right turning motion and a left turning motion.
- the driving device allows a manipulated variable MV to be input to the driving device, and drives the attachment 15 so as to make the attachment 15 perform a motion corresponding to the thus input manipulated variable MV.
- the plurality of actuators 17 are disposed at respective appropriate positions in the work machine 10 and driven by drive energy that is supplied from the drive control part 19 so as to make the attachment 15 perform the plurality of types of motions, respectively.
- the driving device according to the present embodiment includes a plurality of hydraulic actuators, namely, a turning motor 17a, a boom cylinder 17b, an arm cylinder 17c and a tip attachment cylinder 17d shown in FIG. 1 , which are driven by the supply of hydraulic fluid.
- the turning motor 17a which is a hydraulic motor, turns the upper turning body 13 with respect to the lower traveling body 11 to thereby make the attachment 15 perform the turning motion.
- the turning motor 17a alternatively, may be an electric motor that is driven by the supply of electric power.
- Each of the boom cylinder 17b, the arm cylinder 17c, and the tip attachment cylinder 17d is a hydraulic cylinder.
- the boom cylinder 17b performs expansion and contraction motions with respect to the upper turning body 13 so as to make the boom 15b perform the rising and falling motions.
- the arm cylinder 17c performs expansion and contraction motions so as to move the arm 15c vertically rotationally with respect to the boom 15b.
- the tip attachment cylinder 17d performs expansion and contraction motions so as to move the tip attachment 15d vertically rotationally with respect to the arm 15c.
- the driving device may further include an actuator for actuating the movable part.
- the drive control part 19 supplies drive energy (supplies hydraulic fluid in the present embodiment) to the plurality of actuators 17 to operate the plurality of actuators 17, and controls the movements of the plurality of actuators 17 so as to make the attachment 15 performs a motion corresponding to the manipulated variable MV that is input to the drive control part 19.
- the drive control part 19, thus, controls the drive of the attachment 15 by the plurality of actuators 17, based on the manipulated variable MV that is input to the drive control part 19.
- the drive control part 19 illustrated in FIG. 1 includes a hydraulic circuit for supplying hydraulic fluid to the plurality of actuators (hydraulic actuators) 17.
- the drive control part 19 may include an electric circuit for supplying electric power to the electric actuator.
- the drive control part 19 controls the motion of the attachment 15 by changing respective directions and speeds of the actions of the actuators 17.
- the drive control part 19 illustrated in FIG. 2 includes a hydraulic pump 19a and a plurality of control valves 19c.
- the hydraulic pump 19a discharges hydraulic fluid for operating the plurality of actuators 17.
- the plurality of control valves 19c are interposed between the hydraulic pump 19a and the plurality of actuators 17, respectively.
- Each of the control valves 19c makes a valve opening action so as to control the direction and speed of the operation of the corresponding actuator 17 among the plurality of actuators 17.
- the control valve 19c is composed of a pilot-operated hydraulic selector valve, which is opened by the input of a pilot pressure thereto as the manipulated variable MV, by a stroke corresponding to the pilot pressure, to thereby make the direction and flow rate of hydraulic fluid supplied from the pump 19a to the actuator 17 correspond to the manipulated variable MV.
- the operation part 21 allows an operator to apply a plurality of types of work motions to the operation part 21.
- the plurality of types of work motions are operations for make the work machine 10 perform the plurality of types of motions, respectively.
- the operation part 21 may be provided in the cab 13a as shown in FIG. 1 .
- the operation part 21, alternatively, may be provided outside the work machine 10 to allow remote control to be performed.
- the operation part 21 includes a plurality of operation devices to which the plurality of types of work motions are applied, respectively.
- Each of the operation devices includes a work operation member and a manipulated variable generation part.
- To the work operation member is applied a corresponding work operation among the plurality of types of work motions.
- the work operation member may be, for example, either of an operation lever, an operation pedal, a touch panel and a key.
- the manipulated variable generation part generates the manipulated variable MV corresponding to the direction and magnitude of the work operation applied to the work operation member, namely, a drive command, and inputs the generated manipulated variable to the drive control part 19.
- the manipulated variable generation part of each of the operation devices is composed of a pilot valve interposed between a non-illustrated pilot hydraulic pressure source (for example, a pilot pump) and a control valve 19c that corresponds to the operation device among the plurality of control valves 19c, configured to be opened by the magnitude of the work operation so as to input a pilot pressure, which corresponds to the direction and magnitude of the work operation, to the control valve 19c as the manipulated variable MV, namely, the drive command.
- a non-illustrated pilot hydraulic pressure source for example, a pilot pump
- a control valve 19c that corresponds to the operation device among the plurality of control valves 19c, configured to be opened by the magnitude of the work operation so as to input a pilot pressure, which corresponds to the direction and magnitude of the work operation, to the control valve 19c as the manipulated variable MV, namely, the drive command.
- the manipulated variable MV is not limited to the pilot pressure (hydraulic pressure).
- the manipulated variable MV may be an electric signal (for example, a current value) to be input to the electric actuator.
- the manipulated variable MV is generated for each of the types of motions of the attachment 15.
- the plurality of operation devices included in the operation part 21 correspond to the right turning motion, the left turning motion, the boom rising motion, the boom falling motion, the arm crowd motion, and the arm damp motion, the first tip attachment motion and the second tip attachment motion, respectively, and the operation devices generate respective pilot pressures corresponding to the types of motions as the manipulated variables MV, namely, the drive commands, and input them to the control valves 19c.
- the manipulated variable MV has an effective range from the minimum manipulated variable MVmin to the maximum manipulated variable MVmax shown in FIG. 4 .
- the actuator 17 corresponding to the control valve 19c is not activated; therefore, the motion corresponding to the actuator 17 (for example, boom rising motion) among the plurality of types of motions of the attachment 15 is not performed.
- the maximum manipulated variable MVmax is the maximum value of the manipulated variable MV that is input from the operation part 21 to the drive control part 19.
- the maximum manipulated variable MVmax is the maximum pilot pressure that can be input to the control valve 19c (for example, 3MPa).
- the maximum manipulated variable MVmax By the input of the maximum manipulated variable MVmax, both the opening degree of the control valve 19c and the flow rate of the hydraulic fluid supplied from the control valve 19c to the actuator 17 is maximized, causing the actuator 17 to actuate the movable part that is connected to the actuator 17 at the maximum speed.
- the automatic operation system is a system that generates a manipulated variable MV separately from the operation part 21 and inputs it to the driving device to thereby execute an automatic operation of the work machine 10.
- the automatic operation system includes a manipulated-variable detection device 23, a posture detection device 25, a controller 30, which are shown in FIG. 2 , and a non-illustrated solenoid valve.
- the manipulated-variable detection device 23 detects the manipulated variable MV which is input from the operation part 21 to the driving device (the drive control part 19 in the present embodiment).
- the manipulated-variable detection device 23 includes a plurality of manipulated-variable sensors that detect respective manipulated variables MV that are input from the plurality of operation devices to the plurality of control valves 19c, namely, respective pilot pressures, and each of the manipulated-variable sensors is a pressure sensor.
- the manipulated-variable detection device 23 may either include a sensor that detects an electrical signal, such as a current sensor, or be included in the controller 30.
- the plurality of manipulated-variable sensors included in the manipulated-variable detection device 23 detect a plurality of manipulated variables MV corresponding to the types of motions of the attachment 15, respectively.
- the plurality of manipulated-variable sensors include a right turning manipulated-variable sensor 23a1, a left turning manipulated-variable sensor 23a2, a boom rising manipulated-variable sensor 23b1, a boom falling manipulated-variable sensor 23b2, an arm crowd manipulated-variable sensor 23c1, an arm dump manipulated-variable sensor 23c2, a tip attachment first manipulated-variable sensor 23d1 and a tip attachment second manipulated-variable sensor 23d2, which sensors are shown in FIG. 2 .
- Each of the manipulated-variable detection device 23, the posture detection device 25 and the controller 30 may be either installed on the work machine 10 or placed outside the work machine 10.
- the posture detection device 25 detects a physical quantity related to the posture of the attachment 15, serving as a speed information acquisition part that acquires speed information on a motion speed, which is the speed of the motion of the attachment 15.
- the posture detection device 25 may detect either a physical quantity directly related to the posture of the attachment 15, such as an angle or a position of a specific part of the attachment 15, or a velocity or angular velocity of the specific part of the attachment 15.
- the posture detection device 25 may be configured either to directly detect the speed of the motion of the attachment 15 or to detect information for indirectly acquiring the speed of the attachment 15, for example, at least one of the posture and the acceleration (or angular acceleration).
- the posture detection device 25 includes a plurality of sensors corresponding to respective motions of the attachment 15, namely, a turning sensor 25a, a boom sensor 25b, an arm sensor 25c and a tip attachment sensor 25d, which are shown in FIG. 4 .
- the turning sensor 25a detects a physical quantity related to the posture of the upper turning body 13 with respect to the lower traveling body 11 shown in FIG. 1 , namely, the turning posture that is the posture with respect to the turning direction.
- the turning sensor 25a is, for example, an angle sensor that detects the turning angle of the upper turning body 13 with respect to the lower traveling body 11, the angle sensor being attachable to, for example, a turning shaft or a turning support part.
- the boom sensor 25b detects a physical quantity related to the posture of the boom 15b.
- the boom sensor 25b is, for example, an angle sensor (for example, a rotary encoder) that detects the rotation angle (rising angle) of the boom 15b with respect to the upper turning body 13, the angle sensor being attachable to the rotation support shaft of the boom 15b, namely, a boom foot pin, or the part that supports the boom 15b.
- the arm sensor 25c is a sensor that detects a physical quantity related to the posture of the arm 15c, for example, an angle sensor that detects the rotation angle of the arm 15c with respect to the boom 15b.
- the tip attachment sensor 25d is a sensor that detects a physical quantity related to the posture of the tip attachment 15d, for example, an angle sensor that detects the rotation angle of the tip attachment 15d with respect to the arm 15c.
- the boom sensor 25b, the arm sensor 25c and the bucket sensor 25d may include tilt sensors (for example, gyro sensors, acceleration sensors, inertial measurement devices) which detect respective angles of the boom 15b, the arm 15c and the tip attachment 15d to the horizontal surface, namely, respective inclination angles thereof.
- tilt sensors for example, gyro sensors, acceleration sensors, inertial measurement devices
- the boom sensor 25b, the arm sensor 25c and the tip attachment sensor 25d may be respective stroke sensors that detect the stroke of the boom cylinder 17b, the stroke of the arm cylinder 17c, and the stroke of the tip attachment cylinder 17d.
- the turning sensor 25a, the boom sensor 25b, the arm sensor 25c and the tip attachment sensor 25d may detect physical quantities (including motion speeds) related to respective postures of the upper turning body 13, the boom 15b, the arm 15c and the tip attachment 15d based on at least one of a two-dimensional image or a distance image.
- the controller 30 is a device that performs arithmetic control operations for the automatic operation of the work machine 10 based on information acquired by the manipulated-variable detection device 23 and the posture detection device 25, being composed of, for example, a computer including an interface that performs inputs and outputs signals, an calculation unit that performs calculation proceedings, and a storage unit that stores information.
- the functions of the controller 30 are provided, for example, through the execution of a program stored in the storage unit by the calculation unit. Specifically, the controller 30 shown in FIG.
- a map generation part 41 includes a map generation part 41, a map complementation part 43, a map storage part 45, a work plan setting part 51, a target speed generation part 53 and a manipulated-variable calculation part 55, which constitutes a manipulated-variable input part in association with the non-illustrated electromagnetic valve.
- the map generation part 41 generates, for example, a map M shown in FIG. 4 based on the manipulated variable MV detected by the manipulated-variable detection device 23, that is, the manual manipulated variable MVm that is input from the operation part 21 to the drive control part 19 through a manual operation by an operator, and the speed information acquired by the posture detection device 25.
- the map M defines the relationship between a motion speed V provided by the speed information, that is, the speed of the motion of the attachment 15 (in the present embodiment, each of the types of motions), and the manipulated variable MV detected by the manipulated-variable detection device 23.
- the map complementation part 43 performs complementation of the map M when the complementation is necessary. The case where the complementation is necessary and the detail of the complementation are described below.
- the map storage part 45 stores the map M.
- the map M stored in the map storage part 45 is the map generated by the map generation part 41 when no complementation is performed by the map complementation part 43, or the complemented map when the complementation is performed by the
- the work plan setting part 51 sets a work plan for the work machine 10.
- the work plan is information that serves as a target of the work motion of the work machine 10.
- the work plan includes information about a target trajectory T of the control target part 15e (the tip of the bucket in the example shown in FIG. 3 ).
- the information about the target trajectory T includes respective positions (coordinates) of a plurality of target points of the control target part 15e included in the target trajectory T, and information about the order of the plurality of target points.
- the information about the target trajectory T may include, as information on the respective positions of the plurality of target points, at least one of information on the turning angle of the upper turning body 13, information on the distance from the turning center of the upper turning body 13 with respect to the lower traveling body 11 to the control target part 15e, namely, a work radius, and information about the height of the control target part 15e.
- the information about the target trajectory T may include a movement time of the control target part 15e between adjacent target points among the plurality of target points or a parameter corresponding thereto.
- the work plan that is set by the work plan setting part 51 according to the present embodiment includes a plurality of work phases F.
- Each of the work phases F includes information about the target trajectory T.
- the plurality of work phases F in the work plan shown in FIG. 3 , include a series of phases, namely, a capture phase F1, a lifting and turning phase F2, a release phase F3 and a return turning phase F4, the series of phases F1 to F4 constituting a single cycle.
- the capture phase F1 is a phase corresponding to a motion in which the tip attachment 15 captures a work object.
- the work object is not limited but allowed to be, for example, any of soil, wood, metal, and waste.
- the motion corresponding to the capture phase F1 is, for example, the motion of excavating earth and sand of soil.
- the lifting and turning phase F2 corresponds to a lifting and turning motion in which the control target part 15e moves from a capture position at which the work object is to be captured to a release position at which the work object is to be released with the tip attachment 15d capturing the work object.
- the lifting and turning motion is a composite motion including at least the boom rising or falling motion and the turning motion, which motions are simultaneously performed.
- the release phase F3 corresponds to a release motion in which the tip attachment 15d releases the work object at the release position.
- the release motion is, for example, a motion for discharging soil to a vessel of a transport vehicle D shown in FIG. 3 or the like, including a rotational motion of the tip attachment 15d.
- the return turning phase F4 corresponds to a return turning motion in which the control target part 15e moves from the release position to a position where the tip attachment 15d captures a work object next time.
- the return turning motion is a composite motion including at least the boom rising or falling motion and the turning motion, which motions are simultaneously performed.
- the work plan that is set by the work plan setting part 51 according to the present embodiment includes a plurality of cycles (e.g., ten times).
- the work plan setting part 51 may set, for example, different target trajectories T for respective cycles.
- the work plan setting part 51 may set, for example, the work plan so as to render respective target capture positions of the work objects in the plurality of cycles different from each other.
- the work plan setting part 51 may set, for example, the work plan so as to render respective target release positions of the work objects in the plurality of cycles different from each other.
- the work plan setting part 51 may set, for example, the work plan so as to terminate the series of cycles when a predetermined termination condition is satisfied.
- the termination condition is, for example, that the amount of the work object being laid in a place where the work object is to be collected (e.g., sediment pit S, etc.) is equal to or less than a predetermined value or that the number of cycles that has been performed is equal to a predetermined number of times.
- the work plan setting part 51 may set the work plan so as to start the next cycle when a predetermined restart condition is satisfied after one cycle is terminated.
- the restart condition is, for example, that a work object of a predetermined amount or more is replenished to a place where the work object is to be collected (such as a sediment pit S).
- the work plan setting part 51 may set the work plan based on either the teaching executed by the operator or a method other than the teaching (e.g., numerical input by an operator, etc.).
- the teaching includes, for example, manually moving the control target part 15e along a trajectory corresponding to the desired target trajectory T by (i) application of a work operation to the operation part 21 by an operator getting on the work machine 10 or (ii) application of a work operation to the operation part 21 provided outside the work machine 10 by an operator.
- the work plan setting part 51 sets the trajectory along which the control target part 15e thus has been manually moved, as the target trajectory T.
- the target speed generation part 53 generates a target speed during the performance of the automatic operation of the work machine 10, i.e., a target value of the motion speed of the attachment 15, for example, by calculation.
- the target speed generation part 53 according to the present embodiment generates a plurality of target speeds corresponding to the plurality of types of motions of the attachment 15, respectively.
- the target speed generation part 53 generates the plurality of target speeds so as to allow the work machine 10 to be automatically operated in accordance with the work plan set by the work plan setting part 51, that is, so as to make the attachment 15 perform a motion corresponding to the work plan.
- the target speed generation part 53 generates the target speed so as to cause the control target part 15e to move along the target trajectory T.
- the manipulated-variable calculation part 55 calculates the manipulated variable MV for making the attachment 15 perform each of the types of motions at the target speed generated by the target speed generation part 53, namely, an automatic-operation manipulated variable MVa. Specifically, based on the target speed generated by the target speed generation part 53 and the map M complemented by the map complementation part 43 (or the map M generated by the map generation part 41 when no complementation is performed), the manipulated-variable calculation part 55 calculates the manipulated variable MV for making the attachment 15 perform the work motion at the target speed (automatic-operation manipulated variable MVa).
- the manipulated-variable calculation part 55 further generates a manipulated-variable command signal, which is an electric signal necessary for inputting the manipulated variable MV to the drive control part 19, and inputs the manipulated-variable command signal to each of the solenoid valves.
- a manipulated-variable command signal which is an electric signal necessary for inputting the manipulated variable MV to the drive control part 19, and inputs the manipulated-variable command signal to each of the solenoid valves.
- the plurality of solenoid valves are interposed between the non-illustrated pilot hydraulic source and the plurality of control valves 19c, respectively, constituting a manipulated-variable input part in association with the manipulated-variable calculation part 55.
- Each of the solenoid valves allows the manipulated-variable command signal to be input from the manipulated-variable calculation part 55 to the solenoid valve, and performs valve opening to allow the pilot pressure corresponding to the input manipulated-variable command signal, namely, the automatic-operation manipulated variable MV to be input to the control valve 19c.
- the solenoid valve which only has to be configured to change the secondary pressure of the solenoid valve, that is, the pilot pressure to be input to the control valve 19c, in response to the input electrical signal, may be either an electromagnetic proportional pressure regulation valve or an electromagnetic proportional reverse proportional valve.
- a manual operation is performed by an operator (step S11 in FIG. 5 ).
- a work operation is applied by an operator to each of the necessary operation devices included in the operation part 21.
- the work operation to be applied to the operation part 21 may be either an operation performed for purpose of nothing but generating the map M or a teaching operation for setting the work plan.
- the operation part 21, when the work operation is applied thereto, inputs a manipulated variable MV (pilot pressure in the present embodiment) corresponding to the work operation to the drive device (in the present embodiment, each of the control valves 19c of the drive control part 19).
- the driving device when the manipulated variable MV is input thereto, actuates the attachment 15 so as to make the attachment 15 perform the motion corresponding to the manipulated variable MV.
- the pilot pressure as the manipulated variable MV is input to each of the control valves 19c of the drive control part 19 to make the control valve 19c perform valve opening by an opening degree corresponding to the pilot pressure, and the control valve 19c allows hydraulic fluid to be supplied to the actuator 17 that is connected to the control valve 19c among the plurality of actuators 17 at a flow rate corresponding to the pilot pressure.
- the manipulated-variable detection device 23 detects the manipulated variable MV (the pilot pressure in the present embodiment) to be input from the operation part 21 to the drive control part 19.
- the posture detection device 25 detects the motion speed V, which is a physical quantity related to the posture of the attachment 15 and which is the speed of the motion of each of the attachments 15, for example, the operating speed of each of the actuators 17.
- the map generation part 41 of the controller 30 generates a map M indicating the relationship between the manipulated variable MV detected by the manipulated-variable detection device 23 in the manual operation, namely, the manual manipulated variable MVm, and the motion speed V acquired from the information detected by the posture detection device 25 when the manipulated variable MV is detected.
- the map generation part 41 preferably generates a plurality of different maps M that correspond to a plurality of types of motions of the attachment 15 (for example, boom rising motion, boom falling motion) shown in FIG. 3 , respectively.
- the map generation part 41 is preferably configured to generate the map M for each of the types of motions.
- the map generation part 41 generates different maps M corresponding to the plurality of work situations of the work machine 10, respectively.
- the map generation part 41 is preferably configured to generate the map M for each of the work situations. Examples of the working situation of the work machine 10 include the work phase F, the cycle, and other load conditions (the condition of the load acting on the attachment 15).
- the map generation part 41 generates different maps M corresponding to the plurality of work phases F, respectively.
- the map generation part 41 is preferably configured to generate the map M for each of the work phases F.
- the reason therefor is, for example, as follows.
- Table 1 below shows a specific example of the plurality of maps M generated by the map generation part 41 and corresponding to the plurality of types of motions and the plurality of phases F, respectively.
- the map generation part 41 generates a plurality of different maps M corresponding to a plurality of cycles, respectively, the plurality of cycles composed of the series of work phases F, respectively.
- the map generation part 41 is preferably configured to generate the map M for each of the cycles. For example, there can be assumed a case where respective target trajectories T set in the plurality of cycles are different from each other, whereby respective conditions of the loads acting on the attachment 15 in the plurality of cycles are different from each other. This generates a possibility that the relationship between the manipulated variable MV and the motion speed V with the same operation (e.g., boom rising motion) and the same work phase F is varied depending on the cycle. This is the same as to a work operation other than the boom rising motion. It is, therefore, preferable that the map generation part 41 generates a plurality of different maps M corresponding to the cycles, respectively, the cycles composed of the series of work phases F, respectively.
- the plurality of conditions of the load acting on the attachment 15 are not limited to those due to the work phase F or the cycle.
- the map generation part 41 may generate, for example, a plurality of different maps M depending on the condition (e.g., mass, size) of the object which is captured by the attachment 15.
- the map generation part 41 may generate a plurality of different maps M corresponding to the situations, respectively.
- the map generation part 41 is preferably configured to generate the map M for each of the situations.
- the map complementation part 43 of the controller 30 complements the map M so as to render the maximum value of the manipulated variable MV of the map M equal to the maximum manipulated variable MVmax (step S14).
- the map generation part 41 generates the map M for defining the relationship between the manipulated variable MV and the motion speed V on the basis of the manipulated variable MV that is input to the drive control part 19 when a work operation is applied to the operation part 21 by the manual operation and the motion speed V (step S11), there can be a case where a work operation having a size corresponding to the maximum manipulated variable MVmax is not applied to the operation part 21 in the manual operation.
- the maximum acquisition manipulated variable MV1 which is the maximum value of the manipulated variable (manual manipulated variable) MVm acquired by the manual operation, is less than the maximum manipulated variable MVmax.
- the manipulated-variable detection device 23 and the posture detection device 25 cannot acquire the manipulated variable MV and the motion speed V.
- a non-acquirable range where neither of the manipulated variable MV1 and the motion speed V for generating the map M can be acquired by the manual operation, on the side where the manipulated variable MV1 and the motion speed are larger than that in the ready-generated map portion M1 which can be generated by the manual operation (right side and upper side in FIG. 4 ).
- the target speed generation part 53 of the controller 30 may generate a target speed greater than the maximum acquisition speed V1 as a target speed Vt for the automatic operation.
- a target speed Vt may be generated.
- the manipulated variable MV corresponding to the target speed Vt greater than the maximum acquisition speed V1 (i.e., the manipulated variable MV greater than the maximum acquisition manipulated variable MV1), however, is not included in the ready-generated map portion M1.
- the ready-generated map portion M1 thus, cannot provide a target speed for making the attachment 15 perform the work motion at a speed greater than the maximum acquisition speed V1.
- the work machine 10 in spite of its ability to actuate the attachment 15 at a motion speed V greater than the maximum acquisition speed V1 (e.g., the maximum speed Vmax), cannot execute a control to make the attachment 15 perform a work motion at the motion speed V greater than the maximum acquisition speed V1. This hinders, for example, a delay of the actual position of the control target part 15e with respect to the position of the control target part 15e specified by the target trajectory T shown in FIG. 3 (that is, the target position) from being recovered.
- Such a problem due to the presence of the non-acquisition range could be solved by an application of a work operation with a magnitude corresponding to the maximum manipulated variable MVmax to the operation part 21 by an operator in the manual operation (step S11); however, this involves another problem as follows.
- an operator has to apply a special operation for generating a map M in which the maximum acquisition manipulated variable MV1 reaches the maximum manipulated variable Pmax, that is, a work operation greater than the maximum value of the work operation required for the teaching, to the operation part 21, separately from the teaching. This increases the workload of the operator.
- the operation applied for generating such a map M that the maximum acquisition manipulated variable MV1 reaches the maximum manipulated variable MVmax that is, a work operation with the magnitude corresponding to the maximum manipulated variable MVmax
- a work operation with the magnitude corresponding to the maximum manipulated variable MVmax will cause a high-speed motion of the attachment 15 at the maximum speed Vmax.
- Such performance of the work motion by the attachment 15 at a speed more than the necessary motion speed during the manual operation requires an operator to pay attention to prevent the attachment 15 from coming into contact with surrounding objects, thus increasing the workload of the operator.
- the map complementation part 43 complements the entire map M by compensating an additional map portion M2 for the non-acquisition range in addition to the ready-generated map portion M1. Specifically, when the maximum acquisition manipulated variable MV1, which is the maximum value of the manipulated variable MV in the ready-generated map portion M1, does not reach the preset maximum manipulated variable MVmax (YES in step S13), the map complementation part 43 generates the additional map portion M2 to complement the map M (Step S14). Specifically, the map complementation part 43 complements the map M so as to render the maximum value of the manipulated variable MV included in the map M equal to the maximum manipulated variable MVmax.
- the map complementation part 43 performs no complementation of the map M, thus maintaining the map M generated by the map generation part 41 as it is.
- the map complementation part 43 complements each of the maps M.
- the map generation part 41 has generated a plurality of different maps M corresponding to the plurality of types of motions of the attachment 15, respectively, it is preferable that the map complementation part 43 complements each of the maps M corresponding to the plurality of types of motions, respectively.
- the map complementation part 43 complements each of the maps M corresponding to the work phases F, respectively.
- the map generation part 41 has generated a plurality of maps M corresponding to a plurality of cycles, respectively, the cycles composed of a series of the work phases F, respectively, it is preferable that the map complementation part 43 complements each of the maps M corresponding to the cycles, respectively.
- the specific method of complementation by the map complementation part 43 that is, the generation of the additional map portion M2 in the present embodiment, is not limited.
- the additional map portion M2 may be either (1) generated based on information on the maximum speed Vmax that is set in advance (e.g., stored in the controller 30) or (2) estimated from the ready-generated map portion M1. The details are as follows.
- the additional map portion M2 can be generated based on information on the motion speed V corresponding to the maximum manipulated variable MVmax, namely, the maximum speed Vmax.
- the information is information set in advance of the complementation of the map M, for example, information prestored in the controller 30.
- the information of the maximum speed Vmax may be included in a base map BM as shown in FIG. 4 .
- the base map BM is prepared in advance, as a base of the map M, for example, prestored in the controller 30.
- the base map BM defines the relationship between the manipulated variable MV and the motion speed V over the full range from the minimum manipulated variable MVmin to the maximum manipulated variable MVmax.
- the base map BM illustrated in FIG. 4 defines the relationship given by a straight line with a constant inclination.
- the base map BM alternatively, may be provided in a curve.
- the base map BM may be set either prior to the shipping (e.g., during manufacturing) of the work machine 10 or by an operator or the like upon the start of work perform by the work machine 10 at a new work site. Alternatively, may be performed teaching for generating the base map BM prior to teaching for generating the map M.
- a plurality of base maps BM may be set correspondingly to various states of the work machine 10 (see FIG. 1 ). For example, may be set either a plurality of base maps BM corresponding to the plurality of types of motions of the attachment 15 or a plurality of base maps BM corresponding to a plurality of conditions of a load acting on the attachment 15.
- a plurality of base maps BM corresponding to the plurality of states of the work machine 10 are used for the complementation of the maps M.
- the condition of a load acting on the attachment 15 is detected when the teaching for generating each of the maps M is performed and the map complementation part 43 selects the base map BM corresponding to the detected load condition (e.g., equivalent to or close to the load condition) from among the plurality of base maps BM to complement the map M based on the selected base map BM.
- the map complementation part 43 generates the additional map portion M2 for the range where the manipulated variable MV is larger than the maximum acquisition manipulated variable MV1, without changing the ready-generated map portion M1 (e.g., so as to directly reflect the teaching result onto the map M). Specifically, the map complementation part 43 performs the generation of the additional map portion M2, i.e., the complementation of the map M, based on the relationship between the maximum manipulated variable MVmax specified at the terminal end of the base map BM and the maximum speed Vmax. For example, the map complementation part 43 may either set, as shown in FIG.
- the maximum speed Vmax specified in the base map BM directly as the motion speed (maximum speed Vmax) corresponding to the maximum manipulated variable MVmax of the complemented map M or complement the map M by extending the map M from the ready-generated map portion M1 to the maximum manipulated variable MVmax based on the inclination of the base map BM, that is, the rate of increase in the manipulated variable MV to the increase in the motion speed V.
- the ready-generated map portion M1 may be slightly modified along with the generation of the additional map portion M2.
- the maximum speed Vmax corresponding to the maximum manipulated variable MVmax is not limited to one based on the base map BM. For example, may be prestored in the controller 30 (in advance of the complementation of the map M) just the value of the maximum speed Vmax corresponding to the maximum manipulated variable MVmax. Besides, a plurality of maximum speeds Vmax corresponding to the maximum manipulated variable MVmax may be set correspondingly to the plurality of states of the work machine 10.
- the map complementation part 43 may select the maximum speed Vmax corresponding to the state of the work machine 10, which state is acquired when teaching for setting the map M is performed, from among a plurality of maximum speeds Vmax prepared correspondingly to the maximum manipulated variable MVmax to complement the map M based on the thus selected maximum speed Vmax.
- the map complementation part 43 may complement the map M by estimating the additional map portion M2 from the ready-generated map portion M1.
- the map complementation part 43 may generate the additional map portion M2 by extending the ready-generated map portion M1.
- the extension can be made based on, for example, the inclination of the terminal part of the graph that indicates the relationship between the motion speed V and the manipulated variable MV in the ready-generated map portion M1, i.e., the rate of increase in the manipulated variable MV to the increase in the motion speed V at the terminal part.
- the terminal part is the end part on the side closer to the maximum manipulated variable MVmax i n the graph (right side in FIG. 4 ).
- the inclination of the terminal end may be either of (a) the inclination at the terminal end of the ready-generated map portion M1, that is, the point corresponding to the maximum acquisition speed V1 (a portion corresponding to the maximum acquisition manipulated variable MV1), (b) the average value of the inclination in the range from the speed V smaller than the maximum acquisition speed V1 by a predetermined value to the maximum acquisition speed V1 in the ready-generated map portion M1, (c) the average value of the inclination in the range from the manipulated variable MV1 smaller than the maximum acquisition manipulated variable MV1 by a predetermined value to the maximum acquisition manipulated variable MV1 in the ready-generated map portion M1.
- the additional map portion M2 generated by the map complementation part 43 may be either a straight line with the "inclination” that is set based on the ready-generated map portion M1 or a line (e.g., a straight line or a curve) calculated based on the "inclination".
- the additional map portion M2 alternatively, may be generated based on the average value of the inclination of the entire ready-generated map portion M1.
- map complementation part 43 may complement the map M based on both the base map BM and the inclination of the graph of the ready-generated map portion M1.
- the target speed generation part 53 of the controller 30 generates a target speed Vt so as to make the work machine 10 perform the plurality of types of motions according to the work plan that is set by the work plan setting part 51 (Step S21). Specifically, the target speed generation part 53 generates a plurality of target speeds Vt corresponding to the plurality of types of motions (e.g., boom rising motion, boom falling motion) of the attachment 15, respectively. The target speed generation part 53 inputs (instructs) the thus generated target speed to the manipulated-variable calculation part 55.
- the manipulated-variable calculation part 55 reads, from the map storage part 45, the map M corresponding to the current work state of the work machine 10 among the plurality of maps M stored in the map storage part 45 (Step S22). For example, the manipulated-variable calculation part 55 reads a plurality of maps M corresponding to the types of motions of the attachment 15, respectively. Other examples of the map M to be read by the manipulated-variable calculation part 55 include a map M corresponding to the current load condition of the attachment 15, a map M corresponding to the current work phase F, and a map M corresponding to the current cycle.
- the manipulated-variable calculation part 55 calculates (determines) the manipulated variable MV corresponding to the target speed Vt generated by the target speed generation part 53, namely, an automatic-operation manipulated variable MVa (Step S23). For example, according to the map M shown in FIG.
- the manipulated-variable calculation part 55 calculates the manipulated variable MV corresponding to the target speed Vt based on the ready-generated map portion M1 whereas, when the target speed Vt is larger than the maximum acquisition speed V1, the manipulated-variable calculation part 55 calculates the manipulated variable MV corresponding to the target speed Vt based on the additional map portion M2 added by the map complementation part 43.
- the manipulated-variable calculation part 55 generates a manipulated-variable command signal for providing the thus determined manipulated variable MV (pilot pressure in the present embodiment) and inputs it to the not-illustrated solenoid valve (Step S24).
- the solenoid valve is opened so as to allow the pilot pressure to be input to the drive control part 19 in response to the manipulated-variable command signal.
- the drive control part 19 changes the movement of the actuator 17 corresponding to the manipulated variable MV among the plurality of actuators 17 based on the input pilot pressure, i.e., the manipulated variable MV (automatic-operation manipulated variable MVa).
- the actuator 17 is an electric actuator
- an electric signal (command signal) corresponding to the manipulated variable MV may be either directly input to the electric actuator from the manipulated-variable calculation part 55 or input to a circuit for controlling the action of the electric actuator.
- the complementation of the map M by the map complementation part 43 enables the followability of the motion speed V to the target speed Vt in the automatic operation to be improved.
- the target speed generation part 53 generates a high target speed Vt so as to reduce the delay; however, if the target speed Vt is greater than the maximum acquisition speed V1 shown in FIG.
- the manipulated variable MV corresponding to the target speed Vt cannot be calculated with only the ready-generated map portion M1.
- the manipulated-variable calculation part 55 cannot calculate the manipulated variable MV corresponding to the target speed Vt that exceeds the maximum acquisition speed V1.
- the complementation of the map M by the map complementation part 43 i.e., the addition of the additional map portion M2
- the manipulated-variable calculation part 55 even when the target speed Vt is greater than the maximum acquisition speed (for example, the maximum value of the speed V when the work plan is taught) V 1, to calculate the manipulated variable MV corresponding to the target speed Vt (> V1) based on the additional map portion M2, thereby allowing the delay of the speed V and the position of the control target part 15e to be quickly reduced.
- connection of each component shown in FIG. 2 of the above embodiment may be changed.
- order of the steps of the flowcharts illustrated in FIGS. 5 and 6 may be changed and some of the steps may not be performed.
- the number of components may be changed and some of the components may not be provided.
- the fixation, connection, etc. of the components may be direct or indirect.
- what has been described as a plurality of members or parts different from each other may be one member or part.
- what has been described as one member or part may be divided into a plurality of members or parts different from each other.
- each component may have only a portion of each feature (working function, arrangement, shape, actuation, etc.).
- the system is a system for performing an automatic operation of a work machine that includes a machine body, a work device, an operation part, and a driving device.
- the system includes a manipulated-variable detection device, a speed information acquisition device, a map generation part, a map complementation part, a target speed generation part 53, and a manipulated-variable input part.
- the work device is attached to the machine body capably of performing a work motion.
- the driving device allows a manipulated variable to be input to the driving device, and makes the work device perform the work motion in accordance with the manipulated variable.
- the operation part allows a work operation for operating the work device to be applied to the operation part, and inputs the manipulated variable corresponding to the work operation to the driving device.
- the manipulated-variable detection device detects the manipulated variable to be input from the operation part to the driving device.
- the speed information acquisition device acquires speed information on a motion speed that is a speed of the work motion of the work device.
- the map generation part generates a map based on the manipulated variable detected by the manipulated-variable detection device and the speed information acquired by the speed information acquisition device. The map defines a relationship between the manipulated variable and the motion speed of the work device.
- the map complementation part complements the map so as to render the maximum value of the manipulated variable of the map equal to the maximum manipulated variable.
- the target speed generation part generates a target speed that is a target value of the motion speed for an automatic operation of the work machine.
- the manipulated-variable input part generates the manipulated variable for making the work device perform the work motion at the target speed based on the target speed generated by the target speed generation part and the map complemented by the map complementation part, and inputs the manipulated variable to the driving device.
- the map complementation part enables the manipulated-variable input part to generate the manipulated variable corresponding to the target speed based on the complemented map and input the manipulated variable to the driving device even when a target speed greater than a maximum value of the manipulated variable included in the map generated by the map generating part is generated by the target speed generating part. This makes it possible to perform a control for reducing a delay caused by the lower actual motion speed of the work device in the automatic operation than the target speed, thereby allowing the followability of the motion speed of the work device to the target speed to be improved.
- the map complementation part is configured to complement the map based on information that is preset for the motion speed corresponding to the maximum manipulated variable. This allows the map to be complemented by a simple operation.
- the map complementation part is configured to complement the map based on an inclination of a graph that indicates a relationship between the motion speed and the manipulated variable in the map generated by the map generating part.
- the map complementation part can complement the map without requiring any special information other than the map portion that has been already generated by the map generating part.
- the map generation part is configured to generate the map for each of the types of motions and the map complementation part is configured to complement the map generated for each of the types of motions.
- Such generation and complementation of the map corresponding to each of the types of motions of the work device enables the followability of the motion speed of the work device to the target speed to be enhanced.
- the automatic operation system for example, can be applied to a work machine in which the machine body includes a lower traveling body and an upper turning body mounted on the lower traveling body capably of turning and the work device includes a boom that is attached to the upper turning body capably of rising and falling, an arm that is connected to the boom capably of vertically rotational movement, and a tip attachment that is connected to the arm capably of vertically rotational movement.
- the plurality of types of motions include a turning motion of the upper turning body with respect to the lower traveling body, a rising and falling motion of the boom with respect to the upper turning body, a rotational movement of the arm with respect to the boom, and a rotational movement of the tip attachment with respect to the arm.
- the map generation part is configured to generate the map for each of different work situations of the work machine
- the map complementation part is configured to complement the map generated for each of the work situations. This allows the followability of the motion speed of the work machine to the target speed to be improved in each of the work situations of the work machine.
Landscapes
- Engineering & Computer Science (AREA)
- Mining & Mineral Resources (AREA)
- Mechanical Engineering (AREA)
- Civil Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Structural Engineering (AREA)
- Life Sciences & Earth Sciences (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Paleontology (AREA)
- Operation Control Of Excavators (AREA)
Abstract
Provided is an automatic operation system providing high followability to a target speed, including a map generation part (41), a map complementation part (43) and a manipulated variable output part (55). The map generation part (41) generates a map indicating the relationship between a motion speed (V) of a work device (15) and a manipulated variable (MV) detected by a manipulated-variable detection device (23). The map complementation part (43) complements the map, when the maximum value of the manipulated variable (MV) of the map is less than the maximum manipulated variable, to render the maximum value equal to the maximum manipulated variable. The manipulated variable output part (55) generates the manipulated variable (MV) for automatic operation based on the target speed and the complemented map and inputs the manipulated variable to a driving device (17, 19).
Description
- The present invention relates to a system for performing an automatic operation of a work machine.
- In Patent Document 1 is described an apparatus for performing an automatic operation of a hydraulic work machine. The apparatus includes a mode selection means of switching the driving mode between a teaching mode and an automatic operation mode. In the teaching mode, the supply flow rate to the hydraulic driving device is stored in time series. In the automatic operation mode, the opening degree of the control valve to provide a target value, which is the supply flow rate stored in time series, is calculated, and a command with respect to the opening degree is input to the control valve.
- According to the apparatus, in which the manipulated variable (opening command in the above document 1) is calculated by use of the supply flow rate stored in time series as the target value, it is not possible to input such a manipulated variable to the control valve as to render the actual supply flow rate larger than the amount stored in time series. This may hinder the actual speed of the work machine from being made close to the target speed when the actual speed falls below the target speed to thereby disable the attachment from being operated in accordance with the target speed. This problem may occur also when a manipulated variable is input to an element other than the control valve.
- Patent Literature 1:
Japanese Unexamined Patent Publication No. Hei 11-181820 - It is an object of the present invention to provide a system for performing an automatic operation of a work machine, the system being capable of making the speed of the motion of a work device of the work machine quickly follow a target speed.
- Provided is a system for performing an automatic operation of a work machine that includes a machine body, a work device, an operation part, and a driving device. The system includes a manipulated-variable detection device, a speed information acquisition device, a map generation part, a map complementation part, a target speed generation part, and a manipulated-variable input part. The work device is attached to the machine body capably of performing a work motion. The driving device allows a manipulated variable to be input to the driving device, and makes the work device perform the work motion in accordance with the manipulated variable. The operation part allows a work operation for operating the work device to be applied to the operation part, and inputs the manipulated variable corresponding to the work operation to the driving device. The manipulated-variable detection device detects the manipulated variable that is input from the operation part to the driving device. The speed information acquisition device acquires speed information on a motion speed of the work device. The map generation part generates a map based on the manipulated variable detected by the manipulated-variable detection device and the speed information acquired by the speed information acquisition device. The map defines a relationship between the manipulated variable and the motion speed of the work device. When a maximum value of the manipulated variable included in the map generated by the map generation part is smaller than a preset maximum manipulated variable, the map complementation part complements the map so as to render the maximum value of the manipulated variable of the map equal to the maximum manipulated variable. The target speed generation part generates a target speed that is a target value of the motion speed for an automatic operation of the work machine. The manipulated-variable input part generates the manipulated variable for making the work device perform the work motion at the target speed based on the target speed generated by the target speed generation part and the map complemented by the map complementation part, and inputs the manipulated variable to the driving device.
-
-
Fig. 1 is a side view of a work machine according to an embodiment of the present invention. -
FIG. 2 is a block diagram showing components of the work machine and a system for the automatic operation thereof. -
FIG. 3 is a side view showing a target trajectory of the tip of a bucket of the work machine. -
FIG. 4 is a diagram showing a map generated and complemented in the automatic operation system. -
FIG. 5 is a flowchart showing arithmetic control operations performed for generating and complementing the map. -
FIG. 6 is a flowchart showing arithmetic control operations that is performed for the automatic operation of the work machine based on the complemented map. - A preferred embodiment of the present invention will be described with reference to
FIGS. 1 to 6 . -
FIG. 1 shows awork machine 10 according to the embodiment. - The
work machine 10 is a machine for performing work, and an automatic operation of thework machine 10 can be performed by an automatic operation system shown inFIG. 2 . As well as the automatic operation, thework machine 10 can be also manually operated by an operator's operation. Thework machine 10 may be either operated by an operator getting on thework machine 10 or remotely controlled from the outside of thework machine 10. Thework machine 10 is, for example, a construction machine for performing construction work. Thework machine 10 shown inFIG. 1 is an excavator. The work machine to which the automatic operation system according to the present invention is applied, however, may be a work machine other than an excavator, such as a crane. - The
work machine 10 includes amachine body 12, anattachment 15, a driving device and anoperation part 21, the driving device including a plurality ofactuators 17 and adrive control part 19 shown inFIG. 2 . - The
machine body 12 is the main body of thework machine 10. Themachine body 12 includes alower traveling body 11 and an upper turningbody 13. - The lower traveling
body 11 is capable of performing a traveling motion, which causes thework machine 10 to travel on the ground. The lower travelingbody 11 includes a traveling device, for example, a pair of crawlers. - The upper turning
body 13 is mounted on the lower travelingbody 11 capably of turning. The upper turningbody 13 includes acab 13a. Thecab 13a allows an operator to make operations for thework machine 10 in thecab 13a. - The
attachment 15 is a work device capable of performing work motions. Theattachment 15 shown inFIG. 1 includes aboom 15b, anarm 15c, and atip attachment 15d. Theboom 15b is attached to the upper turningbody 13 capably of performing a rising and falling motions, that is, vertically rotational movement, with respect to the upper turningbody 13. Thearm 15c is connected to theboom 15b capably of vertically rotational movement with respect to theboom 15b. Thetip attachment 15d is attached to thearm 15c capably of vertically rotational movement to form the tip of theattachment 15. Thetip attachment 15d shown inFIG. 1 is a bucket that scoops earth and sand. Alternatively, thetip attachment 15d may be either a device that pinches objects, such as a grapple, or a device that crushes objects, such as a breaker. Any part of theattachment 15, which is the work device, can be specified as thecontrol target part 15e. According to the example shown inFIG. 1 , the tip of thetip attachment 15d, that is, the tip of the bucket, is specified as thecontrol target part 15e. Thecontrol target part 15e may be another part, for example, the tip of thearm 15c. - The
attachment 15 is capable of performing a plurality of types of motions as the work motions. The plurality of types of motions include rotational movement of theboom 15b with respect to the upper turningbody 13, specifically, a boom rising motion and a boom falling motion. The boom rising motion is an upward (clockwise direction inFIG. 1 ) rotational movement of theboom 15b with respect to the upper turningbody 13, and the boom falling motion is a downward (counterclockwise inFIG. 1 ) rotational movement of theboom 15b with respect to the upper turningbody 13. The plurality of types of motions include vertically rotational movement of thearm 15c with respect to theboom 15b, specifically, an arm crowd motion and an arm damp motion. The arm crowd motion is a rotational movement of thearm 15c with respect to theboom 15b in a direction in which the tip of thearm 15c approaches theboom 15b (counterclockwise inFIG. 1 ), and the arm damp motion is a rotational movement of thearm 15c with respect to theboom 15b in a direction in which the tip of thearm 15c approaches theboom 15b (clockwise inFIG. 1 ). The plurality of motions include a vertically rotational movement of thetip attachment 15d with respect to thearm 15c, specifically, a first tip attachment motion and a second tip attachment motion. The first tip attachment motion is a rotational movement of thetip attachment 15d with respect to thearm 15c in a direction in which the tip of thetip attachment 15d approaches thearm 15c (counterclockwise inFIG. 1 ), and the second tip attachment motion is a rotational movement of thetip attachment 15d with respect to thearm 15c in a direction in which the tip of thetip attachment 15d goes away from thearm 15c (counterclockwise inFIG. 1 ). Since thetip attachment 15d illustrated inFIG. 1 is the bucket, the first and second tip attachment motions are also referred to as a bucket excavation motion and a bucket dump motion, respectively. The plurality of types of motions include turning motions of turning integrally with theupper turning body 13 with respect to the lower travelingbody 11, specifically, a right turning motion and a left turning motion. - The driving device allows a manipulated variable MV to be input to the driving device, and drives the
attachment 15 so as to make theattachment 15 perform a motion corresponding to the thus input manipulated variable MV. - The plurality of
actuators 17 are disposed at respective appropriate positions in thework machine 10 and driven by drive energy that is supplied from thedrive control part 19 so as to make theattachment 15 perform the plurality of types of motions, respectively. As the plurality ofactuators 17, the driving device according to the present embodiment includes a plurality of hydraulic actuators, namely, a turningmotor 17a, aboom cylinder 17b, anarm cylinder 17c and atip attachment cylinder 17d shown inFIG. 1 , which are driven by the supply of hydraulic fluid. - The turning
motor 17a, which is a hydraulic motor, turns theupper turning body 13 with respect to the lower travelingbody 11 to thereby make theattachment 15 perform the turning motion. The turningmotor 17a, alternatively, may be an electric motor that is driven by the supply of electric power. - Each of the
boom cylinder 17b, thearm cylinder 17c, and thetip attachment cylinder 17d is a hydraulic cylinder. Theboom cylinder 17b performs expansion and contraction motions with respect to theupper turning body 13 so as to make theboom 15b perform the rising and falling motions. Thearm cylinder 17c performs expansion and contraction motions so as to move thearm 15c vertically rotationally with respect to theboom 15b. Thetip attachment cylinder 17d performs expansion and contraction motions so as to move thetip attachment 15d vertically rotationally with respect to thearm 15c. In the case where thetip attachment 15d includes a movable part, such as a device for pinching an object, the driving device may further include an actuator for actuating the movable part. - The
drive control part 19 supplies drive energy (supplies hydraulic fluid in the present embodiment) to the plurality ofactuators 17 to operate the plurality ofactuators 17, and controls the movements of the plurality ofactuators 17 so as to make theattachment 15 performs a motion corresponding to the manipulated variable MV that is input to thedrive control part 19. Thedrive control part 19, thus, controls the drive of theattachment 15 by the plurality ofactuators 17, based on the manipulated variable MV that is input to thedrive control part 19. Thedrive control part 19 illustrated inFIG. 1 includes a hydraulic circuit for supplying hydraulic fluid to the plurality of actuators (hydraulic actuators) 17. In the case where the plurality ofactuators 17 include an electric actuator, thedrive control part 19 may include an electric circuit for supplying electric power to the electric actuator. Thedrive control part 19 controls the motion of theattachment 15 by changing respective directions and speeds of the actions of theactuators 17. - The
drive control part 19 illustrated inFIG. 2 includes ahydraulic pump 19a and a plurality ofcontrol valves 19c. - The
hydraulic pump 19a discharges hydraulic fluid for operating the plurality ofactuators 17. - The plurality of
control valves 19c are interposed between thehydraulic pump 19a and the plurality ofactuators 17, respectively. Each of thecontrol valves 19c makes a valve opening action so as to control the direction and speed of the operation of the correspondingactuator 17 among the plurality ofactuators 17. Specifically, thecontrol valve 19c is composed of a pilot-operated hydraulic selector valve, which is opened by the input of a pilot pressure thereto as the manipulated variable MV, by a stroke corresponding to the pilot pressure, to thereby make the direction and flow rate of hydraulic fluid supplied from thepump 19a to theactuator 17 correspond to the manipulated variable MV. - The
operation part 21 allows an operator to apply a plurality of types of work motions to theoperation part 21. The plurality of types of work motions are operations for make thework machine 10 perform the plurality of types of motions, respectively. Theoperation part 21 may be provided in thecab 13a as shown inFIG. 1 . Theoperation part 21, alternatively, may be provided outside thework machine 10 to allow remote control to be performed. - The
operation part 21 includes a plurality of operation devices to which the plurality of types of work motions are applied, respectively. Each of the operation devices includes a work operation member and a manipulated variable generation part. To the work operation member is applied a corresponding work operation among the plurality of types of work motions. The work operation member may be, for example, either of an operation lever, an operation pedal, a touch panel and a key. The manipulated variable generation part generates the manipulated variable MV corresponding to the direction and magnitude of the work operation applied to the work operation member, namely, a drive command, and inputs the generated manipulated variable to thedrive control part 19. The manipulated variable generation part of each of the operation devices according to the present embodiment is composed of a pilot valve interposed between a non-illustrated pilot hydraulic pressure source (for example, a pilot pump) and acontrol valve 19c that corresponds to the operation device among the plurality ofcontrol valves 19c, configured to be opened by the magnitude of the work operation so as to input a pilot pressure, which corresponds to the direction and magnitude of the work operation, to thecontrol valve 19c as the manipulated variable MV, namely, the drive command. - The manipulated variable MV is not limited to the pilot pressure (hydraulic pressure). For example, in the case where the plurality of
actuators 17 include an electric actuator, the manipulated variable MV may be an electric signal (for example, a current value) to be input to the electric actuator. The manipulated variable MV is generated for each of the types of motions of theattachment 15. In the present embodiment, the plurality of operation devices included in theoperation part 21 correspond to the right turning motion, the left turning motion, the boom rising motion, the boom falling motion, the arm crowd motion, and the arm damp motion, the first tip attachment motion and the second tip attachment motion, respectively, and the operation devices generate respective pilot pressures corresponding to the types of motions as the manipulated variables MV, namely, the drive commands, and input them to thecontrol valves 19c. - The manipulated variable MV has an effective range from the minimum manipulated variable MVmin to the maximum manipulated variable MVmax shown in
FIG. 4 . With just the input of the manipulated variable MV that is less than the minimum manipulated variable MVmin to thecontrol valve 19c, theactuator 17 corresponding to thecontrol valve 19c is not activated; therefore, the motion corresponding to the actuator 17 (for example, boom rising motion) among the plurality of types of motions of theattachment 15 is not performed. The maximum manipulated variable MVmax is the maximum value of the manipulated variable MV that is input from theoperation part 21 to thedrive control part 19. For example, in the case where the manipulated variable MV is a pilot pressure, the maximum manipulated variable MVmax is the maximum pilot pressure that can be input to thecontrol valve 19c (for example, 3MPa). By the input of the maximum manipulated variable MVmax, both the opening degree of thecontrol valve 19c and the flow rate of the hydraulic fluid supplied from thecontrol valve 19c to theactuator 17 is maximized, causing theactuator 17 to actuate the movable part that is connected to theactuator 17 at the maximum speed. - The automatic operation system is a system that generates a manipulated variable MV separately from the
operation part 21 and inputs it to the driving device to thereby execute an automatic operation of thework machine 10. Specifically, the automatic operation system includes a manipulated-variable detection device 23, aposture detection device 25, acontroller 30, which are shown inFIG. 2 , and a non-illustrated solenoid valve. - The manipulated-
variable detection device 23 detects the manipulated variable MV which is input from theoperation part 21 to the driving device (thedrive control part 19 in the present embodiment). The manipulated-variable detection device 23 according to the present embodiment includes a plurality of manipulated-variable sensors that detect respective manipulated variables MV that are input from the plurality of operation devices to the plurality ofcontrol valves 19c, namely, respective pilot pressures, and each of the manipulated-variable sensors is a pressure sensor. In the case where the manipulated variable MV is an electrical signal, the manipulated-variable detection device 23 may either include a sensor that detects an electrical signal, such as a current sensor, or be included in thecontroller 30. - The plurality of manipulated-variable sensors included in the manipulated-
variable detection device 23 detect a plurality of manipulated variables MV corresponding to the types of motions of theattachment 15, respectively. Specifically, the plurality of manipulated-variable sensors include a right turning manipulated-variable sensor 23a1, a left turning manipulated-variable sensor 23a2, a boom rising manipulated-variable sensor 23b1, a boom falling manipulated-variable sensor 23b2, an arm crowd manipulated-variable sensor 23c1, an arm dump manipulated-variable sensor 23c2, a tip attachment first manipulated-variable sensor 23d1 and a tip attachment second manipulated-variable sensor 23d2, which sensors are shown inFIG. 2 . - Each of the manipulated-
variable detection device 23, theposture detection device 25 and thecontroller 30 may be either installed on thework machine 10 or placed outside thework machine 10. - The
posture detection device 25 detects a physical quantity related to the posture of theattachment 15, serving as a speed information acquisition part that acquires speed information on a motion speed, which is the speed of the motion of theattachment 15. Theposture detection device 25 may detect either a physical quantity directly related to the posture of theattachment 15, such as an angle or a position of a specific part of theattachment 15, or a velocity or angular velocity of the specific part of theattachment 15. In other words, theposture detection device 25 may be configured either to directly detect the speed of the motion of theattachment 15 or to detect information for indirectly acquiring the speed of theattachment 15, for example, at least one of the posture and the acceleration (or angular acceleration). - The
posture detection device 25 according to the present embodiment includes a plurality of sensors corresponding to respective motions of theattachment 15, namely, a turningsensor 25a, aboom sensor 25b, anarm sensor 25c and atip attachment sensor 25d, which are shown inFIG. 4 . - The turning
sensor 25a detects a physical quantity related to the posture of theupper turning body 13 with respect to the lower travelingbody 11 shown inFIG. 1 , namely, the turning posture that is the posture with respect to the turning direction. The turningsensor 25a is, for example, an angle sensor that detects the turning angle of theupper turning body 13 with respect to the lower travelingbody 11, the angle sensor being attachable to, for example, a turning shaft or a turning support part. - The
boom sensor 25b detects a physical quantity related to the posture of theboom 15b. Theboom sensor 25b is, for example, an angle sensor (for example, a rotary encoder) that detects the rotation angle (rising angle) of theboom 15b with respect to theupper turning body 13, the angle sensor being attachable to the rotation support shaft of theboom 15b, namely, a boom foot pin, or the part that supports theboom 15b. - The
arm sensor 25c is a sensor that detects a physical quantity related to the posture of thearm 15c, for example, an angle sensor that detects the rotation angle of thearm 15c with respect to theboom 15b. Similarly, thetip attachment sensor 25d is a sensor that detects a physical quantity related to the posture of thetip attachment 15d, for example, an angle sensor that detects the rotation angle of thetip attachment 15d with respect to thearm 15c. - The
boom sensor 25b, thearm sensor 25c and thebucket sensor 25d, alternatively, may include tilt sensors (for example, gyro sensors, acceleration sensors, inertial measurement devices) which detect respective angles of theboom 15b, thearm 15c and thetip attachment 15d to the horizontal surface, namely, respective inclination angles thereof. - Alternatively, the
boom sensor 25b, thearm sensor 25c and thetip attachment sensor 25d may be respective stroke sensors that detect the stroke of theboom cylinder 17b, the stroke of thearm cylinder 17c, and the stroke of thetip attachment cylinder 17d. - Alternatively, the turning
sensor 25a, theboom sensor 25b, thearm sensor 25c and thetip attachment sensor 25d may detect physical quantities (including motion speeds) related to respective postures of theupper turning body 13, theboom 15b, thearm 15c and thetip attachment 15d based on at least one of a two-dimensional image or a distance image. - The
controller 30 is a device that performs arithmetic control operations for the automatic operation of thework machine 10 based on information acquired by the manipulated-variable detection device 23 and theposture detection device 25, being composed of, for example, a computer including an interface that performs inputs and outputs signals, an calculation unit that performs calculation proceedings, and a storage unit that stores information. The functions of thecontroller 30 are provided, for example, through the execution of a program stored in the storage unit by the calculation unit. Specifically, thecontroller 30 shown inFIG. 2 includes amap generation part 41, amap complementation part 43, amap storage part 45, a workplan setting part 51, a targetspeed generation part 53 and a manipulated-variable calculation part 55, which constitutes a manipulated-variable input part in association with the non-illustrated electromagnetic valve. - The
map generation part 41 generates, for example, a map M shown inFIG. 4 based on the manipulated variable MV detected by the manipulated-variable detection device 23, that is, the manual manipulated variable MVm that is input from theoperation part 21 to thedrive control part 19 through a manual operation by an operator, and the speed information acquired by theposture detection device 25. The map M defines the relationship between a motion speed V provided by the speed information, that is, the speed of the motion of the attachment 15 (in the present embodiment, each of the types of motions), and the manipulated variable MV detected by the manipulated-variable detection device 23. Themap complementation part 43 performs complementation of the map M when the complementation is necessary. The case where the complementation is necessary and the detail of the complementation are described below. Themap storage part 45 stores the map M. The map M stored in themap storage part 45 is the map generated by themap generation part 41 when no complementation is performed by themap complementation part 43, or the complemented map when the complementation is performed by themap complementation part 43. - The work
plan setting part 51 sets a work plan for thework machine 10. The work plan is information that serves as a target of the work motion of thework machine 10. The work plan, in the present embodiment, includes information about a target trajectory T of thecontrol target part 15e (the tip of the bucket in the example shown inFIG. 3 ). The information about the target trajectory T includes respective positions (coordinates) of a plurality of target points of thecontrol target part 15e included in the target trajectory T, and information about the order of the plurality of target points. The information about the target trajectory T may include, as information on the respective positions of the plurality of target points, at least one of information on the turning angle of theupper turning body 13, information on the distance from the turning center of theupper turning body 13 with respect to the lower travelingbody 11 to thecontrol target part 15e, namely, a work radius, and information about the height of thecontrol target part 15e. The information about the target trajectory T may include a movement time of thecontrol target part 15e between adjacent target points among the plurality of target points or a parameter corresponding thereto. - The work plan that is set by the work
plan setting part 51 according to the present embodiment includes a plurality of work phases F. Each of the work phases F includes information about the target trajectory T. The plurality of work phases F, in the work plan shown inFIG. 3 , include a series of phases, namely, a capture phase F1, a lifting and turning phase F2, a release phase F3 and a return turning phase F4, the series of phases F1 to F4 constituting a single cycle. - The capture phase F1 is a phase corresponding to a motion in which the
tip attachment 15 captures a work object. The work object is not limited but allowed to be, for example, any of soil, wood, metal, and waste. The motion corresponding to the capture phase F1 is, for example, the motion of excavating earth and sand of soil. - The lifting and turning phase F2 corresponds to a lifting and turning motion in which the
control target part 15e moves from a capture position at which the work object is to be captured to a release position at which the work object is to be released with thetip attachment 15d capturing the work object. The lifting and turning motion is a composite motion including at least the boom rising or falling motion and the turning motion, which motions are simultaneously performed. - The release phase F3 corresponds to a release motion in which the
tip attachment 15d releases the work object at the release position. The release motion is, for example, a motion for discharging soil to a vessel of a transport vehicle D shown inFIG. 3 or the like, including a rotational motion of thetip attachment 15d. - The return turning phase F4 corresponds to a return turning motion in which the
control target part 15e moves from the release position to a position where thetip attachment 15d captures a work object next time. The return turning motion is a composite motion including at least the boom rising or falling motion and the turning motion, which motions are simultaneously performed. - The work plan that is set by the work
plan setting part 51 according to the present embodiment includes a plurality of cycles (e.g., ten times). The workplan setting part 51 may set, for example, different target trajectories T for respective cycles. The workplan setting part 51 may set, for example, the work plan so as to render respective target capture positions of the work objects in the plurality of cycles different from each other. The workplan setting part 51 may set, for example, the work plan so as to render respective target release positions of the work objects in the plurality of cycles different from each other. The workplan setting part 51 may set, for example, the work plan so as to terminate the series of cycles when a predetermined termination condition is satisfied. The termination condition is, for example, that the amount of the work object being laid in a place where the work object is to be collected (e.g., sediment pit S, etc.) is equal to or less than a predetermined value or that the number of cycles that has been performed is equal to a predetermined number of times. The workplan setting part 51 may set the work plan so as to start the next cycle when a predetermined restart condition is satisfied after one cycle is terminated. The restart condition is, for example, that a work object of a predetermined amount or more is replenished to a place where the work object is to be collected (such as a sediment pit S). - The work
plan setting part 51 may set the work plan based on either the teaching executed by the operator or a method other than the teaching (e.g., numerical input by an operator, etc.). The teaching includes, for example, manually moving thecontrol target part 15e along a trajectory corresponding to the desired target trajectory T by (i) application of a work operation to theoperation part 21 by an operator getting on thework machine 10 or (ii) application of a work operation to theoperation part 21 provided outside thework machine 10 by an operator. The workplan setting part 51 sets the trajectory along which thecontrol target part 15e thus has been manually moved, as the target trajectory T. - The target
speed generation part 53 generates a target speed during the performance of the automatic operation of thework machine 10, i.e., a target value of the motion speed of theattachment 15, for example, by calculation. The targetspeed generation part 53 according to the present embodiment generates a plurality of target speeds corresponding to the plurality of types of motions of theattachment 15, respectively. Specifically, the targetspeed generation part 53 generates the plurality of target speeds so as to allow thework machine 10 to be automatically operated in accordance with the work plan set by the workplan setting part 51, that is, so as to make theattachment 15 perform a motion corresponding to the work plan. The targetspeed generation part 53 generates the target speed so as to cause thecontrol target part 15e to move along the target trajectory T. - The manipulated-
variable calculation part 55 calculates the manipulated variable MV for making theattachment 15 perform each of the types of motions at the target speed generated by the targetspeed generation part 53, namely, an automatic-operation manipulated variable MVa. Specifically, based on the target speed generated by the targetspeed generation part 53 and the map M complemented by the map complementation part 43 (or the map M generated by themap generation part 41 when no complementation is performed), the manipulated-variable calculation part 55 calculates the manipulated variable MV for making theattachment 15 perform the work motion at the target speed (automatic-operation manipulated variable MVa). The manipulated-variable calculation part 55 further generates a manipulated-variable command signal, which is an electric signal necessary for inputting the manipulated variable MV to thedrive control part 19, and inputs the manipulated-variable command signal to each of the solenoid valves. - The plurality of solenoid valves are interposed between the non-illustrated pilot hydraulic source and the plurality of
control valves 19c, respectively, constituting a manipulated-variable input part in association with the manipulated-variable calculation part 55. Each of the solenoid valves allows the manipulated-variable command signal to be input from the manipulated-variable calculation part 55 to the solenoid valve, and performs valve opening to allow the pilot pressure corresponding to the input manipulated-variable command signal, namely, the automatic-operation manipulated variable MV to be input to thecontrol valve 19c. The solenoid valve, which only has to be configured to change the secondary pressure of the solenoid valve, that is, the pilot pressure to be input to thecontrol valve 19c, in response to the input electrical signal, may be either an electromagnetic proportional pressure regulation valve or an electromagnetic proportional reverse proportional valve. - Next will be described actions for automatic operation executed by the automatic operation system with reference to the flowcharts of
FIGS. 5 and6 . The actions for the automatic operation include the actions shown inFIG. 5 , i.e., (A) actions for the generation and complementation of the map M, and the actions shown inFIG. 6 , i.e., (B) actions for actually performing the automatic operation of thework machine 10. - To generate the map M, a manual operation is performed by an operator (step S11 in
FIG. 5 ). Specifically, a work operation is applied by an operator to each of the necessary operation devices included in theoperation part 21. The work operation to be applied to theoperation part 21 may be either an operation performed for purpose of nothing but generating the map M or a teaching operation for setting the work plan. Theoperation part 21, when the work operation is applied thereto, inputs a manipulated variable MV (pilot pressure in the present embodiment) corresponding to the work operation to the drive device (in the present embodiment, each of thecontrol valves 19c of the drive control part 19). The driving device, when the manipulated variable MV is input thereto, actuates theattachment 15 so as to make theattachment 15 perform the motion corresponding to the manipulated variable MV. Specifically, in the present embodiment, the pilot pressure as the manipulated variable MV is input to each of thecontrol valves 19c of thedrive control part 19 to make thecontrol valve 19c perform valve opening by an opening degree corresponding to the pilot pressure, and thecontrol valve 19c allows hydraulic fluid to be supplied to theactuator 17 that is connected to thecontrol valve 19c among the plurality ofactuators 17 at a flow rate corresponding to the pilot pressure. - On the other hand, the manipulated-
variable detection device 23 detects the manipulated variable MV (the pilot pressure in the present embodiment) to be input from theoperation part 21 to thedrive control part 19. Besides, theposture detection device 25 detects the motion speed V, which is a physical quantity related to the posture of theattachment 15 and which is the speed of the motion of each of theattachments 15, for example, the operating speed of each of theactuators 17. - The
map generation part 41 of thecontroller 30 generates a map M indicating the relationship between the manipulated variable MV detected by the manipulated-variable detection device 23 in the manual operation, namely, the manual manipulated variable MVm, and the motion speed V acquired from the information detected by theposture detection device 25 when the manipulated variable MV is detected. - The
map generation part 41 preferably generates a plurality of different maps M that correspond to a plurality of types of motions of the attachment 15 (for example, boom rising motion, boom falling motion) shown inFIG. 3 , respectively. In short, themap generation part 41 is preferably configured to generate the map M for each of the types of motions. - Preferably, the
map generation part 41 generates different maps M corresponding to the plurality of work situations of thework machine 10, respectively. In short, themap generation part 41 is preferably configured to generate the map M for each of the work situations. Examples of the working situation of thework machine 10 include the work phase F, the cycle, and other load conditions (the condition of the load acting on the attachment 15). - Preferably, the
map generation part 41 generates different maps M corresponding to the plurality of work phases F, respectively. In short, themap generation part 41 is preferably configured to generate the map M for each of the work phases F. The reason therefor is, for example, as follows. - [1 Load Condition] Focusing on, for example, the
boom 15b of theattachment 15, the condition of the load acting on theboom 15b is varied depending on the work phase F. This causes a case where the relationship between the manipulated variable MV and the motion speed V is varied depending on the work phase F even with the same work motion (e.g., boom rising motion) of theboom 15b. The same applies to the other work motions than the boom rising motion. It is preferable, therefore, that themap generation part 41 generates a plurality of different maps M corresponding to the plurality of work phases F, respectively. - [2 Composite Motion] Different composite motions are performed depending on the work phases F. The composite motion is the simultaneous performance of a plurality of motions (e.g., the boom rising motion and the arm crowd motion) selected from the plurality of types of motions of the
attachment 15. In the composite motion, the hydraulic fluid discharged from thehydraulic pump 19a is distributed to a plurality of actuators (hydraulic actuators in the present embodiment) 17 corresponding to the plurality of motions, respectively. This causes a case where the motion speed V corresponding to the same motion (e.g., boom rising motion) and the same manipulated variable MV is varied depending on the work phase F. The same is the case other than the boom rising motion. Besides, also in the case where the plurality ofactuators 17 are a plurality of electric actuators, limited power is distributed to the plurality of electric actuators. It is preferable, therefore, that themap generation part 41 generates a plurality of different maps M corresponding to the plurality of work phases F, respectively. - Table 1 below shows a specific example of the plurality of maps M generated by the
map generation part 41 and corresponding to the plurality of types of motions and the plurality of phases F, respectively.[TABLE 1] WORK PHASE F TYPE OF MOTION BOOM RISING MOTION BOOM FALLING MOTION ARM CROWD MOTION ARM DUMP MOTION TIP ATT FIRST MOTION TIP ATT SECOND MOTION RIGHT TURNING MOTION LEFT TURNING MOTION CAPTURE PHASE F1 BOOM RISING MAP 1 BOOM FALLING MAP 1 ARM CROWD MAP 1 ARM DUMP MAP 1 TIP ATT FIRST MAP 1 TIP ATT SECOND MAP 1 RIGHT TURNING MAP 1 LEFT TURNING MAP 1 LIFTING TURNING PHASE F2 BOOM RISING MAP 2 BOOM FALLING MAP 2 ARM CROWD MAP 2 ARM DUMP MAP 2 TIP ATT FIRST MAP 2 TIP ATT SECOND MAP 2 RIGHT TURNING MAP 2 LEFT TURNING MAP 2 RELEASE PHASE F3 BOOM RISING MAP 3 BOOM FALLING MAP 3 ARM CROWD MAP 3 ARM DUMP MAP 3 TIP ATT FIRST MAP 3 TIP ATT SECOND MAP 3 RIGHT TURNING MAP 3 LEFT TURNING MAP 3 RETURN TURNING PHASE F4 BOOM RISING MAP 4 BOOM FALLING MAP 4 ARM CROWD MAP 4 ARM DUMP MAP 4 TIP ATT FIRST MAP 4 TIP ATT SECOND MAP 4 RIGHT TURNING MAP 4 LEFT TURNING MAP 4 - Preferably, the
map generation part 41 generates a plurality of different maps M corresponding to a plurality of cycles, respectively, the plurality of cycles composed of the series of work phases F, respectively. In summary, themap generation part 41 is preferably configured to generate the map M for each of the cycles. For example, there can be assumed a case where respective target trajectories T set in the plurality of cycles are different from each other, whereby respective conditions of the loads acting on theattachment 15 in the plurality of cycles are different from each other. This generates a possibility that the relationship between the manipulated variable MV and the motion speed V with the same operation (e.g., boom rising motion) and the same work phase F is varied depending on the cycle. This is the same as to a work operation other than the boom rising motion. It is, therefore, preferable that themap generation part 41 generates a plurality of different maps M corresponding to the cycles, respectively, the cycles composed of the series of work phases F, respectively. - The plurality of conditions of the load acting on the
attachment 15 are not limited to those due to the work phase F or the cycle. Themap generation part 41 may generate, for example, a plurality of different maps M depending on the condition (e.g., mass, size) of the object which is captured by theattachment 15. - Alternatively, in the case of presence of a plurality of situations that are different from each other in the relationship between the manipulated variable MV and the motion speed V due to a cause other than the load acting on the
attachment 15, themap generation part 41 may generate a plurality of different maps M corresponding to the situations, respectively. In summary, themap generation part 41 is preferably configured to generate the map M for each of the situations. - When the maximum value of the manipulated variable MV included in the thus generated map M is smaller than a preset maximum manipulated variable MVmax (YES in step S13), the
map complementation part 43 of thecontroller 30 complements the map M so as to render the maximum value of the manipulated variable MV of the map M equal to the maximum manipulated variable MVmax (step S14). The details are as follows. - Although the
map generation part 41 generates the map M for defining the relationship between the manipulated variable MV and the motion speed V on the basis of the manipulated variable MV that is input to thedrive control part 19 when a work operation is applied to theoperation part 21 by the manual operation and the motion speed V (step S11), there can be a case where a work operation having a size corresponding to the maximum manipulated variable MVmax is not applied to theoperation part 21 in the manual operation. For example, as shown inFIG. 4 , there can be a case where the maximum acquisition manipulated variable MV1, which is the maximum value of the manipulated variable (manual manipulated variable) MVm acquired by the manual operation, is less than the maximum manipulated variable MVmax. In this case, in the range where the manipulated variable MV is larger than the maximum acquisition manipulated variable MV1, that is, in the range where the motion speed V is larger than the maximum acquisition speed V1 which is the motion speed corresponding to the maximum acquisition manipulated variable MV1, the manipulated-variable detection device 23 and theposture detection device 25 cannot acquire the manipulated variable MV and the motion speed V. Thus is generated a non-acquirable range where neither of the manipulated variable MV1 and the motion speed V for generating the map M can be acquired by the manual operation, on the side where the manipulated variable MV1 and the motion speed are larger than that in the ready-generated map portion M1 which can be generated by the manual operation (right side and upper side inFIG. 4 ). - The presence of the non-acquisition range causes, for example, the following problems. During automatic operation of the
work machine 10 described below, the targetspeed generation part 53 of thecontroller 30 may generate a target speed greater than the maximum acquisition speed V1 as a target speed Vt for the automatic operation. For example, during the performance of the automatic operation of thework machine 10 shown inFIG. 3 , an application of a load larger than the maximum value of the load applied to theattachment 15 when the manual operation is being performed (Step S11) may cause a target speed Vt greater than the maximum acquisition speed V1 to be generated. The manipulated variable MV corresponding to the target speed Vt greater than the maximum acquisition speed V1 (i.e., the manipulated variable MV greater than the maximum acquisition manipulated variable MV1), however, is not included in the ready-generated map portion M1. The ready-generated map portion M1, thus, cannot provide a target speed for making theattachment 15 perform the work motion at a speed greater than the maximum acquisition speed V1. Hence, thework machine 10, in spite of its ability to actuate theattachment 15 at a motion speed V greater than the maximum acquisition speed V1 (e.g., the maximum speed Vmax), cannot execute a control to make theattachment 15 perform a work motion at the motion speed V greater than the maximum acquisition speed V1. This hinders, for example, a delay of the actual position of thecontrol target part 15e with respect to the position of thecontrol target part 15e specified by the target trajectory T shown inFIG. 3 (that is, the target position) from being recovered. - Such a problem due to the presence of the non-acquisition range could be solved by an application of a work operation with a magnitude corresponding to the maximum manipulated variable MVmax to the
operation part 21 by an operator in the manual operation (step S11); however, this involves another problem as follows. For example, in the case of the map M generated based on the result of the teaching for the purpose of setting a work plan, etc., an operator has to apply a special operation for generating a map M in which the maximum acquisition manipulated variable MV1 reaches the maximum manipulated variable Pmax, that is, a work operation greater than the maximum value of the work operation required for the teaching, to theoperation part 21, separately from the teaching. This increases the workload of the operator. Besides, the operation applied for generating such a map M that the maximum acquisition manipulated variable MV1 reaches the maximum manipulated variable MVmax, that is, a work operation with the magnitude corresponding to the maximum manipulated variable MVmax, will cause a high-speed motion of theattachment 15 at the maximum speed Vmax. Such performance of the work motion by theattachment 15 at a speed more than the necessary motion speed during the manual operation requires an operator to pay attention to prevent theattachment 15 from coming into contact with surrounding objects, thus increasing the workload of the operator. Furthermore, it will force unaccustomed work operations upon operators who does not tend to perform a great work operation corresponding to the maximum manipulated variable MVmax (i.e., operators who tend to do work at relatively low speeds). - To solve the aforementioned problems, the
map complementation part 43 complements the entire map M by compensating an additional map portion M2 for the non-acquisition range in addition to the ready-generated map portion M1. Specifically, when the maximum acquisition manipulated variable MV1, which is the maximum value of the manipulated variable MV in the ready-generated map portion M1, does not reach the preset maximum manipulated variable MVmax (YES in step S13), themap complementation part 43 generates the additional map portion M2 to complement the map M (Step S14). Specifically, themap complementation part 43 complements the map M so as to render the maximum value of the manipulated variable MV included in the map M equal to the maximum manipulated variable MVmax. On the other hand, when the maximum acquisition manipulated variable MV1 reaches the maximum manipulated variable MVmax (NO in step S13), themap complementation part 43 performs no complementation of the map M, thus maintaining the map M generated by themap generation part 41 as it is. - For the case where a plurality of maps M are generated by the
map generation part 41, it is preferable that themap complementation part 43 complements each of the maps M. For example, in the case where themap generation part 41 has generated a plurality of different maps M corresponding to the plurality of types of motions of theattachment 15, respectively, it is preferable that themap complementation part 43 complements each of the maps M corresponding to the plurality of types of motions, respectively. In the case where themap generation part 41 has generated a plurality of maps M corresponding to the work phases F, respectively, it is preferable that themap complementation part 43 complements each of the maps M corresponding to the work phases F, respectively. In the case where themap generation part 41 has generated a plurality of maps M corresponding to a plurality of cycles, respectively, the cycles composed of a series of the work phases F, respectively, it is preferable that themap complementation part 43 complements each of the maps M corresponding to the cycles, respectively. - The specific method of complementation by the
map complementation part 43, that is, the generation of the additional map portion M2 in the present embodiment, is not limited. The additional map portion M2 may be either (1) generated based on information on the maximum speed Vmax that is set in advance (e.g., stored in the controller 30) or (2) estimated from the ready-generated map portion M1. The details are as follows. - The additional map portion M2 can be generated based on information on the motion speed V corresponding to the maximum manipulated variable MVmax, namely, the maximum speed Vmax. The information is information set in advance of the complementation of the map M, for example, information prestored in the
controller 30. - The information of the maximum speed Vmax, for example, may be included in a base map BM as shown in
FIG. 4 . The base map BM is prepared in advance, as a base of the map M, for example, prestored in thecontroller 30. The base map BM defines the relationship between the manipulated variable MV and the motion speed V over the full range from the minimum manipulated variable MVmin to the maximum manipulated variable MVmax. The base map BM illustrated inFIG. 4 defines the relationship given by a straight line with a constant inclination. The base map BM, alternatively, may be provided in a curve. - The base map BM may be set either prior to the shipping (e.g., during manufacturing) of the
work machine 10 or by an operator or the like upon the start of work perform by thework machine 10 at a new work site. Alternatively, may be performed teaching for generating the base map BM prior to teaching for generating the map M. - Similarly to the map M, a plurality of base maps BM may be set correspondingly to various states of the work machine 10 (see
FIG. 1 ). For example, may be set either a plurality of base maps BM corresponding to the plurality of types of motions of theattachment 15 or a plurality of base maps BM corresponding to a plurality of conditions of a load acting on theattachment 15. - In the case of the performance of teaching for generating the plurality of maps M corresponding to a plurality of states of the
work machine 10, a plurality of base maps BM corresponding to the plurality of states of thework machine 10 are used for the complementation of the maps M. For example, it is preferable that the condition of a load acting on theattachment 15 is detected when the teaching for generating each of the maps M is performed and themap complementation part 43 selects the base map BM corresponding to the detected load condition (e.g., equivalent to or close to the load condition) from among the plurality of base maps BM to complement the map M based on the selected base map BM. - The
map complementation part 43 generates the additional map portion M2 for the range where the manipulated variable MV is larger than the maximum acquisition manipulated variable MV1, without changing the ready-generated map portion M1 (e.g., so as to directly reflect the teaching result onto the map M). Specifically, themap complementation part 43 performs the generation of the additional map portion M2, i.e., the complementation of the map M, based on the relationship between the maximum manipulated variable MVmax specified at the terminal end of the base map BM and the maximum speed Vmax. For example, themap complementation part 43 may either set, as shown inFIG. 4 , the maximum speed Vmax specified in the base map BM directly as the motion speed (maximum speed Vmax) corresponding to the maximum manipulated variable MVmax of the complemented map M or complement the map M by extending the map M from the ready-generated map portion M1 to the maximum manipulated variable MVmax based on the inclination of the base map BM, that is, the rate of increase in the manipulated variable MV to the increase in the motion speed V. The ready-generated map portion M1 may be slightly modified along with the generation of the additional map portion M2. - The maximum speed Vmax corresponding to the maximum manipulated variable MVmax is not limited to one based on the base map BM. For example, may be prestored in the controller 30 (in advance of the complementation of the map M) just the value of the maximum speed Vmax corresponding to the maximum manipulated variable MVmax. Besides, a plurality of maximum speeds Vmax corresponding to the maximum manipulated variable MVmax may be set correspondingly to the plurality of states of the
work machine 10. For example, themap complementation part 43 may select the maximum speed Vmax corresponding to the state of thework machine 10, which state is acquired when teaching for setting the map M is performed, from among a plurality of maximum speeds Vmax prepared correspondingly to the maximum manipulated variable MVmax to complement the map M based on the thus selected maximum speed Vmax. - The
map complementation part 43 may complement the map M by estimating the additional map portion M2 from the ready-generated map portion M1. For example, themap complementation part 43 may generate the additional map portion M2 by extending the ready-generated map portion M1. The extension can be made based on, for example, the inclination of the terminal part of the graph that indicates the relationship between the motion speed V and the manipulated variable MV in the ready-generated map portion M1, i.e., the rate of increase in the manipulated variable MV to the increase in the motion speed V at the terminal part. The terminal part is the end part on the side closer to the maximum manipulated variable MVmax i n the graph (right side inFIG. 4 ). For example, the inclination of the terminal end may be either of (a) the inclination at the terminal end of the ready-generated map portion M1, that is, the point corresponding to the maximum acquisition speed V1 (a portion corresponding to the maximum acquisition manipulated variable MV1), (b) the average value of the inclination in the range from the speed V smaller than the maximum acquisition speed V1 by a predetermined value to the maximum acquisition speed V1 in the ready-generated map portion M1, (c) the average value of the inclination in the range from the manipulated variable MV1 smaller than the maximum acquisition manipulated variable MV1 by a predetermined value to the maximum acquisition manipulated variable MV1 in the ready-generated map portion M1. The additional map portion M2 generated by themap complementation part 43 may be either a straight line with the "inclination" that is set based on the ready-generated map portion M1 or a line (e.g., a straight line or a curve) calculated based on the "inclination". The additional map portion M2, alternatively, may be generated based on the average value of the inclination of the entire ready-generated map portion M1. - Specific method for complementing the map M by the
map complementation part 43 is not limited to above-described ones. For example, themap complementation part 43 may complement the map M based on both the base map BM and the inclination of the graph of the ready-generated map portion M1. - Next will be described arithmetic control operations to be performed for the automatic operation of the
work machine 10 with reference to the flowchart ofFIG. 6 . - The target
speed generation part 53 of thecontroller 30 generates a target speed Vt so as to make thework machine 10 perform the plurality of types of motions according to the work plan that is set by the work plan setting part 51 (Step S21). Specifically, the targetspeed generation part 53 generates a plurality of target speeds Vt corresponding to the plurality of types of motions (e.g., boom rising motion, boom falling motion) of theattachment 15, respectively. The targetspeed generation part 53 inputs (instructs) the thus generated target speed to the manipulated-variable calculation part 55. - The manipulated-
variable calculation part 55 reads, from themap storage part 45, the map M corresponding to the current work state of thework machine 10 among the plurality of maps M stored in the map storage part 45 (Step S22). For example, the manipulated-variable calculation part 55 reads a plurality of maps M corresponding to the types of motions of theattachment 15, respectively. Other examples of the map M to be read by the manipulated-variable calculation part 55 include a map M corresponding to the current load condition of theattachment 15, a map M corresponding to the current work phase F, and a map M corresponding to the current cycle. - Based on the map M read from the
map storage part 45, the manipulated-variable calculation part 55 calculates (determines) the manipulated variable MV corresponding to the target speed Vt generated by the targetspeed generation part 53, namely, an automatic-operation manipulated variable MVa (Step S23). For example, according to the map M shown inFIG. 4 , when the target speed Vt generated by the targetspeed generation part 53 is equal to or less than the maximum acquisition speed V1, the manipulated-variable calculation part 55 calculates the manipulated variable MV corresponding to the target speed Vt based on the ready-generated map portion M1, whereas, when the target speed Vt is larger than the maximum acquisition speed V1, the manipulated-variable calculation part 55 calculates the manipulated variable MV corresponding to the target speed Vt based on the additional map portion M2 added by themap complementation part 43. - The manipulated-
variable calculation part 55 generates a manipulated-variable command signal for providing the thus determined manipulated variable MV (pilot pressure in the present embodiment) and inputs it to the not-illustrated solenoid valve (Step S24). The solenoid valve is opened so as to allow the pilot pressure to be input to thedrive control part 19 in response to the manipulated-variable command signal. Thedrive control part 19 changes the movement of the actuator 17 corresponding to the manipulated variable MV among the plurality ofactuators 17 based on the input pilot pressure, i.e., the manipulated variable MV (automatic-operation manipulated variable MVa). Thus, the automatic operation of thework machine 10 based on the target speed Vt generated by the targetspeed generation part 53 is performed. In the case where theactuator 17 is an electric actuator, an electric signal (command signal) corresponding to the manipulated variable MV may be either directly input to the electric actuator from the manipulated-variable calculation part 55 or input to a circuit for controlling the action of the electric actuator. - The complementation of the map M by the
map complementation part 43 enables the followability of the motion speed V to the target speed Vt in the automatic operation to be improved. For example, below will be described assuming the case where thecontrol target part 15e has an actual motion speed V that is lower than the target speed Vt of thecontrol target part 15e because of the large load acting on theattachment 15, which deviates (delays) the actualcontrol target part 15e from the target position of thecontrol target part 15e at a certain point in time. In this case, the targetspeed generation part 53 generates a high target speed Vt so as to reduce the delay; however, if the target speed Vt is greater than the maximum acquisition speed V1 shown inFIG. 4 , the manipulated variable MV corresponding to the target speed Vt cannot be calculated with only the ready-generated map portion M1. In summary, without complementation of the map M by themap complementation part 43, the manipulated-variable calculation part 55 cannot calculate the manipulated variable MV corresponding to the target speed Vt that exceeds the maximum acquisition speed V1. In contrast, the complementation of the map M by themap complementation part 43, i.e., the addition of the additional map portion M2, enables the manipulated-variable calculation part 55, even when the target speed Vt is greater than the maximum acquisition speed (for example, the maximum value of the speed V when the work plan is taught) V 1, to calculate the manipulated variable MV corresponding to the target speed Vt (> V1) based on the additional map portion M2, thereby allowing the delay of the speed V and the position of thecontrol target part 15e to be quickly reduced. - The embodiments described above may be variously modified. For example, the connection of each component shown in
FIG. 2 of the above embodiment may be changed. For example, the order of the steps of the flowcharts illustrated inFIGS. 5 and6 may be changed and some of the steps may not be performed. For example, the number of components may be changed and some of the components may not be provided. For example, the fixation, connection, etc. of the components may be direct or indirect. For example, what has been described as a plurality of members or parts different from each other may be one member or part. For example, what has been described as one member or part may be divided into a plurality of members or parts different from each other. For example, each component may have only a portion of each feature (working function, arrangement, shape, actuation, etc.). - As has been described, there is provided a system for performing an automatic operation of a work machine, the system being capable of making the speed of the motion of a work device of the work machine quickly follow a target speed. The system is a system for performing an automatic operation of a work machine that includes a machine body, a work device, an operation part, and a driving device. The system includes a manipulated-variable detection device, a speed information acquisition device, a map generation part, a map complementation part, a target
speed generation part 53, and a manipulated-variable input part. The work device is attached to the machine body capably of performing a work motion. The driving device allows a manipulated variable to be input to the driving device, and makes the work device perform the work motion in accordance with the manipulated variable. The operation part allows a work operation for operating the work device to be applied to the operation part, and inputs the manipulated variable corresponding to the work operation to the driving device. The manipulated-variable detection device detects the manipulated variable to be input from the operation part to the driving device. The speed information acquisition device acquires speed information on a motion speed that is a speed of the work motion of the work device. The map generation part generates a map based on the manipulated variable detected by the manipulated-variable detection device and the speed information acquired by the speed information acquisition device. The map defines a relationship between the manipulated variable and the motion speed of the work device. When a maximum value of the manipulated variable included in the map generated by the map generation part is smaller than a preset maximum manipulated variable, the map complementation part complements the map so as to render the maximum value of the manipulated variable of the map equal to the maximum manipulated variable. The target speed generation part generates a target speed that is a target value of the motion speed for an automatic operation of the work machine. The manipulated-variable input part generates the manipulated variable for making the work device perform the work motion at the target speed based on the target speed generated by the target speed generation part and the map complemented by the map complementation part, and inputs the manipulated variable to the driving device. - The map complementation part enables the manipulated-variable input part to generate the manipulated variable corresponding to the target speed based on the complemented map and input the manipulated variable to the driving device even when a target speed greater than a maximum value of the manipulated variable included in the map generated by the map generating part is generated by the target speed generating part. This makes it possible to perform a control for reducing a delay caused by the lower actual motion speed of the work device in the automatic operation than the target speed, thereby allowing the followability of the motion speed of the work device to the target speed to be improved.
- Preferably, the map complementation part is configured to complement the map based on information that is preset for the motion speed corresponding to the maximum manipulated variable. This allows the map to be complemented by a simple operation.
- Preferably, the map complementation part is configured to complement the map based on an inclination of a graph that indicates a relationship between the motion speed and the manipulated variable in the map generated by the map generating part. The map complementation part can complement the map without requiring any special information other than the map portion that has been already generated by the map generating part.
- For the case where the work device is capable of performing a plurality of types of motions as the work motion, it is preferable that the map generation part is configured to generate the map for each of the types of motions and the map complementation part is configured to complement the map generated for each of the types of motions.
- Such generation and complementation of the map corresponding to each of the types of motions of the work device enables the followability of the motion speed of the work device to the target speed to be enhanced.
- The automatic operation system, for example, can be applied to a work machine in which the machine body includes a lower traveling body and an upper turning body mounted on the lower traveling body capably of turning and the work device includes a boom that is attached to the upper turning body capably of rising and falling, an arm that is connected to the boom capably of vertically rotational movement, and a tip attachment that is connected to the arm capably of vertically rotational movement. In this case, the plurality of types of motions include a turning motion of the upper turning body with respect to the lower traveling body, a rising and falling motion of the boom with respect to the upper turning body, a rotational movement of the arm with respect to the boom, and a rotational movement of the tip attachment with respect to the arm.
- Preferably, the map generation part is configured to generate the map for each of different work situations of the work machine, and the map complementation part is configured to complement the map generated for each of the work situations. This allows the followability of the motion speed of the work machine to the target speed to be improved in each of the work situations of the work machine.
Claims (6)
- An automatic operation system for performing an automatic operation of a work machine that includes a machine body, a work device attached to the machine body capably of performing a work motion, a driving device and an operation part, the driving device allowing a manipulated variable to be input to the driving device and configured to make the work device perform the work motion in accordance with the manipulated variable, the operation part allowing a work operation for operating the work device to be applied to the operation part and configured to input the manipulated variable corresponding to the work operation to the driving device, the automatic operation system comprising:a manipulated-variable detection device that detects the manipulated variable that is input from the operation part to the driving device;a speed information acquisition device that acquires speed information on a motion speed that is a speed of the work motion of the work device;a map generation part that generates a map that defines a relationship between the speed information acquired by the speed information acquisition device and the manipulated variable detected by the manipulated-variable detection device;a map complementation part that complements the map, when a maximum value of the manipulated variable included in the map generated by the map generation part is smaller than a preset maximum manipulated variable, so as to render the maximum value of the manipulated variable of the map equal to the maximum manipulated variable;a target speed generation part that generates a target speed that is a target value of the motion speed for the automatic operation of the work machine; anda manipulated-variable input part that generates the manipulated variable for making the work device perform the work motion at the target speed based on the target speed generated by the target speed generation part and the map complemented by the map complementation part and inputs the manipulated variable to the driving device.
- The automatic operation system according to claim 1, wherein the map complementation part is configured to complement the map based on information that is preset for the motion speed corresponding to the maximum manipulated variable.
- The manipulated-variable calculation system according to claim 1 or 2, wherein the map complementation part is configured to complement the map based on an inclination of a graph that indicates a relationship between the motion speed and the manipulated variable in the map generated by the map generating part.
- The automatic operation system according to any one of claims 1 to 3, wherein: the work device is capable of performing a plurality of types of motions as the work motion; the map generation part is configured to generate the map for each of the types of motions; and the map complementation part is configured to complement the map generated for each of the types of motions.
- The automatic operation system according to claim 4, wherein: the machine body includes a lower traveling body and an upper turning body mounted on the lower traveling body capably of turning; the work device includes a boom that is attached to the upper turning body capably of rising and falling, an arm that is connected to the boom capably of vertically rotational movement, and a tip attachment that is connected to the arm capably of vertically rotational movement; and the plurality of types of motions include a turning motion of the upper turning body with respect to the lower traveling body, a rising and falling motion of the boom with respect to the upper turning body, a rotational movement of the arm with respect to the boom, and a rotational movement of the tip attachment with respect to the arm.
- The automatic operation system according to any one of claims 1 to 5, wherein the map generation part is configured to generate the map for each of different work situations of the work machine, and the map complementation part is configured to complement the map generated for each of the work situations.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021179517A JP2023068411A (en) | 2021-11-02 | 2021-11-02 | Operation amount calculation system |
PCT/JP2022/037935 WO2023079915A1 (en) | 2021-11-02 | 2022-10-11 | Automatic driving system for work machine |
Publications (1)
Publication Number | Publication Date |
---|---|
EP4403704A1 true EP4403704A1 (en) | 2024-07-24 |
Family
ID=86241367
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
EP22889738.5A Pending EP4403704A1 (en) | 2021-11-02 | 2022-10-11 | Automatic driving system for work machine |
Country Status (4)
Country | Link |
---|---|
EP (1) | EP4403704A1 (en) |
JP (1) | JP2023068411A (en) |
CN (1) | CN118140025A (en) |
WO (1) | WO2023079915A1 (en) |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11181820A (en) | 1997-12-18 | 1999-07-06 | Kobe Steel Ltd | Automatic operation device for hydraulic working machine |
JP4793352B2 (en) * | 2007-02-21 | 2011-10-12 | コベルコ建機株式会社 | Swivel control device and work machine equipped with the same |
JP4917574B2 (en) * | 2008-06-24 | 2012-04-18 | 住友建機株式会社 | Drive control device having learning function and construction machine including the same |
JP5669559B2 (en) * | 2010-12-17 | 2015-02-12 | 株式会社神戸製鋼所 | Control device and work machine equipped with the same |
JP6573319B2 (en) * | 2015-12-24 | 2019-09-11 | キャタピラー エス エー アール エル | Actuator drive controller for construction machinery |
-
2021
- 2021-11-02 JP JP2021179517A patent/JP2023068411A/en active Pending
-
2022
- 2022-10-11 CN CN202280070969.9A patent/CN118140025A/en active Pending
- 2022-10-11 WO PCT/JP2022/037935 patent/WO2023079915A1/en active Application Filing
- 2022-10-11 EP EP22889738.5A patent/EP4403704A1/en active Pending
Also Published As
Publication number | Publication date |
---|---|
JP2023068411A (en) | 2023-05-17 |
WO2023079915A1 (en) | 2023-05-11 |
CN118140025A (en) | 2024-06-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR100227197B1 (en) | Interference preventing system for construction machine | |
EP0739437B1 (en) | Device and method for controlling attachment of construction machine | |
US6498973B2 (en) | Flow control for electro-hydraulic systems | |
JP3091667B2 (en) | Excavation control device for construction machinery | |
KR100191391B1 (en) | Area limiting excavation control system for construction machines | |
US10920394B2 (en) | Construction machine | |
CN110392755B (en) | Hydraulic working machine | |
EP2518221B1 (en) | Electronic hydraulic control apparatus using variable behavior characteristics, and method for same | |
EP2514879B1 (en) | Position control apparatus and method for a working tool of a construction machine | |
JP6807290B2 (en) | Work machine | |
CN107208397B (en) | Rotation control device of construction equipment and control method thereof | |
JP6695620B2 (en) | Construction machinery | |
JP3198249B2 (en) | Construction machine interference prevention equipment | |
JP4455465B2 (en) | Front control device for construction machinery | |
EP4403704A1 (en) | Automatic driving system for work machine | |
JP7181128B2 (en) | construction machinery | |
JP3713358B2 (en) | Front control device for construction machinery | |
JP3466371B2 (en) | Construction machine interference prevention equipment | |
CN111492111B (en) | Excavator | |
KR960013594B1 (en) | Auto-control method of excavating work for excavator operation | |
KR20030008572A (en) | Hydraulic control appratus and method for Excavator which can operate automatically work | |
JP2000355957A (en) | Zone restrictive excavation controller for hydraulic shovel | |
JP3727423B2 (en) | Control method of electronically controlled work vehicle | |
JP2871871B2 (en) | Hydraulic drive for construction machinery | |
KR950004023B1 (en) | Method and apparatus for actuator control of excavator |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: THE INTERNATIONAL PUBLICATION HAS BEEN MADE |
|
PUAI | Public reference made under article 153(3) epc to a published international application that has entered the european phase |
Free format text: ORIGINAL CODE: 0009012 |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: REQUEST FOR EXAMINATION WAS MADE |
|
17P | Request for examination filed |
Effective date: 20240416 |
|
AK | Designated contracting states |
Kind code of ref document: A1 Designated state(s): AL AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HR HU IE IS IT LI LT LU LV MC ME MK MT NL NO PL PT RO RS SE SI SK SM TR |