The present invention relates to a control device, an operation device, a control method, and a work vehicle.
Priority is claimed on Japanese Patent Application No. 2021-060559, filed on Mar. 31, 2021, the content of which is incorporated herein by reference.
A grader work equipment consists of a blade, a circle, a drawbar, lifters, and the like, and a plurality of actuators are provided for positioning them (for example, Patent Literature 1). For example, there are three actuators that control a movement of the drawbar, the left and right blade lift cylinders and the drawbar shift cylinder, but in order to achieve a desired angle, three axes operations spanning a plurality of operation levers is required, which poses a challenge because the operation is complicated and difficult.
The present invention has been made in view of the above circumstances, and an object of the present invention is to provide a control device, an operation device, a control method, and a work vehicle that can be easily operated.
In order to solve the above problems, one aspect of the present invention is a control device that controls a drawbar attached to a main frame of a grader, in which a movement of the drawbar is generated by at least three actuators, and the control device controls, based on an output signal from one operation lever having at least three degrees of freedom, the plurality of actuators such that a movement of the one operation lever corresponds to the movement of the drawbar.
In addition, another aspect of the present invention is an operation device including the control device and the operation lever.
In addition, another aspect of the present invention is a control method for controlling a drawbar attached to a main frame of a grader, in which a movement of the drawbar is generated by at least three actuators, the control method including controlling, based on an output signal from one operation lever having at least three degrees of freedom, the plurality of actuators such that a movement of the one operation lever corresponds to the movement of the drawbar.
In addition, still another aspect of the present invention is a work vehicle including a main frame, a drawbar attached to the main frame and restrained to the main frame by a ball shaft, three actuators attached to the main frame to determine a posture of the drawbar, one operation lever operated by an operator, and a control device that controls the actuators based on an output signal from the operation lever, in which the control device controls the actuators such that a movement of the operation lever corresponds to the movement of the drawbar.
According to each aspect of the present invention, an operation can be simplified.
Hereinafter, an embodiment of the present invention will be described with reference to the drawings. In each figure, the same reference numerals are used for the same or corresponding configurations, and the description thereof will be omitted as appropriate.
<Overview of Work Machine>
In the present embodiment, as shown in
As shown in
The cab 3 is supported by the vehicle main body 2. The cab 3 is internally provided with a driver's seat 31 on which an operator is seated and an operator operation device (not shown) operated by the operator to operate the motor grader 1.
The traveling device 4 supports the vehicle main body 2. In the present embodiment, the traveling device 4 includes two rotatable front wheels 5 and four rear wheels 6. The motor grader 1 is capable of traveling on a road surface RS by the front wheels 5 and the rear wheels 6 of the traveling device 4. The traveling device of the work machine is not limited to the wheels, and may be a crawler belt or the like.
The work equipment 10 is supported by the vehicle main body 2. As shown in
The main frame 11 is a holding unit that supports each unit, is composed of two subframes pin-coupled near the cab 3 and can be refracted (articulated).
The blade 14 is supported to enable shift and tilt with respect to the drawbar 12, and performs excavating, earthmoving, and shaping. The circle 13 is a large gear having teeth on the inner side, which holds the blade 14 and rotates in the direction of arrow A6 by the circle rotation motor 26. In this case, the blade 14 is attached to the drawbar 12.
The drawbar 12 is pivotally and rotatably (hereinafter, referred to as pivotally) restrained to the main frame 11 at an end portion of the drawbar 12 via one ball shaft 23, supporting the circle 13 and receiving a traction force. The ball shaft 23 is also called a ball coupling, a ball joint, or the like, and connects the main frame 11 and the drawbar 12. In this case, the drawbar 12 is attached to the main frame 11 of the motor grader 1. Further, the drawbar 12 is restrained by the main frame 11 and one ball shaft 23.
The right blade lift cylinder 15 is pivotally supported to the main frame 11 via the lifter 21 at its intermediate portion, and pivotally supported to the drawbar 12 at one end portion of the right blade lift cylinder 15, extending and retracting in the direction of arrow A1. The left blade lift cylinder 16 is pivotally supported to the main frame 11 via the lifter 22 at its intermediate portion, and pivotally supported to the drawbar 12 at one end portion of the left blade lift cylinder 16, extending and retracting in the direction of arrow A2. The drawbar shift cylinder 17 is pivotally supported to the main frame 11 at one end portion, and is pivotally supported to the drawbar 12 at the other end portion, extending and retracting in the direction of arrow A3. The right blade lift cylinder 15, the left blade lift cylinder 16, and the drawbar shift cylinder 17 control the position and posture of the drawbar 12.
The blade shift cylinder 24 is connected to the drawbar 12 at one end portion and supported by the blade 14 at the other end portion, extending and retracting in the direction of arrow A4 to laterally shift the blade 14. The power tilt cylinder 25 is connected to the drawbar 12 at one end portion and supported by the blade 14 at the other end portion, changing a cutting angle of the blade 14 in the rotation direction of arrow A5. The cutting angle is the angle formed between the cutting edge of the blade 14 and the road surface RS when the blade 14 is in contact with the road surface (ground) RS.
<Drawbar Control and Input Operation>
In the present embodiment, when controlling the position and posture of the drawbar 12, a rotation direction α is defined with the up-down direction indicated by arrow Az as a rotation axis, a rotation direction β with the front-rear direction indicated by arrow Ay as a rotation axis, and a rotation direction γ with the left-right direction indicated by arrow Ax as a rotation axis, in which the three directions indicate the directions with respect to the ball shaft 23 which serves as a restraint point of the drawbar 12, taking the pivotal and rotational center of the ball shaft 23 as an origin. The linear movements of the right blade lift cylinder 15, the left blade lift cylinder 16, and the drawbar shift cylinder 17 are controlled by considering them as three axes rotational movements around the ball shaft 23. In addition, an operator's input operation when operating the drawbar 12 is performed using a joy stick 32 (
The joy stick 32 further includes a slide switch 33. The slide switch 33 is an example of an operation unit that operates a movement of the blade 14 of the motor grader 1 and the operator can slide the blade 14 left or right by sliding the slide switch 33 left or right.
The joy stick 32 outputs, for example, signals representing rotation angles αj, βj, and γj (or signals representing change amounts Δαj, Δβj, and Δγj of rotation angles αj, βj, and γj per a predetermined time) according to an operation state of the lever 32L. In addition, the joy stick 32 outputs a signal representing the amount of sliding of the slide switch 33.
<Configuration of Control System>
The power source 201 generates the power for operating the work machine 1. An internal combustion engine or an electric motor is an example of the power source 201. The power source 201 is not limited to the internal combustion engine or the electric motor. For example, the power source 201 may be a so-called hybrid device in which the internal combustion engine, a generator motor, and a power storage device are combined. In addition, the power source 201 may have a configuration in which the power storage device and the generator motor are combined without having the internal combustion engine.
The PTO 202 transmits at least a portion of the power of the power source 201 to the hydraulic pump 203. The PTO 202 distributes the power of the power source 201 to the traveling device 4 and the hydraulic pump 203.
The traveling device 4 includes, for example, a transmission, a drive shaft, a brake, rear wheels 6, and the like. Front wheels 5 are driven by, for example, a hydraulic motor (not shown).
Under the control of the controller 100, the hydraulic control valve unit 204 controls the flow rate and direction of hydraulic fluid supplied to each of the right blade lift cylinder 15, the left blade lift cylinder 16, the drawbar shift cylinder 17, the blade shift cylinder 24, the power tilt cylinder 25, and the circle rotation motor 26.
In addition, the output signal of the joy stick 32, the amount of sliding of the slide switch 33, the output signal of the joy stick 34, the amount of operation of an accelerator pedal 35 provided in the cab 3, the output signal of a drawbar rotation angle meter 36, a cylinder length meter 37, and the like are input to the controller 100. The accelerator pedal 35 is an input operation device of the operator and indicates output of the power source 201. In addition, the drawbar rotation angle meter 36 measures (calculates) a drawbar rotation angle (α, β, γ) shown in
<Operation Example of Control System>
When the processing shown in
Next, the controller 100 calculates a drawbar rotation angle target value (αt, βt, γt) based on the drawbar rotation angle initial value (α0, β0, γ0) and the posture change (Δαj, Δβj, Δγj) of the joy stick (step S104). The drawbar rotation angle target value (αt, βt, γt) is, for example, a value obtained by adding a value obtained by multiplying the posture change (Δαj, Δβj, Δγj) of the joy stick by a predetermined coefficient to the drawbar rotation angle initial value (α0, β0, γ0) for each component. The predetermined coefficient can be, for example, a value that can be adjusted by the operator within a certain range.
Next, the controller 100 acquires the drawbar rotation angle (α, β, γ) output by the drawbar rotation angle meter 36 and sets the drawbar rotation angle (α, β, γ) as the current drawbar rotation angle (αr, βr, γr) (step S105). Next, the controller 100 controls the right blade lift cylinder 15, the left blade lift cylinder 16, and the drawbar shift cylinder 17 based on the drawbar rotation angle target value (αt, βt, γ) and the current drawbar rotation angle (αr, βr, γr) (step S106). Next, the controller 100 determines whether the current drawbar rotation angle (αr, βr, γr) reaches the drawbar rotation angle target value (αt, βt, γt) (whether the current drawbar rotation angle (αr, βr, γr) is within the drawbar rotation angle target value (αt, βt, γt)) (step S107).
In a case where the current drawbar rotation angle (αr, βr, βr, γr) reaches the drawbar rotation angle target value (αt, βt, γt) (in case of “YES” in step S107), the controller 100 ends the processing shown in
By the above processing, the controller 100 can change the rotation angle (α, β, γ) of the drawbar 12 to correspond to the operation input (change (Δαj, Δβj, Δγj) of the rotation angle (αj, βj, γj)) to the lever 32L of the joy stick 32. In this case, the drawbar 12 moves in the same direction as the lever rotation operation by the operator.
In the controller 100 (S303), extension and retraction speeds ΔV1, ΔV2, and ΔV3 of the right blade lift cylinder 15, the left blade lift cylinder 16, and the drawbar shift cylinder 17 are further calculated based on (a deviation of) the current drawbar rotation angle (α, β, γ) and the drawbar rotation angle target value (αt, βt, γt) (S306).
Next, as the operation of the cylinder and work equipment (S308), the hydraulic valve control of the right blade lift cylinder 15, the left blade lift cylinder 16, and the drawbar shift cylinder 17 is performed based on the extension and retraction speeds ΔV1, ΔV2, and ΔV3 (S309). Here, the extension and retraction of the right blade lift cylinder (S310), the extension and retraction of the left blade lift cylinder (S311), and the extension and retraction of the drawbar shift cylinder (S312) are performed to rotate the drawbar 12 (S313). In addition, the current rotation angle is newly detected by the drawbar rotation angle meter 36 (S314).
The processing in the block S315 is executed in a shorter cycle than the processing in the block S307.
By the above processing, the control system 300 can change the rotation angle (α, β, γ) of the drawbar 12 to correspond to the operation input (change (Δαj, Δβj, Δγj) of the rotation angle (αj, βj, γj)) to the lever 32L of the joy stick 32. In this case, the drawbar 12 moves in the same direction as the lever rotation operation by the operator.
Next, another operation example will be described with reference to
When the processing shown in
Next, the controller 100 calculates the drawbar rotation angle target value (Δα, Δβ, Δγ) based on the drawbar rotation angle initial value (α0, β0, γ0) and the posture change (Δαj, Δβj, Δγj) of the joy stick (step S204). The drawbar rotation angle target value (αt, βt, γt) is, for example, a value based on the drawbar rotation angle initial value (α0, β0, γ0) and a value obtained by multiplying the posture change (Δαj, Δβj, Δγj) of the joy stick by a predetermined coefficient for each component. The predetermined coefficient can be, for example, a value that can be adjusted by the operator within a certain range.
Next, the controller 100 acquires the current length (L1, L2, L3) of each cylinder and sets the current length (L1, L2, L3) as the length initial value (L1o, L2o, L3o) of each cylinder (step S205). Next, the controller 100 calculates the target value (ΔL1, ΔL2, ΔL3) for the change in length of each cylinder based on the drawbar rotation angle initial value (α0, β0, γ0) and the drawbar rotation angle target value (Δα, Δβ, Δγ) (step S206).
In step S206, the controller 100 uses a rotation matrix and a coordinate transformation matrix to calculate the target value (ΔL1, ΔL2, ΔL3) for the change in length of each cylinder to correspond to the drawbar rotation angle target value (Δα, Δβ, Δγ). In the present embodiment, the mechanism of the drawbar 12 is classified into a model of a rotational three degrees of freedom parallel mechanism, in terms of machine kinematics. In the rotational three degrees of freedom parallel mechanism, there is one cylinder length (L1, L2, L3) for each of the right blade lift cylinder 15, the left blade lift cylinder 16, and the drawbar shift cylinder 17, which achieves the desired posture (α, β, γ) of the drawbar 12. Therefore, when each cylinder length is adjusted at the same time, it is possible to control the posture (α, β, γ) of the drawbar 12. That is, it is possible to calculate the amount of extension and retraction of the cylinder required for angular rotation from the three axes angles, which are lever input angle signals of the joy stick 32. By using the rotation matrix, it is possible to calculate a change in the coordinates of a restraint point of each cylinder on the drawbar 12. In addition, since the coordinates of the restraint point on the vehicle main body 2 side do not change, the length of each cylinder after the rotation of the drawbar 12 can be calculated.
Next, the controller 100 acquires the current length (L1, L2, L3) of each cylinder (step S207) and calculates the current length change (ΔL1r, ΔL2r, ΔL3r) of each cylinder (step S208). Next, the controller 100 controls the right blade lift cylinder 15, the left blade lift cylinder 16, and the drawbar shift cylinder 17 based on the target value (ΔL1, ΔL2, ΔL3) for the change in length of each cylinder and the current length change (ΔL1r, ΔL2r, ΔL3r) of each cylinder (step S209). Next, the controller 100 determines whether the current length change (ΔL1r, ΔL2r, ΔL3r) of each cylinder reaches the target value (ΔL1, ΔL2, ΔL3) for the change in the length of each cylinder (step S210).
In a case where the current length change (ΔL1r, ΔL2r, ΔL3r) of each cylinder reaches the target value (ΔL1, ΔL2, ΔL3) for the change in the length of each cylinder (in case of “YES” in step S210), the controller 100 ends the processing shown in
By the above processing, the controller 100 can change the rotation angle (α, β, γ) of the drawbar 12 to correspond to the operation input (change (Δαj, Δβj, Δγj) of the rotation angle (αj, βj, γj)) to the lever 32L of the joy stick 32. In this case, the drawbar 12 moves in the same direction as the lever rotation operation by the operator.
In the controller 100 (S403), the amounts of the extension and retraction ΔL1, ΔL2, and ΔL3 of the right blade lift cylinder 15, the left blade lift cylinder 16, and the drawbar shift cylinder 17 are further calculated based on the current drawbar rotation angle (α, β, γ), the drawbar rotation angle target value (Δα, Δβ, Δγ), and the cylinder length (L1, L2, L3) (406).
Next, as the operation of the cylinder and work equipment (8408), the hydraulic valve control of the right blade lift cylinder 15, the left blade lift cylinder 16, and the drawbar shift cylinder 17 is performed based on the amounts of the extension and retraction ΔL1, ΔL2, and ΔL3 (S409). Here, the extension and retraction of the right blade lift cylinder (8410), the extension and retraction of the left blade lift cylinder (8411), and the extension and retraction of the drawbar shift cylinder (8412) are performed to rotate the drawbar 12 (S413). In addition, the current rotation angle is newly detected by the drawbar rotation angle meter 36 (S414). In addition, the current cylinder length (L1, L2, L3) is newly detected by the cylinder length meter 37 (S415).
The processing in the block S416 is executed in a shorter cycle than the processing in the block 8407.
By the above processing, the control system 300 can change the rotation angle (α, β, γ) of the drawbar 12 to correspond to the operation input (change (Δαj, Δβj, Δγj) of the rotation angle (αj, βj, γj)) to the lever 32L of the joy stick 32. In this case, the drawbar 12 moves in the same direction as the lever rotation operation by the operator.
<Operation Example of Motor Grader>
Next, an operation example of the motor grader 1 will be described with reference to
In a case where the traveling posture is set using the three operation levers that operate the cylinder lengths of the right blade lift cylinder 15, the left blade lift cylinder 16, and the drawbar shift cylinder 17, operations, which adjust a tilt by the drawbar shift cylinder 17 since the drawbar 12 tilts when the drawbar 12 is slightly lifted by the right blade lift cylinder 15 and the left blade lift cylinder 16, and adjust a tilt by the drawbar shift cylinder 17 since the drawbar 12 tilts when the drawbar 12 is slightly lifted by the right blade lift cylinder 15 and the left blade lift cylinder 16, need to be repeated multiple times.
In a case where the trenching posture is set using the three operation levers that operate the cylinder lengths of the right blade lift cylinder 15, the left blade lift cylinder 16, and the drawbar shift cylinder 17, when lifting the drawbar 12, operations, which adjust a tilt by the drawbar shift cylinder 17 since the drawbar 12 tilts when the drawbar 12 is slightly lifted by the right blade lift cylinder 15 and the left blade lift cylinder 16, and adjust a tilt by the drawbar shift cylinder 17 since the drawbar 12 tilts when the drawbar 12 is slightly lifted by the right blade lift cylinder 15 and the left blade lift cylinder 16, need to be repeated multiple times.
In a case where achieving a shoulder reach maximum (MAX) using three operation levers that operate each cylinder length of the right blade lift cylinder 15, the left blade lift cylinder 16, and the drawbar shift cylinder 17, (1) first, the drawbar 12 is lifted to some extent by the right blade lift cylinder 15 and the left blade lift cylinder 16 (it is because the right side of the drawbar 12 is lowered by the operation (2)). (2) the drawbar shift cylinder 17 is used for maximum extension. (3) since the drawbar 12 tilts, the left side is lowered to adjust the drawbar 12 horizontal using the left blade lift cylinder 16. (4) the blade 14 is installed on the ground and the height thereof is adjusted using the right blade lift cylinder 15 and the left blade lift cylinder 16. (5) next, the blade 14 is slid to the right using the blade shift cylinder 24. The operation is complicated as compared with the present embodiment.
In a case where the ground leveling work posture is set by using the three operation levers that operate each cylinder length of the right blade lift cylinder 15, the left blade lift cylinder 16, and the drawbar shift cylinder 17, (1) first, the operator checks the ground leveling depth by the visual inspection, (2) lowers the drawbar 12 in parallel using the right blade lift cylinder 15 and the left blade lift cylinder 16, (3) lifts the left side using the left blade lift cylinder 16 to adjust the drawbar 12 to be parallel, for example, in a case where the left side is lowered too much, and (4) transitions to the visual inspection of the ground leveling. The operation is complicated as compared with the present embodiment.
Hitherto, the embodiment of the present invention has been described with reference to the drawings. However, a specific configuration is not limited to the above-described embodiment, and includes a design change within the scope not departing from the concept of the present invention. In addition, programs executed by a computer in the above-described embodiment can be partially or entirely distributed via a computer-readable recording medium or a communication line.
As described above, the controller 100 of the present embodiment is a control device that controls a drawbar attached to a main frame of a grader, in which a movement of the drawbar is generated by at least three actuators, and the control device controls, based on an output signal from one operation lever having at least three degrees of freedom, the plurality of actuators such that a movement of the one operation lever corresponds to the movement of the drawbar. The drawbar is restrained by the main frame and one ball shaft, and the axial rotation of the operation lever corresponds to the axial rotation of the drawbar about the ball shaft. Further, the operation lever includes an operation unit that operates a movement of a blade attached to the drawbar. In addition, in a case where the operation unit is slid left or right, the blade is slid left or right. In addition, the tilt of the operation lever corresponds to the tilt of the drawbar. In addition, the control system 300 of the present embodiment is an operation device including the control device and the operation lever. The motor grader 1 of the present embodiment is a work vehicle including a main frame, a drawbar attached to the main frame and restrained to the main frame by a ball shaft, three actuators attached to the main frame to determine a posture of the drawbar, one operation lever operated by an operator, and a control device that controls the actuators based on an output signal from the operation lever, in which the control device controls the actuators such that a movement of the operation lever corresponds to the movement of the drawbar.
According to each of these aspects, the operation can be simplified.
According to each aspect of the present invention, an operation can be simplified.
Number | Date | Country | Kind |
---|---|---|---|
2021-060559 | Mar 2021 | JP | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2022/014222 | 3/25/2022 | WO |