WO2023238504A1 - 作業機械、作業機械を制御するための方法、及びシステム - Google Patents

作業機械、作業機械を制御するための方法、及びシステム Download PDF

Info

Publication number
WO2023238504A1
WO2023238504A1 PCT/JP2023/015107 JP2023015107W WO2023238504A1 WO 2023238504 A1 WO2023238504 A1 WO 2023238504A1 JP 2023015107 W JP2023015107 W JP 2023015107W WO 2023238504 A1 WO2023238504 A1 WO 2023238504A1
Authority
WO
WIPO (PCT)
Prior art keywords
blade
attitude
mode
actuators
operating device
Prior art date
Application number
PCT/JP2023/015107
Other languages
English (en)
French (fr)
Inventor
拓也 園田
好秀 中江
貴志 前田
Original Assignee
株式会社小松製作所
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 株式会社小松製作所 filed Critical 株式会社小松製作所
Publication of WO2023238504A1 publication Critical patent/WO2023238504A1/ja

Links

Images

Classifications

    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/76Graders, bulldozers, or the like with scraper plates or ploughshare-like elements; Levelling scarifying devices
    • E02F3/80Component parts
    • E02F3/84Drives or control devices therefor, e.g. hydraulic drive systems
    • E02F3/841Devices for controlling and guiding the whole machine, e.g. by feeler elements and reference lines placed exteriorly of the machine

Definitions

  • the present invention relates to a work machine, a method for controlling a work machine, and a system.
  • Some working machines are equipped with a working device such as a blade and a plurality of actuators.
  • the attitude of the work machine is changed according to the stroke operations of the plurality of actuators.
  • the attitude of the work equipment includes the height and orientation of the work equipment.
  • the motor grader of Patent Document 1 includes a front frame, a drawbar, a circle, a blade, left and right lift cylinders, a drawbar shift cylinder, and a hydraulic motor.
  • the above motor grader is equipped with a plurality of operating levers corresponding to each cylinder.
  • the left lift cylinder performs a stroke operation in response to the operation of the left lift lever.
  • the right lift cylinder strokes in response to the operation of the right lift lever.
  • the drawbar shift cylinder performs a stroke operation in response to the operation of the drawbar shift lever.
  • the hydraulic motor rotates in response to the operation of the rotary lever. The operator changes the attitude of the blade by operating these operating levers.
  • FIG. 1 is a side view of a working machine according to an embodiment.
  • FIG. 3 is a perspective view of the front part of the working machine.
  • FIG. 2 is an exploded perspective view showing the structure of a lifter bracket and its surroundings. It is a schematic diagram showing a drive system and a control system of a work machine.
  • FIG. 2 is a schematic rear view of the working machine showing the attitude of the working machine.
  • FIG. 2 is a schematic plan view of the working machine showing the attitude of the working machine.
  • FIG. 2 is a schematic side view of the working machine showing the attitude of the working machine.
  • FIG. 2 is a schematic plan view of the working machine showing the attitude of the working machine.
  • FIG. 2 is a schematic plan view of the working machine showing the attitude of the working machine.
  • FIG. 1 is a side view of a working machine 1 according to an embodiment.
  • FIG. 2 is a perspective view of the front part of the working machine 1.
  • the working machine 1 includes a vehicle body 2, front wheels 3, rear wheels 4, and a working machine 5.
  • Vehicle body 2 includes a front frame 11, a rear frame 12, a cab 13, and a power chamber 14.
  • the rear frame 12 is connected to the front frame 11.
  • the front frame 11 can be articulated laterally with respect to the rear frame 12.
  • 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. .
  • the work machine 5 is movably connected to the vehicle body 2.
  • Work machine 5 includes a support member 15, a blade 16, and a lifter bracket 29.
  • the support member 15 is movably connected to the vehicle body 2.
  • the support member 15 supports the blade 16.
  • the support member 15 and the blade 16 are supported by the front frame 11 via a lifter bracket 29.
  • Support member 15 includes a drawbar 17 and a circle 18.
  • the drawbar 17 is arranged below the front frame 11.
  • the drawbar 17 is connected to the shaft support 19 of the front frame 11.
  • the pivot support 19 is arranged at the front of the front frame 11.
  • the drawbar 17 extends rearward from the front of the front frame 11.
  • the drawbar 17 is supported so as to be swingable at least in the vertical and horizontal directions of the vehicle body 2 with respect to the front frame 11 .
  • the pivot support 19 includes a ball joint.
  • the drawbar 17 is rotatably connected to the front frame 11 via a ball joint.
  • the circle 18 is connected to the rear of the drawbar 17.
  • the circle 18 is rotatably supported by the drawbar 17.
  • Blade 16 is connected to circle 18 .
  • the blade 16 is supported by a drawbar 17 via a circle 18.
  • the blade 16 is rotatably supported by a circle 18 around a tilt axis 21.
  • the tilt shaft 21 extends in the left-right direction.
  • the blade 16 is supported by a circle 18 so as to be slidable in the left-right direction.
  • the work machine 1 includes a plurality of actuators 22-27 for changing the attitude of the work machine 5.
  • the multiple actuators 22-27 include multiple hydraulic cylinders 22-26.
  • the plurality of hydraulic cylinders 22-26 are connected to the working machine 5.
  • the plurality of hydraulic cylinders 22-26 expand and contract using hydraulic pressure.
  • the plurality of hydraulic cylinders 22-26 change the attitude of the working machine 5 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."
  • the left lift cylinder 22 and the right lift cylinder 23 are connected to the front frame 11 so as to be able to swing left and right.
  • 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 rotatably 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 able to swing left and right. Due to the stroke motion of the left lift cylinder 22 and the right lift cylinder 23, the drawbar 17 swings up and down around the shaft support 19. This causes the blade 16 to move up and down.
  • 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 a lifter bracket 29.
  • the drawbar 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 drawbar shift cylinder 24 extends from one left and right side of the front frame 11 toward the opposite side.
  • FIG. 3 is an exploded perspective view showing the structure of the lifter bracket 29 and its surroundings.
  • a lifter guide 30 is fixed to the front frame 11.
  • the lifter guide 30 has an annular shape and is arranged around the front frame 11.
  • the lifter guide 30 is provided with a plurality of lock holes 301.
  • the plurality of lock holes 301 are arranged in line in the circumferential direction of the lifter guide 30.
  • only some of the plurality of lock holes 301 are marked with numerals 301, and the numerals of other lock holes 301 are omitted.
  • the lifter bracket 29 includes a through hole 291.
  • the front frame 11 is passed through the through hole 291 .
  • Lifter bracket 29 includes an upper bracket 29a and a lower bracket 29b.
  • the upper bracket 29a and the lower bracket 29b are each formed in a semicircular shape.
  • the upper bracket 29a and the lower bracket 29b are connected to each other so as to sandwich the lifter guide 30 therebetween.
  • Left and right lift cylinders 22 and 23 are attached to the upper bracket 29a.
  • the drawbar shift cylinder 24 is attached to the lower bracket 29b.
  • the lifter bracket 29 includes lock pins 51 and 52.
  • the lock pins 51 and 52 are arranged facing the lifter guide 30.
  • the lock pins 51 and 52 are provided movably within and outside the lock hole 301.
  • the lifter bracket 29 becomes rotatable with respect to the front frame 11.
  • the lock pins 51 and 52 are arranged in the lock hole 301 (hereinafter referred to as the "locked state)
  • the lifter bracket 29 cannot rotate relative to the front frame 11 and is fixed to the front frame 11. .
  • the left and right lift cylinders 22 and 23 expand and contract, thereby causing the blade 16 to rotate around the front frame 11.
  • the blade tilt cylinder 25 is connected to the circle 18 and the blade 16.
  • the stroke operation of the blade tilt cylinder 25 causes the blade 16 to rotate around the tilt axis 21 .
  • the blade shift cylinder 26 is connected to the circle 18 and the blade 16. By the stroke operation of the blade tilt cylinder 25, the blade 16 slides left and right with respect to the circle 18.
  • FIG. 4 is a schematic diagram showing the drive system 6 and control system 7 of the working machine 1.
  • the work machine 1 includes a drive source 31, a hydraulic pump 32, a power transmission device 33, and a control valve 34.
  • the drive source 31 is, for example, an internal combustion engine.
  • the drive source 31 may be an electric motor or a hybrid of an internal combustion engine and an electric motor.
  • the hydraulic pump 32 is driven by the drive source 31 to discharge hydraulic oil.
  • the control valve 34 is connected to the hydraulic pump 32 and the plurality of hydraulic cylinders 22-26 via a hydraulic circuit.
  • Control valve 34 includes a plurality of valves each connected to a plurality of hydraulic cylinders 22-26.
  • the control valve 34 controls the flow rate of hydraulic oil supplied from the hydraulic pump 32 to the plurality of hydraulic cylinders 22-26.
  • 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 oil supplied from the hydraulic pump 32 to the rotary actuator 27 .
  • the rotary actuator 27 may be an electric motor.
  • the power transmission device 33 transmits the driving force from the drive source 31 to the rear wheels 4.
  • Power transmission device 33 may include a torque converter and/or multiple speed change gears.
  • the power transmission device 33 may be a transmission such as an HST (Hydraulic Static Transmission) or an HMT (Hydraulic Mechanical Transmission).
  • the plurality of parameters include a yaw angle ⁇ 1, a pitch angle ⁇ 2, and a roll angle ⁇ 3 of the drawbar 17.
  • FIG. 6 is a schematic plan view of the working machine 1 showing the attitude of the working machine 5.
  • the yaw angle ⁇ 1 of the drawbar 17 is the inclination angle of the drawbar 17 in the left-right direction with respect to the longitudinal direction of the vehicle body 2.
  • the yaw angle ⁇ 1 of the drawbar 17 may be an inclination angle of the drawbar 17 in the left-right direction with respect to the front-rear direction of the front frame 11.
  • the position of the blade 16 in the left-right direction changes depending on the yaw angle ⁇ 1 of the drawbar 17.
  • FIG. 7 is a schematic side view of the working machine 1 showing the attitude of the working machine 5.
  • the pitch angle ⁇ 2 of the drawbar 17 is the vertical inclination angle of the drawbar 17 with respect to the longitudinal direction of the vehicle body 2.
  • the roll angle ⁇ 3 of the drawbar 17 is the inclination angle of the drawbar 17 about the roll axis A1 extending in the longitudinal direction of the vehicle body 2.
  • the plurality of parameters include the rotation angle ⁇ 4 of the circle 18, the tilt angle ⁇ 5 of the blade 16, and the shift amount W1 of the blade 16.
  • FIG. 8 is a schematic plan view of the working machine 1 showing the attitude of the working machine 5. As shown in FIG. As shown in FIG. 8, the rotation angle ⁇ 4 of the circle 18 is the rotation angle ⁇ 4 of the circle 18 with respect to the longitudinal direction of the vehicle body 2. As shown in FIG. 7, the tilt angle ⁇ 5 of the blade 16 is the inclination angle of the blade 16 around the tilt axis 21 extending in the left-right direction.
  • FIG. 9 is a schematic plan view of the working machine 1 showing the attitude of the working machine 5. As shown in FIG. As shown in FIG. 9, the shift amount W1 of the blade 16 is the amount by which the blade 16 slides in the left-right direction with respect to the circle 18.
  • the operating device 35 can be operated by the operator to change the above-mentioned parameters.
  • the operating device 35 includes a plurality of operating members 41-46.
  • the plurality of operating members 41-46 are configured to control the height of the left end 161 of the blade 16, the height of the right end 162, the yaw angle ⁇ 1 of the drawbar 17, and the rotation angle ⁇ 4 of the circle 18, among the plurality of parameters described above. They are provided corresponding to the tilt angle ⁇ 5 of the blade 16 and the shift amount W1 of the blade 16, respectively.
  • the drawbar shift lever 43 is operated to change the yaw angle ⁇ 1 of the drawbar 17.
  • the rotation lever 44 is operated to change the rotation angle ⁇ 4 of the circle 18.
  • the blade tilt lever 45 is operated to change the tilt angle ⁇ 5 of the blade 16.
  • the blade shift lever 46 is operated to change the shift amount W1 of the blade 16.
  • Each of the plurality of operating members 41-46 outputs a signal indicating the operation of each operating member 41-46 by the operator.
  • the operating device 35 includes a lifter lock switch 47.
  • Work machine 1 includes a lifter lock actuator 28.
  • the lifter lock switch 47 is operated to switch the lifter bracket 29 between a locked state and a released state.
  • the lifter lock actuator 28 moves the lock pins 51 and 52 into and out of the lock hole 301.
  • the lifter lock actuator 28 is, for example, a hydraulic actuator, and moves the lock pins 51 and 52 into and out of the lock hole 301 using hydraulic pressure.
  • lifter lock actuator 28 may be an electric actuator.
  • the lifter lock actuator 28 moves the lock pins 51 and 52 into and out of the lock hole 301 in response to the operation of the lifter lock switch 47.
  • the controller 36 acquires the attitude of the work machine 5 based on signals from the plurality of sensors S1 to S6. That is, the controller 36 calculates the current values of the plurality of parameters described above based on the signals from the plurality of sensors S1-S6. As described above, the controller 36 executes integrated control to change the attitude of the working machine 5 by controlling the plurality of actuators 22-27 in accordance with the operations of the plurality of operating members 41-46.
  • FIG. 10 is a table showing the correspondence between the operating members operated by the operator and the actuators that are driven.
  • a plurality of parameters indicating the attitude of the work machine 5 change according to the operation of one actuator.
  • FIGS. 11 and 12 are rear views of the mathematical model M1 showing the attitude of the working machine 5.
  • the mathematical model M1 shows the geometrical positional relationship of each part of the working machine 5 that is linked to the operation of the actuator.
  • the controller 36 calculates the positions and angles of the drawbar 17, circle 18, and blade 16 corresponding to the stroke length of the hydraulic cylinders 22-26 and the rotation angle ⁇ 4 of the rotary actuator 27 using the mathematical model M1.
  • FIG. 11 shows the working machine 5 in its initial state.
  • FIG. 12 shows the working machine 5 when the left lift cylinder 22 is contracted from the initial state.
  • the actuators other than the left lift cylinder 22 are maintained in the initial state.
  • the contraction of the left lift cylinder 22 causes the left end portion 161 of the blade 16 to rise from the initial position 161'.
  • the right end 162 of the blade 16 is lowered from its initial position 162'.
  • the blade 16 moves to the left from its initial position. That is, in accordance with the stroke operation of the left lift cylinder 22, the height of the left end portion 161 of the blade 16 changes, and the height of the right end portion 162 of the blade 16 and the yaw angle ⁇ 1 of the drawbar 17 change.
  • the controller 36 contracts the left lift cylinder 22. As a result, the left end portion 161 of the blade 16 rises.
  • the controller 36 also causes the right lift cylinder 23 to contract. This prevents the right end portion 162 of the blade 16 from descending.
  • the controller 36 also causes the drawbar shift cylinder 24 to contract. Thereby, changes in the yaw angle ⁇ 1 of the blade 16 are suppressed. Thereby, the left end portion 161 of the blade 16 rises in the vertical direction.
  • the vertical direction is a direction parallel to the direction of gravity.
  • step S102 the controller 36 acquires the operation of the operating device 35.
  • the controller 36 receives a signal from any one of the plurality of operating members 41-46 described above, indicating the operation of that operating member.
  • step S103 the controller 36 determines a target posture.
  • the controller 36 determines the target posture according to the operation of the operating member. For example, when the left lift lever 41 is operated, the height of the right end 162 of the blade 16 and the lateral position of the drawbar 17 are held constant, and the height of the left end 161 of the blade 16 is kept constant.
  • the pitch angle ⁇ 2 and roll angle ⁇ 3 of the drawbar 17, which have a height corresponding to the operation of the lift lever 41, are determined as the target posture. Note that the yaw angle ⁇ 1 of the drawbar 17 is maintained at the initial state value.
  • the controller 36 responds to the operation of the left lift lever 41 by a combination of stroke operations of the left lift cylinder 22, right lift cylinder 23, and drawbar shift cylinder 24.
  • the target posture of the working machine 5 is realized.
  • the controller 36 realizes the target posture of the work implement 5 according to the operation of the operating member by combining the operations of the plurality of actuators 22-27.
  • the controller 36 operates the left lift cylinder 22, the right lift cylinder 23, and the drawbar shift cylinder 24. Similar to the left lift cylinder 22, when the right lift cylinder 23 performs a stroke operation, the height of the right end portion 162 of the blade 16 changes according to the stroke operation of the right lift cylinder 23, and the height of the left end portion 161 of the blade 16 changes. The height and the lateral position of the drawbar 17 also change.
  • FIG. 15A shows the work machine 5 in a conventional motor grader when the drawbar shift cylinder 24 performs a stroke operation from an initial state.
  • the drawbar shift cylinder 24 when the drawbar shift cylinder 24 performs a stroke operation, the height of the left end portion 161 and the height of the right end portion 162 of the blade 16 also change according to the stroke operation of the drawbar shift cylinder 24, as shown in FIG. 15A. Change. Further, the yaw angle ⁇ 1 of the drawbar 17 changes according to the stroke operation of the drawbar shift cylinder 24.
  • the controller 36 controls the height of the left end portion 161 and the height of the right end portion 162 of the blade 16 when the drawbar shift lever 43 is operated, as shown in FIG. 15B.
  • the pitch angle ⁇ 2 and roll angle ⁇ 3 of the drawbar 17 are determined as the target posture so that the yaw angle ⁇ 1 of the drawbar 17 becomes an angle corresponding to the operation of the drawbar shift lever 43 while being held constant.
  • the controller 36 realizes the target posture of the work implement 5 according to the operation of the drawbar shift lever 43 by combining the stroke operations of the left lift cylinder 22, right lift cylinder 23, and drawbar shift cylinder 24.
  • FIG. 16A is a side view showing the working machine 5 in an initial state.
  • FIG. 16B shows the working machine 5 in a conventional motor grader when the circle 18 rotates from the initial state.
  • the height of the left end 161 and the right end 162 of the blade 16 also change in accordance with the rotation of the circle 18, as shown in FIG. 16B.
  • the rotation angle ⁇ 4 of the circle 18 changes according to the rotation of the circle 18.
  • the controller 36 is configured such that when the rotary lever 44 is operated, the height of the left end 161 and the height of the right end 162 of the blade 16 are constant, as shown in FIG. 16C.
  • the yaw angle ⁇ 1, the pitch angle ⁇ 2, and the roll angle ⁇ 3 of the drawbar 17 are determined as the target posture so that the rotation angle ⁇ 4 of the circle 18 becomes the rotation angle ⁇ 4 corresponding to the operation of the rotation lever 44 while being held at do.
  • the controller 36 controls the target posture of the work implement 5 according to the operation of the rotary lever 44 by combining the stroke operations of the left lift cylinder 22, the right lift cylinder 23, and the drawbar shift cylinder 24, and the rotation operation of the rotary actuator 27. Make it happen.
  • the controller 36 tilts the blade 16 while keeping the height of the blade 16 constant, as shown in FIG. 17C.
  • the yaw angle ⁇ 1, the pitch angle ⁇ 2, and the roll angle ⁇ 3 of the drawbar 17 such that the angle ⁇ 5 corresponds to the operation of the blade tilt lever 45 are determined as the target posture.
  • the controller 36 realizes the target posture of the work equipment 5 according to the operation of the blade tilt lever 45 by combining the stroke operations of the left lift cylinder 22, right lift cylinder 23, drawbar shift cylinder 24, and blade tilt cylinder 25.
  • the controller 36 controls the blade shift cylinder 26 so that the amount of shift of the blade 16 corresponds to the operation of the blade shift lever 46.
  • the target posture of the work machine 5 is determined in accordance with the operation of the operating device 35.
  • the target stroke length of each of the plurality of hydraulic cylinders 22-26 and the rotation angle ⁇ 4 of the rotary actuator 27 for causing the work machine 5 to assume the target posture are determined by a combination of the stroke operations of the plurality of hydraulic cylinders 22-26.
  • each of the plurality of hydraulic cylinders 22-26 and the rotary actuator 27 is controlled based on the determined target stroke length and rotation angle ⁇ 4.
  • the operator can adjust the height of the left end 161 of the blade 16 while keeping the height of the right end 162 of the blade 16 and the lateral position of the drawbar 17 constant. can be changed.
  • the operator can change the height of the right end 162 of the blade 16 while keeping the height of the left end 161 of the blade 16 and the lateral position of the drawbar 17 constant. can do.
  • the operator can change the yaw angle ⁇ 1 of the drawbar 17 while keeping the height of the left end 161 and the right end 162 of the blade 16 constant.
  • the rotation lever 44 the operator can change the rotation angle ⁇ 4 of the circle 18 while keeping the height of the left end 161 and the right end 162 of the blade 16 constant.
  • the blade tilt lever 45 the operator can change the tilt angle ⁇ 5 of the blade 16 while keeping the height of the left end 161 and the right end 162 of the blade 16 constant.
  • FIG. 18 is a front view of the working machine 5 when the blade 16 is in the normal position.
  • FIG. 19 is a front view of the working machine 5 when the blade 16 is in the bank cutting attitude.
  • the position of the vehicle body 2 is indicated by a chain double-dashed line.
  • the blade 16 has a larger roll angle ⁇ 6 than in the normal attitude.
  • the operator causes the work machine 5 to take a bank cut posture.
  • the blade 16 in the bank cut attitude, the blade 16 is held at a large inclination with respect to the horizontal direction, almost to the vertical direction. In this state, the blade 16 excavates the terrain to form a slope.
  • the operator changes the blade 16 from the normal attitude to the bank cut attitude as follows. First, the operator operates the lifter lock switch 47 to move the lock pins 51 and 52 out of the lock hole 301, thereby releasing the lifter bracket 29. The operator rotates the blade 16 together with the lifter bracket 29 around the front frame 11 by operating the left and right lift levers 41 and 42. The operator stops the blade 16 in the bank cut position and operates the lifter lock switch 47 to move the lock pins 51 and 52 into the lock hole 301, thereby locking the lifter bracket 29. Thereby, the blade 16 is held in the bank cut position.
  • the controller 36 executes integrated control in a control mode different from that when the blade 16 is in the normal attitude described above.
  • FIG. 20 is a flowchart showing the integrated control processing executed by the controller 36.
  • the controller 36 obtains the current attitude of the blade 16.
  • the controller 36 obtains the current attitude of the blade 16 from the roll angle ⁇ 6 of the blade 16.
  • the roll angle ⁇ 6 of the blade 16 is, for example, the inclination angle of the blade 16 with respect to the ground 100.
  • the roll angle ⁇ 6 of the blade 16 may be an inclination angle of the blade 16 with respect to the vehicle body 2.
  • the controller 36 obtains the roll angle ⁇ 6 of the blade 16 based on the roll angle ⁇ 3 of the drawbar 17 described above, for example.
  • step S202 the controller 36 determines whether the current attitude of the blade 16 is a bank cut attitude.
  • the controller 36 determines whether the attitude of the blade 16 is the bank cut attitude based on the roll angle ⁇ 6 of the blade 16. For example, when the roll angle ⁇ 6 of the blade 16 is larger than a predetermined threshold value, the controller 36 determines that the current attitude of the blade 16 is the bank cut attitude. If the roll angle ⁇ 6 of the blade 16 is less than or equal to a predetermined threshold, the controller 36 determines that the current attitude of the blade 16 is not the bank cut attitude but the normal attitude. If the controller 36 determines that the current attitude of the blade 16 is the normal attitude, the process proceeds to step S203.
  • step S203 the controller 36 selects the first mode as integrated control of the blade 16. That is, when the current attitude of the blade 16 is the normal attitude, the controller 36 selects the first mode as the control mode of the blade 16. Then, in step S204, integrated control is executed in the first mode. In the first mode, the controller 36 executes processing similar to the integrated control processing described above.
  • the controller 36 moves the blade 16 to the left in response to the operations of the left lift lever 41 and the right lift lever 42 so as to move the blade 16 in the vertical directions H1 and H2.
  • the controller 36 controls the left lift cylinder 22, the right lift cylinder 23, and the drawbar shift cylinder 24 so that the left end 161 of the blade 16 moves in the vertical direction H1.
  • the controller 36 controls the left lift cylinder 22, right lift cylinder 23, and drawbar shift cylinder 24 so that the right end 162 of the blade 16 moves in the vertical direction H2. do.
  • the controller 36 controls the plurality of actuators so that the entire blade 16 moves in parallel in the vertical directions H1 and H2. .
  • the controller 36 moves the left lift lever 41 and the right lift lever 42 so that the entire blade 16 moves upward in parallel in the vertical directions H1 and H2. 22, right lift cylinder 23, and drawbar shift cylinder 24.
  • the controller 36 moves the left lift cylinder 22 and the left lift lever 42 so that the entire blade 16 moves downward in parallel in the vertical directions H1 and H2.
  • the right lift cylinder 23 and drawbar shift cylinder 24 are controlled.
  • step S202 if the current attitude of the blade 16 is the bank cut attitude, the process proceeds to step S205.
  • step S205 the controller 36 selects the second mode as integrated control of the blade 16. Then, in step S204, integrated control is executed in the second mode.
  • the controller 36 moves the blade 16 in the blade normal directions H3 and H4 in accordance with the operations of the left lift lever 41 and the right lift lever 42. , controls the left lift cylinder 22, right lift cylinder 23, and drawbar shift cylinder 24.
  • the blade normal directions H3 and H4 are directions perpendicular to the longitudinal direction of the blade 16.
  • the controller 36 controls the left lift cylinder 22, the right lift cylinder 23, and the drawbar shift cylinder so that the left end 161 of the blade 16 moves in the blade normal direction H3. 24.
  • the controller 36 moves the left lift cylinder 22, right lift cylinder 23, and drawbar shift cylinder 24 so that the right end 162 of the blade 16 moves in the blade normal direction H4. control.
  • the controller 36 moves the left lift cylinder 22 and the right lift lever so that the entire blade 16 moves in parallel in the blade normal directions H3 and H4. Controls the lift cylinder 23 and drawbar shift cylinder 24.
  • the controller 36 moves the blade 16 to the left so that the entire blade 16 moves upward in parallel in the blade normal directions H3 and H4. Controls the lift cylinder 22, right lift cylinder 23, and drawbar shift cylinder 24.
  • the controller 36 moves the left lift cylinder so that the entire blade 16 moves downward in parallel in the blade normal directions H3 and H4. 22, right lift cylinder 23, and drawbar shift cylinder 24.
  • the first mode or the second mode is selected depending on the attitude of the blade 16.
  • a plurality of actuators are controlled to move the blade 16 in the vertical directions H1 and H2 in response to operations of the left and right lift levers 41 and 42.
  • a plurality of actuators are controlled to move the blade 16 in the blade normal directions H3 and H4 in accordance with the operations of the left and right lift levers 41 and 42. This facilitates the operation for changing the attitude of the working machine 5. Further, even when the blade 16 takes an extreme posture such as a bank cut posture, the operational feeling is prevented from deteriorating.
  • the work machine 1 is not limited to a motor grader, but may be another work machine such as a bulldozer.
  • the parameters indicating the attitude of the working machine 5 are not limited to those in the above embodiment, and may be changed.
  • the plurality of operating members 41-46 are not limited to those in the above embodiment, and may be modified.
  • the operating member is not limited to a lever, but may be a joystick, a switch, or another member such as a touch panel.
  • the number of modes in integrated control is not limited to two, and may be more than two. That is, modes other than the first mode and second mode described above may be selectable.
  • the posture of the blade 16 is not limited to the above-mentioned normal posture and bank cut posture, but may further include other postures.
  • FIG. 21 is a schematic diagram showing a drive system 6 and a control system 7 of a working machine 1 according to a modification.
  • the work machine 1 may include a lifter bracket sensor S7.
  • the lifter bracket sensor S7 detects the rotation angle ⁇ 7 of the lifter bracket 29 with respect to the front frame 11, as shown in FIG.
  • the rotation angle ⁇ 7 of the lifter bracket 29 is the rotation angle of the lifter bracket 29 from a predetermined standard position with respect to the front frame 11.
  • the operation for changing the posture of the working machine becomes easy, and the deterioration of the operational feeling due to the posture of the working machine is suppressed.

Abstract

作業機械は、車体と、作業機と、複数のアクチュエータと、操作装置と、センサと、コントローラとを備える。作業機は、ブレードを含む。センサは、ブレードの現在の姿勢を検出する。コントローラは、複数のアクチュエータのストローク動作の組み合わせにより、ブレードが、操作装置の操作に応じて、現在の姿勢から、ブレード法線方向に移動するための複数のアクチュエータのそれぞれの目標ストローク長を決定する。ブレード法線方向は、ブレードの長手方向に垂直な方向である。コントローラは、目標ストローク長に基づいて、複数のアクチュエータを制御する。

Description

作業機械、作業機械を制御するための方法、及びシステム
 本発明は、作業機械、作業機械を制御するための方法、及びシステムに関する。
 作業機械には、ブレードなどの作業機と、複数のアクチュエータとを備えるものがある。複数のアクチュエータのストローク動作に応じて、作業機の姿勢が変更される。作業機の姿勢は、作業機の高さと向きとを含む。例えば、特許文献1のモータグレーダは、フロントフレームと、ドローバと、サークルと、ブレードと、左右のリフトシリンダと、ドローバシフトシリンダと、油圧モータとを備えている。
 ドローバは、フロントフレームに対して上下方向及び左右方向に揺動可能に支持される。サークルは、ドローバに対して回転可能に支持される。ブレードは、サークルに接続される。左右のリフトシリンダは、ドローバを上下に移動させる。ドローバシフトシリンダは、ドローバを左右に揺動させる。油圧モータは、サークルを回転させる。
 また、上記のモータグレーダは、各シリンダに対応する複数の操作レバーを備えている。例えば、左リフトレバーの操作に応じて、左リフトシリンダがストローク動作する。右リフトレバーの操作に応じて、右リフトシリンダがストローク動作する。ドローバシフトレバーの操作に応じて、ドローバシフトシリンダがストローク動作する。回転レバーの操作に応じて、油圧モータが回転動作する。オペレータは、これらの操作レバーを操作することで、ブレードの姿勢を変更する。
特許第5624691号公報
 上記のモータグレーダでは、オペレータが目標とする姿勢をブレードにとらせるために、複数の操作レバーを同時に操作する必要がある。例えば、オペレータが、ブレードの左端のみを上昇させたい場合に、オペレータが左リフトレバーのみを操作すると、左リフトシリンダが収縮することでブレードの左端が上昇するが、同時にブレードの右端が下降してしまう。従って、オペレータが、ブレードの左端のみを上昇させたい場合には、右端の上昇を抑えるために他のレバーも同時に操作する必要がある。
 また、ブレードが水平に保持されている場合、オペレータが、左リフトレバーと右リフトレバーとを同時に操作しても、ブレードは鉛直方向にまっすぐ上昇せず、ドローバシフトシリンダを回転させながら斜め上方向に移動してしまう。ブレードをまっすぐ鉛直に上昇させるためには、左リフトレバー、右リフトレバー,ドローバシフトレバーの3本を同時に操作する必要がある。そのため、作業機の操作は容易ではない。
 本発明の目的は、作業機械において、作業機の姿勢を変更するための操作を容易にすることにある。
 本発明の第1の態様に係る作業機械は、車体と、作業機と、複数のアクチュエータと、操作装置と、センサと、コントローラとを備える。作業機は、ブレードを含む。作業機は、車体に対して可動的に接続される。複数のアクチュエータは、作業機に接続される。複数のアクチュエータは、車体に対するブレードの姿勢を変更する。操作装置は、ブレードの姿勢を変更するために操作可能である。センサは、ブレードの現在の姿勢を検出する。コントローラは、ブレードの現在の姿勢を取得する。コントローラは、複数のアクチュエータのストローク動作の組み合わせにより、ブレードが、操作装置の操作に応じて、現在の姿勢から、ブレード法線方向に移動するための複数のアクチュエータのそれぞれの目標ストローク長を決定する。ブレード法線方向は、ブレードの長手方向に垂直な方向である。コントローラは、目標ストローク長に基づいて複数のアクチュエータを制御する。
 本発明の第2の態様に係る方法は、作業機械を制御するための方法である。作業機械は、車体と、作業機と、複数のアクチュエータとを備える。作業機は、ブレードを含む。作業機は、車体に対して可動的に接続される。複数のアクチュエータは、作業機に接続される。複数のアクチュエータは、車体に対するブレードの姿勢を変更する。当該方法は、ブレードの現在の姿勢を取得することと、操作装置への操作を示す信号を取得することと、複数のアクチュエータのストローク動作の組み合わせにより、ブレードが、操作装置の操作に応じて、現在の姿勢から、ブレードの長手方向に垂直なブレード法線方向に移動するための複数のアクチュエータのそれぞれの目標ストローク長を決定することと、目標ストローク長に基づいて複数のアクチュエータを制御すること、を備える。
 本発明の第3の態様に係るシステムは、作業機械を制御するためのシステムである。作業機械は、車体と、作業機と、複数のアクチュエータとを備える。作業機は、ブレードを含む。作業機は、車体に対して可動的に接続される。複数のアクチュエータは、作業機に接続される。複数のアクチュエータは、車体に対するブレードの姿勢を変更する。当該システムは、操作装置とコントローラとを備える。操作装置は、ブレードの姿勢を変更するために操作可能である。コントローラは、ブレードの現在の姿勢を取得する。コントローラは、複数のアクチュエータのストローク動作の組み合わせにより、ブレードが、操作装置の操作に応じて、現在の姿勢から、ブレード法線方向に移動するための複数のアクチュエータのそれぞれの目標ストローク長を決定する。ブレード法線方向は、ブレードの長手方向に垂直な方向である。コントローラは、目標ストローク長に基づいて複数のアクチュエータを制御する。
 本発明によれば、操作装置の操作に応じて、ブレードをブレード法線方向に移動するように、複数のアクチュエータが制御される。それにより、作業機の姿勢を変更するための操作が容易になる。
実施形態に係る作業機械の側面図である。 作業機械の前部の斜視図である。 リフタブラケット及びその周辺の構成を示す分解斜視図である。 作業機械の駆動系及び制御系を示す模式図である。 作業機の姿勢を示す作業機械の模式的な背面図である。 作業機の姿勢を示す作業機械の模式的な平面図である。 作業機の姿勢を示す作業機械の模式的な側面図である。 作業機の姿勢を示す作業機械の模式的な平面図である。 作業機の姿勢を示す作業機械の模式的な平面図である。 オペレータによって操作される操作部材と、駆動されるアクチュエータとの対応を示す表である。 作業機の姿勢を示す数学モデルの背面図である。 作業機の姿勢を示す数学モデルの背面図である。 作業機の姿勢を示す数学モデルの背面図である。 作業機の姿勢を変更するための統合制御の処理を示すフローチャートである。 作業機の姿勢を示す数学モデルの背面図である。 作業機の姿勢を示す数学モデルの側面図である。 作業機の姿勢を示す数学モデルの側面図である。 ブレードが通常姿勢である場合の作業機の正面図である。 ブレードがバンクカット姿勢である場合の作業機の正面図である。 統合制御の処理を示すフローチャートである。 変形例に係る作業機械の駆動系及び制御系を示す模式図である。 ブレードがバンクカット姿勢である場合の作業機の正面図である。
 以下図面を参照して、本発明の実施形態について説明する。図1は、実施形態に係る作業機械1の側面図である。図2は、作業機械1の前部の斜視図である。図1に示すように、作業機械1は、車体2と、前輪3と、後輪4と、作業機5とを備える。車体2は、フロントフレーム11と、リアフレーム12と、キャブ13と、動力室14とを含む。
 リアフレーム12は、フロントフレーム11に接続されている。フロントフレーム11は、リアフレーム12に対して、左右にアーティキュレート可能である。なお、以下の説明において、前後左右の各方向は、アーティキュレート角が0、すなわち、フロントフレーム11とリアフレーム12とが真っすぐな状態での車体2の前後左右の各方向を意味するものとする。
 キャブ13と動力室14とは、リアフレーム12上に配置されている。キャブ13には、図示しない運転席が配置されている。動力室14には、後述する駆動系が配置されている。フロントフレーム11は、リアフレーム12から前方へ延びている。前輪3は、フロントフレーム11に取り付けられている。後輪4は、リアフレーム12に取り付けられている。
 作業機5は、車体2に対して可動的に接続されている。作業機5は、支持部材15と、ブレード16と、リフタブラケット29とを含む。支持部材15は、車体2に可動的に接続されている。支持部材15は、ブレード16を支持している。支持部材15とブレード16とは、リフタブラケット29を介して、フロントフレーム11に支持されている。支持部材15は、ドローバ17とサークル18とを含む。ドローバ17は、フロントフレーム11の下方に配置される。
 図2に示すように、ドローバ17は、フロントフレーム11の軸支部19に接続されている。軸支部19は、フロントフレーム11の前部に配置されている。ドローバ17は、フロントフレーム11の前部から後方へ延びている。ドローバ17は、フロントフレーム11に対して少なくとも車体2の上下方向と左右方向とに揺動可能に支持されている。例えば、軸支部19は、ボールジョイントを含む。ドローバ17は、ボールジョイントを介して、フロントフレーム11に対して回転可能に接続されている。
 サークル18は、ドローバ17の後部に接続されている。サークル18は、ドローバ17に対して回転可能に支持される。ブレード16は、サークル18に接続される。ブレード16は、サークル18を介して、ドローバ17に支持されている。ブレード16は、チルト軸21回りに回転可能にサークル18に支持されている。チルト軸21は、左右方向に延びている。ブレード16は、左右方向にスライド可能にサークル18に支持されている。
 作業機械1は、作業機5の姿勢を変更するための複数のアクチュエータ22-27を備えている。複数のアクチュエータ22-27は、複数の油圧シリンダ22-26を含む。複数の油圧シリンダ22-26は、作業機5に接続されている。複数の油圧シリンダ22-26は、油圧によって伸縮する。複数の油圧シリンダ22-26は、伸縮することで、車体2に対する作業機5の姿勢を変更する。以下の説明では、油圧シリンダの伸縮を「ストローク動作」と呼ぶ。
 詳細には、複数の油圧シリンダ22-26は、左リフトシリンダ22と、右リフトシリンダ23と、ドローバシフトシリンダ24と、ブレードチルトシリンダ25と、ブレードシフトシリンダ26とを含む。左リフトシリンダ22と右リフトシリンダ23とは、左右方向に互いに離れて配置されている。左リフトシリンダ22は、ドローバ17の左部分に接続されている。右リフトシリンダ23は、ドローバ17の右部分に接続されている。左リフトシリンダ22と右リフトシリンダ23とは、ドローバ17に対して左右に揺動可能に接続されている。
 左リフトシリンダ22と右リフトシリンダ23とは、フロントフレーム11に対して、左右に揺動可能に接続されている。詳細には、左リフトシリンダ22と右リフトシリンダ23とは、リフタブラケット29を介して、フロントフレーム11に接続されている。リフタブラケット29は、フロントフレーム11に対して回転可能に接続されている。リフタブラケット29は、左リフトシリンダ22と右リフトシリンダ23とを左右に揺動可能に支持している。左リフトシリンダ22と右リフトシリンダ23とのストローク動作により、ドローバ17は、軸支部19回りに上下に揺動する。それにより、ブレード16が上下に移動する。
 ドローバシフトシリンダ24は、ドローバ17とフロントフレーム11とに接続されている。ドローバシフトシリンダ24は、リフタブラケット29を介してフロントフレーム11に接続されている。ドローバシフトシリンダ24は、フロントフレーム11に対して、揺動可能に接続されている。ドローバシフトシリンダ24は、ドローバ17に対して、揺動可能に接続されている。ドローバシフトシリンダ24は、フロントフレーム11からドローバ17に向かって、斜め下方に延びている。ドローバシフトシリンダ24は、フロントフレーム11の左右の一側方から反対の側方へ向かって延びている。ドローバシフトシリンダ24のストローク動作により、ドローバ17は、軸支部19回りに左右に揺動する。
 図3は、リフタブラケット29及びその周辺の構成を示す分解斜視図である。図3に示すように、フロントフレーム11には、リフタガイド30が固定されている。リフタガイド30は、円環状の形状を有しており、フロントフレーム11の周囲に配置されている。リフタガイド30には、複数のロック孔301が設けられている。複数のロック孔301は、リフタガイド30の周方向に並んで配置されている。なお、図3においては、複数のロック孔301の一部のみに符号301がふされており、他のロック孔301の符号は省略されている。
 リフタブラケット29は、貫通孔291を含む。貫通孔291には、フロントフレーム11が通される。リフタブラケット29は、上ブラケット29aと、下ブラケット29bとを含む。上ブラケット29aと下ブラケット29bとは、それぞれ半円環状に形成されている。上ブラケット29aと下ブラケット29bとは、リフタガイド30を挟み込むように互いに連結される。上ブラケット29aには左右のリフトシリンダ22,23が取り付けられる。下ブラケット29bには、ドローバシフトシリンダ24が取り付けられる。
 図2に示すように、リフタブラケット29は、ロックピン51,52を含む。ロックピン51,52は、リフタガイド30に向かい合って配置される。ロックピン51,52は、ロック孔301内とロック孔301外とに移動可能に設けられる。ロックピン51,52がロック孔301外に配置されている状態(以下、「解除状態」と呼ぶ)では、リフタブラケット29は、フロントフレーム11に対して回転可能となる。ロックピン51,52がロック孔301内に配置されている状態(以下、「ロック状態」と呼ぶ)では、リフタブラケット29は、フロントフレーム11に対して回転不能となり、フロントフレーム11に固定される。リフタブラケット29が解除状態で、左右のリフトシリンダ22,23が伸縮することにより、ブレード16がフロントフレーム11回りに回転する。
 図1に示すように、ブレードチルトシリンダ25は、サークル18とブレード16とに接続されている。ブレードチルトシリンダ25のストローク動作により、ブレード16がチルト軸21回りに回転する。図2に示すように、ブレードシフトシリンダ26は、サークル18とブレード16とに接続されている。ブレードチルトシリンダ25のストローク動作により、ブレード16がサークル18に対して左右にスライドする。
 複数のアクチュエータ22-27は、回転アクチュエータ27を含む。回転アクチュエータ27は、ドローバ17とサークル18とに接続されている。回転アクチュエータ27は、ドローバ17に対してサークル18を回転させる。それにより、ブレード16が、上下方向に延びる回転軸回りに回転する。
 図4は、作業機械1の駆動系6及び制御系7を示す模式図である。図4に示すように、作業機械1は、駆動源31と、油圧ポンプ32と、動力伝達装置33と、制御弁34とを備えている。駆動源31は、例えば内燃機関である。或いは、駆動源31は、電動モータ、或いは内燃機関と電動モータとのハイブリッドであってもよい。油圧ポンプ32は、駆動源31によって駆動されることで、作動油を吐出する。
 制御弁34は、油圧回路を介して油圧ポンプ32と複数の油圧シリンダ22-26とに接続されている。制御弁34は、複数の油圧シリンダ22-26にそれぞれ接続される複数の弁を含む。制御弁34は、油圧ポンプ32から複数の油圧シリンダ22-26に供給される作動油の流量を制御する。
 本実施形態では、回転アクチュエータ27は、油圧モータである。制御弁34は、油圧回路を介して油圧ポンプ32と回転アクチュエータ27とに接続されている。制御弁34は、油圧ポンプ32から回転アクチュエータ27に供給される作動油の流量を制御する。なお、回転アクチュエータ27は、電動モータであってもよい。
 動力伝達装置33は、駆動源31からの駆動力を後輪4に伝達する。動力伝達装置33は、トルクコンバータ、及び/又は、複数の変速ギアを含んでもよい。或いは、動力伝達装置33は、HST(Hydraulic Static Transmission)、或いは、HMT(Hydraulic Mechanical Transmission)などのトランスミッションであってもよい。
 図4に示すように、作業機械1は、操作装置35とコントローラ36とを備えている。操作装置35は、作業機5の姿勢を変更するためにオペレータによって操作可能である。作業機5の姿勢は、複数のパラメータによって定義される。複数のパラメータは、車体2に対するブレード16の位置と向きとを示す。図5は、作業機5の姿勢を示す作業機械1の模式的な背面図である。図5に示すように、複数のパラメータは、ブレード16の左端部161の高さと、右端部162の高さとを含む。
 複数のパラメータは、ドローバ17のヨー角θ1と、ピッチ角θ2と、ロール角θ3とを含む。図6は、作業機5の姿勢を示す作業機械1の模式的な平面図である。図6に示すように、ドローバ17のヨー角θ1は、車体2の前後方向に対するドローバ17の左右方向の傾斜角度である。なお、ドローバ17のヨー角θ1は、フロントフレーム11の前後方向に対するドローバ17の左右方向の傾斜角度であってもよい。ブレード16の左右方向における位置は、ドローバ17のヨー角θ1に応じて変化する。
 図7は、作業機5の姿勢を示す作業機械1の模式的な側面図である。図7に示すように、ドローバ17のピッチ角θ2は、車体2の前後方向に対するドローバ17の上下方向の傾斜角度である。図5に示すように、ドローバ17のロール角θ3は、車体2の前後方向に延びるロール軸A1回りのドローバ17の傾斜角度である。
 複数のパラメータは、サークル18の回転角θ4と、ブレード16のチルト角θ5と、ブレード16のシフト量W1とを含む。図8は、作業機5の姿勢を示す作業機械1の模式的な平面図である。図8に示すように、サークル18の回転角θ4は、車体2の前後方向に対するサークル18の回転角θ4である。図7に示すように、ブレード16のチルト角θ5は、左右方向に延びるチルト軸21回りのブレード16の傾斜角である。図9は、作業機5の姿勢を示す作業機械1の模式的な平面図である。図9に示すように、ブレード16のシフト量W1は、サークル18に対するブレード16の左右方向へのスライド量である。
 操作装置35は、上述したパラメータを変更するためにオペレータによって操作可能である。操作装置35は、複数の操作部材41-46を含む。複数の操作部材41-46は、上述した複数のパラメータのうち、ブレード16の左端部161の高さと、右端部162の高さと、ドローバ17のヨー角θ1と、サークル18の回転角θ4と、ブレード16のチルト角θ5と、ブレード16のシフト量W1とのそれぞれに対応して設けられている。
 複数の操作部材41-46は、左リフトレバー41と、右リフトレバー42と、ドローバシフトレバー43と、回転レバー44と、ブレードチルトレバー45と、ブレードシフトレバー46とを含む。左リフトレバー41は、ブレード16の左端部161の高さを変更するために操作される。右リフトレバー42は、ブレード16の右端部162の高さを変更するために操作される。
 ドローバシフトレバー43は、ドローバ17のヨー角θ1を変更するために操作される。回転レバー44は、サークル18の回転角θ4を変更するために操作される。ブレードチルトレバー45は、ブレード16のチルト角θ5を変更するために操作される。ブレードシフトレバー46は、ブレード16のシフト量W1を変更するために操作される。複数の操作部材41-46のそれぞれは、オペレータによる各操作部材41-46への操作を示す信号を出力する。
 また、操作装置35は、リフタロックスイッチ47を含む。作業機械1は、リフタロックアクチュエータ28を含む。リフタロックスイッチ47は、リフタブラケット29をロック状態と解除状態とに切り替えるために操作される。リフタロックアクチュエータ28は、ロックピン51,52をロック孔301内とロック孔301外とに移動させる。リフタロックアクチュエータ28は、例えば油圧アクチュエータであり、油圧によりロックピン51,52をロック孔301内とロック孔301外とに移動させる。或いは、リフタロックアクチュエータ28は、電動アクチュエータであってもよい。リフタロックアクチュエータ28は、リフタロックスイッチ47の操作に応じて、ロックピン51,52をロック孔301内とロック孔301外とに移動させる。
 コントローラ36は、駆動源31及び動力伝達装置33を制御することで、作業機械1を走行させる。また、コントローラ36は、油圧ポンプ32と制御弁34とを制御することで、作業機5を動作させる。コントローラ36は、プロセッサ37と記憶装置38とを含む。プロセッサ37は、例えばCPUであり、作業機械1を制御するためのプログラムを実行する。記憶装置38は、RAM及びROMなどのメモリと、SSD或いはHDDなどの補助記憶装置を含む。記憶装置38は、作業機械1を制御するためのプログラムとデータとを記憶している。
 図4に示すように、作業機械1は、作業機5の姿勢を検出するための複数のセンサS1-S6を含む。複数のセンサS1-S6は、例えば磁気センサである。ただし、複数のセンサS1-S6は、光学センサなどの他の方式のセンサであってもよい。複数のセンサS1-S5は、上述した複数の油圧シリンダ22-26のストローク長を検出する。複数のセンサS1-S5は、左リフトセンサS1と、右リフトセンサS2と、ドローバシフトセンサS3と、ブレードチルトセンサS4と、ブレードシフトセンサS5とを含む。
 左リフトセンサS1は、左リフトシリンダ22のストローク長を検出する。右リフトセンサS2は、右リフトシリンダ23のストローク長を検出する。ドローバシフトセンサS3は、ドローバシフトシリンダ24のストローク長を検出する。ブレードチルトセンサS4は、ブレードチルトシリンダ25のストローク長を検出する。ブレードシフトセンサS5は、ブレードシフトシリンダ26のストローク長を検出する。
 複数のセンサS1-S6は、回転センサS6を含む。回転センサS6は、サークル18の回転角θ4を検出する。複数のセンサS1-S6は、検出したストローク長及び回転角θ4を示す信号を出力する。
 コントローラ36は、複数のセンサS1-S6からの信号に基づいて、作業機5の姿勢を取得する。すなわち、コントローラ36は、複数のセンサS1-S6からの信号に基づいて、上述した複数のパラメータの現在の値を算出する。上述したように、コントローラ36は、複数の操作部材41-46の操作に応じて、複数のアクチュエータ22-27を制御することで、作業機5の姿勢を変更する統合制御を実行する。
 以下、統合制御について詳細に説明する。なお、以下の説明において、作業機5の姿勢は、フロントフレーム11に対する作業機5の姿勢を意味する。或いは、作業機5の姿勢は、アーティキュレート角が0であるときの車体2に対する作業機5の姿勢を意味する。以下、コントローラ36によって実行される作業機5の姿勢を変更するための制御について説明する。
 図10は、オペレータによって操作される操作部材と、駆動されるアクチュエータとの対応を示す表である。作業機械1では、上述した作業機5の構造により、1つのアクチュエータの動作に応じて、作業機5の姿勢を示す複数のパラメータが変化する。例えば、図11及び図12は、作業機5の姿勢を示す数学モデルM1の背面図である。数学モデルM1は、アクチュエータの動作に連動する作業機5の各部分の幾何学的な位置関係を示す。コントローラ36は、数学モデルM1により、油圧シリンダ22-26のストローク長と、回転アクチュエータ27の回転角θ4とに対応したドローバ17、サークル18、及びブレード16の位置と角度とを算出する。
 図11は、初期状態の作業機5を示している。図12は、左リフトシリンダ22が初期状態から収縮したときの作業機5を示している。図12では、左リフトシリンダ22以外のアクチュエータは初期状態に維持されている。図12に示すように、左リフトシリンダ22が収縮することで、ブレード16の左端部161が初期状態の位置161’から上昇する。しかし、ブレード16の右端部162は初期状態の位置162’から下降する。また、ブレード16は、初期状態の位置から左方へ移動する。すなわち、左リフトシリンダ22のストローク動作に応じて、ブレード16の左端部161の高さが変化すると共に、ブレード16の右端部162の高さと、ドローバ17のヨー角θ1が変化する。
 従って、左リフトレバー41の操作に応じて左リフトシリンダ22のみを動作させる場合、ブレード16の左端部161の高さが変化するだけではなく、ブレード16の右端部162の高さと、ドローバ17の左右方向の位置も変化してしまう。そこで、コントローラ36は、左リフトレバー41が操作されているときには、図13に示すように、左リフトレバー41の操作に応じてブレード16の左端部161の高さを変化させると共に、ブレード16の右端部162の高さと、ドローバ17のヨー角θ1とを一定に保持するように、左リフトシリンダ22と、右リフトシリンダ23と、ドローバシフトシリンダ24とを制御する。
 例えば、ブレード16の左端部161を上昇させるように左リフトレバー41が操作されているときには、コントローラ36は、左リフトシリンダ22を収縮させる。それにより、ブレード16の左端部161が上昇する。また、コントローラ36は、右リフトシリンダ23を収縮させる。それにより、ブレード16の右端部162の下降が抑えられる。また、コントローラ36は、ドローバシフトシリンダ24を収縮させる。それにより、ブレード16のヨー角θ1の変化が抑えられる。それにより、ブレード16の左端部161は、鉛直方向に上昇する。鉛直方向は、重力方向に平行な方向である。
 詳細には、図14は、コントローラ36によって実行される作業機5の統合制御の処理を示すフローチャートである。図14に示すように、ステップS101では、コントローラ36は、作業機5の現在の姿勢を取得する。コントローラ36は、複数のセンサS1-S6からの信号に基づいて、各油圧シリンダ22-26の現在のストローク長と、サークル18の現在の回転角θ4とを取得する。コントローラ36は、各油圧シリンダ22-26の現在のストローク長と、サークル18の現在の回転角θ4とに基づいて、作業機5の姿勢を示す上述した複数のパラメータを算出する。
 ステップS102では、コントローラ36は、操作装置35の操作を取得する。コントローラ36は、上述した複数の操作部材41-46のいずれかから、その操作部材の操作を示す信号を受信する。
 ステップS103では、コントローラ36は、目標姿勢を決定する。コントローラ36は、操作部材の操作に応じて目標姿勢を決定する。例えば、左リフトレバー41が操作されているときには、ブレード16の右端部162の高さと、ドローバ17の左右方向の位置とが一定に保持されながら、ブレード16の左端部161の高さが、左リフトレバー41の操作に応じた高さとなるような、ドローバ17のピッチ角θ2とロール角θ3とを、目標姿勢として決定する。なお、ドローバ17のヨー角θ1は、初期状態の値に維持される。
 ステップS104では、コントローラ36は、目標ストローク長を決定する。コントローラ36は、作業機5が目標姿勢をとるための各油圧シリンダ22-26の目標ストローク長を算出する。上記の例では、コントローラ36は、上述した目標姿勢を示すドローバ17のピッチ角θ2とロール角θ3とを実現する左リフトシリンダ22の第1目標ストローク長と、右リフトシリンダ23の第2目標ストローク長と、ドローバシフトシリンダ24の第3目標ストローク長とを算出する。
 ステップS105では、コントローラ36は、ストローク差を算出する。ストローク差は、目標ストローク長と現在のストローク長との差である。上記の例では、コントローラ36は、左リフトシリンダ22の現在のストローク長と第1目標ストローク長との差を、第1ストローク差として決定する。コントローラ36は、右リフトシリンダ23の現在のストローク長と第2目標ストローク長との差を、第2ストローク差として決定する。コントローラ36は、ドローバシフトシリンダ24の現在のストローク長と第3目標ストローク長との差を、第3ストローク差として決定する。
 ステップS106では、コントローラ36は、作業機5が目標姿勢をとるための各油圧シリンダ22-26の目標ストローク速度を決定する。コントローラ36は、各油圧シリンダ22-26のストローク差に基づいて、目標ストローク速度を決定する。上記の例では、コントローラ36は、第1ストローク差に基づいて、左リフトシリンダ22の第1目標ストローク速度を決定する。コントローラ36は、第2ストローク差に基づいて、右リフトシリンダ23の第2目標ストローク速度を決定する。コントローラ36は、第3ストローク差に基づいて、ドローバシフトシリンダ24の第3目標ストローク速度を決定する。
 ステップS107では、コントローラ36は、目標ストローク速度に基づいて、各アクチュエータを制御する。上記の例では、コントローラ36は、第1目標ストローク速度で左リフトシリンダ22がストローク動作するように、制御弁34を制御する。コントローラ36は、第2目標ストローク速度で右リフトシリンダ23がストローク動作するように、制御弁34を制御する。コントローラ36は、第3目標ストローク速度でドローバシフトシリンダ24がストローク動作するように、制御弁34を制御する。それにより、図13に示すように、ブレード16の右端部162の高さと、ドローバ17の左右方向の位置とが一定に保持されながら、左リフトレバー41の操作に応じてブレード16の左端部161の高さが鉛直方向に変化する。
 以上のように、左リフトレバー41が操作されているときには、コントローラ36は、左リフトシリンダ22と右リフトシリンダ23とドローバシフトシリンダ24とのストローク動作の組み合わせにより、左リフトレバー41の操作に応じた作業機5の目標姿勢を実現させる。他の操作部材が操作されているときも同様に、コントローラ36は、複数のアクチュエータ22-27の動作の組み合わせにより、当該操作部材の操作に応じた作業機5の目標姿勢を実現させる。
 例えば、図10に示すように、右リフトレバー42が操作されているときには、コントローラ36は、左リフトシリンダ22と、右リフトシリンダ23と、ドローバシフトシリンダ24とを動作させる。左リフトシリンダ22と同様に、右リフトシリンダ23がストローク動作するときには、右リフトシリンダ23のストローク動作に応じて、ブレード16の右端部162の高さが変化すると共に、ブレード16の左端部161の高さとドローバ17の左右方向の位置も変化する。
 そのため、コントローラ36は、右リフトレバー42が操作されているときには、ブレード16の左端部161の高さと、ドローバ17のヨー角θ1とが一定に保持されながら、ブレード16の右端部162の高さが、鉛直方向に移動して、右リフトレバー42の操作に応じた高さとなるような、ドローバ17のピッチ角θ2とロール角θ3とを、目標姿勢として決定する。そして、コントローラ36は、左リフトシリンダ22と右リフトシリンダ23とドローバシフトシリンダ24とのストローク動作の組み合わせにより、右リフトレバー42の操作に応じた作業機5の目標姿勢を実現させる。
 ドローバシフトレバー43が操作されているときには、コントローラ36は、左リフトシリンダ22と、右リフトシリンダ23と、ドローバシフトシリンダ24とを動作させる。図15Aは、従来のモータグレーダにおける、ドローバシフトシリンダ24が初期状態からストローク動作するときの作業機5を示している。従来のモータグレーダにおいては、ドローバシフトシリンダ24がストローク動作するときには、図15Aに示すように、ドローバシフトシリンダ24のストローク動作に応じて、ブレード16の左端部161の高さと右端部162の高さも変化する。また、ドローバシフトシリンダ24のストローク動作に応じて、ドローバ17のヨー角θ1が変化する。
 そのため、本実施形態に係る作業機械1では、コントローラ36は、ドローバシフトレバー43が操作されているときには、図15Bに示すように、ブレード16の左端部161の高さと右端部162の高さとが一定に保持されながら、ドローバ17のヨー角θ1が、ドローバシフトレバー43の操作に応じた角度になるような、ドローバ17のピッチ角θ2とロール角θ3とを、目標姿勢として決定する。そして、コントローラ36は、左リフトシリンダ22と右リフトシリンダ23とドローバシフトシリンダ24とのストローク動作の組み合わせにより、ドローバシフトレバー43の操作に応じた作業機5の目標姿勢を実現させる。
 回転レバー44が操作されているときには、コントローラ36は、左リフトシリンダ22と、右リフトシリンダ23と、ドローバシフトシリンダ24と、回転アクチュエータ27とを動作させる。図16Aは、初期状態の作業機5を示す側面図である。図16Bは、従来のモータグレーダにおける、サークル18が初期状態から回転したときの作業機5を示している。従来のモータグレーダにおいては、回転アクチュエータ27によってサークル18が回転するときには、図16Bに示すように、サークル18の回転に応じて、ブレード16の左端部161の高さと右端部162の高さも変化する。また、サークル18の回転に応じて、サークル18の回転角θ4が変化する。
 そのため、本実施形態に係る作業機械1では、コントローラ36は、回転レバー44が操作されているときには、図16Cに示すように、ブレード16の左端部161の高さと右端部162の高さとが一定に保持されながら、サークル18の回転角θ4が、回転レバー44の操作に応じた回転角θ4になるような、ドローバ17のヨー角θ1とピッチ角θ2とロール角θ3とを、目標姿勢として決定する。そして、コントローラ36は、左リフトシリンダ22と右リフトシリンダ23とドローバシフトシリンダ24のストローク動作と、回転アクチュエータ27の回転動作との組み合わせにより、回転レバー44の操作に応じた作業機5の目標姿勢を実現させる。
 ブレードチルトレバー45が操作されているときには、コントローラ36は、左リフトシリンダ22と、右リフトシリンダ23と、ドローバシフトシリンダ24と、ブレードチルトシリンダ25を動作させる。図17Aは、初期状態の作業機5を示す側面図である。図17Bは、従来のモータグレーダにおける、ブレードチルトシリンダ25が初期状態からストローク動作したときの作業機5を示している。従来のモータグレーダにおいては、図17Bに示すように、ブレードチルトシリンダ25がストローク動作するときには、ブレードチルトシリンダ25のストローク動作に応じて、ブレード16の高さも変化する。また、ブレードチルトシリンダ25のストローク動作に応じて、ブレード16のチルト角θ5が変化する。
 そのため、本実施形態に係る作業機械1では、コントローラ36は、ブレードチルトレバー45が操作されているときには、図17Cに示すように、ブレード16の高さが一定に保持されながら、ブレード16のチルト角θ5が、ブレードチルトレバー45の操作に応じた角度になるような、ドローバ17のヨー角θ1とピッチ角θ2とロール角θ3とを、目標姿勢として決定する。そして、コントローラ36は、左リフトシリンダ22と右リフトシリンダ23とドローバシフトシリンダ24とブレードチルトシリンダ25とのストローク動作の組み合わせにより、ブレードチルトレバー45の操作に応じた作業機5の目標姿勢を実現させる。
 なお、ブレードシフトレバー46が操作されているときには、コントローラ36は、ブレード16のシフト量がブレードシフトレバー46の操作に応じた量になるように、ブレードシフトシリンダ26を制御する。
 以上説明した本実施形態に係る作業機械1では、操作装置35の操作に応じて、作業機5の目標姿勢が決定される。複数の油圧シリンダ22-26のストローク動作の組み合わせにより作業機5が目標姿勢をとるための複数の油圧シリンダ22-26のそれぞれの目標ストローク長と回転アクチュエータ27の回転角θ4が決定される。そして、決定された目標ストローク長と回転角θ4に基づいて、複数の油圧シリンダ22-26と回転アクチュエータ27とのそれぞれが制御される。それにより、操作装置35の簡易な操作によって、複数の油圧シリンダ22-26のストローク動作と回転アクチュエータ27の回転動作とが組み合わされることで、作業機5が目標姿勢をとる。そのため、作業機械1において、作業機5の操作が容易になる。
 例えば、オペレータは、左リフトレバー41のみを操作することで、ブレード16の右端部162の高さと、ドローバ17の左右方向の位置とを一定に保持しながら、ブレード16の左端部161の高さを変更することができる。オペレータは、右リフトレバー42のみを操作することで、ブレード16の左端部161の高さと、ドローバ17の左右方向の位置とを一定に保持しながら、ブレード16の右端部162の高さを変更することができる。
 オペレータは、ドローバシフトレバー43のみを操作することで、ブレード16の左端部161の高さと右端部162の高さとを一定に保持しながら、ドローバ17のヨー角θ1を変更することができる。オペレータは、回転レバー44のみを操作することで、ブレード16の左端部161の高さと右端部162の高さとを一定に保持しながら、サークル18の回転角θ4を変更することができる。オペレータは、ブレードチルトレバー45のみを操作することで、ブレード16の左端部161の高さと右端部162の高さとを一定に保持しながら、ブレード16のチルト角θ5を変更することができる。
 以上、ブレード16が通常姿勢である場合の統合制御について説明した。次に、ブレード16がバンクカット姿勢である場合の統合制御について説明する。図18は、ブレード16が通常姿勢である場合の作業機5の正面図である。図19は、ブレード16がバンクカット姿勢である場合の作業機5の正面図である。図18及び図19においては、車体2の位置が二点鎖線で示されている。図18及び図19に示すように、バンクカット姿勢において、ブレード16は、通常姿勢よりも大きなロール角θ6を有する。
 例えば、地形に斜面を形成する作業では、オペレータは、作業機5にバンクカット姿勢をとらせる。図19に示すように、バンクカット姿勢では、ブレード16が、垂直方向に近いぐらい、水平方向に対して大きく傾斜して保持される。この状態で、ブレード16によって地形を掘削することで、斜面が形成される。
 例えば、オペレータは、以下のようにしてブレード16を通常姿勢からバンクカット姿勢に変更する。まず、オペレータは、リフタロックスイッチ47を操作して、ロックピン51,52をロック孔301外に移動させることで、リフタブラケット29を解除状態とする。オペレータは、左右のリフトレバー41,42を操作することで、リフタブラケット29と共にブレード16をフロントフレーム11回りに回転させる。オペレータは、ブレード16をバンクカット姿勢となる位置で停止させ、リフタロックスイッチ47を操作して、ロックピン51,52をロック孔301内に移動させることで、リフタブラケット29をロック状態とする。それにより、ブレード16がバンクカット姿勢に保持される。
 作業機5がバンクカット姿勢のような極端な姿勢をとっている場合に、上述した通常姿勢での統合制御が実行されると、操作装置35の操作と、ブレード16の動作との間の乖離により、オペレータの操作感が損なわれる可能性がある。例えば、地形に斜面を形成する作業では、オペレータは、斜面に垂直な方向にブレード16を移動させることで、ブレード16を斜面に押し付けることがある。この場合、上述した通常姿勢での統合制御では、オペレータが、左リフトレバー41と右リフトレバー42とを同時に操作すると、ブレード16は、斜面に垂直な方向ではなく、鉛直方向に動作してしまう。そのため、オペレータは、左リフトレバー41と右リフトレバー42のみならず、他のレバーも同時に操作する必要があり、むしろ操作感が損なわれてしまう。そこで、以下に説明するように、コントローラ36は、ブレード16がバンクカット姿勢である場合には、上述した通常姿勢である場合とは異なる制御モードで、統合制御を実行する。
 図20は、コントローラ36によって実行される統合制御の処理を示すフローチャートである。図20に示すように、ステップ201では、コントローラ36は、ブレード16の現在の姿勢を取得する。コントローラ36は、ブレード16のロール角θ6により、ブレード16の現在の姿勢を取得する。ブレード16のロール角θ6は、例えば、地面100に対するブレード16の傾斜角である。或いは、ブレード16のロール角θ6は、車体2に対するブレード16の傾斜角であってもよい。コントローラ36は、例えば、上述したドローバ17のロール角θ3に基づいて、ブレード16のロール角θ6を取得する。
 ステップS202では、コントローラ36は、ブレード16の現在の姿勢が、バンクカット姿勢であるかを判定する。コントローラ36は、ブレード16のロール角θ6に基づいて、ブレード16の姿勢が、バンクカット姿勢であるかを判定する。コントローラ36は、例えば、ブレード16のロール角θ6が所定の閾値より大きい場合に、ブレード16の現在の姿勢が、バンクカット姿勢であると判定する。コントローラ36は、ブレード16のロール角θ6が所定の閾値以下である場合には、ブレード16の現在の姿勢が、バンクカット姿勢ではなく、通常姿勢であると判定する。コントローラ36が、ブレード16の現在の姿勢は通常姿勢であると、判定した場合には、処理は、ステップS203に進む。
 ステップS203では、コントローラ36は、ブレード16の統合制御として、第1モードを選択する。すなわち、ブレード16の現在の姿勢が、通常姿勢である場合には、コントローラ36は、ブレード16の制御モードとして第1モードを選択する。そして、ステップS204において、第1モードにて統合制御を実行する。第1モードでは、コントローラ36は、上述した統合制御の処理と同様の処理を実行する。
 図18に示すように、第1モードの統合制御では、コントローラ36は、左リフトレバー41と右リフトレバー42の操作に応じて、ブレード16を、鉛直方向H1,H2に移動するように、左リフトシリンダ22と右リフトシリンダ23とドローバシフトシリンダ24とを制御する。例えば、オペレータが、左リフトレバー41のみを操作した場合、コントローラ36は、ブレード16の左端部161が鉛直方向H1に移動するように、左リフトシリンダ22と右リフトシリンダ23とドローバシフトシリンダ24とを制御する。オペレータが、右リフトレバー42のみを操作した場合、コントローラ36は、ブレード16の右端部162が鉛直方向H2に移動するように、左リフトシリンダ22と右リフトシリンダ23とドローバシフトシリンダ24とを制御する。
 オペレータが、左リフトレバー41と右リフトレバー42とを共に同じ量だけ操作した場合には、コントローラ36は、ブレード16全体が鉛直方向H1,H2に並行移動するように、複数のアクチュエータを制御する。例えば、オペレータが、左リフトレバー41と右リフトレバー42とを同様に上げ操作した場合には、コントローラ36は、ブレード16全体が鉛直方向H1,H2において上向きに並行移動するように、左リフトシリンダ22と右リフトシリンダ23とドローバシフトシリンダ24とを制御する。オペレータが、左リフトレバー41と右リフトレバー42とを同様に下げ操作した場合には、コントローラ36は、ブレード16全体が鉛直方向H1,H2において下向きに並行移動するように、左リフトシリンダ22と右リフトシリンダ23とドローバシフトシリンダ24とを制御する。
 ステップS202において、ブレード16の現在の姿勢が、バンクカット姿勢である場合には、処理はステップS205に進む。ステップS205では、コントローラ36は、ブレード16の統合制御として第2モードを選択する。そして、ステップS204において、第2モードにて統合制御を実行する。
 図19に示すように、第2モードの統合制御では、コントローラ36は、左リフトレバー41と右リフトレバー42の操作に応じて、ブレード16を、ブレード法線方向H3,H4に移動するように、左リフトシリンダ22と右リフトシリンダ23とドローバシフトシリンダ24とを制御する。ブレード法線方向H3,H4は、ブレード16の長手方向に垂直な方向である。例えば、オペレータが、左リフトレバー41のみを操作した場合、コントローラ36は、ブレード16の左端部161がブレード法線方向H3に移動するように、左リフトシリンダ22と右リフトシリンダ23とドローバシフトシリンダ24とを制御する。オペレータが、右リフトレバー42のみを操作した場合、コントローラ36は、ブレード16の右端部162がブレード法線方向H4に移動するように、左リフトシリンダ22と右リフトシリンダ23とドローバシフトシリンダ24とを制御する。
 オペレータが、左リフトレバー41と右リフトレバー42とを同様に操作した場合には、コントローラ36は、ブレード16全体がブレード法線方向H3,H4に並行移動するように、左リフトシリンダ22と右リフトシリンダ23とドローバシフトシリンダ24とを制御する。例えば、オペレータが、左リフトレバー41と右リフトレバー42とを同様に上げ操作した場合には、コントローラ36は、ブレード16全体がブレード法線方向H3,H4において上向きに並行移動するように、左リフトシリンダ22と右リフトシリンダ23とドローバシフトシリンダ24とを制御する。オペレータが、左リフトレバー41と右リフトレバー42とを同様に下げ操作した場合には、コントローラ36は、ブレード16全体がブレード法線方向H3,H4において下向きに並行移動するように、左リフトシリンダ22と右リフトシリンダ23とドローバシフトシリンダ24とを制御する。
 以上説明した本実施形態に係る作業機械1では、ブレード16の姿勢に応じて、第1モード又は第2モードが選択される。第1モードでは、左右のリフトレバー41,42の操作に応じて、ブレード16を鉛直方向H1,H2に移動するように、複数のアクチュエータが制御される。第2モードでは、左右のリフトレバー41,42の操作に応じて、ブレード16をブレード法線方向H3,H4に移動するように、複数のアクチュエータが制御される。それにより、作業機5の姿勢を変更するための操作が容易になる。また、バンクカット姿勢のように、ブレード16が極端な姿勢をとる場合でもあって、操作感の低下が抑えられる。
 以上、本発明の一実施形態について説明したが、本発明は上記実施形態に限定されるものではなく、発明の要旨を逸脱しない範囲で種々の変更が可能である。
 作業機械1は、モータグレーダに限らず、ブルドーザなどの他の作業機械であってもよい。作業機5の姿勢を示すパラメータは、上記の実施形態のものに限らず、変更されてもよい。複数の操作部材41-46は、上記の実施形態のものに限らず、変更されてもよい。例えば、操作部材は、レバーに限らず、ジョイスティック、スイッチ、或いはタッチパネルなどの他の部材であってもよい。
 作業機5の姿勢を検出するためのセンサは、上記の実施形態のものに限らず、変更されてもよい。例えば、センサは、慣性計測装置(IMU)であってもよい。IMUは、ドローバ17と、フロントフレーム11または車体2のそれぞれに装着されてもよい。IMUによって、ドローバ17とフロントフレーム11との姿勢が検出されてもよい。
 統合制御におけるモードは、2つに限らず、2つより多くてもよい。すなわち、上述した第1モードと第2モード以外のモードが選択可能であってもよい。ブレード16の姿勢は、上述した通常姿勢とバンクカット姿勢とに限らず、他の姿勢をさらに含んでもよい。
 左リフトレバー41と右リフトレバー42とが操作されたときに動作させるアクチュエータの組み合わせは、左リフトシリンダ22と右リフトシリンダ23とドローバシフトシリンダ24とに限らない。例えば、ブレードシフトシリンダ26が組み合わされてもよい。
 ブレード16の姿勢は、ブレード16のロール角θ6に限らず、他のパラメータによって判定されてもよい。例えば、図21は、変形例に係る作業機械1の駆動系6及び制御系7を示す模式図である。図21に示すように、作業機械1は、リフタブラケットセンサS7を含んでもよい。リフタブラケットセンサS7は、図22に示すように、フロントフレーム11に対するリフタブラケット29の回転角度θ7を検出する。リフタブラケット29の回転角度θ7は、フロントフレーム11に対する所定の標準位置からのリフタブラケット29の回転角度である。
 リフタブラケットセンサS7は、例えば近接センサであってもよい。リフタブラケットセンサS7は、リフタブラケット29とフロントフレーム11との間に配置されてもよい。或いは、リフタブラケット29のロックピン51,52と、リフタガイド30のロック孔301との間に配置されてもよい。例えば、ロックピン51,52がどのロック孔301に嵌っているかによって、ブレード16がバンクカット姿勢か否かが判定されてもよい。
 コントローラ36は、リフタブラケット29の回転角度θ7に基づいて、ブレード16の姿勢が、通常姿勢であるか、又はバンクカット姿勢であるかを判定してもよい。例えば、コントローラ36は、リフタブラケット29の回転角度θ7が所定の閾値より大きい場合に、ブレード16の姿勢が、バンクカット姿勢であると判定してもよい。コントローラ36は、リフタブラケット29の回転角度θ7が所定の閾値以下である場合に、ブレード16の姿勢が、通常姿勢であると判定してもよい。
 本発明によれば、作業機の姿勢を変更するための操作が容易になると共に、作業機の姿勢による操作感の低下が抑えられる。
 2:車体、 5:作業機、 11:フロントフレーム、 16:ブレード、 22-27:アクチュエータ、 29:リフタブラケット、 35:操作装置、 36:コントローラ、 41:左リフトレバー、 42:右リフトレバー、 S1-S7:センサ、 H1,H2:鉛直方向、 H3,H4:ブレード法線方向

Claims (20)

  1.  車体と、
     ブレードを含み、前記車体に対して可動的に接続された作業機と、
     前記作業機に接続され、前記車体に対する前記ブレードの姿勢を変更する複数のアクチュエータと、
     前記ブレードの姿勢を変更するために操作可能な操作装置と、
     前記ブレードの現在の姿勢を検出するセンサと、
     コントローラと、
    を備え、
     前記コントローラは、
      前記ブレードの現在の姿勢を取得し、
      前記複数のアクチュエータのストローク動作の組み合わせにより、前記ブレードが、前記操作装置の操作に応じて、前記現在の姿勢から、前記ブレードの長手方向に垂直なブレード法線方向に移動するための前記複数のアクチュエータのそれぞれの目標ストローク長を決定し、
      前記目標ストローク長に基づいて前記複数のアクチュエータを制御する、
    作業機械。
  2.  前記コントローラは、
      前記操作装置の操作に応じた前記ブレードの制御モードを、少なくとも第1モードと第2モードとから選択し、
      前記第1モードでは、前記操作装置の操作に応じて、前記ブレードを、重力方向に平行な鉛直方向に移動するように、前記複数のアクチュエータを制御し、
      前記第2モードでは、前記操作装置の操作に応じて、前記ブレードを、前記ブレード法線方向に移動するように、前記複数のアクチュエータを制御する、
    請求項1に記載の作業機械。
  3.  前記コントローラは、
      前記操作装置の操作に応じた前記ブレードの制御モードを、前記ブレードの現在の姿勢に応じて、少なくとも前記第1モードと前記第2モードとから選択する、
    請求項2に記載の作業機械。
  4.  前記コントローラは、
      前記ブレードの現在の姿勢が、通常姿勢であるか、又は、前記通常姿勢よりも大きなロール角を有するバンクカット姿勢であるかを判定し、
      前記ブレードの現在の姿勢が、前記通常姿勢である場合には、前記ブレードの制御モードとして前記第1モードを選択し、
      前記ブレードの現在の姿勢が、前記バンクカット姿勢である場合には、前記ブレードの制御モードとして前記第2モードを選択する、
    請求項3に記載の作業機械。
  5.  前記センサは、地面、又は、前記車体に対する前記ブレードのロール角を検出し、
     前記コントローラは、前記ロール角に基づいて、前記ブレードの姿勢が、前記通常姿勢であるか、又は前記バンクカット姿勢であるかを判定する、
    請求項4に記載の作業機械。
  6.  前記車体は、前記車体の前後方向に延びるフロントフレームを含み、
     前記作業機は、前記フロントフレームに対して回転可能に接続されたリフタブラケットを含み、
     前記ブレードは、前記リフタブラケットを介して前記フロントフレームに支持されており、
     前記センサは、前記フロントフレームに対する前記リフタブラケットの回転角度を検出し、
     前記コントローラは、前記リフタブラケットの回転角度に基づいて、前記ブレードの姿勢が、前記通常姿勢であるか、又は前記バンクカット姿勢であるかを判定する、
    請求項4に記載の作業機械。
  7.  前記操作装置は、左リフト操作部材を含み、
     前記コントローラは、
      前記第1モードでは、前記左リフト操作部材の操作に応じて、前記ブレードの左端部を前記鉛直方向に移動するように、前記複数のアクチュエータを制御し、
     前記第2モードでは、前記左リフト操作部材の操作に応じて、前記ブレードの左端部を前記ブレード法線方向に移動するように、前記複数のアクチュエータを制御する、
    請求項2に記載の作業機械。
  8.  前記操作装置は、右リフト操作部材を含み、
     前記コントローラは、
      前記第1モードでは、前記右リフト操作部材の操作に応じて、前記ブレードの右端部を前記鉛直方向に移動するように、前記複数のアクチュエータを制御し、
     前記第2モードでは、前記右リフト操作部材の操作に応じて、前記ブレードの右端部を前記ブレード法線方向に移動するように、前記複数のアクチュエータを制御する、
    請求項2に記載の作業機械。
  9.  作業機械を制御するための方法であって、前記作業機械は、車体と、ブレードを含み前記車体に対して可動的に接続された作業機と、前記作業機に接続され前記車体に対する前記ブレードの姿勢を変更する複数のアクチュエータと、を備え、前記方法は、
     前記ブレードの現在の姿勢を取得することと、
     操作装置への操作を示す信号を取得することと、
     前記複数のアクチュエータのストローク動作の組み合わせにより、前記ブレードが、前記操作装置の操作に応じて、前記現在の姿勢から、前記ブレードの長手方向に垂直なブレード法線方向に移動するための前記複数のアクチュエータのそれぞれの目標ストローク長を決定することと、
     前記目標ストローク長に基づいて前記複数のアクチュエータを制御すること、
    を備える方法。
  10.  前記操作装置の操作に応じた前記ブレードの制御モードを、少なくとも第1モードと第2モードとから選択することと、
     前記第1モードでは、前記操作装置の操作に応じて、前記ブレードを、重力方向に平行な鉛直方向に移動するように、前記複数のアクチュエータを制御することと、
     前記第2モードでは、前記操作装置の操作に応じて、前記ブレードを、前記ブレード法線方向に移動するように、前記複数のアクチュエータを制御すること、
    をさらに備える請求項9に記載の方法。
  11.  前記操作装置の操作に応じた前記ブレードの制御モードを、前記ブレードの現在の姿勢に応じて、少なくとも前記第1モードと前記第2モードとから選択すること、
    をさらに備える請求項10に記載の方法
  12.  前記ブレードの現在の姿勢が、通常姿勢であるか、又は、前記通常姿勢よりも大きなロール角を有するバンクカット姿勢であるかを判定することと、
     前記ブレードの現在の姿勢が、前記通常姿勢である場合には、前記ブレードの制御モードとして前記第1モードを選択することと、
     前記ブレードの現在の姿勢が、前記バンクカット姿勢である場合には、前記ブレードの制御モードとして前記第2モードを選択すること、
    を備える請求項11に記載の方法。
  13.  地面、又は、前記車体に対する前記ブレードのロール角を検出することと、
     前記ロール角に基づいて、前記ブレードの姿勢が、前記通常姿勢であるか、又は前記バンクカット姿勢であるかを判定すること、
    をさらに備える請求項12に記載の方法。
  14.  前記車体は、前記車体の前後方向に延びるフロントフレームを含み、
     前記作業機は、前記フロントフレームに対して回転可能に接続されたリフタブラケットを含み、
     前記ブレードは、前記リフタブラケットを介して前記フロントフレームに支持されており、
     前記フロントフレームに対する前記リフタブラケットの回転角度を検出することと、
     前記リフタブラケットの回転角度に基づいて、前記ブレードの姿勢が、前記通常姿勢であるか、又は前記バンクカット姿勢であるかを判定すること、
    をさらに備える請求項12に記載の方法。
  15.  前記操作装置は、左リフト操作部材を含み、
     前記第1モードでは、前記左リフト操作部材の操作に応じて、前記ブレードの左端部を前記鉛直方向に移動するように、前記複数のアクチュエータを制御することと、
     前記第2モードでは、前記左リフト操作部材の操作に応じて、前記ブレードの左端部を前記ブレード法線方向に移動するように、前記複数のアクチュエータを制御すること、
    をさらに備える請求項10に記載の方法。
  16.  前記操作装置は、右リフト操作部材を含み、
     前記第1モードでは、前記右リフト操作部材の操作に応じて、前記ブレードの右端部を前記鉛直方向に移動するように、前記複数のアクチュエータを制御することと、
     前記第2モードでは、前記右リフト操作部材の操作に応じて、前記ブレードの右端部を前記ブレード法線方向に移動するように、前記複数のアクチュエータを制御すること、
    をさらに備える請求項10に記載の方法。
  17.  作業機械を制御するためのシステムであって、前記作業機械は、車体と、ブレードを含み前記車体に対して可動的に接続された作業機と、前記作業機に接続され前記車体に対する前記ブレードの姿勢を変更する複数のアクチュエータと、を備え、前記システムは、
     前記ブレードの姿勢を変更するために操作可能な操作装置と、
     コントローラと、
    を備え、
     前記コントローラは、
      前記ブレードの現在の姿勢を取得し、
      前記複数のアクチュエータのストローク動作の組み合わせにより、前記ブレードが、前記操作装置の操作に応じて、前記現在の姿勢から、前記ブレードの長手方向に垂直なブレード法線方向に移動するための前記複数のアクチュエータのそれぞれの目標ストローク長を決定し、
      前記目標ストローク長に基づいて前記複数のアクチュエータを制御する、
    システム。
  18.  前記コントローラは、
      前記操作装置の操作に応じた前記ブレードの制御モードを、少なくとも第1モードと第2モードとから選択し、
      前記第1モードでは、前記操作装置の操作に応じて、前記ブレードを、重力方向に平行な鉛直方向に移動するように、前記複数のアクチュエータを制御し、
      前記第2モードでは、前記操作装置の操作に応じて、前記ブレードを、前記ブレード法線方向に移動するように、前記複数のアクチュエータを制御する、
    請求項17に記載のシステム。
  19.  前記コントローラは、
      前記操作装置の操作に応じた前記ブレードの制御モードを、前記ブレードの現在の姿勢に応じて、少なくとも前記第1モードと前記第2モードとから選択する、
    請求項18に記載の作業機械。
  20.  前記コントローラは、
      前記ブレードの現在の姿勢が、通常姿勢であるか、又は、前記通常姿勢よりも大きなロール角を有するバンクカット姿勢であるかを判定し、
      前記ブレードの現在の姿勢が、前記通常姿勢である場合には、前記ブレードの制御モードとして前記第1モードを選択し、
      前記ブレードの現在の姿勢が、前記バンクカット姿勢である場合には、前記ブレードの制御モードとして前記第2モードを選択する、
    請求項19に記載のシステム。
PCT/JP2023/015107 2022-06-08 2023-04-14 作業機械、作業機械を制御するための方法、及びシステム WO2023238504A1 (ja)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2022-092789 2022-06-08
JP2022092789A JP2023179888A (ja) 2022-06-08 2022-06-08 作業機械、作業機械を制御するための方法、及びシステム

Publications (1)

Publication Number Publication Date
WO2023238504A1 true WO2023238504A1 (ja) 2023-12-14

Family

ID=89118020

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2023/015107 WO2023238504A1 (ja) 2022-06-08 2023-04-14 作業機械、作業機械を制御するための方法、及びシステム

Country Status (2)

Country Link
JP (1) JP2023179888A (ja)
WO (1) WO2023238504A1 (ja)

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5273502A (en) * 1975-12-16 1977-06-20 Komatsu Mfg Co Ltd Device for automatically controlling blade of grader
JPS5771939A (en) * 1980-10-20 1982-05-06 Komatsu Ltd Automatic controller for excavator
JPS58191823A (ja) * 1982-04-30 1983-11-09 Komatsu Ltd モ−タグレ−ダの制御装置
JPS63118426A (ja) * 1986-10-15 1988-05-23 Komatsu Ltd ブルド−ザのブレ−ド制御装置および方法
JPH0339526A (ja) * 1989-06-28 1991-02-20 Spectra Physics Inc モータグレーダの横断傾斜カットを制御する方法及び装置
JPH04126952U (ja) * 1991-05-01 1992-11-19 株式会社小松エスト モータグレーダのブレード昇降装置
US20220112684A1 (en) * 2020-10-14 2022-04-14 Jiangsu Xcmg Construction Machinery Research Institute Ltd. Grader and slope scraping control method and device thereof
WO2022264713A1 (ja) * 2021-06-15 2022-12-22 株式会社小松製作所 作業機械および作業機械を制御するための方法

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5273502A (en) * 1975-12-16 1977-06-20 Komatsu Mfg Co Ltd Device for automatically controlling blade of grader
JPS5771939A (en) * 1980-10-20 1982-05-06 Komatsu Ltd Automatic controller for excavator
JPS58191823A (ja) * 1982-04-30 1983-11-09 Komatsu Ltd モ−タグレ−ダの制御装置
JPS63118426A (ja) * 1986-10-15 1988-05-23 Komatsu Ltd ブルド−ザのブレ−ド制御装置および方法
JPH0339526A (ja) * 1989-06-28 1991-02-20 Spectra Physics Inc モータグレーダの横断傾斜カットを制御する方法及び装置
JPH04126952U (ja) * 1991-05-01 1992-11-19 株式会社小松エスト モータグレーダのブレード昇降装置
US20220112684A1 (en) * 2020-10-14 2022-04-14 Jiangsu Xcmg Construction Machinery Research Institute Ltd. Grader and slope scraping control method and device thereof
WO2022264713A1 (ja) * 2021-06-15 2022-12-22 株式会社小松製作所 作業機械および作業機械を制御するための方法

Also Published As

Publication number Publication date
JP2023179888A (ja) 2023-12-20

Similar Documents

Publication Publication Date Title
JP7223526B2 (ja) 作業車両
WO2022264713A1 (ja) 作業機械および作業機械を制御するための方法
WO2021065404A1 (ja) 作業機械
WO2023238504A1 (ja) 作業機械、作業機械を制御するための方法、及びシステム
JP7406414B2 (ja) モータグレーダおよびモータグレーダの制御方法
WO2024084791A1 (ja) 作業機械、及び、作業機械を制御するための方法
WO2024053259A1 (ja) 作業機械、及び、作業機械を制御するための方法
WO2023067898A1 (ja) 作業機械、及び、作業機械を制御するための方法
WO2023021826A1 (ja) 作業機械、及び、作業機械を制御するための方法
WO2023053700A1 (ja) 作業機械を制御するためのシステムおよび方法
WO2023145196A1 (ja) 作業機械、作業機械を制御するための方法、及び、作業機械の制御システム
WO2023286443A1 (ja) 作業機械、及び、作業機械を制御するための方法
WO2021193319A1 (ja) ステアリング装置、および作業機械
WO2023286444A1 (ja) 作業機械、及び作業機械を制御するための方法
WO2023112560A1 (ja) 作業機械、作業機械を制御するための方法、及びシステム
WO2023135916A1 (ja) 作業機械、作業機械を制御するための方法、及びシステム
WO2023112563A1 (ja) 作業機械、作業機械を制御するための方法、及びシステム
WO2023286442A1 (ja) 作業機械、及び、作業機械を制御するための方法
WO2023021825A1 (ja) 作業機械、及び、作業機械を制御するための方法
WO2024089987A1 (ja) 作業機械及び作業機械を制御するための方法
WO2024070797A1 (ja) ステアリング装置および作業車両
WO2022255001A1 (ja) 作業機械、及び作業機械を制御するための方法
CN117980565A (zh) 作业机械、用于控制作业机械的方法以及系统

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 23819491

Country of ref document: EP

Kind code of ref document: A1