WORK MACHINE, METHOD AND SYSTEM FOR CONTROLLING WORK MACHINE
20250305247 ยท 2025-10-02
Inventors
Cpc classification
E02F3/76
FIXED CONSTRUCTIONS
E02F9/264
FIXED CONSTRUCTIONS
International classification
Abstract
A work machine includes a vehicle body, a support member, a blade, a rotation angle sensor, an object sensor, and a controller. The support member is connected to the vehicle body. The blade is rotatably supported by the support member. The rotation angle sensor detects a rotation angle of the blade. The object sensor detects an object around the work machine and outputs a signal indicating a presence or absence of the object. The controller is configured to set a detection range around the work machine. The controller is configured to determine the presence or absence of the object within the detection range based on the signal from the object sensor. The controller is configured to set the detection range according to the rotation angle of the blade.
Claims
1. A work machine comprising: a vehicle body; a support member connected to the vehicle body; a blade rotatably supported by the support member; a rotation angle sensor configured to detect a rotation angle of the blade; an object sensor configured to detect an object around the work machine and output a signal indicating a presence or absence of the object; and a controller configured to set a detection range around the work machine and determine the presence or absence of the object within the detection range based on the signal from the object sensor, the controller being configured to set the detection range according to the rotation angle of the blade.
2. The work machine according to claim 1, wherein the controller is configured to set a reference range for the detection range based on a width of the vehicle body, and expand the detection range from the reference range based on the rotation angle of the blade.
3. The work machine according to claim 2, wherein the controller is configured to detect a position of a left end and a position of a right end of the blade based on the rotation angle of the blade, expand the detection range leftward from the reference range when the left end of the blade protrudes from the vehicle body in a width direction, and expand the detection range rightward from the reference range when the right end of the blade protrudes from the vehicle body in the width direction.
4. The work machine according to claim 1, wherein the support member supports the blade in a slidable manner left and right, the work machine further comprises a blade shift sensor configured to detect a blade shift amount indicating an amount of a left and right movement of the blade, and the controller is configured to set the detection range according to the blade shift amount.
5. The work machine according to claim 1, wherein the support member includes a drawbar supported by the vehicle body so as to be swingable left and right, the work machine further comprises a drawbar shift sensor configured to detect a drawbar shift amount indicating an amount of a left and right movement of the drawbar, and the controller is configured to set the detection range according to the drawbar shift amount.
6. A method for controlling a work machine, the work machine including a vehicle body, a support member connected to the vehicle body, and a blade rotatably supported by the support member, the method comprising: obtaining a rotation angle of the blade; receiving a signal indicating a presence or absence of an object around the work machine; setting a detection range around the work machine; determining the presence or absence of the object within the detection range based on the signal; and setting the detection range according to the rotation angle of the blade.
7. The method according to claim 6, further comprising: setting a reference range for the detection range based on a width of the vehicle body; and expanding the detection range from the reference range based on the rotation angle of the blade.
8. The method according to claim 7, further comprising: detecting a position of a left end and a position of a right end of the blade based on the rotation angle of the blade; expanding the detection range leftward from the reference range when the left end of the blade protrudes from the vehicle body in a width direction; and expanding the detection range from the reference range rightward when the right end of the blade protrudes from the vehicle body in the width direction.
9. The method according to claim 6, wherein the support member supports the blade in a slidable manner left and right, and the method further comprises; obtaining a blade shift amount indicating an amount of a left and right movement of the blade; and setting the detection range according to the blade shift amount.
10. The method according to claim 6, wherein the support member includes a drawbar supported by the vehicle body so as to be swingable left and right, and the method further comprises; obtaining a drawbar shift amount indicating an amount of a left and right movement of the drawbar; and setting the detection range according to the drawbar shift amount.
11. A system for controlling a work machine, the work machine including a vehicle body, a support member connected to the vehicle body, and a blade rotatably supported by the support member, the system comprising: a rotation angle sensor configured to detect a rotation angle of the blade; an object sensor configured to detect an object around the work machine and outputs a signal indicating a presence or absence of the object; and a controller configured to set a detection range around the work machine and determine the presence or absence of the object within the detection range based on the signal from the object sensor, the controller being configured to set the detection range according to the rotation angle of the blade.
12. The system according to claim 11, wherein the controller is configured to set a reference range for the detection range based on a width of the vehicle body, and expand the detection range from the reference range based on the rotation angle of the blade.
13. The system of claim 12, wherein the controller is configured to detect a position of a left end and a position of a right end of the blade based on the rotation angle of the blade, expand the detection range leftward from the reference range when the left end of the blade protrudes from the vehicle body in a width direction, and expand the detection range rightward from the reference range when the right end of the blade protrudes from the vehicle body in the width direction.
14. The system according to claim 11, wherein the support member supports the blade in a slidable manner left and right, the system further comprises a blade shift sensor configured to detect a blade shift amount indicating an amount of a left and right movement of the blade, and the controller is configured to set the detection range according to the blade shift amount.
15. The system according to claim 11, wherein the support member includes a drawbar supported by the vehicle body so as to be swingable left and right, the system further comprises a drawbar shift sensor configured to detect a drawbar shift amount indicating an amount of a left and right movement of the drawbar, and the controller is configured to set the detection range according to the drawbar shift amount.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0010]
[0011]
[0012]
[0013]
[0014]
[0015]
[0016]
[0017]
[0018]
[0019]
[0020]
[0021]
[0022]
DETAILED DESCRIPTION OF EMBODIMENT(S)
[0023] An embodiment of the present invention will be described below with reference to the drawings.
[0024] The vehicle body frame 4 supports the front wheels 6 and the work implement 3. The vehicle body frame 4 includes a front frame 11 and a rear frame 12. The rear frame 12 is connected to the front frame 11. The front frame 11 is configured to be articulated laterally with respect to the rear frame 12. In the following description, the front, rear, left, and right directions mean the front, rear, left, and right directions of the vehicle body 2 when the articulation angle is 0, that is, the front frame 11 and the rear frame 12 are straight.
[0025] A cab 13 and a power chamber 14 are disposed on the rear frame 12. A driver's seat (not shown) is disposed in the cab 13. A drive system, which will be described later, is disposed in the power chamber 14. The front frame 11 extends forward from the rear frame 12. The front wheels 6 are attached to the front frame 11. The tandem drive 5 is connected to the rear frame 12. The tandem drive 5 supports the rear wheels 7A and 7B and drives the rear wheels 7A and 7B. Note that in
[0026] The work implement 3 is movably connected to the vehicle body 2. The work implement 3 includes a support member 15 and a blade 16. The support member 15 is movably connected to the vehicle body 2. The support member 15 supports the blade 16. The support member 15 includes a drawbar 17 and a circle 18. The drawbar 17 and the circle 18 are disposed below the front frame 11.
[0027] As shown in
[0028] The circle 18 is connected to the rear part of the drawbar 17. The circle 18 is rotatably supported by the drawbar 17. The blade 16 is connected to the circle 18. The blade 16 is supported by the drawbar 17 via the circle 18. The blade 16 is rotatably supported by the circle 18 around a tilt axis 21. The tilt axis 21 extends in the left-right direction. The blade 16 is supported by the circle 18 so as to be slidable in the left-right direction.
[0029] The work machine 1 includes a plurality of actuators 22 to 27 for changing the attitude of the work implement 3. The plurality of actuators 22 to 27 include a plurality of hydraulic cylinders 22 to 26. The plurality of hydraulic cylinders 22 to 26 are connected to the work implement 3. The plurality of hydraulic cylinders 22 to 26 expand and contract using hydraulic pressure. The plurality of hydraulic cylinders 22 to 26 change the attitude of the work implement 3 with respect to the vehicle body 2 by expanding and contracting. In the following explanation, the expansion and contraction of the hydraulic cylinder will be referred to as a stroke operation.
[0030] Specifically, the plurality of hydraulic cylinders 22 to 26 include a left lift cylinder 22, a right lift cylinder 23, a drawbar shift cylinder 24, a blade tilt cylinder 25, and a blade shift cylinder 26. The left lift cylinder 22 and the right lift cylinder 23 are disposed apart from each other in the left-right direction. The left lift cylinder 22 is connected to the left portion of the drawbar 17. The right lift cylinder 23 is connected to the right portion of the drawbar 17. The left lift cylinder 22 and the right lift cylinder 23 are connected to the draw bar 17 so as to be swingable left and right.
[0031] The left lift cylinder 22 and the right lift cylinder 23 are connected to the front frame 11 so as to be swingable left and right. Specifically, the left lift cylinder 22 and the right lift cylinder 23 are connected to the front frame 11 via a lifter bracket 29. The lifter bracket 29 is connected to the front frame 11. The lifter bracket 29 supports the left lift cylinder 22 and the right lift cylinder 23 so as to be swingable left and right. Due to the stroke motion of the left lift cylinder 22 and the right lift cylinder 23, the draw bar 17 swings up and down around the pivot support 19. This causes the blade 16 to move up and down.
[0032] The drawbar shift cylinder 24 is connected to the drawbar 17 and the front frame 11. The drawbar shift cylinder 24 is connected to the front frame 11 via the lifter bracket 29. The draw bar shift cylinder 24 is swingably connected to the front frame 11. The drawbar shift cylinder 24 is swingably connected to the drawbar 17. The drawbar shift cylinder 24 extends diagonally downward from the front frame 11 toward the drawbar 17. The draw bar shift cylinder 24 extends from one side of the front frame 11 in the left-right direction toward the opposite side. By the stroke operation of the drawbar shift cylinder 24, the drawbar 17 swings left and right around the pivot support 19.
[0033] As shown in
[0034] The plurality of actuators 22 to 27 include a rotary actuator 27. The rotary actuator 27 is connected to the draw bar 17 and the circle 18. The rotary actuator 27 rotates circle 18 relative to the draw bar 17. Thereby, the blade 16 rotates around the rotation axis extending in the vertical direction.
[0035]
[0036] The control valve 34 is connected to the hydraulic pump 32 and the plurality of hydraulic cylinders 22 to 26 via a hydraulic circuit. The control valve 34 includes a plurality of valves each connected to a plurality of hydraulic cylinders 22 to 26. The control valve 34 controls the flow rate of hydraulic fluid supplied from the hydraulic pump 32 to the plurality of hydraulic cylinders 22 to 26.
[0037] The rotary actuator 27 is a hydraulic motor. The control valve 34 is connected to the hydraulic pump 32 and the rotary actuator 27 via a hydraulic circuit. The control valve 34 controls the flow rate of hydraulic fluid supplied from the hydraulic pump 32 to the rotary actuator 27. Note that the rotary actuator 27 may be an electric motor.
[0038] The power transmission device 33 transmits the driving force from the drive source 31 to the rear wheels 7A and 7B. The power transmission device 33 may include a torque converter and/or a plurality of speed change gears. Alternatively, the power transmission device 33 may be a transmission such as an HST (Hydraulic Static Transmission) or an HMT (Hydraulic Mechanical Transmission).
[0039] As shown in
[0040] The controller 36 controls the drive source 31 and the power transmission device 33 to cause the work machine 1 to travel. Further, the controller 36 controls the hydraulic pump 32 and the control valve 34 to operate the work implement 3. The controller 36 includes a processor 37 and a storage device 38. The processor 37 is, for example, a CPU, and executes a program for controlling the work machine 1. The storage device 38 includes memories such as RAM and ROM, and auxiliary storage devices such as SSD or HDD. The storage device 38 stores programs and data for controlling the work machine 1.
[0041] As shown in
[0042] The blade shift sensor 42 detects the blade shift amount Lbs. As shown in
[0043] The draw bar shift sensor 43 detects the draw bar shift amount Lds. As shown
[0044] in
[0045] The rotation angle sensor 41, the blade shift sensor 42, and the draw bar shift sensor 43 are, for example, IMUs (inertial measurement units). Alternatively, the rotation angle sensor 41, the blade shift sensor 42, and the draw bar shift sensor 43 may be cameras. In that case, the controller 36 analyzes the images acquired by the rotation angle sensor 41, the blade shift sensor 42, and the draw bar shift sensor 43 to calculate the blade rotation angle s, the blade shift amount Lbs, and the draw bar shift amount Lds. Alternatively, the blade shift sensor 42 may be a sensor that detects the stroke length of the blade shift cylinder 26. The drawbar shift sensor 43 may be a sensor that detects the stroke length of the draw bar shift cylinder 24.
[0046] As shown in
[0047] The output device 45 is, for example, a display. The output device 45 displays an image in response to a command signal from the controller 36. Alternatively, the output device 45 may be a speaker. The output device 45 may output audio in response to a command signal from the controller 36.
[0048] The controller 36 sets a detection range 50 around the work machine 1 and determines the presence or absence of an object within the detection range 50 based on the signal from the object sensor 44. For example, as shown in
[0049] The controller 36 sets the detection range 50 according to the blade rotation angle s, the blade shift amount Lbs, and the drawbar shift amount Lds. Hereinafter, a method of setting the detection range 50 by the controller 36 will be explained.
[0050] As shown in
[0051] In step S4, the controller 36 calculates the left blade length Lwl. As shown in
[0052] In step S5, the controller 36 calculates the right blade length Lwr. As shown in
[0053] In addition, in the above equations (1) and (2), the leftward blade shift amount Lbs and draw bar shift amount Lds are defined as positive values, and the rightward blade shift amount Lbs and draw bar shift amount Lds are defined as negative values.
[0054] In step S6, the controller 36 determines whether both the left end 16L and right end 16R of the blade 16 protrude from the width L0 of the vehicle body 2 (hereinafter referred to as vehicle width), as shown in
[0055] If the controller 36 determines that both the left end 16L and right end 16R of the blade 16 protrude from the vehicle width L0, the process proceeds to step S7.
[0056] In step S7, the controller 36 expands the detection range 50 to both left and right sides. As shown in
[0057] In step S6, if at least one of the left end 16L and the right end 16R of the blade 16 does not protrude from the vehicle width L0, the process proceeds to step S8. In step S8, the controller 36 determines whether only the left end 16L of the blade 16 protrudes from the vehicle width L0. That is, the controller 36 determines whether the left end 16L of the blade 16 protrudes from the vehicle width L0 and whether the right end 16R of the blade 16 is located within the vehicle width L0.
[0058] The controller 36 determines that only the left end 16L of the blade 16 protrudes from the vehicle width L0 when the following second condition is satisfied.
[0059] If the controller 36 determines that only the left end 16L of the blade 16 protrudes from the vehicle width L0, the process advances to step S9. In step S9, the controller 36 expands the detection range 50 to the left. As shown in
[0060] In
[0061] In step S8, if the left end 16L of the blade 16 does not protrude from the vehicle width L0, the process proceeds to step S10. In step S10, the controller 36 determines whether only the right end 16R of the blade 16 protrudes from the vehicle width L0. That is, the controller 36 determines whether the right end 16R of the blade 16 protrudes from the vehicle width L0 and whether the left end 16L of the blade 16 is located within the vehicle width L0.
[0062] The controller 36 determines that only the right end 16R of the blade 16 protrudes from the vehicle width L0 when the following third condition is satisfied.
[0063] If the controller 36 determines that only the right end 16R of the blade 16 protrudes from the vehicle width L0, the process proceeds to step S11. In step S11, the controller 36 expands the detection range 50 to the right. As shown in
[0064] Although not shown in the drawings, when the blade 16 slides to the right and the drawbar 17 swings to the right so that the position of the right end 16R of the blade 16 protrudes from the vehicle width L0, the controller 36 expands the detection range 50 to the right from the reference range 51.
[0065] In step S10, if the right end 16R of the blade 16 does not protrude from the vehicle width L0, the process proceeds to step S12. In step S12, the controller 36 sets the reference range 51 as the detection range 50, as shown in
[0066] In the work machine 1 according to the present embodiment described above, the detection range 50 of objects around the work machine 1 is set according to the blade rotation angle s, the blade shift amount Lbs, and the drawbar shift amount Lds. Thereby, it is possible to appropriately determine whether or not an object exists around the work machine 1.
[0067] Although one embodiment of the present invention has been described above, the present invention is not limited to the above embodiment, and various changes can be made without departing from the gist of the invention.
[0068] The work machine 1 is not limited to a motor grader, but may be another type of work machine. The configuration of the work machine 1 is not limited to that described above, and may be modified. For example, the configuration of the work implement 3 may be changed. A part of the control system of the work machine I may be located outside of the work machine 1. For example, the operating device 35 and the output device 45 may be disposed outside the work machine 1.
[0069] The controller 36 may be configured by a plurality of controllers. The above-described processing may be executed in a distributed manner across the plurality of controllers. Some of the plurality of controllers may be placed outside the work machine 1.
[0070] The processing performed when an object is detected within the detection range 50 is not limited to that of the embodiment described above, and may be modified. For example, when an object is detected within the detection range 50, the controller 36 may perform processing such as stopping the work implement 3 and/or the vehicle body 2, or restricting the operation thereof.
[0071] The process for setting the detection range 50 is not limited to that of the above embodiment, and may be modified. For example, in consideration of detection errors, the controller 36 may add an arbitrary margin width to the width Lall of the detection range 50 described above.
[0072] As shown in
[0073] According to the present invention, it is possible to appropriately determine whether an object exists around a work machine.