Technical Field
[0001] The present invention relates to a work machine such as a construction machine, a
program, and a method for controlling a work machine, and particularly relates to
a work machine that transmits attachment information from a communication device disposed
at a replaceable attachment to a communication device disposed at a main body part,
a program, and a method for controlling the work machine.
Background Art
[0002] A work machine has been put into practical use such as a construction machine including
a main body part having a lower travelling body and an upper slewing body, and a work
device to which a replaceable attachment is attached and which is attached to the
main body part so as to be changeable in attitude. In recent years, it is required
to identify an attachment attached to a work device in real time for appropriate control
of a work machine and appropriate management of an operation condition of the work
machine.
[0003] According to the work machine disclosed in Patent Literature 1 below, a two-dimensional
bar code indicating attachment information is attached to an attachment. The attachment
information is acquired by reading the two-dimensional bar code using a mobile terminal
by a worker. The acquired attachment information is wirelessly transmitted from the
mobile terminal to a control unit of the work machine. The control unit controls a
maximum flow rate of hydraulic oil supplied to the attachment based on the received
attachment information.
[0004] In addition, according to the work machine disclosed in Patent Literature 2 below,
a plurality of pieces of correlation data is stored in a storage unit in advance,
the correlation data indicating a relationship between a cylinder speed of a hydraulic
cylinder and an operation command value for operating the hydraulic cylinder according
to a type of bucket. Type data indicating a type of bucket is acquired by an acquisition
unit. A control unit selects one piece of the correlation data corresponding to the
type data acquired by the acquisition unit from among the plurality of pieces of correlation
data stored in the storage unit, and controls the operation command value based on
the selected correlation data.
[0005] However, according to the work machine disclosed in Patent Literature 1, since it
is necessary for a worker to get off the work machine and perform work of reading
the two-dimensional bar code to acquire the attachment information, work efficiency
is low.
[0006] In addition, according to the work machine disclosed in Patent Literature 2, since
it is necessary to prepare in advance a plurality of pieces of correlation data indicating
a relationship between a cylinder speed of the hydraulic cylinder and an operation
command value for operating the hydraulic cylinder according to a type of bucket,
preparation work therefor is complicated and inefficient.
Citation List
Patent Literature
Summary of Invention
[0008] An object of the present invention is to obtain a work machine capable of efficiently
and accurately acquiring attachment information of a replaceable attachment, a program,
and a method for controlling the work machine.
[0009] A work machine according to one aspect of the present invention includes: a main
body part; a work device to which a replaceable attachment is attached and which is
attached to the main body part so as to be changeable in attitude; an angle detection
means that detects a drive angle of the work device and outputs angle data; a first
communication device disposed at the attachment; a second communication device disposed
at the main body part; and a determination unit, in which the first communication
device includes: an inertial sensor that detects a direction of the attachment with
respect to a predetermined reference direction to output first direction data; and
a transmitter that transmits attachment information including the first direction
data as a radio signal, the second communication device includes a receiver that receives
the attachment information transmitted from the transmitter, and the determination
unit includes: a direction specifying unit that specifies a direction of the attachment
with respect to the reference direction based on the angle data input from the angle
detection means to output second direction data; and a difference/similarity determination
unit that determines difference or similarity between a transmission source attachment
of the attachment information and the attachment attached to the work device based
on the first direction data included in the attachment information input from the
receiver and the second direction data input from the direction specifying unit.
Brief Description of Drawings
[0010]
FIG. 1 is a view schematically illustrating a configuration of a work machine according
to an embodiment of the present invention.
FIG. 2 is a block diagram illustrating a configuration for operating a work device
in a simplified manner.
FIG. 3 is a view illustrating a part of the configuration of the work device.
FIG. 4 is a block diagram illustrating a configuration of a slave device.
FIG. 5 is a flowchart illustrating an operation flow of the slave device.
FIG. 6 is a block diagram illustrating a configuration of a master device.
FIG. 7 is a block diagram illustrating a configuration of a controller.
FIG. 8 is a block diagram illustrating a functional configuration of a determination
unit.
FIG. 9 is a diagram illustrating a relationship between angles θ1 to Θ4 and an angle
α2.
FIG. 10 is a flowchart illustrating a processing flow of the determination unit.
FIG. 11 is a block diagram illustrating a configuration of a controller according
to a modification.
Description of Embodiments
[0011] FIG. 1 is a diagram schematically illustrating a configuration of a work machine
1 according to an embodiment of the present invention. In an example of the present
embodiment, the work machine 1 is a construction machine to which a nibbler is attached
as a replaceable attachment 33. It is noted that the attachment is not limited to
a nibbler, and another attachment 33 such as a bucket or a breaker may be attached.
In addition, the work machine is not limited to a construction machine, and may be
another work machine such as an agricultural machine or an industrial machine to which
an arbitrary replaceable and attitude-changeable attachment is attached.
[0012] As illustrated in FIG. 1, the work machine 1 includes a crawler type lower travelling
body 21, an upper slewing body 22 slewably disposed on the lower travelling body 21,
and a work device 3 attached to the upper slewing body 22. The lower travelling body
21 and the upper slewing body 22 constitute a main body part 2 of the work machine
1.
[0013] The work device 3 includes a boom 31 attached to the upper slewing body 22 so as
to be raised and lowered, an arm 32 swingably attached to a distal end of the boom
31, and an attachment 33 swingably attached to a distal end of the arm 32. Although
not illustrated, the work device 3 includes an actuator such as a boom cylinder that
raises and lowers the boom 31 with respect to the upper slewing body 22, an actuator
such as an arm cylinder that swings the arm 32 with respect to the boom 31, and an
actuator such as an attachment cylinder that swings the attachment 33 with respect
to the arm 32.
[0014] A controller 7 that controls the entire work machine 1 is disposed inside the upper
slewing body 22. An attitude of the work device 3 is changed by changing an angle
(boom angle) of the boom 31 with respect to the upper slewing body 22, an angle (arm
angle) of the arm 32 with respect to the boom 31, and an angle (attachment angle)
of the attachment 33 with respect to the arm 32 by hydraulic control of the controller
7 according to lever operation by an operator of the work machine 1.
[0015] The work machine 1 further includes angle sensors 41 to 43 each configured with a
potentiometer, a rotary encoder, or the like. The angle sensor 41 (boom angle sensor)
detects a boom angle θ1 (see FIG. 9) by detecting a rotation angle of a rotation shaft
81 (also referred to as a "boom foot pin") coupling the upper slewing body 22 and
the boom 31, and outputs boom angle data indicating the boom angle θ1. The angle sensor
42 (arm angle sensor) detects an arm angle Θ2 (see FIG. 9) by detecting a rotation
angle of a rotation shaft 82 (also referred to as a "boom top pin" or an "arm foot
pin") coupling the boom 31 and the arm 32, and outputs arm angle data indicating the
arm angle Θ2. The angle sensor 43 (attachment angle sensor) detects an attachment
angle Θ3 (see FIG. 9) by detecting a rotation angle of a rotation shaft 83 (also referred
to as an "arm top pin") coupling the arm 32 and the attachment 33, and outputs attachment
angle data indicating the attachment angle Θ3. The angle sensors 41 to 43 are connected
to the controller 7 by wire, and the boom angle data, the arm angle data, and the
attachment angle data are input from the angle sensors 41 to 43 to the controller
7, respectively.
[0016] The work machine 1 further includes an inclination sensor 5 configured with an inertial
sensor such as an acceleration sensor or a gyro sensor. The inclination sensor 5 is
disposed in the upper slewing body 22. The inclination sensor 5 detects an inclination
angle Θ4 (see FIG. 9) of a slewing plane L1 of the upper slewing body 22 with respect
to a horizontal direction X, and outputs inclination angle data indicating the inclination
angle Θ4. The inclination sensor 5 is connected to the controller 7 by wire, and the
inclination angle data is input from the inclination sensor 5 to the controller 7.
[0017] In addition, the work machine 1 includes a slave device 61 as a first communication
device and a master device 62 as a second communication device. The slave device 61
and the master device 62 can wirelessly communicate with each other by an arbitrary
communication system such as Wi-Fi, Bluetooth (registered trademark), or a low power
wide area (LPWA). The slave device 61 is disposed at the attachment 33, and the master
device 62 is disposed at the upper slewing body 22. In a case where there are a plurality
of attachments 33, the slave device 61 is disposed for each of the plurality of attachments
33. In order to ensure good communication condition between the slave device 61 and
the master device 62, the slave device 61 is disposed on a back surface 30 (a surface
opposed to the upper slewing body 22) of the attachment 33, and the master device
62 is disposed on a front surface (a surface opposed to the attachment 33) of the
upper slewing body 22. The master device 62 and the controller 7 can perform wired
communication or wireless communication with each other by an arbitrary communication
system such as a controller area network (CAN).
[0018] FIG. 2 is a block diagram illustrating a configuration for operating the work device
3 in a simplified manner. The controller 7 controls an actuator drive circuit 78 by
control information S19, and the actuator drive circuit 78 controls an actuator 79
by control information S20. The actuator 79 includes the above-described boom cylinder,
arm cylinder, attachment cylinder, and the like. The actuator drive circuit 78 includes
a hydraulic pump driven by an engine as a power source, a control valve for regulating
a supply amount of hydraulic oil from the hydraulic pump to each actuator 79, an operation
lever for generating a pilot pressure for controlling the control valve, and the like.
When the operation lever is operated by the operator of the work machine 1, the control
valve is controlled by the pilot pressure varying according to an operation amount
of the operation lever, and the hydraulic oil of a discharge amount according to the
pilot pressure is supplied to the actuator 79, so that the actuator 79 is operated
by a hydraulic pressure of the hydraulic oil. As a result, the work device 3 executes
desired operation according to the lever operation of the operator.
[0019] FIG. 3 is a view illustrating a part of the configuration of the work device 3. The
attachment 33 is rotatably fixed to the distal end of the arm 32 by an arm top pin
83 that is detachable when the attachment 33 is replaced. One end of an idler link
89 is rotatably fixed to the arm 32 by an idler link pin 85. One end of an attachment
link 90 is rotatably fixed to the attachment 33 by an attachment link pin 84 that
is detachable when the attachment 33 is replaced. The other end of the idler link
89 and the other end of the attachment link 90 are rotatably fixed to a distal end
of a rod 88 of an attachment cylinder 87 by an attachment rod pin 86. In the example
of the present embodiment, an extending direction of a straight line connecting the
arm top pin 83 and the attachment link pin 84 is perpendicular to the back surface
30 of the attachment 33 at which the slave device 61 is disposed.
[0020] FIG. 4 is a block diagram illustrating a configuration of the slave device 61. As
illustrated in a connection relationship of FIG. 4, the slave device 61 includes an
inertial sensor 611 such as an acceleration sensor or a gyro sensor, a signal processing
unit 612, a nonvolatile storage unit 613 such as a ROM, a transmitter 614 for wireless
communication, and a counter 615 that counts the number of clocks of a predetermined
operation clock.
[0021] The inertial sensor 611 detects an angle α1 (see FIG. 9) of a principal surface normal
line direction of the slave device 61 with respect to a predetermined reference direction,
and outputs a signal S11 including first direction data D1 indicating the angle α1.
As illustrated in FIG. 9, in the example of the present embodiment, the predetermined
reference direction is a vertically downward direction Y, and the principal surface
normal line direction of the slave device 61 is equal to a direction in which a normal
line H of the back surface 30 of the attachment 33 extends.
[0022] The storage unit 613 stores control information S12 regarding the attachment 33 at
which its own slave device 61 is disposed. The control information S12 includes, for
example, type information, unique identification information, manufacturer information,
control parameters, and the like of the attachment 33. The control parameters include
pressure information (relief pressure, allowable upper limit value of in-cylinder
pressure, etc.) of hydraulic oil supplied to the attachment 33, flow rate information
(pump flow rate, pilot pressure, etc.) of the hydraulic oil supplied to the attachment
33, dimensional information (outer dimension, gravity center positional information,
etc.) of the attachment, and the like.
[0023] The signal processing unit 612 generates attachment information S13 including the
first direction data D1 input from the inertial sensor 611 and the control information
S12 read from the storage unit 613, and transfers the generated attachment information
S13 to the transmitter 614. The signal processing unit 612 repeatedly executes generation
processing and transfer processing of the attachment information S13 at a predetermined
transmission time interval defined by the counter 615. The transmission time interval
can be set to an arbitrary value within a range of several seconds to several minutes,
for example.
[0024] The transmitter 614 modulates the attachment information S13 input from the signal
processing unit 612 to transmit attachment information S14 as a radio signal with
a predetermined transmission signal strength.
[0025] FIG. 5 is a flowchart illustrating an operation flow of the slave device 61. A drive
power of the slave device 61 is supplied from a button battery or the like contained
in the slave device 61. When power supply to the slave device 61 is started, the counter
615 first clears a counter value in Step SP21.
[0026] Next, in Step SP22, the counter 615 increments the counter value by counting the
number of clocks of the predetermined operation clock.
[0027] Next, in Step SP23, the signal processing unit 612 determines whether or not the
counter value of the counter 615 has reached a predetermined set value (corresponding
to the above described transmission time interval).
[0028] In a case where the counter value has not reached the set value (Step SP23: NO),
the operations of Steps SP22 and SP23 are repeatedly executed.
[0029] When the counter value reaches the set value (Step SP23: YES), next, in Step SP24,
the signal processing unit 612 generates the attachment information S13 based on the
first direction data D1 and the control information S12, and inputs the generated
attachment information S13 to the transmitter 614. As a result, the attachment information
S14 as the radio signal is transmitted from the transmitter 614.
[0030] Next, in Step SP25, the signal processing unit 612 determines whether or not to stop
power supply to the slave device 61 due to shortage of a remaining capacity of the
button battery or the like.
[0031] In a case where the power supply to the slave device 61 is not stopped (Step SP25:
NO), the operations after Step SP21 are repeatedly executed.
[0032] In a case where the power supply to the slave device 61 is stopped (Step SP25: YES),
the signal processing unit 612 ends the operation of each part of the slave device
61 to stop the power supply to the slave device 61.
[0033] FIG. 6 is a block diagram illustrating a configuration of the master device 62. As
illustrated in a connection relationship of FIG. 6, the master device 62 includes
a receiver 621 for wireless communication, a signal processing unit 622, and a transfer
processing unit 623.
[0034] The receiver 621 receives the attachment information S14 as the radio signal transmitted
from the transmitter 614 of the slave device 61, and demodulates the attachment information
S13. The receiver 621 generates attachment information S15 including an RSSI value
indicating a received signal strength of the attachment information S14 by adding
the RSSI value to the attachment information S13.
[0035] The signal processing unit 622 performs error detection processing and error correction
processing by an arbitrary algorithm on the attachment information S15 input from
the receiver 621 to output attachment information S16 in which a code error accompanying
the wireless communication is corrected.
[0036] The transfer processing unit 623 transfers the attachment information S16 input from
the signal processing unit 622 to the controller 7 according to a predetermined transfer
condition. The transfer condition is, for example, transfer in a case where the type
of the attachment is nibbler, and no transfer in other cases, or transfer in a case
where a manufacturer of the attachment is an authorized manufacturer, and no transfer
in other cases. Note that the transfer processing unit 623 may be omitted.
[0037] FIG. 7 is a block diagram illustrating a configuration of the controller 7. As illustrated
in a connection relationship of FIG. 7, the controller 7 includes a determination
unit 71 realized as a function of an information processing device such as a CPU,
a control unit 72, and a nonvolatile storage unit 73 such as a ROM. The storage unit
73 stores a program 100.
[0038] FIG. 8 is a block diagram illustrating a functional configuration of the determination
unit 71. The information processing device reads the program 100 illustrated in FIG.
7 from the storage unit 73 and executes the program, whereby the determination unit
71 functions as a direction specifying unit 711 and a difference/similarity determination
unit 712. In other words, the program 100 is a program for causing the information
processing device mounted on the work machine 1 to function as the direction specifying
unit 711 and the difference/similarity determination unit 712.
[0039] The direction specifying unit 711 specifies a direction of the attachment 33 with
respect to the reference direction (the vertically downward direction Y) based on
angle data S17 (first to fourth angle data) input from the angle detection means (the
angle sensors 41 to 43 and the inclination sensor 5), and outputs second direction
data D2 indicating the direction. In the example of the present embodiment, the direction
of the attachment 33 is an angle α2 (see FIG. 9) of the principal surface normal line
direction of the slave device 61.
[0040] FIG. 9 is a diagram illustrating a relationship among the boom angle θ1, the arm
angle Θ2, the attachment angle Θ3, the inclination angle 04, and the angle α2. As
illustrated in FIG. 9, the boom angle θ1 is an angle formed by the slewing plane L1
of the upper slewing body 22 and a straight line L2 passing through the boom foot
pin 81 and the boom top pin 82. The arm angle Θ2 is an angle formed by the straight
line L2 and a straight line L3 passing through the arm foot pin 82 and the arm top
pin 83. The attachment angle Θ3 is an angle formed by the straight line L3 and a straight
line L4 passing through the arm top pin 83 and the attachment link pin 84. The inclination
angle Θ4 is an angle formed by the horizontal direction X and the slewing plane L1
of the upper slewing body 22. The angle α2 is an angle formed by the vertically downward
direction Y and the straight line L4. When the boom angle θ1, the arm angle Θ2, the
attachment angle 03, the inclination angle 04, and the angle α2 are defined as described
above, the angle α2 is expressed by the following Formula (1) using the boom angle
θ1, the arm angle Θ2, the attachment angle θ3, and the inclination angle Θ4.

[0041] The direction specifying unit 711 calculates the angle α2 by performing the calculation
of the Formula (1) based on the angle data S17 and outputs the second direction data
D2 indicating the angle α2.
[0042] Based on the attachment information S16 input from the master device 62 and the second
direction data D2 input from the direction specifying unit 711, the difference/similarity
determination unit 712 determines difference or similarity between an attachment of
a transmission source of the attachment information S14 (hereinafter referred to as
"transmission source attachment") and the attachment attached to the work device 3
of the own machine (hereinafter referred to as "own machine attachment").
[0043] FIG. 10 is a flowchart illustrating a processing flow of the determination unit 71.
First, in Step SP11, the difference/similarity determination unit 712 acquires the
attachment information S16 from the master device 62. The attachment information S16
includes the first direction data D1, the control information S12, and the RSSI value.
[0044] Next, in Step SP12, the difference/similarity determination unit 712 determines whether
or not the RSSI value included in the attachment information S16 is equal to or greater
than a predetermined threshold value Vth2 set in advance. The threshold value Vth2
is set such that an RSSI value when the attachment information S14 transmitted from
the own machine attachment is received by the receiver 621 of the own machine is equal
to or greater than the threshold value Vth2, and an RSSI value when the attachment
information S14 transmitted from an attachment (hereinafter referred to as a "nearby
attachment") attached to a work machine parked in the vicinity of the own machine
is received by the receiver 621 of the own machine is less than the threshold value
Vth2.
[0045] In a case where the RSSI value included in the attachment information S16 is less
than the threshold value Vth2 (Step SP12: NO), then in Step SP17, the difference/similarity
determination unit 712 determines that the transmission source attachment and the
own machine attachment are different from each other, and ends the processing.
[0046] When the RSSI value included in the attachment information S16 is equal to or greater
than the threshold value Vth2 (Step SP12: YES), next, in Step SP13, the direction
specifying unit 711 acquires the angle data S17 (boom angle data, arm angle data,
attachment angle data, and inclination angle data) from the angle sensors 41 to 43
and the inclination sensor 5.
[0047] Next, in Step SP14, the direction specifying unit 711 calculates the angle α2 by
performing the calculation of the Formula (1) based on the angle data S17, and outputs
the second direction data D2 indicating the angle α2. The second direction data D2
is input to the difference/similarity determination unit 712.
[0048] Next, in Step SP15, the difference/similarity determination unit 712 calculates an
absolute value of a difference between the angle α1 indicated by the first direction
data D1 included in the attachment information S16 and the angle α2 indicated by the
second direction data D2 input from the direction specifying unit 711, and determines
whether or not the value is equal to or less than a predetermined threshold value
Vth1.
[0049] In a case where the absolute value of the difference between the angle α1 and the
angle α2 is greater than the threshold value Vth1 (Step SP15: NO), then in Step SP17,
the difference/similarity determination unit 712 determines that the transmission
source attachment and the own machine attachment are different from each other, and
ends the processing.
[0050] In a case where the absolute value of the difference between the angle α1 and the
angle α2 is equal to or less than the threshold value Vth1 (Step SP15: YES), then
in Step SP16, the difference/similarity determination unit 712 determines that the
transmission source attachment and the own machine attachment are the same, inputs
the control information S12 included in the attachment information S16 to the control
unit 72 as control information S18, and ends the processing.
[0051] As illustrated in FIG. 7, the control unit 72 updates the control information S19
for controlling the actuator drive circuit 78 with the control information S18 input
from the determination unit 71. For example, the control unit 72 updates a drive start
pressure value of an electromagnetic relief valve based on hydraulic oil pressure
information included in the control information S18. Alternatively, the control unit
72 updates a flow rate of the hydraulic pump or the pilot pressure of the control
valve based on hydraulic oil flow rate information included in the control information
S18. Alternatively, the control unit 72 updates a control parameter of interference
prevention control between the main body part 2 and the attachment 33 or a control
parameter of falling alarm control of the work machine 1 based on the dimensional
information included in the control information S18.
[0052] Instead of the above configuration in which the control unit 72 unconditionally updates
the control information S19 based on the control information S18, it may be configured
such that when the control information S18 is input from the determination unit 71,
the control unit 72 displays a confirmation message for inquiring the operator about
necessity of updating the control information S19 on a display device (not illustrated)
in the main body part 2, and executes update processing of the control information
S19 on condition that an update command is input by the operator. As a result, it
is possible to avoid a situation in which the control information S19 is unintentionally
updated when the update of the control information S19 is unnecessary.
[0053] In addition, instead of the above configuration in which the control information
S12 including specification information of each attachment 33 is transmitted from
the slave device 61 to the master device 62, it may be configured such that the specification
information of each attachment 33 is stored in a nonvolatile storage unit that can
be referred to by the control unit 72 in association with unique identification information,
and only the first direction data D1 and the unique identification information are
transmitted from the slave device 61 to the master device 62. In this case, when the
determination unit 71 determines that the transmission source attachment and the own
machine attachment are the same, the unique identification information received from
the slave device 61 is input to the control unit 72, and the control unit 72 reads
specification information corresponding to the input unique identification information
from the above described nonvolatile storage unit as the control information S18.
As a result, an amount of transmission data from the slave device 61 to the master
device 62 can be reduced.
[0054] Further, instead of the above configuration in which the determination unit 71 is
mounted in the controller 7, it may be configured such that the determination unit
71 is mounted in the master device 62. This enables reduction in a processing load
of the controller 7.
[0055] In addition, when the content of the attachment information S16 acquired this time
in Step SP11 is the same as the content of the attachment information S16 acquired
last time, the controller 7 or the master device 62 may omit the processing after
Step SP12 with respect to the attachment information S16 acquired this time. Specifically,
when acquiring the attachment information S16 in Step SP11, the difference/similarity
determination unit 712 compares the control information S12 included in the attachment
information S16 acquired this time with the control information S12 included in the
attachment information S16 acquired last time, and determines that the attachment
information S16 acquired this time is the same as the attachment information S16 acquired
last time when the contents (particularly, the unique identification information and
the control parameters) of both pieces of the control information are the same.
[0056] According to the work machine 1 of the present embodiment, the transmitter 614 of
the slave device 61 (the first communication device) transmits the attachment information
S14 including the first direction data D1 as a radio signal, and the receiver 621
of the master device 62 (the second communication device) receives the attachment
information S14. In addition, the direction specifying unit 711 specifies the direction
of the attachment 33 with respect to the reference direction based on the angle data
S17 input from the angle detection means (the angle sensors 41 to 43 and the inclination
sensor 5), and outputs the second direction data D2. Then, the difference/similarity
determination unit 712 determines difference or similarity between the transmission
source attachment and the own machine attachment based on the first direction data
D1 included in the attachment information S16 input from the receiver 621 and the
second direction data D2 input from the direction specifying unit 711. Therefore,
the determination unit 71 can allow the attachment information (the control information
S18) to be input of to the control unit 72 on condition that the difference/similarity
determination unit 712 determines that the transmission source attachment and the
own machine attachment are the same. As a result, the control unit 72 can efficiently
and accurately acquire the attachment information (the control information S18) of
the replaceable attachment 33. For example, even in a situation where a plurality
of work machines 1 are parked side by side in a parking lot, it is possible to avoid
erroneous acquisition of attachment information transmitted from an attachment 33
attached to a nearby work machine 1 as attachment information of an attachment 33
attached to the own machine.
[0057] According to the work machine 1 of the present embodiment, the transmitter 614 transmits
the attachment information S14 including the control information S12. The control
unit 72 updates the control parameter (the control information S19) of the work device
3 based on the control information S12 included in the attachment information S16
input from the receiver 621 on condition that the difference/similarity determination
unit 712 determines that the transmission source attachment and the own machine attachment
are the same. As a result, it is possible to efficiently and accurately update the
control parameter (the control information S19) of the work device 3 to which the
replaceable attachment 33 is attached.
[0058] According to the work machine 1 of the present embodiment, the control information
S12 transmitted from the slave device 61 to the master device 62 includes at least
one of the pressure information of the hydraulic oil supplied to the attachment 33,
the flow rate information of the hydraulic oil, and the dimensional information of
the attachment 33. By including the pressure information of the hydraulic oil, it
is possible to perform optimum relief pressure control, overload alarm control, and
the like for each attachment 33. By including the flow rate information of the hydraulic
oil, it is possible to perform optimum pump flow rate control, pilot pressure control,
and the like for each attachment 33. By including the dimensional information of the
attachment 33, it is possible to perform optimum interference prevention control,
falling alarm control, and the like for each attachment 33.
[0059] In addition, in the work machine 1 according to the present embodiment, the difference/similarity
determination unit 712 determines that the transmission source attachment and the
own machine attachment are the same on condition that the difference between the first
direction data D1 included in the attachment information S16 input from the receiver
621 and the second direction data D2 input from the direction specifying unit 711
is equal to or less than the first threshold value Vth1. Therefore, it is possible
to accurately determine difference or similarity between both attachments by simple
processing of comparing the difference between the first direction data D1 and the
second direction data D2 with the first threshold value Vth1.
[0060] Further, according to the work machine 1 of the present embodiment, the difference/similarity
determination unit 712 further determines that the transmission source attachment
and the own machine attachment are the same on condition that the RSSI value (the
received signal strength) of the attachment information S14 received by the receiver
621 is equal to or greater than the second threshold value Vth2. Therefore, even when
the difference between the first direction data D1 and the second direction data D2
is equal to or less than the first threshold value Vth1, if the RSSI value of the
attachment information S14 received by the receiver 621 is less than the second threshold
value Vth2, the difference/similarity determination unit 712 determines that both
attachments are different. The second threshold value Vth2 is set such that the RSSI
value when the attachment information S14 transmitted from the own machine attachment
is received by the receiver 621 of the own machine is equal to or greater than the
second threshold value Vth2, and the RSSI value when the attachment information S14
transmitted from a nearby attachment is received by the receiver 621 of the own machine
is less than the second threshold value Vth2. Therefore, in a case where an attitude
of the nearby attachment is the same as or approximate to an attitude of the own machine
attachment, it is possible to more reliably avoid a situation in which the attachment
information S14 transmitted from the nearby attachment is erroneously acquired as
the attachment information S14 of the own machine attachment.
[0061] According to the work machine 1 of the present embodiment, the transfer processing
unit 623 determines whether or not to transfer the attachment information S16 input
from the signal processing unit 622 to the controller 7 based on the predetermined
transfer condition. Therefore, since the attachment information S16 is not transferred
to the controller 7 when the transfer condition is not satisfied, it is possible to
select whether or not to transfer the attachment information S16 to the controller
7 according to a type, a manufacturer, or the like of the attachment 33.
[0062] Further, according to the work machine 1 of the present embodiment, the direction
specifying unit 711 specifies the direction of the attachment 33 with respect to the
reference direction based on the boom angle data indicating the boom angle θ1, the
arm angle data indicating the arm angle θ2, the attachment angle data indicating the
attachment angle 03, and the inclination angle data indicating the inclination angle
Θ4 of the main body part 2. Therefore, the present invention can be applied to a construction
machine having a work arm including the boom 31, the arm 32, and the attachment 33.
In addition, since not only the boom angle data, the arm angle data, and the attachment
angle data but also the inclination angle data indicating the inclination angle Θ4
of the main body part 2 are referred to, even in a case where the work machine 1 is
parked on an inclined surface, the direction of the attachment 33 with respect to
the reference direction can be accurately specified, resulting in enabling improvement
in the accuracy of difference/similarity determination processing by the difference/similarity
determination unit 712.
<Modification>
[0063] FIG. 11 is a block diagram illustrating a configuration of a controller 7 according
to a modification. The controller 7 includes a replacement detection unit 74 in addition
to the configuration illustrated in FIG. 7.
[0064] The replacement detection unit 74 measures a weight of the attachment 33 attached
to the arm 32 by a weight sensor disposed at the distal end of the arm 32, or measures
a pressure in a pipe of the attachment 33 attached to the arm 32 by a pressure sensor
disposed at a distal end of the pipe in the arm 32. Then, the replacement detection
unit 74 detects replacement of the attachment 33 by detecting a change in these measurement
results.
[0065] When detecting replacement of the attachment 33, the replacement detection unit 74
inputs a replacement detection signal S30 to the control unit 72. When the replacement
detection signal S30 is input, the control unit 72 inputs, to the master device 62,
an attachment information request signal S31 for requesting the new attachment 33
after replacement to transmit attachment information. The master device 62 transmits
the input attachment information request signal S31 to the slave device 61 as a radio
signal. Upon receiving the attachment information request signal S31, the slave device
61 generates the attachment information S14 and wirelessly transmits the attachment
information toward the master device 62 similarly to the above embodiment.
[0066] Similarly to the above embodiment, the control unit 72 updates the control parameter
(the control information S19) of the work device 3 based on the control information
S12 included in the attachment information S14 received from the slave device 61 on
condition that the difference/similarity determination unit 712 determines that the
transmission source attachment and the own machine attachment are the same.
[0067] According to the work machine 1 of the present modification, when the replacement
detection unit 74 detects replacement of the attachment 33, the control unit 72 receives
the attachment information S14 from the slave device 61 disposed at the new attachment
33 after the replacement, and executes the update processing of the control parameter
(the control information S19) of the work device 3 based on the attachment information
S14. As a result, it is possible to realize optimum drive control for the new attachment
33 after the replacement.
[0068] Characteristics of the above-described embodiments are summarized as follows.
[0069] A work machine according to one aspect of the present invention includes: a main
body part; a work device to which a replaceable attachment is attached and which is
attached to the main body part so as to be changeable in attitude; an angle detection
means that detects a drive angle of the work device and outputs angle data; a first
communication device disposed at the attachment; a second communication device disposed
at the main body part; and a determination unit, in which the first communication
device includes: an inertial sensor that detects a direction of the attachment with
respect to a predetermined reference direction to output first direction data; and
a transmitter that transmits attachment information including the first direction
data as a radio signal, the second communication device includes a receiver that receives
the attachment information transmitted from the transmitter, and the determination
unit includes: a direction specifying unit that specifies a direction of the attachment
with respect to the reference direction based on the angle data input from the angle
detection means to output second direction data; and a difference/similarity determination
unit that determines difference or similarity between a transmission source attachment
of the attachment information and the attachment attached to the work device based
on the first direction data included in the attachment information input from the
receiver and the second direction data input from the direction specifying unit.
[0070] According to the work machine according to this aspect, the transmitter of the first
communication device transmits attachment information including the first direction
data as a radio signal, and the receiver of the second communication device receives
the attachment information. In addition, the direction specifying unit specifies a
direction of the attachment with respect to the reference direction based on the angle
data input from the angle detection means, and outputs the second direction data.
Then, based on the first direction data included in the attachment information input
from the receiver and the second direction data input from the direction specifying
unit, the difference/similarity determination unit determines difference or similarity
between a transmission source attachment of the attachment information and the attachment
attached to the work device. Therefore, the determination unit can allow the attachment
information to be input to a control unit that controls the work device on condition
that the difference/similarity determination unit determines that the transmission
source attachment of the attachment information and the attachment attached to the
work device are the same. As a result, the control unit can efficiently and accurately
acquire attachment information of a replaceable attachment. For example, even in a
situation where a plurality of work machines are parked side by side in a parking
lot, it is possible to avoid erroneous acquisition of attachment information transmitted
from an attachment attached to a nearby work machine as attachment information of
an attachment attached to the own machine.
[0071] The work machine according to the above aspect preferably further includes a control
unit that controls the work device, in which the first communication device further
includes a storage unit that stores control information regarding an attachment at
which the first communication device is disposed, the transmitter transmits the attachment
information further including the control information read from the storage unit,
and the control unit updates a control parameter of the work device based on the control
information included in the attachment information input from the receiver on condition
that the difference/similarity determination unit determines that a transmission source
attachment of the attachment information is same as the attachment attached to the
work device.
[0072] According to the work machine according to this aspect, the transmitter transmits
the attachment information including the control information. The control unit updates
the control parameter of the work device based on the control information included
in the attachment information input from the receiver on condition that the difference/similarity
determination unit determines that the transmission source attachment of the attachment
information is the same as the attachment attached to the work device. As a result,
it is possible to efficiently and accurately update the control parameter of the work
device to which the replaceable attachment is attached.
[0073] In the work machine according to the above aspect, it is preferable that the attachment
is hydraulically controlled, and the control information includes at least one of
pressure information of hydraulic oil supplied to the attachment, flow rate information
of the hydraulic oil, and dimensional information of the attachment.
[0074] According to the work machine according to this aspect, the control information transmitted
from the first communication device to the second communication device includes at
least one of pressure information of hydraulic oil supplied to the attachment, flow
rate information of the hydraulic oil, and dimensional information of the attachment.
By including the pressure information of the hydraulic oil, optimum relief pressure
control, overload alarm control, and the like can be performed for each attachment.
By including the flow rate information of the hydraulic oil, optimum pump flow rate
control, pilot pressure control, and the like can be performed for each attachment.
By including the dimensional information of the attachment, optimum interference prevention
control, falling alarm control, and the like can be performed for each attachment.
[0075] In the work machine according to the above aspect, the control unit preferably includes
a replacement detection unit that detects the attachment having been replaced, and
in a case where replacement of the attachment is detected by the replacement detection
unit, receives the attachment information from the attachment newly replaced, and
executes update processing of a control parameter of the work device based on the
attachment information.
[0076] According to the work machine according to this aspect, in a case where replacement
of the attachment is detected by the replacement detection unit, the control unit
receives the attachment information from the attachment newly replaced, and executes
update processing of a control parameter of the work device based on the attachment
information. As a result, it is possible to realize optimum drive control for the
newly replaced attachment.
[0077] In the work machine according to the above aspect, on condition that a difference
between the first direction data included in the attachment information input from
the receiver and the second direction data input from the direction specifying unit
is equal to or less than a first threshold value, the difference/similarity determination
unit preferably determines that a transmission source attachment of the attachment
information is the same as the attachment attached to the work device.
[0078] According to the work machine according to this aspect, the difference/similarity
determination unit determines that the transmission source attachment of the attachment
information and the attachment attached to the work device are the same on condition
that a difference between the first direction data included in the attachment information
input from the receiver and the second direction data input from the direction specifying
unit is equal to or less than the first threshold value. Therefore, it is possible
to accurately determine difference or similarity between both the attachments by simple
processing of comparing the difference between the first direction data and the second
direction data with the first threshold value.
[0079] In the work machine according to the above aspect, it is preferable that on condition
that a received signal strength of the attachment information received by the receiver
is equal to or greater than a second threshold value, the difference/similarity determination
unit further determines that a transmission source attachment of the attachment information
is the same as the attachment attached to the work device.
[0080] According to the work machine according to this aspect, on condition that a received
signal strength of the attachment information received by the receiver is equal to
or greater than the second threshold value, the difference/similarity determination
unit further determines that a transmission source attachment of the attachment information
is the same as the attachment attached to the work device. Therefore, even if the
difference between the first direction data and the second direction data is equal
to or less than the first threshold value, when the received signal strength of the
attachment information received by the receiver is less than the second threshold
value, the difference/similarity determination unit determines that both attachments
are different. The second threshold value is set such that the received signal strength
when the attachment information transmitted from the attachment attached to the own
machine (hereinafter referred to as "own machine attachment") is received by the receiver
of the own machine is equal to or greater than the second threshold value, and the
received signal strength when the attachment information transmitted from the attachment
attached to a work machine parked near the own machine (hereinafter referred to as
"nearby attachment") is received by the receiver of the own machine is less than the
second threshold value. Therefore, in a case where an attitude of the nearby attachment
is the same as or approximate to an attitude of the own machine attachment, it is
possible to more reliably avoid a situation in which the attachment information transmitted
from the nearby attachment is erroneously acquired as the attachment information of
the own machine attachment.
[0081] In the work machine according to the above aspect, the second communication device
preferably further includes a transfer processing unit that determines whether or
not to input the attachment information received by the receiver to the determination
unit based on a predetermined transfer condition.
[0082] In the work machine according to this aspect, the transfer processing unit determines
whether or not to input the attachment information received by the receiver to the
determination unit based on a predetermined transfer condition. Therefore, since the
attachment information is not transferred to the determination unit when the transfer
condition is not satisfied, it is possible to select whether or not to transfer the
attachment information from the receiver to the determination unit according to a
type, a manufacturer, or the like of the attachment.
[0083] In the work machine according to the above aspect, it is preferable that the work
device includes: a boom having one end rotatably coupled to the main body part; an
arm having one end rotatably coupled to the other end of the boom; and the attachment
rotatably attached to the other end of the arm, the angle detection means includes:
a boom angle sensor that detects a boom angle that is an angle of the boom with respect
to the main body part, and outputs boom angle data; an arm angle sensor that detects
an arm angle that is an angle of the arm with respect to the boom, and outputs arm
angle data; an attachment angle sensor that detects an attachment angle that is an
angle of the attachment with respect to the arm, and outputs attachment angle data;
and an inclination angle sensor that detects an inclination angle of the main body
part with respect to a horizontal direction, and outputs inclination angle data, and
the direction specifying unit specifies a direction of the attachment with respect
to the reference direction based on the boom angle data, the arm angle data, the attachment
angle data, and the inclination angle data.
[0084] In the work machine according to this aspect, the direction specifying unit specifies
the direction of the attachment with respect to the reference direction based on the
boom angle data, the arm angle data, the attachment angle data, and the inclination
angle data. This enables the present invention to be applied to a construction machine
having a work arm including a boom, an arm, and an attachment. In addition, since
not only the boom angle data, the arm angle data, and the attachment angle data but
also the inclination angle data indicating the inclination angle of the main body
part are referred to, even in a case where the work machine is parked on an inclined
surface, the direction of the attachment with respect to the reference direction can
be accurately specified, resulting in improving the accuracy of the difference/similarity
determination processing by the difference/similarity determination unit.
[0085] A program according to one aspect of the present invention is a program for causing
an information processing device mounted on a work machine to function as a direction
specifying means and a difference/similarity determination means, the work machine
including: a main body part; a work device to which a replaceable attachment is attached
and which is attached to the main body part so as to be changeable in attitude; an
angle detection means that detects a drive angle of the work device and outputs angle
data; a first communication device disposed at the attachment; and a second communication
device disposed at the main body part, the first communication device including: an
inertial sensor that detects a direction of the attachment with respect to a predetermined
reference direction to output first direction data; and a transmitter that transmits
attachment information including the first direction data as a radio signal, and the
second communication device including: a receiver that receives the attachment information
transmitted from the transmitter, in which the direction specifying means specifies
a direction of the attachment with respect to the reference direction based on the
angle data input from the angle detection means to output second direction data, and
the difference/similarity determination means determines difference or similarity
between a transmission source attachment of the attachment information and the attachment
attached to the work device based on the first direction data included in the attachment
information input from the receiver and the second direction data input from the direction
specifying means.
[0086] According to the program according to this aspect, the transmitter of the first communication
device transmits attachment information including the first direction data as a radio
signal, and the receiver of the second communication device receives the attachment
information. In addition, the direction specifying means specifies the direction of
the attachment with respect to the reference direction based on the angle data input
from the angle detection means, and outputs the second direction data. Then, based
on the first direction data included in the attachment information input from the
receiver and the second direction data input from the direction specifying means,
the difference/similarity determination means determines difference or similarity
between a transmission source attachment of the attachment information and the attachment
attached to the work device. Therefore, the information processing device can allow
the attachment information to be input to the control unit that controls the work
device on condition that the difference/similarity determination means determines
that the transmission source attachment of the attachment information and the attachment
attached to the work device are the same. As a result, the control unit can efficiently
and accurately acquire attachment information of a replaceable attachment. For example,
even in a situation where a plurality of work machines are parked side by side in
a parking lot, it is possible to avoid erroneous acquisition of attachment information
transmitted from an attachment attached to a nearby work machine as attachment information
of an attachment attached to the own machine.
[0087] A method for controlling a work machine according to one aspect of the present invention,
the work machine including: a main body part; a work device to which a replaceable
attachment is attached and which is attached to the main body part so as to be changeable
in attitude; an angle detection means that detects a drive angle of the work device
and outputs angle data; a first communication device disposed at the attachment; and
a second communication device disposed at the main body part, the first communication
device including: an inertial sensor that detects a direction of the attachment with
respect to a predetermined reference direction to output first direction data; and
a transmitter that transmits attachment information including the first direction
data as a radio signal, and the second communication device including: a receiver
that receives the attachment information transmitted from the transmitter, the method
for controlling a work machine including: (A) a step of specifying a direction of
the attachment with respect to the reference direction based on the angle data input
from the angle detection means and generating second direction data; and (B) a step
of determining difference or similarity between a transmission source attachment of
the attachment information and the attachment attached to the work device based on
the first direction data included in the attachment information input from the receiver
and the second direction data generated by the step (A).
[0088] According to the method for controlling a work machine according to this aspect,
the transmitter of the first communication device transmits attachment information
including the first direction data as the radio signal, and the receiver of the second
communication device receives the attachment information. In addition, in the step
(A), the direction of the attachment with respect to the reference direction is specified
based on the angle data input from the angle detection means, and the second direction
data is generated. Then, in the step (B), based on the first direction data included
in the attachment information input from the receiver and the second direction data
generated by the step (A), the difference or similarity between the transmission source
attachment of the attachment information and the attachment attached to the work device
is determined. Therefore, on condition that it is determined in the step (B) that
the transmission source attachment of the attachment information and the attachment
attached to the work device are the same, the attachment information is allowed to
be input to the control unit that controls the work device. As a result, the control
unit can efficiently and accurately acquire attachment information of a replaceable
attachment. For example, even in a situation where a plurality of work machines are
parked side by side in a parking lot, it is possible to avoid erroneous acquisition
of attachment information transmitted from an attachment attached to a nearby work
machine as attachment information of an attachment attached to the own machine.
1. A work machine comprising:
a main body part;
a work device to which a replaceable attachment is attached and which is attached
to the main body part so as to be changeable in attitude;
an angle detection means that detects a drive angle of the work device and outputs
angle data;
a first communication device disposed at the attachment;
a second communication device disposed at the main body part; and
a determination unit,
wherein the first communication device includes:
an inertial sensor that detects a direction of the attachment with respect to a predetermined
reference direction to output first direction data; and
a transmitter that transmits attachment information including the first direction
data as a radio signal,
the second communication device includes a receiver that receives the attachment information
transmitted from the transmitter, and
the determination unit includes:
a direction specifying unit that specifies a direction of the attachment with respect
to the reference direction based on the angle data input from the angle detection
means to output second direction data; and
a difference/similarity determination unit that determines difference or similarity
between a transmission source attachment of the attachment information and the attachment
attached to the work device based on the first direction data included in the attachment
information input from the receiver and the second direction data input from the direction
specifying unit.
2. The work machine according to claim 1, further comprising a control unit that controls
the work device,
wherein the first communication device further includes a storage unit that stores
control information regarding an attachment at which the first communication device
is disposed,
the transmitter transmits the attachment information further including the control
information read from the storage unit, and
the control unit updates a control parameter of the work device based on the control
information included in the attachment information input from the receiver on condition
that the difference/similarity determination unit determines that a transmission source
attachment of the attachment information is same as the attachment attached to the
work device.
3. The work machine according to claim 2, wherein the attachment is hydraulically controlled,
and the control information includes at least one of pressure information of hydraulic
oil supplied to the attachment, flow rate information of the hydraulic oil, and dimensional
information of the attachment.
4. The work machine according to claim 2 or 3, wherein
the control unit
includes a replacement detection unit that detects the attachment having been replaced,
and
in a case where replacement of the attachment is detected by the replacement detection
unit, receives the attachment information from the attachment newly replaced, and
executes update processing of a control parameter of the work device based on the
attachment information.
5. The work machine according to any one of claims 1 to 4, wherein on condition that
a difference between the first direction data included in the attachment information
input from the receiver and the second direction data input from the direction specifying
unit is equal to or less than a first threshold value, the difference/similarity determination
unit determines that a transmission source attachment of the attachment information
is same as the attachment attached to the work device.
6. The work machine according to claim 5, wherein on condition that a received signal
strength of the attachment information received by the receiver is equal to or greater
than a second threshold value, the difference/similarity determination unit further
determines that a transmission source attachment of the attachment information is
the same as the attachment attached to the work device.
7. The work machine according to any one of claims 1 to 6, wherein the second communication
device further includes a transfer processing unit that determines whether or not
to input the attachment information received by the receiver to the determination
unit based on a predetermined transfer condition.
8. The work machine according to any one of claims 1 to 7, wherein
the work device includes:
a boom having one end rotatably coupled to the main body part;
an arm having one end rotatably coupled to the other end of the boom; and
the attachment rotatably attached to the other end of the arm,
the angle detection means includes:
a boom angle sensor that detects a boom angle that is an angle of the boom with respect
to the main body part, and outputs boom angle data;
an arm angle sensor that detects an arm angle that is an angle of the arm with respect
to the boom, and outputs arm angle data;
an attachment angle sensor that detects an attachment angle that is an angle of the
attachment with respect to the arm, and outputs attachment angle data; and
an inclination angle sensor that detects an inclination angle of the main body part
with respect to a horizontal direction, and outputs inclination angle data, and
the direction specifying unit specifies a direction of the attachment with respect
to the reference direction based on the boom angle data, the arm angle data, the attachment
angle data, and the inclination angle data.
9. A program for causing an information processing device mounted on a work machine to
function as a direction specifying means and a difference/similarity determination
means,
the work machine including: a main body part; a work device to which a replaceable
attachment is attached and which is attached to the main body part so as to be changeable
in attitude; an angle detection means that detects a drive angle of the work device
and outputs angle data; a first communication device disposed at the attachment; and
a second communication device disposed at the main body part,
the first communication device including: an inertial sensor that detects a direction
of the attachment with respect to a predetermined reference direction to output first
direction data; and a transmitter that transmits attachment information including
the first direction data as a radio signal, and
the second communication device including a receiver that receives the attachment
information transmitted from the transmitter,
wherein the direction specifying means specifies a direction of the attachment with
respect to the reference direction based on the angle data input from the angle detection
means to output second direction data, and
the difference/similarity determination means determines difference or similarity
between a transmission source attachment of the attachment information and the attachment
attached to the work device based on the first direction data included in the attachment
information input from the receiver and the second direction data input from the direction
specifying means.
10. A method for controlling a work machine that includes: a main body part; a work device
to which a replaceable attachment is attached and which is attached to the main body
part so as to be changeable in attitude; an angle detection means that detects a drive
angle of the work device and outputs angle data; a first communication device disposed
at the attachment; and a second communication device disposed at the main body part,
the first communication device including: an inertial sensor that detects a direction
of the attachment with respect to a predetermined reference direction to output first
direction data; and a transmitter that transmits attachment information including
the first direction data as a radio signal, and
the second communication device including a receiver that receives the attachment
information transmitted from the transmitter,
the method comprising:
(A) a step of specifying a direction of the attachment with respect to the reference
direction based on the angle data input from the angle detection means and generating
second direction data; and
(B) a step of determining difference or similarity between a transmission source attachment
of the attachment information and the attachment attached to the work device based
on the first direction data included in the attachment information input from the
receiver and the second direction data generated by the step (A).