The present invention relates to a work machine.
As a technology concerning remote operation of a work machine, for example, Patent Document 1 discloses a work vehicle including an imaging device for picking up an image of an object of work, an image transmission section that transmits the image picked up by the imaging device to a controller, an operation signal reception section that receives an operation signal from the controller, and an action control section that restricts the operation signal according to a transmission status of the image.
However, in the above-described prior art, for example, when a communication delay time is suddenly elongated, the work machine would suddenly be stopped in the case where an operation signal of the work machine is restricted according to a communication status. Hence, for example, in the case where the work machine is suddenly stopped when the work machine is loading earth in a bucket, there is a risk that the earth as the load would be scattered. In addition, depending on the work posture, there is a risk that the stability of the machine body is markedly lowered due to the sudden stop. In other words, in the above-described prior art, there is a fear of worsening of workability due to scattering of the load or lowering in the stability of the work machine caused by a sudden stop.
The present invention has been made in consideration of the abovementioned problem, and it is an object of the present invention to provide a work machine capable of appropriately restricting an action according to the communication status while suppressing worsening of workability.
While the present application includes a plurality of types of means for solving the above-described problem, an example of the means is a work machine including a front work device, the work machine including a state amount sensor that senses a state amount relating to an action state of the front work device, and a controller that controls the action of the work machine on the basis of an operation signal transmitted from a remote operation device by radio communication, in which the controller is configured to assess a communication status of the radio communication, and, when restricting the action of the work machine according to a result of the assessment, ease the restriction on the action of the work machine according to a result sensing performed by the state amount sensor.
According to the present invention, an action can appropriately be restricted according to the communication status, while worsening of workability is suppressed.
An embodiment of the present invention will be described below with reference to the drawings. Note that in the following description, a hydraulic excavator including a front work device will be illustrated and described as an example of a work machine, but the present invention can be applied also to work machines other than the hydraulic excavator.
In addition, in the following description, in the case where there are a plurality of the same constituent elements, an alphabet may be added to the last end of a reference character (numeral), but the plurality of constituent elements may collectively be noted by omitting the alphabet. Specifically, for example, when two hydraulic pumps 2a and 2b are present, these may collectively be noted as pumps 2.
A first embodiment of the present invention will be described with reference to
In
The front work device 1A has a configuration in which a plurality of driven members (a boom 8, an arm 9, and a bucket 10) each rotated in the vertical direction are coupled to each other. A base end of the boom 8 is supported in a rotatable manner through a boom pin at a front part of the upper swing structure 12. To a tip of the boom 8, the arm 9 is connected in a rotatable manner through an arm pin, and, to a tip of the arm 9, the bucket 10 is connected in a rotatable manner through a bucket pin. The boom 8 is driven by a boom cylinder 5, the arm 9 is driven by an arm cylinder 6, and the bucket 10 is driven by a bucket cylinder 7. Note that in the following description, the boom cylinder 5, the arm cylinder 6, and the bucket cylinder 7 may be collectively referred to as hydraulic cylinders 5 to 7, or hydraulic actuators 5 to 7.
Here, a hydraulic excavator coordinate system set on the hydraulic excavator will be described.
As depicted in
In addition, the distance from the intersection of the X axis and the Z axis (origin O) to a base end of the boom is defined as L0, the length of the boom 8 (direct distance between joint parts at both ends) is defined as L1, the length of the arm 9 (direct distance between joint parts at both ends) is defined as L2, the length of the bucket 10 (direct distance between a joint part with the arm and a claw tip) is defined as L3, the angle formed between the boom 8 and an XY plane (relative angle between a straight line in the lengthwise direction and the XY plane) is defined as a rotational angle α, the angle formed between the arm 9 and the boom 8 (relative angle of a straight line in the lengthwise direction) is defined as a rotational angle R, the angle formed between the bucket 10 and the arm 9 (relative angle of a straight line in the lengthwise direction) is defined as a rotational angle γ, and the angle formed between the lower track structure 11 and the upper swing structure 12 (relative angle between the X axis and the center axis of the front device 1A when having a bird's-eye view of the XY plane from the upper side of the Z axis; see
Further, an inclination in the front-rear direction of the machine body 1B of the hydraulic excavator 100 relative to the horizontal plane is defined as an angle θ.
Described with reference to
A machine body inclination angle sensor 33 for sensing the inclination angle ϕ of the upper swing structure 12 (the machine body 1B of the hydraulic excavator 100) relative to a reference plane (for example, a horizontal plane) is attached to the upper swing structure 12. For example, an inclination angle sensor of a liquid-filled electrostatic capacitance system, an inertial measurement unit, or the like can be used as the machine body inclination angle sensor 33.
A swing angle sensor 34 for sensing the relative angle θ of the upper swing structure 12 and the lower track structure 11 is attached to a swing center shaft of the upper swing structure 12 relative to the lower track structure 11.
The angle sensors 30, 31, and 32, the machine body inclination angle sensor 33, and the swing angle sensor 34 constitute a posture sensor.
As depicted in
In addition, as depicted in
Operation signals outputted from the operation devices 801 and 823 and a signal outputted from the engine speed setter 880 are transmitted to a controller 40 of the hydraulic excavator 100 through a communication device 850 of the remote operation device 800 and a communication device 650 of the hydraulic excavator 100 (see
The hydraulic excavator 100 includes a remote/riding selector 670 (see
As depicted in
The operation devices 1 and 23 are of an electric lever system, and generate electrical signals according to the amount and a direction of an operation performed by the operator and transmit the electrical signals to the controller 40. The controller 40 outputs, to a solenoid valve unit 160, electrical signals for driving solenoid valves 54a to 59a and 54b to 59b (see
The hydraulic fluid discharged from the hydraulic pumps 2 is supplied to the right track hydraulic motor 3a, the left track hydraulic motor 3b, the swing hydraulic motor 4, the boom cylinder 5, the arm cylinder 6, and the bucket cylinder 7 through the flow control valves 15a to 15f. The hydraulic fluid supplied from the hydraulic pumps 2 causes the boom cylinder 5, the arm cylinder 6, and the bucket cylinder 7 to extend or contract, whereby the boom 8, the arm 9, and the bucket 10 are each rotated, and the position and posture of the bucket 10 are varied. In addition, the hydraulic fluid supplied from the hydraulic pumps 2 causes the swing hydraulic motor 4 to rotate, whereby the upper swing structure 12 swings relative to the lower track structure 11. Besides, the hydraulic fluid supplied from the hydraulic pumps 2 causes the right track hydraulic motor 3a and the left track hydraulic motor 3b to rotate, whereby the lower track structure 11 travels.
The boom cylinder 5, the arm cylinder 6, and the bucket cylinder 7 are provided with load sensors 16a to 16f for sensing cylinder pressures. The load sensors 16 are, for example, pressure sensors, are provided on the bottom side and the rod side of respective ones of the boom cylinder 5, the arm cylinder 6, and the bucket cylinder 7, and sense and output the pressures as electrical signals to the controller 40. Note that in
The engine 18 includes an engine speed sensor 490 which is a rotation sensor for sensing the engine speed.
A pump line 148a which is a delivery line of the pilot pump 48 is connected to the solenoid valves 54 to 59 inside the solenoid valve unit 160 through a lock valve 39. The lock valve 39 is, for example, a solenoid switch valve, and its solenoid driving section is electrically connected to a position sensor for a gate lock lever (not illustrated) disposed in the cabin. In other words, the position of the gate lock lever is sensed by the position sensor, and a signal according to the position of the gate lock lever is inputted from the position sensor to the lock valve 39, whereby the lock valve 39 is switched between a communicating state and an interrupted state. For example, in the case where the position of the gate lock lever is in a lock position, the lock valve 39 is closed with the pump line 148a being interrupted, and the supply of pilot pressures from the pilot pump 48 to the solenoid valves 54 to 59 of the solenoid valve unit 160 is interrupted, whereby operations by the operation devices 1, 23 (or the operation devices 801, 823) are invalidated, and such actions as traveling, swinging, and excavation of the hydraulic excavator 100 are inhibited. In addition, in the case where the gate lock lever is located in an unlock position, the lock valve 39 is opened with the pump line 148a being opened, and the supply of the pilot pressures from the pilot pump 48 to the solenoid valves 54 to 59 of the solenoid valve unit 160 is permitted, whereby operations by the operation devices 1 and 23 (or the operation devices 801 and 823) are validated, and such actions as traveling, swinging, and excavation are made possible.
<Solenoid Valve Unit 160>
As depicted in
The openings of the solenoid proportional valves 54a to 59a and 54b to 59b are minimum when not energized, and the openings are enlarged as currents which are control signals from the controller 40 are increased. In this way, the openings of the solenoid proportional valves 54a to 59a and 54b to 59b correspond to the control signals from the controller 40. In the solenoid valve unit 160, by outputting the control signals from the controller 40 to drive the solenoid proportional valves 54a to 59b, pilot pressures can be generated even when no operations are performed by the operator on the corresponding operation devices 1 and 23 (or the operation devices 801 and 823), so that actions of the hydraulic actuators 3 to 7 can be caused in a forcible manner.
In
As depicted in
The operation signal selection section 730 selects signals from the operation devices 1 and 23 and outputs the signals to the target action computation section 700 when the riding operation state is selected by the remote/riding selector 670, and selects signals corresponding to the operation signals (namely, signals from the operation devices 801 and 823) from among signals received by the communication device 650 and outputs the selected signals to the target action computation section 700 when the remote operation state is selected by the remote/riding selector 670.
The engine speed setting signal selection section 740 selects a signal from the engine speed setter 480 and outputs the selected signal to the target action computation section 700 and the engine controller 470 when the riding operation state is selected by the remote/riding selector 670, and selects a signal corresponding to the engine rotational seed setting signal (namely, a signal from the engine speed setter 880) from among signals received from the communication device 650 and outputs the selected signal to the target action computation section 700 and the engine controller 470 when the remote operation state is selected by the remote/riding selector 670.
The communication status determination section 710 extracts, from signals received by the communication device 650, information (time information) concerning the time of transmission of the signals by the remote operation device 800, computes the difference between this time and the time of reception of the signals by the communication device 650 as a communication delay time Tc, and, in the case where the communication delay time Tc is greater than a preset threshold Tc0, determines that the current state is a communication delay state, and outputs the determination result and the communication delay time Tc to the target action computation section 700. In addition, in the case where the communication delay time Tc is not more than the preset threshold Tc0, the communication status determination section 710 determines that the current state is a communication normal state, and outputs the determination result and the communication delay time Tc to the target action computation section 700.
The eased deceleration determination section 720 determines whether or not eased deceleration is to be conducted according to signals from the sensors 30 to 34 which are posture sensors and the pressure sensors 16a to 16f which are load sensors, and outputs the determination result (eased deceleration flag) and deceleration/acceleration to be used at the time of performing the eased deceleration (eased deceleration determination process). The details of the eased deceleration determination process will be described later.
The target action computation section 700 computes target actuator velocities of the hydraulic actuators corresponding to the operations of the operation devices 1 and 23 (or the operation devices 801 and 823), on the basis of operation signals selected and outputted by the operation signal selection section 730 and signals selected and outputted by the engine speed setting signal selection section 740, corrects the target actuator velocities on the basis of the results of determination made by the communication status determination section 710 and the eased deceleration determination section 720, and outputs the corrected target actuator velocities to the solenoid proportional valve control section 44 (target actuator velocity computation and correction process). The details of the target actuator velocity computation and correction process will be described later.
The solenoid proportional valve control section 44 generates control signals (control command values) according to the target actuator velocities outputted from the target action computation section 700, and outputs the control signals to the corresponding solenoid proportional valves 54 to 59.
<Eased Deceleration Determination Process (Eased Deceleration Determination Section (720)>
The eased deceleration determination section 720, first, determines whether or not an eased deceleration is to be conducted, on the basis of signals sensed from the posture sensors 30 to 34 (step S400), and, subsequently, computes deceleration/acceleration αp according to the posture information (step S410).
In addition, concurrently with the processes of steps S400 and S410, whether or not an eased deceleration is to be performed is determined on the basis of signals sensed from the load sensors 16a to 16f (step S401), and, subsequently, deceleration/acceleration al according to the load information is computed (step S411).
When the processes of steps S410 and S411 are completed, subsequently, one with a smaller absolute value of the deceleration/acceleration αp and the deceleration/acceleration αl is outputted (step S420).
In addition, regarding the determination results of steps S400 and S401, whether or not at least either one of the determination results is a determination result indicating that eased deceleration is to be executed is determined (step S430), and, when the determination result is YES, that is, in the case where the determination result indicating that the eased deceleration is to be executed is present, an eased deceleration flag=1 is outputted (step S440). Alternatively, in the case where the determination result in step S430 is NO, that is, in the case where the determination result indicating that the eased deceleration is to be executed is absent, an eased deceleration flag=0 (zero) is outputted (step S441).
Here, as a method for determining execution of the eased deceleration in steps S400 and S401, there is, for example, a method of using ZMP (Zero Moment Point) equation. In the case where the ZMP system is used, stability is assessed from deceleration/acceleration of the case where the action of the hydraulic excavator 100 is assumed to be suddenly stopped, and whether or not the eased deceleration is to be executed is determined on the basis of the assessment result. Note that the determination of execution of the eased deceleration is not limited to being performed by the above-described method; for example, a fixed value may be obtained from a preliminary simulation or a real machine test, or determination may be made on the basis of a determination threshold preset as to a predetermined posture.
The target action computation section 700, first, computes a target velocity of an actuator by use of a predetermined table (see
Subsequently, on the basis of the determination result outputted by the communication status determination section 710, whether or not an action restriction is to be performed is determined (step S510). An action restriction is conducted in the case where the determination result made by the communication status determination section 710 is a communication delay state, whereas the action restriction is not performed in the case where the determination result is a communication normal state.
In the case where the determination result in step S510 is YES, that is, in the case where the determination result made by the communication status determination section 710 is a communication delay state, a deceleration coefficient K is computed on the basis of a communication delay time Tc, by use of a predetermined table (see
Subsequently, whether or not the determination result made by the eased deceleration determination section 720 indicates that the eased deceleration is to be executed is determined (step S530), and, in the case where the determination result is YES, such a target velocity of the actuator as to reach the target velocity of the actuator computed in step S520 with deceleration/acceleration α is outputted (step S540).
In addition, in the case where the determination result in step S510 is NO, that is, in the case where the current state is a communication normal state and an action restriction is not to be conducted, or in the case where the determination result in step S530 is NO, that is, in the case where eased deceleration is not to be conducted, the target velocity of the actuator obtained in step S500 or step S520 is outputted as a final value.
Effects of the present embodiment configured as above will be described.
A case where the communication delay time Tc changes from Tce0 to Tce1 at time T0, as depicted in
(1) On and Before Time T0
On and before time T0, the communication delay time Tc is Tce0, which is not more than the threshold Tc0, so that the communication status determination section 710 determines an action restriction to be unnecessary. Hence, an action restriction based on the communication status is not to be turned ON by the target action computation section 700 (see S510 in
(2) Time T0 to Time T1
As depicted in
As depicted in
Besides, the eased deceleration determination section 720 determines that eased deceleration is to be conducted, from the status of a load on the bucket (see S530 in
(3) From Time T1 On
From time T1 on, though eased deceleration is determined to be conducted (see S530 in
(4) Case where Communication Delay Time Tc is not Less than Tc1
While the case where the communication delay time Tc changes from Tce0 to Tce1 has been exemplified in (1) to (3) above, it is further set in
In the present embodiment configured as above, the action can appropriately be restricted according to a communication status, while worsening of workability due to scattering of a load or lowering in the stability of the work machine caused by a sudden stop is suppressed.
A second embodiment of the present invention will be described with reference to
The present embodiment exemplifies a case where a different table is used in the computation of a restricted actuator target velocity in the first embodiment (see S520 in
As depicted in
In this case, Vt×Ke in
Note that the present invention is not limited to the above-described embodiments, and includes various modifications or combinations within such a scope as not to depart from the gist of the invention. In addition, the present invention is not limited to those embodiments which include all the configurations described in the above embodiments, and includes those embodiments in which some of the configurations is omitted.
For example, while the angle sensors for sensing the angles of the boom 8, the arm 9, and the bucket 10 are used in the embodiments of the present invention, the posture information concerning the excavator may be computed not by the angle sensors but by cylinder stroke sensors. In addition, while description has been made by taking an electric lever type excavator as an example, a configuration in which command pilot pressures generated by hydraulic pilots are controlled in the case of a hydraulic pilot type excavator may also be adopted.
Besides, while the embodiments of the present invention have been described by illustrating the hydraulic excavator as an example of the work machine, this is not limitative, and the present invention may be applied, for example, to other work machines such as a wheel loader or a crane.
In addition, while the case in which all the functions are provided in the controller 40 of the hydraulic excavator 100 has been illustrated as an example in the embodiments of the present invention, a configuration in which some of the functions are disposed in the remote operation device 800 or in a server or the like through which communication is realized may also be adopted.
Besides, while a configuration in which the target velocity of an actuator is restricted has been illustrated in the embodiments of the present invention, a configuration in which operation signals as input signals are restricted or in which engine speed is reduced may also be adopted.
In addition, while the communication delay time Tc has been computed by the difference between the transmission time of the remote operation device 800 and the reception time of the communication device 650 in the embodiments of the present invention, the communication device 650 may transmit a signal to the remote operation device 800, the remote operation device 800 may send back the signal to the communication device 650 without any change, and the communication delay time Tc may be computed from the time taken for the transmission and return.
Besides, while the computation section for computing the communication delay time Tc has been disposed in the controller 40 of the hydraulic excavator 100 in the embodiments of the present invention, this is not limitative, and a configuration in which the computation section is provided in the remote operation device 800 or in a server or the like through which communication between the remote operation device 800 and the communication device 650 is realized and the communication delay time Tc is transmitted to the communication device 650 may also be adopted.
In addition, of the above-described configurations, functions, and the like, a part or the whole part may be realized by designing, for example, as integrated circuits. Besides, the above-described configurations, functions, and the like may be realized on a software basis by interpreting and executing the programs for realizing the respective functions by a processor.
Number | Date | Country | Kind |
---|---|---|---|
2021-046381 | Mar 2021 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2022/003902 | 2/1/2022 | WO |