The present invention relates to a work machine.
For example, a work machine such as a hydraulic excavator is required to be operated in such a manner that the work machine does not interfere with an environmental obstacle or the like in work. Thus, as a technique for supporting operation by an operator, a technique has been proposed in which an operation speed is automatically reduced to stop a work machine when the work machine has entered a range set in advance. For example, in Patent Document 1, a swing-system work machine is disclosed in which an upper swing structure is disposed on a lower track structure swingably around a vertical axis and a work attachment that can be displaced relative to the upper swing structure is disposed. The swing-system work machine includes present location sensing means for sensing a present location of the swing-system work machine, orientation sensing means for sensing an orientation of the upper swing structure, and displacement amount sensing means for sensing a displacement amount of the work attachment with respect to the upper swing structure. The swing-system work machine further includes storing means that stores three-dimensional obstacle coordinates made to correspond to obstacles such as buildings and facilities based on map data, work attachment position calculating means that calculates three-dimensional coordinates of a work attachment position from the sensed present location, the sensed orientation, and the sensed displacement amount of the work attachment with respect to the upper swing structure, and work attachment position coordinate determining means that determines whether or not the calculated work attachment position coordinates fall within an interference avoidance range set based on the stored obstacle coordinates. The swing-system work machine further includes movement velocity setting means for setting a movement velocity of the work attachment in a three-dimensional direction when the work attachment position coordinates fall within the interference avoidance range and control command output means that outputs a control command to a velocity control section of an actuator for swing of the upper swing structure and an actuator for the work attachment in such a manner that the movement velocity set by the movement velocity setting means is obtained.
However, in the above-described prior art, although consideration is made about prevention of interference with an environmental object when a single work machine operates, consideration needs to be further made about a case in which an environmental object that is a subject of prevention of interference moves, i.e., prevention of interference between plural work machines, because it is also quite likely that plural work machines simultaneously carry out work in a working site.
The present invention is made in view of the above description and intends to provide a work machine that can suppress interference between plural work machines.
The present application includes plural means for solving the above-described problem. To cite one example thereof, a work machine includes a work device mounted on a machine main body, a plurality of actuators that drive the machine main body and the work device, a location information acquiring device that acquires location information that is information relating to a location of the machine main body, a posture information acquiring device that acquires posture information that is information relating to posture of the work device, and a controller configured to limit operation of at least one of the plurality of actuators on the basis of a work area that is an area in which movement of the machine main body and the work device is permitted, the location information acquired in the location information acquiring device, and the posture information acquired in the posture information acquiring device. The controller is configured to, in a case that a change instruction to instruct to change the work area to a requested work area is input, judge whether or not change of the work area to the requested work area is possible on the basis of the work area, the location information of the machine main body, and the posture information of the work device, and overwrite the work area with the requested work area to change the work area in an only case that it is judged that change is possible.
According to the present invention, interference between plural work machines can be suppressed.
One embodiment of the present invention will be described below with reference to
In the present embodiment, as one example of a work machine, a hydraulic excavator including a work device (work implement) will be exemplified and described. However, the present invention can be applied also to, besides work machines such as a wheel loader, road machines such as a road roller, a crane, and so forth, for example.
Furthermore, in the following description, when plural elements exist as the same constituent element, alphabets are given to tail ends of reference characters (numbers) in some cases. However, these plural constituent elements are collectively represented with omission of these alphabets in some cases. For example, when four inertial measurement devices 13a to 13d exist, they may be collectively represented as inertial measurement devices 13.
In
A base end of the boom 11 of the work device 15 is supported by a front part of the upper swing structure 10 pivotally in the perpendicular direction. One end of the arm 12 is supported by a tip of the boom 11 pivotally in the perpendicular direction. The bucket 8 is supported by another end of the arm 12, with the intermediary of a bucket link 8a, pivotally in the perpendicular direction.
The boom 11, the arm 12, the bucket 8, the upper swing structure 10, and the lower track structure 9 are driven by a boom cylinder 5, an arm cylinder 6, a bucket cylinder 7, a swing hydraulic motor 4, and left and right traveling hydraulic motors 3 (only a traveling hydraulic motor 3b on the left side is illustrated), respectively, that are hydraulic actuators. The traveling hydraulic motors 3 function as a movement device by driving each of a pair of left and right crawlers.
In a cab 16 in which an operator rides, a right operation lever device 1c and a left operation lever device 1d that output an operation signal for operating the hydraulic actuators 5 to 7 of the work device 15 and the swing hydraulic motor 4 of the upper swing structure 10, a right operation lever device 1a for traveling and a left operation lever device 1b for traveling that output an operation signal for operating the left and right traveling hydraulic motors 3 of the lower track structure 9, a gate lock lever 1e, and a controller 100 are disposed.
The operation lever devices 1a, 1b, 1c, and 1d are each an electrical operation lever device that outputs an electrical signal as the operation signal and each have an operation lever that is tilt-operated forward, rearward, leftward, and rightward by the operator and an electrical signal generating section that generates an electrical signal according to a tilt direction and a tilt amount (lever operation amount) of this operation lever. The electrical signal output from the operation lever devices 1c and 1d is input to the controller 100 through an electrical wiring line. In the present embodiment, operation of the operation lever of the right operation lever device 1c in a front-rear direction corresponds to operation of the boom cylinder 5, and operation of the same operation lever in a left-right direction corresponds to operation of the bucket cylinder 7. Meanwhile, operation of the operation lever of the left operation lever device 1d in the front-rear direction corresponds to operation of the swing hydraulic motor 4, and operation of the same operation lever in the left-right direction corresponds to operation of the arm cylinder 6.
Operation control of the boom cylinder 5, the arm cylinder 6, the bucket cylinder 7, the swing hydraulic motor 4, and the left and right traveling hydraulic motors 3 is carried out by controlling, by a control valve 20, a direction and a flow rate of a hydraulic operating fluid supplied to the hydraulic actuators 3 and 4 to 7 from a hydraulic pump device 2 driven by a prime mover such as an engine or an electric motor (in the present embodiment, an engine 14).
The control valve 20 is driven by a control signal output from the controller 100. The control signal is output from the controller 100 to the control valve 20 on the basis of operation of the right operation lever device 1a for traveling and the left operation lever device 1b for traveling, and operation of the left and right traveling hydraulic motors 3 of the lower track structure 9 is thereby controlled. Furthermore, the control signal is output from the controller 100 to the control valve 20 on the basis of the operation signal from the operation lever devices 1c and 1d, and operation of the hydraulic actuators 4 to 7 is thereby controlled. The boom 11 pivots in an upward-downward direction relative to the upper swing structure 10 by expansion and contraction of the boom cylinder 5. The arm 12 pivots in the upward-downward and front-rear directions relative to the boom 11 by expansion and contraction of the arm cylinder 6. The bucket 8 pivots in the upward-downward and front-rear directions relative to the arm 12 by expansion and contraction of the bucket cylinder 7.
A communication device 500 is disposed at an upper part of the cab 16 in which the operator rides. The communication device 500 doubles as an area change request receiving section and a work area transmitting section. The communication device 500 receives a requested work area (described later) and transmits whether or not change of the work area is possible and a present work area.
Inertial measurement devices (IMU: Inertial Measurement Unit) 13a to 13d as posture information acquiring devices for acquiring posture information are disposed for the vicinity of a linked part to the upper swing structure 10 in the boom 11, the vicinity of a linked part to the boom 11 in the arm 12, the bucket link 8a, and the upper swing structure 10, respectively. The inertial measurement device 13a is a posture information acquiring device (a boom posture sensor) that senses an angle of the boom 11 (a boom angle) with respect to a horizontal plane. The inertial measurement device 13b is a posture information acquiring device (an arm posture sensor) that senses an angle of the arm 12 (an arm angle) with respect to the horizontal plane. The inertial measurement device 13c is a posture information acquiring device (a bucket posture sensor) that senses an angle of the bucket link 8a with respect to the horizontal plane. Furthermore, the inertial measurement device 13d is a posture information acquiring device (a main body posture sensor) that senses an inclination angle (a roll angle, a pitch angle) of the upper swing structure 10 with respect to the horizontal plane.
The inertial measurement devices 13a to 13d are what measure an angular velocity and an acceleration. When a case is considered in which the upper swing structure 10 and the respective driven members 8, 11, and 12 for which the inertial measurement devices 13a to 13d are disposed remain still, the angles of the upper swing structure 10 and the respective driven members 8, 11, and 12 with respect to the horizontal plane can be sensed based on a direction of a gravitational acceleration (that is, a vertically downward direction) in an IMU coordinate system set in the respective inertial measurement devices 13a to 13d and attachment states of the respective inertial measurement devices 13a to 13d (that is, relative positional relations between the respective inertial measurement devices 13a to 13d, the upper swing structure 10, and the respective driven members 8, 11, and 12). Here, the inertial measurement devices 13a to 13c configure posture information acquiring devices that acquire posture information (angle signals) of each of the boom 11, the arm 12, and the bucket (work equipment) 8.
The present invention is not limited to the case in which an inertial measurement device (IMU) is used as the posture information acquiring device. For example, a configuration may be made in such a manner that posture information is acquired by using an inclination angle sensor. Moreover, potentiometers may be disposed for the linked parts of the respective driven members 8, 11, and 12, relative directions (posture information) of the upper swing structure 10 and the respective driven members 8, 11, and 12 may be sensed, and posture (angles with respect to the horizontal plane) of the respective driven members 8, 11, and 12 may be obtained from the sensing result. Furthermore, a configuration may be made in such a manner that a stroke sensor is disposed for each of the boom cylinder 5, the arm cylinder 6, and the bucket cylinder 7, and relative directions (posture information) at the respective connected parts of the upper swing structure 10 and the respective driven members 8, 11, and 12 are computed from stroke change amounts, and the posture (angles with respect to the horizontal plane) of the respective driven members 8, 11, and 12 is obtained from the result thereof.
In the upper swing structure 10, positioning devices 18a and 18b as location information acquiring devices that acquire location information that is information relating to a location of the machine main body are disposed. The positioning devices 18a and 18b are the GNSS (Global Navigation Satellite System), for example. The GNSS refers to a satellite positioning system by which signals from plural satellites are received to find a self-location on the globe. The positioning devices 18a and 18b are what receive signals (electric waves) from plural GNSS satellites (not illustrated) located above the globe and acquire locations of the positioning devices 18a and 18b in a terrestrial coordinate system by executing calculation on the basis of the obtained signals. Because the mounting positions of the positioning devices 18a and 18b with respect to the hydraulic excavator M1 are known in advance, the location and a direction (an orientation) of the hydraulic excavator M1 with respect to a reference point at a working site can be acquired as location information by acquiring the locations of the positioning devices 18a and 18b in the terrestrial coordinate system.
To the controller 100, the operation signal from the right operation lever device 1a for traveling, the left operation lever device 1b for traveling, the right operation lever device 1c, and the left operation lever device 1d, the main body location information from the positioning devices 18a and 18b, the posture information from the inertial measurement devices 13a to 13d, and the requested work area (described later) from the communication device 500 are input. The controller 100 outputs the control signal on the basis of these inputs to drive the control valve 20. In addition, the controller 100 outputs whether or not change of the work area is possible and the present work area to the communication device 500.
In
According to the requested work area from the communication device 500 and whether or not change of the work area is possible from the area change possibility judging section 150, the work area storing section 110 changes the present work area to the requested work area when change of the work area is possible and outputs the work area to the operation limiting section 120 and the communication device 500. On the other hand, when change of the work area is not possible, the work area storing section 110 outputs the present work area to the operation limiting section 120 and the communication device 500 without changing it.
The operation limiting section 120 calculates an operation limiting signal according to the present work area from the work area storing section 110, the main body location information from the positioning devices 18a and 18b, and the posture information from the inertial measurement devices 13a to 13d and outputs the operation limiting signal to the main body control section 130 and the area change possibility judging section 150. Contents of the calculation of the operation limiting section 120 will be described in detail later.
The main body control section 130 calculates and outputs control signals on the basis of the operation signal from the right operation lever device 1c and the left operation lever device 1d and the operation limiting signal from the operation limiting section 120, and drives each directional control valve in the control valve 20 corresponding to a respective one of the signals. Contents of the calculation of the main body control section 130 will be described in detail later.
The operation state acquiring section 140 calculates an operation state of the hydraulic excavator M1 on the basis of the main body location information from the positioning devices 18a and 18b and the posture information from the inertial measurement devices 13a to 13d and outputs the operation state to the area change possibility judging section 150. Here, the operation state is a movement velocity of the hydraulic excavator, a swing velocity, and a movement velocity of the bucket.
The area change possibility judging section 150 receives, as inputs, the requested work area from the communication device 500, the operation state from the operation state acquiring section 140, the present work area from the work area storing section 110, and the operation limiting signal from the operation limiting section 120, calculates whether or not change of the work area is possible based on the inputs, and outputs whether or not change of the work area is possible to the work area storing section 110 and the communication device 500. Regarding the present work area and the operation limiting signal, values of the last cycle of calculation cycles of the controller 100 are used. Details of the calculation executed in the area change possibility judging section 150 will be described later.
In
The operation limiting section 120 calculates the operation limiting signal according to a distance between a boundary of the present work area A1 and the machine main body of the hydraulic excavator M1 or the work device 15. Specifically, first, at each of the center of swing of the hydraulic excavator M1 and a tip part of the work device 15 (a part at which a horizontal distance from the center of swing is the longest in the work device 15), a point that serves as the basis of calculation (hereinafter, referred to as reference points 10a and 15a) is set.
Then, regarding the reference point 10a of the machine main body, a distance LOR from the reference point 10a to the boundary of the work area A1 in the right direction along the y-axis, a distance LOL from the reference point 10a to the boundary of the work area A1 in the left direction along the y-axis, a distance LOF from the reference point 10a to the boundary of the work area A1 in the front direction along the x-axis, and a distance LOB from the reference point 10a to the boundary of the work area A1 in the rear direction along the x-axis are each computed. Further, the operation limiting signal is calculated in such a manner that the movement velocity of the hydraulic excavator M1 in the front direction, the rear direction, the right direction, and the left direction is limited according to the distances LOF, LOB, LOR, and LOL.
Similarly, regarding the reference point 15a of the work device 15, a distance L1R from the reference point 15a to the boundary of the work area A1 in the right direction along the y-axis, a distance L1L from the reference point 15a to the boundary of the work area A1 in the left direction along the y-axis, and a distance L1F from the reference point 15a to the boundary of the work area A1 in the front direction along the x-axis are each computed. Then, the operation limiting signal is calculated in such a manner that the velocity in an extension direction and the swing velocity in the left-right direction regarding the work device 15 are limited according to the distances L1F, L1R, and L1L.
In
Also regarding the other distances L1F, L1L, LOF, LOB, LOR, and LOL, similarly the operation limiting section 120 calculates the velocity ratio of the corresponding hydraulic actuator and outputs the velocity ratio as the operation limiting signal.
In
In
Moreover, when the determination result in the step S1501 is YES, that is, when the area change possibility judging section 150 determines that the hydraulic excavator M1 is operating, subsequently the area change possibility judging section 150 determines whether the hydraulic excavator M1 is under operation limitation (for example, whether the operation limiting signal is lower than 95%) from the operation limiting signal of the operation limiting section 120 (step S1503). When the determination result is YES, the area change possibility judging section 150 judges that change of the work area A1 is impossible (step S1505), and ends the processing.
Further, when the determination result in the step S1503 is NO, that is, when the area change possibility judging section 150 determines that the hydraulic excavator M1 is not under operation limitation, subsequently the area change possibility judging section 150 determines whether a boundary of a requested work area is remoter from the work machine (the reference point 10a and the reference point 15a) than the boundary of the work area (step S1504). When the determination result is YES, the area change possibility judging section 150 determines that change of the work area is possible (step S1502), and ends the processing. When the determination result is NO, the area change possibility judging section 150 determines that change of the work area is impossible (step S1505), and ends the processing.
In the step S1504, regarding all sides different from the work area A1 in the respective sides of the polygon that forms the requested work area, whether the distance thereof from the work machine (the reference point 10a and the reference point 15a) is longer than the boundary of the work area is determined. Furthermore, in the step S1504, when the requested work area is closer in even one side regarding the sides of the determination target (that is, when even one side closer than the respective sides that form the boundary of the work area exists in the respective sides that form the boundary of the requested work area), the area change possibility judging section 150 makes NO as the determination result and proceeds to the step S1505 to judge that change of the work area is impossible. Only when the requested work area is remoter than the work area regarding all sides of the determination target, the area change possibility judging section 150 makes YES as the determination result and proceeds to the step S1502 to judge that change of the work area is possible.
In
In this case, in the processing of the area change possibility judging section 150, it is determined in the step S1501 in
In
In this case, in the processing of the area change possibility judging section 150, it is determined in the step S1501 in
In
In this case, in the processing of the area change possibility judging section 150, it is determined in the step S1501 in
Effects in the present embodiment configured as above will be described.
In the prior art, although consideration is made about prevention of interference with an environmental object when a single work machine operates, consideration needs to be further made about the case in which an environmental object that is a subject of prevention of interference moves, i.e., prevention of interference between plural work machines, because it is also quite likely that plural work machines simultaneously carry out work in a working site.
In contrast, in the present embodiment, in the hydraulic excavator M1 including the work device 15 mounted on the machine main body (the upper swing structure 10 and the lower track structure 9), the plural actuators (for example, the boom cylinder 5, the arm cylinder 6, the bucket cylinder 7, the swing hydraulic motor 4, and the traveling hydraulic motors 3 (3b)) that drive the machine main body and the work device 15, the positioning devices 18a and 18b that acquire location information that is information relating to the location of the machine main body, the inertial measurement devices 13a to 13c that acquire posture information that is information relating to the posture of the work device, and the controller 100 that limits operation of at least one of the plural actuators on the basis of a work area that is an area in which movement of the machine main body and the work device 15 is permitted, the location information acquired in the positioning devices 18a and 18b, and the posture information acquired in the inertial measurement devices 13a to 13c, the controller 100 is configured to, in a case that a change instruction to instruct to change the work area to a requested work area is input, judge whether or not change of the work area to the requested work area is possible on the basis of the work area, the location information of the machine main body, and the posture information of the work device, and overwrite the work area with the requested work area to change the work area in an only case that it is judged that change is possible. Therefore, interference between plural work machines can be suppressed.
For example, in a situation in which plural construction machines operate at the same site as illustrated in
In the situation like that illustrated in
In contrast, in the present embodiment, interference between plural work machines can be suppressed. In addition, lowering of the work efficiency can be suppressed.
Features of the above-described embodiment will be described below.
(1) In the above-described embodiment, in a work machine (for example, the hydraulic excavator M1) including the work device 15 mounted on a machine main body (for example, the upper swing structure 10 and the lower track structure 9), plural actuators (for example, the boom cylinder 5, the arm cylinder 6, the bucket cylinder 7, the swing hydraulic motor 4, and the traveling hydraulic motors 3 (3b)) that drive the machine main body and the work device, a location information acquiring device (for example, the positioning devices 18a and 18b) that acquires location information that is information relating to the location of the machine main body, a posture information acquiring device (for example, the inertial measurement devices 13a to 13c) that acquires posture information that is information relating to the posture of the work device, and the controller 100 that limits operation of at least one of the plural actuators on the basis of the work area A1 that is an area in which movement of the machine main body and the work device is permitted, the location information acquired in the location information acquiring device, and the posture information acquired in the posture information acquiring device, the controller is configured to, in a case that a change instruction to instruct to change the work area to a requested work area is input, judge whether or not change of the work area to the requested work area is possible on the basis of the work area, the location information of the machine main body, and the posture information of the work device, and overwrite the work area with the requested work area to change the work area in an only case that it is judged that change is possible.
This can suppress interference between plural work machines.
(2) Further, in the above-described embodiment, in the work machine (for example, the hydraulic excavator M1) of (1), the change instruction of the work area is generated at the external of the work machine in movement of another work machine (for example, the hydraulic excavator M1) at a working site and is input to the controller through a communication device disposed in the work machine.
(3) Moreover, in the above-described embodiment, in the work machine (for example, the hydraulic excavator M1) of (1), the controller 100 is configured to acquire an operation state of the work machine and determine whether the work machine is in operation, and judge that change of the work area is possible in a case of determining that the work machine is not in operation.
(4) Moreover, in the above-described embodiment, in the work machine (for example, the hydraulic excavator M1) of (3), the controller 100 is configured to determine whether operation of at least one of the plural actuators (for example, the boom cylinder 5, the arm cylinder 6, the bucket cylinder 7, the swing hydraulic motor 4, and the traveling hydraulic motors 3 (3b)) is being limited in a case of determining that the work machine is in operation, and judge that change of the work area is impossible in a case of determining that operation is being limited.
(5) Furthermore, in the above-described embodiment, in the work machine (for example, the hydraulic excavator M1) of (4), the controller 100 is configured to determine whether a boundary of the requested work area is remoter from the machine main body or the work device than a boundary of the work area in a case of determining that operation of at least one of the plural actuators (for example, the boom cylinder 5, the arm cylinder 6, the bucket cylinder 7, the swing hydraulic motor 4, and the traveling hydraulic motors 3 (3b)) is not being limited, and judge that change of the work area is possible in a case of determining that the boundary of the requested work area is remoter.
The present invention is not limited to the above-described embodiment and various modification examples and combinations in such a range as not to depart from the gist thereof are included. Further, the present invention is not limited to what includes all configurations explained in the above-described embodiment, and what is obtained by deleting part of the configurations is also included. Moreover, regarding the above-described respective configurations, functions, and so forth, part or all of them may be implemented through being designed with an integrated circuit, or the like, for example. In addition, the above-described respective configurations, functions, and so forth may be implemented by software through interpretation and execution of a program that implements the respective functions by a processor.
Moreover, in the present embodiment, the configuration in which the controller 100 is mounted in the hydraulic excavator M1 has been described. However, for example, the controller 100 may be disposed separately from the hydraulic excavator M1 and be configured as a control system for the hydraulic excavator (construction machine) M1 that enables remote operation of the hydraulic excavator M1. Furthermore, only the area change possibility judging section 150 may be separated from the hydraulic excavator M1 and be configured to be disposed in the management control system S illustrated in
Number | Date | Country | Kind |
---|---|---|---|
2019-058540 | Mar 2019 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2019/049045 | 12/13/2019 | WO | 00 |