WO2021065136A1 - 制御システム、作業車両の制御方法、および、作業車両 - Google Patents
制御システム、作業車両の制御方法、および、作業車両 Download PDFInfo
- Publication number
- WO2021065136A1 WO2021065136A1 PCT/JP2020/026509 JP2020026509W WO2021065136A1 WO 2021065136 A1 WO2021065136 A1 WO 2021065136A1 JP 2020026509 W JP2020026509 W JP 2020026509W WO 2021065136 A1 WO2021065136 A1 WO 2021065136A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- work vehicle
- steering
- control
- motor grader
- steering mechanism
- Prior art date
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D6/00—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
- B62D6/007—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits adjustable by the driver, e.g. sport mode
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D1/00—Steering controls, i.e. means for initiating a change of direction of the vehicle
- B62D1/02—Steering controls, i.e. means for initiating a change of direction of the vehicle vehicle-mounted
- B62D1/04—Hand wheels
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01B—SOIL WORKING IN AGRICULTURE OR FORESTRY; PARTS, DETAILS, OR ACCESSORIES OF AGRICULTURAL MACHINES OR IMPLEMENTS, IN GENERAL
- A01B69/00—Steering of agricultural machines or implements; Guiding agricultural machines or implements on a desired track
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D12/00—Steering specially adapted for vehicles operating in tandem or having pivotally connected frames
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D5/00—Power-assisted or power-driven steering
- B62D5/06—Power-assisted or power-driven steering fluid, i.e. using a pressurised fluid for most or all the force required for steering a vehicle
- B62D5/061—Power-assisted or power-driven steering fluid, i.e. using a pressurised fluid for most or all the force required for steering a vehicle provided with effort, steering lock, or end-of-stroke limiters
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D5/00—Power-assisted or power-driven steering
- B62D5/06—Power-assisted or power-driven steering fluid, i.e. using a pressurised fluid for most or all the force required for steering a vehicle
- B62D5/065—Power-assisted or power-driven steering fluid, i.e. using a pressurised fluid for most or all the force required for steering a vehicle characterised by specially adapted means for varying pressurised fluid supply based on need, e.g. on-demand, variable assist
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D5/00—Power-assisted or power-driven steering
- B62D5/06—Power-assisted or power-driven steering fluid, i.e. using a pressurised fluid for most or all the force required for steering a vehicle
- B62D5/10—Power-assisted or power-driven steering fluid, i.e. using a pressurised fluid for most or all the force required for steering a vehicle characterised by type of power unit
- B62D5/12—Piston and cylinder
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D5/00—Power-assisted or power-driven steering
- B62D5/06—Power-assisted or power-driven steering fluid, i.e. using a pressurised fluid for most or all the force required for steering a vehicle
- B62D5/20—Power-assisted or power-driven steering fluid, i.e. using a pressurised fluid for most or all the force required for steering a vehicle specially adapted for particular type of steering gear or particular application
- B62D5/26—Power-assisted or power-driven steering fluid, i.e. using a pressurised fluid for most or all the force required for steering a vehicle specially adapted for particular type of steering gear or particular application for pivoted axles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D6/00—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
- B62D6/001—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits the torque NOT being among the input parameters
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/76—Graders, bulldozers, or the like with scraper plates or ploughshare-like elements; Levelling scarifying devices
- E02F3/7636—Graders with the scraper blade mounted under the tractor chassis
- E02F3/764—Graders with the scraper blade mounted under the tractor chassis with the scraper blade being pivotable about a vertical axis
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/76—Graders, bulldozers, or the like with scraper plates or ploughshare-like elements; Levelling scarifying devices
- E02F3/80—Component parts
- E02F3/84—Drives or control devices therefor, e.g. hydraulic drive systems
- E02F3/841—Devices for controlling and guiding the whole machine, e.g. by feeler elements and reference lines placed exteriorly of the machine
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/08—Superstructures; Supports for superstructures
- E02F9/0841—Articulated frame, i.e. having at least one pivot point between two travelling gear units
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/2025—Particular purposes of control systems not otherwise provided for
- E02F9/2045—Guiding machines along a predetermined path
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/2058—Electric or electro-mechanical or mechanical control devices of vehicle sub-units
- E02F9/2087—Control of vehicle steering
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/22—Hydraulic or pneumatic drives
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/22—Hydraulic or pneumatic drives
- E02F9/225—Control of steering, e.g. for hydraulic motors driving the vehicle tracks
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/26—Indicating devices
Definitions
- This disclosure relates to a control system, a work vehicle control method, and a work vehicle.
- Patent Document 1 discloses a motor grader provided with an automatic steering system.
- the automatic steering system is a route generation device that generates a vehicle movement route based on a vehicle position data, a map of a work site, or a parameter indicating a vehicle movement condition, and a route generated by a route shaping device. It has a route tracking device that guides the vehicle along the route.
- an object of the present disclosure is to provide a control system, a work vehicle control method, and a work vehicle that realize a driving assist system in which the burden on the operator is sufficiently reduced.
- the control system is a control system that controls the steering mechanism of the work vehicle.
- the control system includes a control unit.
- the control unit generates a travel route of the work vehicle based on the position and orientation of the work vehicle and the traveling direction of the work vehicle, and causes the work vehicle to travel along the generated travel route. Control the steering mechanism.
- the work vehicle control method is a work vehicle control method including a steering mechanism.
- the control method of the work vehicle is to generate a travel route of the work vehicle based on the position and orientation of the work vehicle and the traveling direction of the work vehicle, and to travel along the generated travel route. It also includes a step to control the steering mechanism.
- the work vehicle according to the present disclosure is provided with a steering mechanism and a control unit.
- the control unit generates a travel route of the work vehicle based on the position and orientation of the work vehicle and the traveling direction of the work vehicle, and the steering mechanism so that the work vehicle travels along the generated travel route. To control.
- FIG. It is a perspective view which shows the motor grader in Embodiment 1.
- FIG. It is a side view which shows the motor grader in FIG.
- It is a system diagram which shows the structure which concerns the steering of a motor grader in FIG.
- It is a block diagram which shows the structure which concerns on the operation assist system of the motor grader in FIG.
- It is a top view which shows typically the motor grader which starts the automatic steering control at the time of turning.
- It is a top view which shows the traveling path generated by the motor grader in FIG.
- It is a top view which shows typically the motor grader which starts the steering automatic control when going straight.
- It is a top view which shows the behavior of a motor grader when a load is applied to a blade.
- FIG. 6 is a system diagram showing a configuration related to the steering of the bulldozer in FIG. It is a block diagram which shows the structure which concerns on the driving assist system of the bulldozer in FIG.
- FIG. 1 is a perspective view showing a motor grader according to the first embodiment.
- FIG. 2 is a side view showing the motor grader in FIG.
- the motor grader 100 is a work machine that performs ground leveling work and snow removal work while traveling.
- the motor grader 100 includes a front frame 14, a rear frame 15, a pair of articulated cylinders 28, a cab 11 provided with a driver's seat, an engine chamber 13, front wheels 16, rear wheels 17, and a working machine 12. Have.
- the front-rear direction is the front-rear direction of the operator seated in the driver's seat in the cab 11.
- the front direction of the operator seated in the driver's seat is the front
- the back direction of the operator seated in the driver's seat is the rear.
- the left-right direction is the left-right direction of the operator seated in the driver's seat.
- the right side when the operator seated in the driver's seat faces the front is the right side
- the left side when the operator seated in the driver's seat faces the front is the left side.
- the vertical direction is a direction orthogonal to a plane including a front-back direction and a left-right direction.
- the side with the ground is the lower side
- the side with the sky is the upper side.
- the front frame 14 and the rear frame 15 constitute the vehicle body frame 18 of the motor grader 100.
- the front frame 14 is provided in front of the rear frame 15.
- the front frame 14 is rotatably connected to the rear frame 15 around the rotation center 121.
- the front frame 14 is rotatably connected to the rear frame 15 by a center pin (not shown) provided on the axis of the rotation center 121.
- the rotation center 121 is an axis extending along the vertical direction.
- the rotation center 121 is located at the center of the motor grader 100 in the left-right direction.
- the front frame 14 extends forward from the rotation center 121.
- the front frame 14 has a base end portion 14p rotatably connected to the rear frame 15 and a tip end portion 14q provided on the side opposite to the base end portion 14p.
- the rear frame 15 extends rearward from the rotation center 121.
- a pair of articulated cylinders 28 are provided on both the left and right sides of the front frame 14.
- the articulated cylinder 28 is a hydraulic cylinder that is driven to expand and contract by hydraulic pressure.
- the articulated cylinder 28 is rotatably connected to the front frame 14 at one end in the telescopic direction and rotatably connected to the rear frame 15 at the other end in the telescopic direction. Due to the expansion / contraction drive of the articulate cylinder 28, the front frame 14 rotates about the rotation center 121 with respect to the rear frame 15.
- the cab 11 is mounted on the rear frame 15.
- the cab 11 forms an indoor space for the operator to board.
- the cab 11 includes a steering handle 41 and a steering lever 42 for steering operation (see FIG. 3 below), a plurality of levers for operating the work equipment 12, and various displays. Equipment etc. are provided.
- the cab 11 may be mounted on the front frame 14.
- the engine chamber 13 is provided behind the cab 11.
- the engine chamber 13 is supported by the rear frame 15.
- the engine is housed in the engine chamber 13.
- the front wheels 16 and the rear wheels 17 are traveling wheels.
- the front wheels 16 are rotatably attached to the front frame 14.
- the front wheel 16 is steerably attached to the front frame 14.
- the front wheels 16 move left and right so that the angle formed with respect to the front-rear direction changes.
- the front wheel 16 is a steering wheel.
- the rear wheel 17 is rotatably attached to the rear frame 15.
- the driving force from the engine is transmitted to the rear wheels 17.
- a total of six traveling wheels including two front wheels 16 having one wheel on each side and four rear wheels 17 having two wheels on each side are shown. The number and arrangement are not limited to this.
- the work machine 12 is provided between the front wheels 16 and the rear wheels 17 in the front-rear direction.
- the working machine 12 is supported by the front frame 14.
- the working machine 12 has a blade 21, a drawbar 22, a swivel circle 23, and a pair of lift cylinders 25.
- the drawbar 22 is provided below the front frame 14.
- the front end portion of the drawbar 22 is swingably connected to the tip end portion 14q of the front frame 14.
- the pair of lift cylinders 25 are provided on both the left and right sides of the front frame 14.
- the rear end of the drawbar 22 is supported by the front frame 14 via a pair of lift cylinders 25.
- the rear end of the drawbar 22 can be raised and lowered with respect to the front frame 14 by expanding and contracting the pair of lift cylinders 25.
- the height of the blade 21 with respect to the front frame 14 and the front wheel 16 is adjusted upward by shortening the drive of the pair of lift cylinders 25 together.
- the height of the blade 21 with respect to the front frame 14 and the front wheel 16 is adjusted downward by the extension drive of the pair of lift cylinders 25 together.
- the drawbar 22 can swing up and down about an axis along the front-rear direction due to different expansion and contraction of the pair of lift cylinders 25.
- the swivel circle 23 is provided below the drawbar 22.
- the swivel circle 23 is rotatably connected to the drawbar 22.
- the swivel circle 23 can swivel clockwise and counterclockwise about an axis along the vertical direction.
- the blade 21 is provided below the swivel circle 23.
- the blade 21 is provided so as to face the ground.
- the blade 21 is supported by the swivel circle 23.
- the blade 21 turns so that the angle (blade propulsion angle) formed by the blade 21 changes in the front-rear direction in the top view as the turning circle 23 turns.
- the swivel axis of the blade 21 is an axis extending along the vertical direction.
- FIG. 3 is a system diagram showing a configuration related to steering of the motor grader in FIG.
- the motor grader 100 further includes a steering mechanism 66, a control unit 51, and an operation unit 67.
- the steering mechanism 66 is a mechanism for operating the traveling direction of the motor grader 100.
- the control unit 51 controls the steering of the motor grader 100.
- the control unit 51 controls the operation of the steering mechanism 66.
- the operation unit 67 is provided in the cab 11.
- the operation unit 67 is operated by an operator to operate the steering mechanism 66.
- the operation unit 67 has a steering handle 41 and a steering lever 42.
- the steering handle 41 is provided in front of the driver's seat in the cab 11.
- the steering handle 41 is, for example, a wheel-shaped steering wheel, which is rotated by an operator.
- the steering lever 42 is provided at a position away from the steering handle 41.
- the steering lever 42 is provided, for example, on the side of the driver's seat in the cab 11.
- the steering lever 42 is tilted by the operator.
- the motor grader 100 further includes an electrofluid pressure control valve 73.
- the operation unit 67 further includes a track valve 71.
- the steering mechanism 66 has a steering valve 72 and a steering cylinder 36.
- the magnetohydrodynamic pressure control valve 73 supplies pressure oil to the steering valve 72.
- the control unit 51 controls the magnetohydrodynamic pressure control valve 73 based on the operation signal from the steering lever 42.
- the raceway valve 71 supplies pressure oil to the steering valve 72 in response to the rotation operation of the steering handle 41.
- the steering valve 72 supplies pressure oil to the steering cylinder 36.
- the steering valve 72 is controlled by the pressure oil supplied from the magnetohydrodynamic pressure control valve 73 and the raceway valve 71.
- the steering cylinder 36 operates the front wheels 16 to the left and right so as to change the angle formed by the front wheels 16 with respect to the front-rear direction by the pressure oil from the steering valve 72.
- the motor grader 100 turns while drawing an arc toward the left front.
- the motor grader 100 turns while drawing an arc toward the front right.
- FIG. 4 is a block diagram showing a configuration related to the operation assist system of the motor grader in FIG. As shown in FIGS. 2 to 4, the control unit 51 controls the operation of the operation assist system of the motor grader 100 described below.
- the motor grader 100 further includes a handle sensor 31 and a lever sensor 32.
- the steering wheel sensor 31 detects the operation of the steering wheel 41.
- the lever sensor 32 detects the operation of the steering lever 42.
- the steering wheel sensor 31 generates an operation signal when the operation of the steering wheel 41 by the operator is detected, and outputs the operation signal to the control unit 51.
- the steering wheel sensor 31 is, for example, a shaft displacement sensor that detects an angular displacement of the steering handle shaft generated by the rotation of the steering handle 41.
- the lever sensor 32 detects the operation of the steering lever 42 by the operator, the lever sensor 32 generates an operation signal and outputs the operation signal to the control unit 51.
- the lever sensor 32 is, for example, a position sensor that detects the angular position of the steering lever 42.
- the steering wheel sensor 31 may have a dead zone so as not to generate an operation signal when the amount of rotation operation of the steering handle 41 is very small.
- the lever sensor 32 may have a dead zone so as not to generate an operation signal when the tilting operation amount of the steering lever 42 is very small. As an example, it is determined that the amount of operation of the steering handle 41 or the steering lever 42 when the steering angle of the front wheels 16 described later changes within ⁇ 0.5 ° is very small.
- the motor grader 100 further includes a first detection unit 61 and a second detection unit 62.
- the first detection unit 61 detects information regarding the position and orientation of the motor grader 100.
- the second detection unit 62 detects information regarding the traveling direction of the motor grader 100.
- the first detection unit 61 has a GNSS (Global Navigation Satellite System) receiver 35.
- the GNSS receiver 35 is, for example, a receiver for GPS (Global Positioning System).
- the antenna 35g of the GNSS receiver 35 (see FIG. 2) is arranged, for example, on the ceiling of the cab 11.
- the GNSS receiver 35 receives a positioning signal from the satellite, calculates the position of the antenna 35g based on the positioning signal, and generates vehicle body position data.
- the GNSS receiver 35 outputs the position and orientation data of the motor grader 100 to the control unit 51.
- the second detection unit 62 has a steering angle sensor 33 and an articulated angle sensor 34.
- the steering angle sensor 33 detects the steering angle of the front wheels 16 (the angle formed by the front wheels 16 with respect to the front-rear direction), and generates a signal of the detected steering angle.
- the steering angle sensor 33 outputs a steering angle signal to the control unit 51.
- the articulated angle sensor 34 detects the articulated angle (connection angle) between the front frame 14 and the rear frame 15, and generates a signal of the detected articulated angle.
- the articulated angle sensor 34 outputs a signal of the articulated angle to the control unit 51.
- control unit 51 sets the position and orientation of the motor grader 100 and the traveling direction of the motor grader 100 when a trigger for starting the automatic control of the steering mechanism 66 is input. Based on this, the traveling path of the motor grader 100 is generated, and the steering mechanism 66 is controlled so that the motor grader 100 travels along the generated traveling path.
- the control unit 51 starts controlling the steering mechanism 66 when the operation of the operation unit 67 is stopped.
- the control unit 51 stops the control of the steering mechanism 66 when the operation of the operation unit 67 is resumed.
- the control unit 51 includes a trigger output unit 52, an automatic control command unit 58, and a steering control unit 54.
- the trigger output unit 52 controls the steering mechanism 66 based on the operation signal of the steering handle 41 from the handle sensor 31 and / or the operation signal of the steering lever 42 from the lever sensor 32 (automatic steering control described later). Outputs a trigger to start or stop.
- the trigger output unit 52 is a trigger for stopping the automatic steering control when an operation signal of the steering handle 41 from the handle sensor 31 or an operation signal of the steering lever 42 from the lever sensor 32 is input (described later). Stop trigger) is output.
- the trigger output unit 52 is a trigger for starting automatic steering control when the operation signal of the steering handle 41 from the handle sensor 31 and the operation signal of the steering lever 42 from the lever sensor 32 are not input (described later). Start trigger) is output.
- the automatic control command unit 58 includes a vehicle position / direction acquisition unit 56, a traveling direction specifying unit 55, and a route generation unit 53.
- the vehicle position / direction acquisition unit 56 acquires the position and direction data of the motor grader 100 from the GNSS receiver 35.
- the position data of the motor grader 100 acquired by the vehicle position / direction acquisition unit 56 is the position of the motor grader 100 defined in the global coordinate system.
- the direction data of the motor grader 100 acquired by the vehicle position / direction acquisition unit 56 is, for example, the direction corresponding to the front of the motor grader 100.
- the steering angle signal from the steering angle sensor 33 and the articulating angle signal from the articulating angle sensor 34 are input to the traveling direction specifying unit 55.
- the traveling direction specifying unit 55 specifies the traveling direction of the motor grader 100 based on the input steering angle and articulation angle.
- the traveling direction of the work vehicle may be specified only based on the steering angle of the front wheels provided on the vehicle body frame.
- the route generation unit 53 is specified by the traveling direction specifying unit 55 and the position and direction data of the motor grader 100 acquired by the vehicle position / direction acquiring unit 56 when the start trigger from the trigger output unit 52 is input.
- a traveling path of the motor grader 100 is generated based on the traveling direction of the motor grader 100.
- the steering control unit 54 controls the steering mechanism 66 so that the motor grader 100 travels along the travel path generated by the route generation unit 53. Specifically, the steering control unit 54 outputs a control signal to the magnetohydrodynamic pressure control valve 73 so that the motor grader 100 travels along the travel path generated by the route generation unit 53.
- the magnetohydrodynamic pressure control valve 73 supplies pressure oil to the steering valve 72 based on a signal from the steering control unit 54 to control the steering cylinder 36 (start of automatic steering control).
- the operation signal of the steering handle 41 from the handle sensor 31 or the operation signal of the steering lever 42 from the lever sensor 32 is input to the trigger output unit 52.
- the trigger output unit 52 outputs a stop trigger.
- the automatic control command unit 58 receives the stop trigger from the trigger output unit 52 and stops the automatic steering control.
- FIG. 5 is a top view schematically showing a motor grader in which automatic steering control is started when turning.
- FIG. 6 is a top view showing a traveling path generated by the motor grader in FIG.
- the steering handle 41 is used as the operation unit 67 for operating the front wheels 16 in FIGS. 5 and 6 and FIG. 7 described later, and the front frame is also used.
- the position where the motor grader 100 is indicated on the motor grader 100A, the motor grader 100B, the motor grader 100C and the motor grader 100D (hereinafter, "position 100A”, “position 100B", “position” It travels so as to move in order (referred to as “100C” and “position 100D”, respectively).
- the operator While the motor grader 100 moves from the position 100A to the position 100B, the operator is driving the motor grader 100 by operating the steering handle 41. During this time, the operation signal of the steering wheel 41 from the steering wheel sensor 31 is input to the trigger output unit 52.
- the trigger output unit 52 outputs a stop trigger.
- the automatic control command unit 58 receives the stop trigger from the trigger output unit 52, and the automatic steering control is not started.
- the operator While the motor grader 100 moves from the position 100B to the position 100C, the operator operates the steering handle 41 to turn the motor grader 100 toward the front right. During this time, the operation signal of the steering wheel 41 from the steering wheel sensor 31 is input to the trigger output unit 52.
- the trigger output unit 52 outputs a stop trigger.
- the automatic control command unit 58 receives the stop trigger from the trigger output unit 52, and the automatic steering control is not started.
- the operator is not operating the steering handle 41 while the motor grader 100 moves from position 100C to position 100D. During this time, the operation signal of the steering wheel 41 from the steering wheel sensor 31 is not input to the trigger output unit 52.
- the trigger output unit 52 outputs a start trigger.
- the automatic control command unit 58 receives the start trigger from the trigger output unit 52, and the automatic steering control is started.
- the trigger output unit 52 outputs the start trigger.
- the vehicle position / direction acquisition unit 56 receives the start trigger from the GNSS receiver 35, the position of the motor grader 100 indicated by the coordinates (X, Y), and the motor grader 100 indicated by the arrow 200. To get the orientation of.
- the traveling direction specifying unit 55 specifies the traveling direction (turning direction) of the motor grader 100 based on the steering angle ⁇ s detected by the steering angle sensor 33.
- the route generation unit 53 of the motor grader 100 is based on the position and direction of the motor grader 100 acquired by the vehicle position / direction acquisition unit 56 and the traveling direction of the motor grader 100 specified by the traveling direction specifying unit 55. Generate a traveling path 210.
- the travel path 210 starts from the position of the motor grader 100 acquired by the vehicle position / orientation acquisition unit 56, and uses the motor grader 100 as a reference based on the direction of the motor grader 100 acquired by the vehicle position / orientation acquisition unit 56. This is a path for turning in the traveling direction specified by the traveling direction specifying unit 55.
- the traveling path 210 is a path for turning the motor grader 100 with a constant radius of curvature r corresponding to the steering angle ⁇ s.
- the steering control unit 54 uses the travel path 210 of the motor grader 100 generated by the route generation unit 53. It is compared with the position of the motor grader 100 which is acquired every moment by the vehicle position / direction acquisition unit 56. As shown by the motor grader 100E in FIG. 5, the steering control unit 54 determines the motor grader when a deviation of more than a predetermined threshold value occurs between the traveling path 210 and the position of the motor grader 100. The steering cylinder 36 is controlled so that the position of 100 returns to the traveling path 210.
- the steering control unit 54 stops the automatic steering control, and the trigger output unit 52 receives the operation signal from the steering wheel sensor 31. If the operation signal of the steering wheel 41 is not input, the automatic steering control is restarted.
- the route generation unit 53 generates a new travel route based on the position and direction of the motor grader 100 at that time and the traveling direction of the motor grader 100.
- FIG. 7 is a top view schematically showing a motor grader in which automatic steering control is started when the vehicle goes straight.
- the motor grader 100 has the positions indicated on the motor grader 100S, the motor grader 100T, and the motor grader 100U (hereinafter, "position 100S”, “position 100T”, and “position 100U”, respectively. It runs so as to move in order.
- the operator While the motor grader 100 moves from the position 100S to the position 100T, the operator is driving the motor grader 100 by operating the steering handle 41. During this time, the operation signal of the steering wheel 41 from the steering wheel sensor 31 is input to the trigger output unit 52.
- the trigger output unit 52 outputs a stop trigger.
- the automatic control command unit 58 receives the stop trigger from the trigger output unit 52, and the automatic steering control is not started.
- the operator is not operating the steering handle 41 while the motor grader 100 moves from position 100T to position 100U. During this time, the operation signal of the steering wheel 41 from the steering wheel sensor 31 is not input to the trigger output unit 52.
- the trigger output unit 52 outputs a start trigger.
- the automatic control command unit 58 receives the start trigger from the trigger output unit 52, and the automatic steering control is started.
- the trigger output unit 52 outputs the start trigger.
- the vehicle position / direction acquisition unit 56 acquires the position and direction of the motor grader 100 from the GNSS receiver 35.
- the route generation unit 53 of the motor grader 100 is based on the position and direction of the motor grader 100 acquired by the vehicle position / direction acquisition unit 56 and the traveling direction of the motor grader 100 specified by the traveling direction specifying unit 55. Generate a traveling path 220.
- the travel path 220 starts from the position of the motor grader 100 acquired by the vehicle position / orientation acquisition unit 56, and uses the motor grader 100 as a reference based on the direction of the motor grader 100 acquired by the vehicle position / orientation acquisition unit 56. This is a route for traveling straight in the traveling direction specified by the traveling direction specifying unit 55.
- the steering control unit 54 acquires the traveling path 220 of the motor grader 100 generated by the route generation unit 53 and the vehicle position / direction acquisition unit 56 every moment. Compare with the position of the motor grader 100. As shown in the motor grader 100V in FIG. 6, the steering control unit 54 determines the motor grader 100 when a deviation of more than a predetermined threshold value occurs between the traveling path 220 and the position of the motor grader 100. The steering cylinder 36 is controlled so that the position of is returned to the traveling path 220.
- FIG. 8 is a top view showing the behavior of the motor grader when a load is applied to the blade.
- the blade 21 is used at an angle with respect to the left-right direction in order to bring the deposit 160 such as earth and sand or snow toward the side of the motor grader 100.
- the traveling direction of the motor grader 100 shifts to the side, or the load from the deposit 160 changes, so that the traveling direction of the motor grader 100 shifts to the left and right. It shakes.
- the work vehicle is not limited to the motor grader 100, and generally travels on the ground having an uneven shape, so that the traveling direction of the work vehicle tends to shift.
- the operator in order to adjust the traveling direction of the motor grader 100, the operator must also operate the operating lever of the working machine 12 while operating the steering handle 41 or the steering lever 42 or performing the leaning operation. ..
- Such work requires a high level of skill and concentration, which imposes an excessive burden on the operator.
- the motor grader 100 when a trigger for starting the automatic steering control is input to the automatic control command unit 58, it is based on the position and orientation of the motor grader 100 and the traveling direction of the motor grader 100. Then, the traveling path of the motor grader 100 is generated, and the steering is automatically controlled so that the motor grader 100 travels along the generated traveling path.
- the operator can concentrate on the operation of the work machine 12 without performing the operation for adjusting the traveling direction of the motor grader 100 while the automatic steering control is executed. Further, since the traveling path of the motor grader 100 is automatically generated based on the position and orientation of the motor grader 100 and the traveling direction of the motor grader 100, the operator can input a map of the work site in advance. , There is no need to input various parameters related to the traveling route. Therefore, it is possible to realize a driving assist system in which the burden on the operator is sufficiently reduced.
- control unit 51 starts automatic steering control when the operations of the steering handle 41 and the steering lever 42 are stopped.
- the operator does not need to perform a special operation to start the automatic steering control, so that the burden on the operator can be further reduced.
- control unit 51 stops the automatic steering control when the operation of the steering handle 41 or the steering lever 42 is restarted.
- the operator can drive the motor grader 100 in the intended direction through the operation of the steering handle 41 or the steering lever 42.
- FIG. 9 is a graph showing the relationship between the steering angle of the front wheels and the turning curvature of the motor grader during automatic steering control.
- the traveling direction specifying portion 55 determines that the steering angle ⁇ s is 0 °. Judging, the traveling direction of the motor grader 100 may be specified in the straight-ahead direction.
- the magnitude of ⁇ s may be, for example, 1 ° or 1.5 °.
- FIG. 10 is a timing chart showing the mutual timing relationship between steering wheel operation, travel path generation, and automatic steering control.
- control unit 51 may start the automatic steering control after the operation of the steering handle 41 and the steering lever 42 has been stopped for a predetermined period of time.
- the control unit 51 may generate a traveling path of the motor grader 100 during the predetermined period.
- the steering control unit 54 starts automatic steering control.
- the length from time t1 to time t2 is, for example, in the range of 0.5 s or more and 1 s or less (0.5 s ⁇ (t2-t1) ⁇ 1 s).
- the length from time t1 to time t4 is, for example, in the range of 1s or more and 2s or less (1s ⁇ (t4-t1) ⁇ 2s).
- the automatic steering control is started after the operation of the steering handle 41 and the steering lever 42 is stopped for a predetermined period, so that the control unit 51 can move the steering handle 41 and the steering lever. It is possible to prevent the automatic steering control from being started in response to the stop of the operation of 42. Further, since the traveling path of the motor grader 100 is generated during a predetermined period from the stop of the operation of the steering handle 41 and the steering lever 42 to the start of the automatic steering control, the transition to the automatic steering control is smoothly performed. be able to.
- FIG. 11 is a flowchart showing a control method of the motor grader according to the first embodiment.
- the control unit 51 is set to the operation assist mode (S101).
- the driving assist mode is set, for example, by the operator turning on the mode setting switch provided in the cab 11.
- the steering wheel sensor 31 detects whether or not the steering wheel 41 is operated by the operator, and the lever sensor 32 detects whether or not the steering lever 42 is operated by the operator (S102).
- the operation signal of the steering handle 41 is input to the trigger output unit 52, and when the steering wheel sensor 31 does not detect the operation of the steering handle 41, the steering is steered.
- the operation signal of the handle 41 is not input to the trigger output unit 52.
- the lever sensor 32 detects the operation of the steering lever 42
- the operation signal of the steering lever 42 is input to the trigger output unit 52, and when the lever sensor 32 does not detect the operation of the steering lever 42, the operation of the steering lever 42 is performed.
- the signal is not input to the trigger output unit 52.
- the automatic control command unit 58 determines whether or not to start the automatic steering control (S103).
- step of S102 when the operation signal of the steering handle 41 from the handle sensor 31 or the operation signal of the steering lever 42 from the lever sensor 32 is input to the trigger output unit 52, the trigger output unit 52 is automatically controlled by the automatic control command unit. A stop trigger is output to 58. In this case, the automatic control command unit 58 determines that the automatic steering control is not started. Next, the process returns to step S102.
- step of S102 when the operation signal of the steering handle 41 from the handle sensor 31 and the operation signal of the steering lever 42 from the lever sensor 32 are not input to the trigger output unit 52, the trigger output unit 52 causes the automatic control command unit 58. Outputs a start trigger to. In this case, the automatic control command unit 58 determines that the automatic steering control is started (S103). Next, the process proceeds to step S104.
- the vehicle position / direction acquisition unit 56 specifies the position and direction of the motor grader 100, and the traveling direction specifying unit 55 specifies the traveling direction of the motor grader 100 (S104).
- the route generation unit 53 determines the position and direction of the motor grader 100 specified by the vehicle position / direction acquisition unit 56 and the traveling direction of the motor grader 100 specified by the traveling direction specifying unit 55. A traveling route of the grader 100 is generated (S105).
- the steering control unit 54 controls the magnetohydrodynamic pressure control valve 73 so that the motor grader 100 travels along the travel path generated by the route generation unit 53 (S106).
- the steering wheel sensor 31 detects the presence or absence of the operation of the steering handle 41 by the operator, and the lever sensor 32 detects the presence or absence of the operation of the steering lever 42 by the operator.
- the command unit 58 continuously executes the step of S108 for determining whether or not to stop the automatic steering control.
- the steering control unit 54 stops the automatic steering control (S109). After that, the process returns to the step of S102.
- FIG. 12 is a block diagram showing a modified example of the configuration related to the driving assist system in FIG. As shown in FIG. 12, in this modification, the motor grader 100 has a changeover switch 37.
- the changeover switch 37 is a switch for switching between starting (on) of automatic steering control and stopping (off) of automatic steering control.
- the changeover switch 37 is provided in the cab 11.
- the form of the changeover switch 37 is not particularly limited, and may be, for example, a push button or a lever.
- the changeover switch 37 may be provided in the touch panel of the monitor.
- a trigger for starting automatic steering control is input to the automatic control command unit 58. Subsequently, the generation of the traveling path of the motor grader 100 and the automatic steering control are executed in order.
- a stop trigger is input to the automatic control command unit 58, and the automatic steering control is stopped.
- the operator can start the automatic steering control at a timing intended by the operator.
- the motor grader 100 as a work vehicle includes a steering mechanism 66 and a control unit 51.
- the control unit 51 generates a traveling path of the motor grader 100 based on the position and orientation of the motor grader 100 and the traveling direction of the motor grader 100, so that the motor grader 100 travels along the generated traveling path.
- the steering mechanism 66 is controlled.
- the control unit 51 generates a traveling path of the motor grader 100 based on the position and orientation of the motor grader 100 and the traveling direction of the motor grader 100, and the motor grader 100 becomes the traveling path. Since the steering mechanism 66 is controlled so as to travel along the same direction, the operator is not required to perform complicated work. Therefore, it is possible to realize a driving assist system in which the burden on the operator is sufficiently reduced.
- control unit 51 of the motor grader 100 is based on the position and orientation of the motor grader 100 and the traveling direction of the motor grader 100 when a trigger for starting the control of the steering mechanism 66 is input.
- a traveling path is generated, and the steering mechanism 66 is controlled so that the motor grader 100 travels along the generated traveling path.
- control unit 51 can determine whether or not to start the control of the steering mechanism 66 based on a predetermined trigger.
- the motor grader 100 further includes a first detection unit 61 and a second detection unit 62.
- the first detection unit 61 detects information regarding the position and orientation of the motor grader 100.
- the second detection unit 62 detects information regarding the traveling direction of the motor grader 100.
- control unit 51 identifies the position and orientation of the motor grader 100 by using the information regarding the position and orientation of the motor grader 100 detected by the first detection unit 61, and the second detection unit 51.
- the traveling direction of the motor grader 100 can be specified by using the information regarding the traveling direction of the motor grader 100 detected by 62.
- the first detection unit 61 includes the GNSS receiver 35.
- the control unit 51 acquires the position and orientation of the motor grader 100 by the GNSS receiver 35.
- the global position and orientation of the motor grader 100 can be easily specified.
- the motor grader 100 further includes a front frame 14 and a rear frame 15.
- the front wheel 16 is provided on the front frame 14.
- the rear frame 15 is provided with a rear wheel 17.
- the rear frame 15 is rotatably connected to the front frame 14.
- the second detection unit 62 includes a steering angle sensor 33 and an articulated angle sensor 34.
- the steering angle sensor 33 detects the steering angle of the front wheels 16.
- the articulated angle sensor 34 detects the articulated angle between the front frame 14 and the rear frame 15.
- the control unit 51 specifies the traveling direction of the motor grader 100 based on the steering angle detected by the steering angle sensor 33 and the articulating angle detected by the articulating angle sensor 34.
- the traveling direction of the motor grader 100 including the steering mechanism of the front wheel 16 and the articulating mechanism of the front frame 14 and the rear frame 15 can be specified.
- the motor grader 100 further includes an operation unit 67.
- the operation unit 67 is operated to operate the steering mechanism 66.
- the control unit 51 starts controlling the steering mechanism 66 when the operation of the operation unit 67 is stopped.
- the operator's operation for starting the control of the steering mechanism 66 is unnecessary, so that the burden on the operator can be further reduced.
- control unit 51 may start the control of the steering mechanism 66 after the state in which the operation of the operation unit 67 is stopped is continued for a predetermined period.
- the control unit 51 may generate a traveling path of the motor grader 100 during the predetermined period.
- control unit 51 it is possible to prevent the control unit 51 from excessively reacting to the stop of the operation of the operation unit 67 and starting the control of the steering mechanism 66. Further, since the control unit 51 generates a traveling path of the motor grader 100 during a predetermined period from the stop of the operation of the operation unit 67 to the start of the control of the steering mechanism 66, the control of the steering mechanism 66 can be smoothly performed. Can be migrated.
- control unit 51 stops the control of the steering mechanism 66 when the operation of the operation unit 67 is resumed.
- the steering mechanism 66 is operated by the operation, so that the operator can move the motor grader 100 in the direction intended by the operator. it can.
- the motor grader 100 may include a changeover switch 37 as a switch for switching the start and stop of the control of the steering mechanism 66 by the control unit 51.
- the operator can start the control of the steering mechanism 66 by the control unit 51 at a timing intended by the operator.
- the control method of the motor grader 100 includes a step (S105) of generating a traveling path of the motor grader 100 based on the position and orientation of the motor grader 100 and the traveling direction of the motor grader 100, and the motor grader 100 is generated.
- a step (S106) for controlling the steering mechanism 66 is provided so as to travel along the traveling path.
- the generation step (S105) is based on the position and orientation of the motor grader 100 and the traveling direction of the motor grader 100 when a trigger for starting the control of the steering mechanism 66 is input. Includes a step to generate a travel path for.
- the motor grader 100 further includes a leaning mechanism that tilts the front wheels 16 to the left and right and an articulating mechanism that bends the front frame 14 and the rear frame 15 as steering mechanisms 66 that operate the traveling direction of the motor grader 100.
- the control of the steering mechanism 66 executed by the control unit 51 is not limited to the automatic steering control, but may be the automatic control of the leaning mechanism, the automatic control of the articulating mechanism, or the steering mechanism. It may be an automatic control of a plurality of leaning mechanisms and articulating mechanisms.
- the work vehicle and its control method in the present disclosure are not limited to the motor grader, and may be applied to various work vehicles such as wheel loaders, dump trucks, and bulldozers.
- the object of control by the control unit may be an articulated angle between a rotatably connected front frame and a rear frame.
- FIG. 13 is a diagram showing the concept of the control system of the steering mechanism of the motor grader.
- the motor grader 100 which is a work vehicle, includes the control unit 51 has been described, but as shown in FIGS. 3 and 13, the steering mechanism 66 of the motor grader is separated from the motor grader.
- the configuration may be controlled by a control unit and an operation unit provided at the same position.
- the control system that controls the steering mechanism 66 of the motor grader generates a traveling path of the motor grader based on the position and orientation of the motor grader and the traveling direction of the motor grader, and makes the traveling path generated by the motor grader.
- a control unit 251 that controls the steering mechanism 66 of the motor grader is provided so as to travel along the line.
- FIG. 14 is a perspective view showing a bulldozer.
- FIG. 15 is a system diagram showing a configuration related to the steering of the bulldozer in FIG.
- the bulldozer 300 has a vehicle body 311 and a working machine 313, and a pair of left and right traction devices 316 (316R, 316L).
- the vehicle body 311 is provided on a pair of left and right traction devices 316 (316R, 316L).
- the vehicle body 311 has a cab 341 and an engine chamber 342.
- the work machine 313 is provided in front of the vehicle body 311.
- the work machine 313 has a blade 318 for performing work such as excavation of earth and sand and leveling.
- the pair of left and right traction devices 316 are devices for running the bulldozer 300.
- the pair of left and right traction devices 316 (316R, 316L) have, for example, a track and a final deceleration device.
- the bulldozer 300 travels by rotationally driving a pair of left and right traction devices 316 (316R, 316L).
- the bulldozer 300 has a steering mechanism 66, a control unit 51, an operation unit 67, and a magnetohydrodynamic pressure control valve 73.
- the steering mechanism 66 has a drive device 331.
- the drive device 331 is a hydraulic motor that is operated by flood control.
- the drive device 331 can drive the right side traction device (first traction device) 316R and the left side traction device (second traction device) 316L independently of each other.
- the operation unit 67 has a steering lever 42.
- the magnetohydrodynamic pressure control valve 73 supplies pressure oil to the drive device 331.
- the control unit 51 controls the magnetohydrodynamic pressure control valve 73 based on the operation signal from the steering lever 42.
- the drive device 331 rotates the traction device 316R on the right side and the traction device 316L on the left side by the pressure oil from the magnetohydrodynamic pressure control valve 73.
- the bulldozer 300 goes straight.
- the bulldozer 300 turns to the left front.
- the bulldozer 300 turns to the right front.
- FIG. 16 is a block diagram showing a configuration related to the operation assist system of the bulldozer in FIG. As shown in FIGS. 15 and 16, the bulldozer 300 has a lever sensor 32. The lever sensor 32 detects the operation of the steering lever 42.
- the bulldozer 300 further includes a first detection unit 61 and a second detection unit 62.
- the first detection unit 61 has a GNSS receiver 35.
- the second detection unit 62 has a right speed sensor 321 and a left speed sensor 322.
- the right speed sensor 321 detects the rotation speed of the traction device 316R on the right side, and outputs a signal of the rotation speed of the detected traction device 316R to the control unit 51.
- the left speed sensor 322 detects the rotation speed of the left traction device 316L, and outputs a signal of the rotation speed of the detected traction device 316L to the control unit 51.
- control unit 51 includes a trigger output unit 52, an automatic control command unit 58, and a steering control unit 54.
- the trigger output unit 52 outputs a trigger for starting or stopping the control of the steering mechanism 66 based on the operation signal of the steering lever 42 from the lever sensor 32.
- the automatic control command unit 58 includes a vehicle position / direction acquisition unit 56, a traveling direction specifying unit 55, and a route generation unit 53.
- the vehicle position / direction acquisition unit 56 acquires the position and direction data of the bulldozer 300 from the GNSS receiver 35.
- the traveling direction specifying unit 55 identifies the traveling direction of the bulldozer 300 based on the rotation speed signal of the traction device 316R from the right speed sensor 321 and the rotation speed signal of the traction device 316L from the left speed sensor 322. ..
- the route generation unit 53 is specified by the traveling direction specifying unit 55 and the position and direction data of the bulldozer 300 acquired by the vehicle position / direction acquiring unit 56 when the start trigger from the trigger output unit 52 is input.
- the travel route of the bulldozer 300 is generated based on the traveling direction of the bulldozer 300.
- the steering control unit 54 controls the steering mechanism 66 so that the bulldozer 300 travels along the travel path generated by the route generation unit 53. Specifically, the steering control unit 54 outputs a control signal to the magnetohydrodynamic pressure control valve 73 so that the bulldozer 300 travels along the travel path generated by the route generation unit 53.
- the magnetohydrodynamic pressure control valve 73 supplies pressure oil to the drive device 331 based on a signal from the steering control unit 54, and controls the rotation speed of the traction device 316R on the right side and the rotation speed of the traction device 316L on the left side. ..
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Mining & Mineral Resources (AREA)
- Civil Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Structural Engineering (AREA)
- Transportation (AREA)
- Combustion & Propulsion (AREA)
- Chemical & Material Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Soil Sciences (AREA)
- Environmental Sciences (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Operation Control Of Excavators (AREA)
- Component Parts Of Construction Machinery (AREA)
- Steering Controls (AREA)
- Non-Deflectable Wheels, Steering Of Trailers, Or Other Steering (AREA)
- Power Steering Mechanism (AREA)
Abstract
作業車両であるモータグレーダは、操向機構(66)と、制御部(51)とを備える。制御部(51)は、モータグレーダの位置および方位と、モータグレーダの進行方向とに基づいて、モータグレーダの走行経路を生成し、モータグレーダが生成された走行経路に沿って走行するように、操向機構(66)を制御する。
Description
本開示は、制御システム、作業車両の制御方法、および、作業車両に関する。
たとえば、米国特許出願公報第2008/0208461号明細書(特許文献1)には、自動操向システムを備えたモータグレーダが開示されている。自動操向システムは、車両の位置データ、作業現場の地図、または、車両の移動条件を示すパラメータなどに基づいて、車両の移動経路を生成する経路生成装置と、経路成形装置によって生成された経路に沿って車両を案内する経路追跡装置とを有する。
特許文献1に開示されるモータグレーダでは、自動操向システムによって、ステアリングを操作するオペレータの負担を軽減しようとしている。しかしながら、オペレータは、予め車両の移動経路の生成に必要な各種情報を経路生成装置に入力しなければならないため、オペレータの負担が十分に軽減されているとはいえない。
そこで本開示の目的は、オペレータの負担が十分に軽減される運転アシストシステムを実現する制御システム、作業車両の制御方法、および、作業車両を提供することである。
本開示に従った制御システムは、作業車両の操向機構を制御する制御システムである。制御システムは、制御部を備える。制御部は、作業車両の位置および方位と、作業車両の進行方向とに基づいて、作業車両の走行経路を生成し、作業車両が生成された走行経路に沿って走行するように、作業車両の操向機構を制御する。
本開示に従った作業車両の制御方法は、操向機構を含む作業車両の制御方法である。作業車両の制御方法は、作業車両の位置および方位と、作業車両の進行方向とに基づいて、作業車両の走行経路を生成するステップと、作業車両が生成された走行経路に沿って走行するように、操向機構を制御するステップとを備える。
本開示に従った作業車両は、操向機構と、制御部とを備える。制御部は、作業車両の位置および方位と、作業車両の進行方向とに基づいて、作業車両の走行経路を生成し、作業車両が生成された走行経路に沿って走行するように、操向機構を制御する。
本開示に従えば、オペレータの負担が十分に軽減される運転アシストシステムを実現する制御システム、作業車両の制御方法、および、作業車両を提供することができる。
本開示の実施の形態について、図面を参照して説明する。なお、以下で参照する図面では、同一またはそれに相当する部材には、同じ番号が付されている。
(実施の形態1)
図1は、実施の形態1におけるモータグレーダを示す斜視図である。図2は、図1中のモータグレーダを示す側面図である。
図1は、実施の形態1におけるモータグレーダを示す斜視図である。図2は、図1中のモータグレーダを示す側面図である。
図1および図2に示されるように、モータグレーダ100は、走行しながら、整地作業を行なったり、除雪作業を行なったりする作業機械である。モータグレーダ100は、フロントフレーム14と、リアフレーム15と、一対のアーティキュレートシリンダ28と、運転席が設けられるキャブ11と、エンジン室13と、前輪16および後輪17と、作業機12とを有する。
以下の説明において、前後方向とは、キャブ11内の運転席に着座したオペレータの前後方向である。運転席に着座したオペレータの正面方向が、前方であり、運転席に着座したオペレータの背後方向が、後方である。左右方向とは、運転席に着座したオペレータの左右方向である。運転席に着座したオペレータが正面を向いたときの右側が、右方であり、運転席に着座したオペレータが正面を向いたときの左側が、左方である。上下方向とは、前後方向および左右方向を含む平面に直交する方向である。地面のある側が、下方であり、空のある側が、上方である。
フロントフレーム14およびリアフレーム15は、モータグレーダ100の車体フレーム18を構成している。フロントフレーム14は、リアフレーム15の前方に設けられている。
フロントフレーム14は、回動中心121を中心としてリアフレーム15に回動可能に連結されている。フロントフレーム14は、回動中心121の軸上に設けられたセンターピン(不図示)により、リアフレーム15に回動可能に連結されている。回動中心121は、上下方向に沿って延びる軸である。回動中心121は、左右方向におけるモータグレーダ100の中央に位置している。
フロントフレーム14は、回動中心121から前方に向けて延びている。フロントフレーム14は、リアフレーム15に回動可能に連結される基端部14pと、基端部14pとは反対側に設けられる先端部14qとを有する。リアフレーム15は、回動中心121から後方に向けて延びている。
一対のアーティキュレートシリンダ28は、フロントフレーム14を挟んで左右両側に設けられている。アーティキュレートシリンダ28は、油圧により伸縮駆動する油圧シリンダである。アーティキュレートシリンダ28は、伸縮方向における一方端において、フロントフレーム14に回動可能に連結され、伸縮方向における他方端において、リアフレーム15に回動可能に連結されている。アーティキュレートシリンダ28の伸縮駆動により、フロントフレーム14は、リアフレーム15に対して回動中心121を中心に回動する。
キャブ11は、リアフレーム15に載置されている。キャブ11は、オペレータが搭乗するための室内空間を形成している。キャブ11には、運転席に加えて、ステアリング操作のためのステアリングハンドル41およびステアリングレバー42(後出の図3を参照)、作業機12を操作するための複数のレバー、ならびに、各種の表示装置などが設けられている。なお、キャブ11は、フロントフレーム14に載置されてもよい。
エンジン室13は、キャブ11の後方に設けられている。エンジン室13は、リアフレーム15により支持されている。エンジン室13には、エンジンが収納されている。
前輪16および後輪17は、走行輪である。前輪16は、フロントフレーム14に回転可能に取り付けられている。前輪16は、フロントフレーム14に対して操向可能に取り付けられている。前輪16は、前後方向に対してなす角度が変化するように左右に動作する。前輪16は、操向輪である。後輪17は、リアフレーム15に回転可能に取り付けられている。後輪17には、エンジンからの駆動力が伝達される。なお、図1中には、片側1輪ずつの2つの前輪16と、片側2輪ずつの4つの後輪17とからなる全6輪の走行輪が示されているが、前輪および後輪の数および配置は、これに限られない。
作業機12は、前後方向において、前輪16および後輪17の間に設けられている。作業機12は、フロントフレーム14により支持されている。作業機12は、ブレード21と、ドローバ22と、旋回サークル23と、一対のリフトシリンダ25とを有する。
ドローバ22は、フロントフレーム14の下方に設けられている。ドローバ22の前端部は、フロントフレーム14の先端部14qに揺動可能に連結されている。一対のリフトシリンダ25は、フロントフレーム14を挟んだ左右両側に設けられている。ドローバ22の後端部は、一対のリフトシリンダ25を介して、フロントフレーム14により支持されている。
一対のリフトシリンダ25の伸縮によって、ドローバ22の後端部がフロントフレーム14に対して上下に昇降可能である。一対のリフトシリンダ25がともに短縮駆動することにより、フロントフレーム14および前輪16に対するブレード21の高さは上方に調整される。一対のリフトシリンダ25がともに伸長駆動することにより、フロントフレーム14および前輪16に対するブレード21の高さは下方に調整される。
ドローバ22は、一対のリフトシリンダ25の互いに異なる伸縮によって、前後方向に沿った軸を中心に上下に揺動可能である。
旋回サークル23は、ドローバ22の下方に設けられている。旋回サークル23は、ドローバ22に旋回可能に連結されている。旋回サークル23は、上下方向に沿った軸を中心に、時計回りおよび反時計回りに旋回可能である。
ブレード21は、旋回サークル23の下方に設けられている。ブレード21は、地面と対向して設けられている。ブレード21は、旋回サークル23により支持されている。ブレード21は、旋回サークル23の旋回運動に伴って、上面視において前後方向に対してブレード21がなす角度(ブレード推進角)が変化するように旋回する。ブレード21の旋回軸は、上下方向に沿って延びる軸である。
図3は、図1中のモータグレーダの操向に関わる構成を示すシステム図である。図3に示されるように、モータグレーダ100は、操向機構66と、制御部51と、操作部67とをさらに有する。
操向機構66は、モータグレーダ100の進行方向を操作する機構である。制御部51は、モータグレーダ100の操向を制御する。制御部51は、操向機構66の動作を制御する。操作部67は、キャブ11内に設けられている。操作部67は、操向機構66を動作させるためにオペレータによって操作される。
操作部67は、ステアリングハンドル41と、ステアリングレバー42とを有する。ステアリングハンドル41は、キャブ11内の運転席の前方に設けられている。ステアリングハンドル41は、たとえば、ホイール形状のハンドルであり、オペレータによって回転操作される。ステアリングレバー42は、ステアリングハンドル41から離れた位置に設けられている。ステアリングレバー42は、たとえば、キャブ11内の運転席の側方に設けられている。ステアリングレバー42は、オペレータによって傾倒操作される。
モータグレーダ100は、電気流体圧制御弁73をさらに有する。操作部67は、軌道バルブ71をさらに有する。操向機構66は、ステアリングバルブ72と、ステアリングシリンダ36とを有する。
電気流体圧制御弁73は、圧油をステアリングバルブ72に供給する。制御部51は、ステアリングレバー42からの操作信号に基づいて、電気流体圧制御弁73を制御する。軌道バルブ71は、ステアリングハンドル41における回転操作に応じて、圧油をステアリングバルブ72に供給する。
ステアリングバルブ72は、ステアリングシリンダ36に圧油を供給する。ステアリングバルブ72は、電気流体圧制御弁73および軌道バルブ71から供給される圧油により制御される。ステアリングシリンダ36は、ステアリングバルブ72からの圧油により、前輪16の前後方向に対してなす角度を変化させるように前輪16を左右に動作させる。前輪16が左側に傾くと、モータグレーダ100は、左前方に向けて円弧を描きながら旋回する。前輪16が右側に傾くと、モータグレーダ100は、右前方に向けて円弧を描きながら旋回する。
このような構成により、オペレータがステアリングハンドル41またはステアリングレバー42を操作することによって、ステアリングシリンダ36が伸縮し、前輪16が左右に動作する。
図4は、図1中のモータグレーダの運転アシストシステムに関わる構成を示すブロック図である。図2から図4に示されるように、制御部51は、以下に説明するモータグレーダ100の運転アシストシステムの動作を制御する。
モータグレーダ100は、ハンドルセンサ31と、レバーセンサ32とをさらに有する。ハンドルセンサ31は、ステアリングハンドル41の操作を検知する。レバーセンサ32は、ステアリングレバー42の操作を検知する。
ハンドルセンサ31は、オペレータによるステアリングハンドル41の操作を検知した場合に操作信号を発生し、操作信号を制御部51に出力する。ハンドルセンサ31は、たとえば、ステアリングハンドル41の回転によって発生するステアリングハンドル軸の角度変位を検出する軸変位センサである。レバーセンサ32は、オペレータによるステアリングレバー42の操作を検知した場合に操作信号を発生し、操作信号を制御部51に出力する。レバーセンサ32は、たとえば、ステアリングレバー42の角度位置を検出する位置センサである。
なお、ハンドルセンサ31は、ステアリングハンドル41の回転操作量が微小である場合には、操作信号を発生しないように不感帯を有してもよい。同様に、レバーセンサ32は、ステアリングレバー42の傾倒操作量が微小である場合には、操作信号を発生しないように不感帯を有してもよい。一例として、後述する前輪16のステアリング角度が±0.5°以内で変化する時のステアリングハンドル41またはステアリングレバー42の操作量は、微小であると判断される。
モータグレーダ100は、第1検知部61と、第2検知部62とをさらに有する。第1検知部61は、モータグレーダ100の位置および方位に関する情報を検知する。第2検知部62は、モータグレーダ100の進行方向に関する情報を検知する。
第1検知部61は、GNSS(全球測位衛星システム:Global Navigation Satellite System)レシーバ35を有する。GNSSレシーバ35は、たとえば、GPS(Global Positioning System)用の受信機である。GNSSレシーバ35のアンテナ35g(図2を参照)は、たとえば、キャブ11の天井部に配置される。GNSSレシーバ35は、衛星より測位信号を受信し、測位信号によりアンテナ35gの位置を演算して車体位置データを生成する。GNSSレシーバ35は、モータグレーダ100の位置および方位データを制御部51に出力する。
第2検知部62は、ステアリング角度センサ33と、アーティキュレート角度センサ34とを有する。ステアリング角度センサ33は、前輪16のステアリング角度(前後方向に対して前輪16がなす角度)を検知し、検知したステアリング角度の信号を発生する。ステアリング角度センサ33は、ステアリング角度の信号を制御部51に出力する。アーティキュレート角度センサ34は、フロントフレーム14とリアフレーム15とのアーティキュレート角度(連結角度)を検知し、検知したアーティキュレート角度の信号を発生する。アーティキュレート角度センサ34は、アーティキュレート角度の信号を制御部51に出力する。
図4に示されるように、制御部51は、操向機構66の自動制御を開始するためのトリガが入力された場合に、モータグレーダ100の位置および方位と、モータグレーダ100の進行方向とに基づいて、モータグレーダ100の走行経路を生成し、モータグレーダ100が生成された走行経路に沿って走行するように、操向機構66を制御する。
制御部51は、操作部67の操作が停止された場合に操向機構66の制御を開始する。制御部51は、操作部67の操作が再開された場合に操向機構66の制御を停止する。
制御部51は、トリガ出力部52と、自動制御指令部58と、ステアリング制御部54とを有する。
トリガ出力部52は、ハンドルセンサ31からのステアリングハンドル41の操作信号、および/または、レバーセンサ32からのステアリングレバー42の操作信号に基づいて、操向機構66の制御(後述するステアリング自動制御)を開始または停止するためのトリガを出力する。
トリガ出力部52は、ハンドルセンサ31からのステアリングハンドル41の操作信号、または、レバーセンサ32からのステアリングレバー42の操作信号が入力された場合に、ステアリング自動制御を停止するためのトリガ(後述する停止トリガ)を出力する。
トリガ出力部52は、ハンドルセンサ31からのステアリングハンドル41の操作信号、および、レバーセンサ32からのステアリングレバー42の操作信号が入力されなかった場合に、ステアリング自動制御を開始するためのトリガ(後述する開始トリガ)を出力する。
自動制御指令部58は、車両位置・方位取得部56と、進行方向特定部55と、経路生成部53とを有する。
車両位置・方位取得部56は、GNSSレシーバ35からモータグレーダ100の位置および方位データを取得する。車両位置・方位取得部56により取得されるモータグレーダ100の位置データは、グローバル座標系において規定されるモータグレーダ100の位置である。車両位置・方位取得部56により取得されるモータグレーダ100の方位データは、たとえば、モータグレーダ100の前方に対応する方位である。
進行方向特定部55には、ステアリング角度センサ33からのステアリング角度の信号と、アーティキュレート角度センサ34からのアーティキュレート角度の信号とが入力される。進行方向特定部55は、入力されたステアリング角度とアーティキュレート角度とに基づいて、モータグレーダ100の進行方向を特定する。
なお、本開示がアーティキュレート機構を備えない作業車両に適用される場合には、車体フレームに設けられた前輪のステアリング角度のみに基づいて、作業車両の進行方向が特定されてもよい。
経路生成部53は、トリガ出力部52からの開始トリガが入力された場合に、車両位置・方位取得部56において取得されたモータグレーダ100の位置および方位データと、進行方向特定部55において特定されたモータグレーダ100の進行方向とに基づいて、モータグレーダ100の走行経路を生成する。
ステアリング制御部54は、モータグレーダ100が、経路生成部53において生成された走行経路に沿って走行するように、操向機構66を制御する。具体的には、ステアリング制御部54は、モータグレーダ100が、経路生成部53において生成された走行経路に沿って走行するように、電気流体圧制御弁73に制御信号を出力する。電気流体圧制御弁73は、ステアリング制御部54からの信号に基づいて、ステアリングバルブ72に圧油を供給し、ステアリングシリンダ36を制御する(ステアリング自動制御の開始)。
オペレータによる操作部67の操作が再開されると、トリガ出力部52には、ハンドルセンサ31からのステアリングハンドル41の操作信号、または、レバーセンサ32からのステアリングレバー42の操作信号が入力される。これにより、トリガ出力部52は、停止トリガを出力する。この場合に、自動制御指令部58は、トリガ出力部52からの停止トリガを受信し、ステアリング自動制御を停止させる。
続いて、制御部51で実行されるステアリング自動制御についてより具体的に説明する。図5は、旋回時にステアリング自動制御が開始されるモータグレーダを模式的に示す上面図である。図6は、図5中のモータグレーダで生成される走行経路を示す上面図である。
なお、説明を簡単にするために、図5および図6、ならびに、後出の図7中には、前輪16を動作させるための操作部67としてステアリングハンドル41のみが用いられ、また、フロントフレーム14とリアフレーム15とが屈曲しておらず、アーティキュレート角度が0°である場合が示されている。
図4および図5に示されるように、モータグレーダ100が、モータグレーダ100A、モータグレーダ100B、モータグレーダ100Cおよびモータグレーダ100Dに示される位置(以下、「位置100A」、「位置100B」、「位置100C」および「位置100D」とそれぞれいう)を順に移動するように走行する。
モータグレーダ100が位置100Aから位置100Bまで移動する間、オペレータは、ステアリングハンドル41を操作することによってモータグレーダ100を走行させている。この間、トリガ出力部52には、ハンドルセンサ31からのステアリングハンドル41の操作信号が入力される。トリガ出力部52は、停止トリガを出力する。自動制御指令部58は、トリガ出力部52からの停止トリガを受信し、ステアリング自動制御は開始されない。
モータグレーダ100が位置100Bから位置100Cまで移動する間、オペレータは、ステアリングハンドル41を操作することによって、モータグレーダ100を右前方に向けて旋回させる。この間、トリガ出力部52には、ハンドルセンサ31からのステアリングハンドル41の操作信号が入力される。トリガ出力部52は、停止トリガを出力する。自動制御指令部58は、トリガ出力部52からの停止トリガを受信し、ステアリング自動制御は開始されない。
モータグレーダ100が位置100Cから位置100Dまで移動する間、オペレータは、ステアリングハンドル41を操作していない。この間、トリガ出力部52には、ハンドルセンサ31からのステアリングハンドル41の操作信号が入力されない。トリガ出力部52は、開始トリガを出力する。自動制御指令部58は、トリガ出力部52からの開始トリガを受信し、ステアリング自動制御が開始される。
図4および図6に示されるように、トリガ出力部52にハンドルセンサ31からのステアリングハンドル41の操作信号が入力されない場合、トリガ出力部52は、開始トリガを出力する。車両位置・方位取得部56は、トリガ出力部52からの開始トリガを受信すると、GNSSレシーバ35から、座標(X,Y)により示されるモータグレーダ100の位置と、矢印200により示されるモータグレーダ100の方位とを取得する。進行方向特定部55は、トリガ出力部52からの開始トリガを受信すると、ステアリング角度センサ33で検知されたステアリング角度θsに基づいて、モータグレーダ100の進行方向(旋回方向)を特定する。
経路生成部53は、車両位置・方位取得部56において取得されたモータグレーダ100の位置および方位と、進行方向特定部55において特定されたモータグレーダ100の進行方向とに基づいて、モータグレーダ100の走行経路210を生成する。走行経路210は、車両位置・方位取得部56において取得されたモータグレーダ100の位置を始点にし、モータグレーダ100を、車両位置・方位取得部56において取得されたモータグレーダ100の方位を基準に、進行方向特定部55において特定された進行方向に旋回させる経路である。走行経路210は、モータグレーダ100をステアリング角度θsに対応する一定の曲率半径rで旋回させる経路である。
図4および図5に示されるように、位置100Cから位置100Dまでのステアリング自動制御が実行される間、ステアリング制御部54は、経路生成部53において生成されたモータグレーダ100の走行経路210と、車両位置・方位取得部56において刻々と取得されるモータグレーダ100の位置とを照らし合わせる。ステアリング制御部54は、図5中のモータグレーダ100Eに示されるように、走行経路210と、モータグレーダ100の位置との間に予め定められた閾値以上のずれが生じた場合には、モータグレーダ100の位置が走行経路210上に戻るようにステアリングシリンダ36を制御する。
このあと、ステアリング制御部54は、トリガ出力部52にハンドルセンサ31からのステアリングハンドル41の操作信号が入力された場合には、ステアリング自動制御を停止し、トリガ出力部52にハンドルセンサ31からのステアリングハンドル41の操作信号が入力されない場合には、ステアリング自動制御を再開する。ステアリング自動制御の再開時には、経路生成部53は、そのときのモータグレーダ100の位置および方位と、モータグレーダ100の進行方向とに基づいて、新たな走行経路を生成する。
図7は、直進時にステアリング自動制御が開始されるモータグレーダを模式的に示す上面図である。
図4および図7に示されるように、モータグレーダ100が、モータグレーダ100S、モータグレーダ100Tおよびモータグレーダ100Uに示される位置(以下、「位置100S」、「位置100T」および「位置100U」とそれぞれいう)を順に移動するように走行する。
モータグレーダ100が位置100Sから位置100Tまで移動する間、オペレータは、ステアリングハンドル41を操作することによってモータグレーダ100を走行させている。この間、トリガ出力部52には、ハンドルセンサ31からのステアリングハンドル41の操作信号が入力される。トリガ出力部52は、停止トリガを出力する。自動制御指令部58は、トリガ出力部52からの停止トリガを受信し、ステアリング自動制御は開始されない。
モータグレーダ100が位置100Tから位置100Uまで移動する間、オペレータは、ステアリングハンドル41を操作していない。この間、トリガ出力部52には、ハンドルセンサ31からのステアリングハンドル41の操作信号が入力されない。トリガ出力部52は、開始トリガを出力する。自動制御指令部58は、トリガ出力部52からの開始トリガを受信し、ステアリング自動制御が開始される。
旋回時と同様に、トリガ出力部52にハンドルセンサ31からのステアリングハンドル41の操作信号が入力されない場合、トリガ出力部52は、開始トリガを出力する。車両位置・方位取得部56は、トリガ出力部52からの開始トリガを受信すると、GNSSレシーバ35から、モータグレーダ100の位置および方位を取得する。進行方向特定部55は、トリガ出力部52からの開始トリガを受信すると、ステアリング角度センサ33で検知されたステアリング角度θs=0°に基づいて、モータグレーダ100の進行方向(直進方向)を特定する。
経路生成部53は、車両位置・方位取得部56において取得されたモータグレーダ100の位置および方位と、進行方向特定部55において特定されたモータグレーダ100の進行方向とに基づいて、モータグレーダ100の走行経路220を生成する。走行経路220は、車両位置・方位取得部56において取得されたモータグレーダ100の位置を始点にし、モータグレーダ100を、車両位置・方位取得部56において取得されたモータグレーダ100の方位を基準に、進行方向特定部55において特定された進行方向に直進させる経路である。
位置100Tから位置100Uまでのステアリング自動制御が実行される間、ステアリング制御部54は、経路生成部53において生成されたモータグレーダ100の走行経路220と、車両位置・方位取得部56において刻々と取得されるモータグレーダ100の位置とを照らし合わせる。ステアリング制御部54は、図6中のモータグレーダ100Vに示されるように、走行経路220と、モータグレーダ100の位置との間に予め定められた閾値以上のずれが生じた場合に、モータグレーダ100の位置が走行経路220上に戻るようにステアリングシリンダ36を制御する。
図8は、ブレードに負荷を受けた場合のモータグレーダの挙動を示す上面図である。図8に示されるように、土砂または雪などの堆積物160をモータグレーダ100の側方に寄せるため、ブレード21が左右方向に対して斜めに傾けて使用される。この場合、ブレード21が堆積物160から負荷を受けることによって、モータグレーダ100の進行方向が側方にずれたり、堆積物160からの負荷が変化することによって、モータグレーダ100の進行方向が左右にぶれたりする。また、モータグレーダ100に限られず、作業車両は、一般的に凹凸形状を有した地面上を走行するため、作業車両の進行方向がずれやすい。
このため、オペレータは、モータグレーダ100の進行方向を調整するために、ステアリングハンドル41またはステアリングレバー42を操作したり、リーニング操作をしたりしながら、作業機12の操作レバーも操作しなければならない。このような作業は、高い技術と集中力とを必要とするため、オペレータに過度な負担を強いる。
これに対して、モータグレーダ100では、自動制御指令部58に、ステアリング自動制御を開始するためのトリガが入力された場合、モータグレーダ100の位置および方位と、モータグレーダ100の進行方向とに基づいて、モータグレーダ100の走行経路を生成し、モータグレーダ100が生成された走行経路に沿って走行するように、ステアリング自動制御を行なう。
このような構成によれば、オペレータは、ステアリング自動制御が実行される間、モータグレーダ100の進行方向を調整するための操作に行なうことなく、作業機12の操作に集中することができる。また、モータグレーダ100の走行経路は、モータグレーダ100の位置および方位と、モータグレーダ100の進行方向とに基づいて自動的に生成されるため、オペレータが、事前に作業現場の地図を入力したり、走行経路に関する各種パラメータを入力したりする必要がない。したがって、オペレータの負担が十分に軽減される運転アシストシステムを実現することができる。
また、制御部51は、ステアリングハンドル41およびステアリングレバー42の操作が停止された場合にステアリング自動制御を開始する。このような構成により、オペレータは、ステアリング自動制御を開始するために特別の操作を行なう必要がないため、オペレータの負担をさらに軽減することができる。
さらに、制御部51は、ステアリングハンドル41またはステアリングレバー42の操作が再開された場合にステアリング自動制御を停止する。このような構成により、オペレータは、ステアリングハンドル41またはステアリングレバー42の操作を通じて、モータグレーダ100を意図した方向に走行させることができる。
図9は、ステアリング自動制御時における前輪のステアリング角度と、モータグレーダの旋回曲率との関係を示すグラフである。
図4および図9に示されるように、前輪16のステアリング角度θsが0°を中心に微小なΔθsの範囲内である場合に、進行方向特定部55は、ステアリング角度θsが0°であると判断して、モータグレーダ100の進行方向を直進方向に特定してもよい。Δθsの大きさは、たとえば、1°であってもよいし、1.5°であってもよい。
図10は、ハンドル操作と、走行経路の生成と、ステアリング自動制御との相互のタイミングの関係を示すタイミングチャートである。
図4および図10に示されるように、制御部51は、ステアリングハンドル41およびステアリングレバー42の操作が停止された状態が所定期間継続された後に、ステアリング自動制御を開始してもよい。制御部51は、その所定期間の間に、モータグレーダ100の走行経路を生成してもよい。
図10に示されるタイミングチャートでは、時間t1において、オペレータがステアリングハンドル41を操作しないことによって、トリガ出力部52にハンドルセンサ31からのステアリングハンドル41の操作信号が入力されない。次に、時間t2から時間t3の間において、経路生成部53がモータグレーダ100の走行経路を生成する。次に、時間t4において、ステアリング制御部54が、ステアリング自動制御を開始する。
時間t1から時間t2までの長さは、たとえば、0.5s以上1s以下の範囲である(0.5s≦(t2-t1)≦1s)。時間t1から時間t4までの長さは、たとえば、1s以上2s以下の範囲である(1s≦(t4-t1)≦2s)。
このような構成によれば、ステアリングハンドル41およびステアリングレバー42の操作が停止された状態が所定期間継続された後に、ステアリング自動制御が開始されるため、制御部51が、ステアリングハンドル41およびステアリングレバー42の操作の停止に過剰に反応してステアリング自動制御を開始することを防止できる。また、ステアリングハンドル41およびステアリングレバー42の操作の停止からステアリング自動制御が開始されるまでの所定期間の間にモータグレーダ100の走行経路が生成されるため、ステアリング自動制御への移行を円滑に行なうことができる。
図11は、実施の形態1におけるモータグレーダの制御方法を示すフローチャートである。図4および図11に示されるように、まず、制御部51が、運転アシストモードに設定される(S101)。運転アシストモードの設定は、たとえば、オペレータが、キャブ11内に設けられたモード設定スイッチをオンすることによって行なわれる。
次に、ハンドルセンサ31が、オペレータによるステアリングハンドル41の操作の有無を検知し、レバーセンサ32が、オペレータによるステアリングレバー42の操作の有無を検知する(S102)。
本ステップにおいて、ハンドルセンサ31がステアリングハンドル41の操作を検知した場合、ステアリングハンドル41の操作信号がトリガ出力部52に入力され、ハンドルセンサ31がステアリングハンドル41の操作を検知しなかった場合、ステアリングハンドル41の操作信号がトリガ出力部52に入力されない。レバーセンサ32がステアリングレバー42の操作を検知した場合、ステアリングレバー42の操作信号がトリガ出力部52に入力され、レバーセンサ32がステアリングレバー42の操作を検知しなかった場合、ステアリングレバー42の操作信号がトリガ出力部52に入力されない。
次に、自動制御指令部58が、ステアリング自動制御を開始するか否かを判断する(S103)。
S102のステップにおいて、ハンドルセンサ31からのステアリングハンドル41の操作信号、または、レバーセンサ32からのステアリングレバー42の操作信号がトリガ出力部52に入力された場合、トリガ出力部52が自動制御指令部58に停止トリガを出力する。この場合、自動制御指令部58は、ステアリング自動制御を開始しないと判断する。次に、S102のステップに戻る。
S102のステップにおいて、ハンドルセンサ31からのステアリングハンドル41の操作信号、および、レバーセンサ32からのステアリングレバー42の操作信号がトリガ出力部52に入力されない場合、トリガ出力部52が自動制御指令部58に開始トリガを出力する。この場合、自動制御指令部58は、ステアリング自動制御を開始すると判断する(S103)。次に、S104のステップに進む。
車両位置・方位取得部56は、モータグレーダ100の位置および方位を特定し、進行方向特定部55が、モータグレーダ100の進行方向を特定する(S104)。
次に、経路生成部53が、車両位置・方位取得部56によって特定されたモータグレーダ100の位置および方位と、進行方向特定部55によって特定されたモータグレーダ100の進行方向とに基づいて、モータグレーダ100の走行経路を生成する(S105)。
次に、ステアリング制御部54が、モータグレーダ100が経路生成部53において生成された走行経路に沿って走行するように、電気流体圧制御弁73を制御する(S106)。
S106のステップを開始した後、ハンドルセンサ31が、オペレータによるステアリングハンドル41の操作の有無を検知し、レバーセンサ32が、オペレータによるステアリングレバー42の操作の有無を検知するS107のステップと、自動制御指令部58が、ステアリング自動制御を停止するか否かを判断するS108のステップとを継続して実行する。S108のステップにおいて、ステアリング自動制御を停止すると判断された場合、ステアリング制御部54は、ステアリング自動制御を停止する(S109)。そのあと、S102のステップに戻る。
図12は、図4中の運転アシストシステムに関わる構成の変形例を示すブロック図である。図12に示されるように、本変形例では、モータグレーダ100は、切り替えスイッチ37を有する。切り替えスイッチ37は、ステアリング自動制御の開始(オン)と、ステアリング自動制御の停止(オフ)とを切り替えるためのスイッチである。
切り替えスイッチ37は、キャブ11内に設けられている。切り替えスイッチ37の形態は、特に限定されず、たとえば、押しボタンであってもよいし、レバーであってもよい。切り替えスイッチ37は、モニタにおけるタッチパネル内に設けられてもよい。
本変形例においては、オペレータによって切り替えスイッチ37がオン操作されると、自動制御指令部58にステアリング自動制御を開始するためのトリガ(開始トリガ)が入力される。続いて、モータグレーダ100の走行経路の生成と、ステアリング自動制御とが順に実行される。オペレータによって切り替えスイッチ37がオフ操作されると、自動制御指令部58に停止トリガが入力され、ステアリング自動制御が停止される。
このような構成によれば、オペレータは、より自らが意図したタイミングでステアリング自動制御を開始させることができる。
以上に説明した、本実施の形態におけるモータグレーダ100およびその制御方法の構成および効果についてまとめて説明する。
作業車両としてのモータグレーダ100は、操向機構66と、制御部51とを備える。制御部51は、モータグレーダ100の位置および方位と、モータグレーダ100の進行方向とに基づいて、モータグレーダ100の走行経路を生成し、モータグレーダ100が生成された走行経路に沿って走行するように、操向機構66を制御する。
このような構成によれば、制御部51は、モータグレーダ100の位置および方位と、モータグレーダ100の進行方向とに基づいて、モータグレーダ100の走行経路を生成し、モータグレーダ100が走行経路に沿って走行するように、操向機構66を制御するため、オペレータに煩雑な作業が求められない。このため、オペレータの負担が十分に軽減される運転アシストシステムを実現することができる。
また、制御部51は、操向機構66の制御を開始するためのトリガが入力された場合に、モータグレーダ100の位置および方位と、モータグレーダ100の進行方向とに基づいて、モータグレーダ100の走行経路を生成し、モータグレーダ100が生成された走行経路に沿って走行するように、操向機構66を制御する。
このような構成によれば、制御部51は、予め定められたトリガに基づいて、操向機構66の制御を開始するか否かを判断することができる。
また、モータグレーダ100は、第1検知部61と、第2検知部62とをさらに備える。第1検知部61は、モータグレーダ100の位置および方位に関する情報を検知する。第2検知部62は、モータグレーダ100の進行方向に関する情報を検知する。
このように構成によれば、制御部51は、第1検知部61により検知されたモータグレーダ100の位置および方位に関する情報を用いて、モータグレーダ100の位置および方位を特定し、第2検知部62により検知されたモータグレーダ100の進行方向に関する情報を用いて、モータグレーダ100の進行方向を特定することができる。
また、第1検知部61は、GNSSレシーバ35を含む。制御部51は、GNSSレシーバ35によって、モータグレーダ100の位置および方位を取得する。
このような構成によれば、モータグレーダ100のグローバルな位置および方位を容易に特定することができる。
また、モータグレーダ100は、フロントフレーム14と、リアフレーム15とをさらに備える。フロントフレーム14には、前輪16が設けられる。リアフレーム15には、後輪17が設けられる。リアフレーム15は、フロントフレーム14に回動可能に連結される。第2検知部62は、ステアリング角度センサ33と、アーティキュレート角度センサ34とを含む。ステアリング角度センサ33は、前輪16のステアリング角度を検知する。アーティキュレート角度センサ34は、フロントフレーム14とリアフレーム15とのアーティキュレート角度を検知する。制御部51は、ステアリング角度センサ33により検知されたステアリング角度と、アーティキュレート角度センサ34により検知されたアーティキュレート角度とに基づいて、モータグレーダ100の進行方向を特定する。
このような構成によれば、前輪16のステアリング機構と、フロントフレーム14およびリアフレーム15のアーティキュレート機構とを備えたモータグレーダ100の進行方向を特定することができる。
また、モータグレーダ100は、操作部67をさらに備える。操作部67は、操向機構66を動作させるために操作される。制御部51は、操作部67の操作が停止された場合に操向機構66の制御を開始する。
このような構成によれば、操向機構66の制御を開始するためのオペレータの操作が不要であるため、オペレータの負担をさらに軽減することができる。
また、制御部51は、操作部67の操作が停止された状態が所定期間継続された後に、操向機構66の制御を開始してもよい。制御部51は、その所定期間の間にモータグレーダ100の走行経路を生成してもよい。
このような構成によれば、制御部51が操作部67の操作の停止に過剰に反応して操向機構66の制御を開始することを防止できる。また、制御部51は、操作部67の操作の停止から操向機構66の制御の開始までの所定期間の間にモータグレーダ100の走行経路を生成するため、操向機構66の制御に円滑に移行することができる。
また、制御部51は、操作部67の操作が再開された場合に操向機構66の制御を停止する。
このような構成によれば、操作部67の操作が再開された場合にはその操作によって操向機構66を動作させることにより、オペレータは、モータグレーダ100を自らの意図した方向に走行させることができる。
また、モータグレーダ100は、制御部51による操向機構66の制御の開始および停止を切り替えるためのスイッチとしての切り替えスイッチ37を備えてもよい。
このような構成によれば、オペレータは、より自らが意図したタイミングで、制御部51による操向機構66の制御を開始させることができる。
モータグレーダ100の制御方法は、モータグレーダ100の位置および方位と、モータグレーダ100の進行方向とに基づいて、モータグレーダ100の走行経路を生成するステップ(S105)と、モータグレーダ100が生成された走行経路に沿って走行するように、操向機構66を制御するステップ(S106)とを備える。
生成するステップ(S105)は、操向機構66の制御を開始するためのトリガが入力された場合に、モータグレーダ100の位置および方位と、モータグレーダ100の進行方向とに基づいて、モータグレーダ100の走行経路を生成するステップを含む。
このような構成によれば、オペレータの負担が十分に軽減される運転アシストシステムを実現することができる。
なお、モータグレーダ100は、モータグレーダ100の進行方向を操作する操向機構66として、前輪16を左右に傾倒させるリーニング機構と、フロントフレーム14とリアフレーム15とを屈曲させるアーティキュレート機構とをさらに有する。制御部51によって実行される操向機構66の制御は、ステアリング自動制御に限られず、リーニング機構の自動制御であってもよいし、アーティキュレート機構の自動制御であってもよいし、ステアリング機構、リーニング機構およびアーティキュレート機構のうちの複数の機構の自動制御であってもよい。
本開示における作業車両およびその制御方法は、モータグレーダに限られず、たとえば、ホイールローダ、ダンプトラックまたはブルドーザなどの各種の作業車両に適用されてもよい。ホイールローダへの適用の場合、制御部による制御の対象は、回動可能に接続されたフロントフレームとリアフレームとのアーティキュレート角度であってもよい。
図13は、モータグレーダの操向機構の制御システムの概念を示す図である。上記の実施の形態では、作業車両であるモータグレーダ100が制御部51を備える場合を説明したが、図3および図13に示されるように、モータグレーダの操向機構66が、モータグレーダから離れた位置に設けられた制御部および操作部によって制御される構成であってもよい。
モータグレーダの操向機構66を制御する制御システムは、モータグレーダの位置および方位と、モータグレーダの進行方向とに基づいて、モータグレーダの走行経路を生成し、モータグレーダが生成された走行経路に沿って走行するように、モータグレーダの操向機構66を制御する制御部251を備える。
(実施の形態2)
本実施の形態では、実施の形態1において説明した運転アシストシステムがブルドーザに適用された場合の構成を説明する。以下、実施の形態1における構成と重複する構成については、その説明を繰り返さない。
本実施の形態では、実施の形態1において説明した運転アシストシステムがブルドーザに適用された場合の構成を説明する。以下、実施の形態1における構成と重複する構成については、その説明を繰り返さない。
図14は、ブルドーザを示す斜視図である。図15は、図14中のブルドーザの操向に関わる構成を示すシステム図である。
図14に示されるように、ブルドーザ300は、車体311と、作業機313と、左右一対の牽引装置316(316R,316L)とを有する。車体311は、左右一対の牽引装置316(316R,316L)上に設けられている。車体311は、キャブ341と、エンジン室342とを有する。作業機313は、車体311の前方に設けられている。作業機313は、土砂の掘削および整地などの作業を行なうためのブレード318を有する。
左右一対の牽引装置316(316R,316L)は、ブルドーザ300を走行させるための装置である。左右一対の牽引装置316(316R,316L)は、たとえば、履帯と、終減速装置とを有する。左右一対の牽引装置316(316R,316L)が回転駆動されることによって、ブルドーザ300が走行する。
図14および図15に示されるように、ブルドーザ300は、操向機構66と、制御部51と、操作部67と、電気流体圧制御弁73とを有する。
操向機構66は、駆動装置331を有する。駆動装置331は、油圧により作動する油圧モータである。駆動装置331は、右側の牽引装置(第1牽引装置)316Rと、左側の牽引装置(第2牽引装置)316Lとを互いに独立して駆動させることが可能である。
操作部67は、ステアリングレバー42を有する。電気流体圧制御弁73は、圧油を駆動装置331に供給する。制御部51は、ステアリングレバー42からの操作信号に基づいて、電気流体圧制御弁73を制御する。駆動装置331は、電気流体圧制御弁73からの圧油により、右側の牽引装置316Rと、左側の牽引装置316Lとを回転させる。右側の牽引装置316Rの回転速度と、左側の牽引装置316Lの回転速度とが同じである場合、ブルドーザ300が直進する。右側の牽引装置316Rの回転速度が、左側の牽引装置316Lの回転速度よりも大きい場合、ブルドーザ300が左前方に向けて旋回する。左側の牽引装置316Lの回転速度が、右側の牽引装置316Rの回転速度よりも大きい場合、ブルドーザ300が右前方に向けて旋回する。
図16は、図14中のブルドーザの運転アシストシステムに関わる構成を示すブロック図である。図15および図16に示されるように、ブルドーザ300は、レバーセンサ32を有する。レバーセンサ32は、ステアリングレバー42の操作を検知する。
ブルドーザ300は、第1検知部61と、第2検知部62とをさらに有する。第1検知部61は、GNSSレシーバ35を有する。第2検知部62は、右速度センサ321と、左速度センサ322とを有する。右速度センサ321は、右側の牽引装置316Rの回転速度を検知し、検知した牽引装置316Rの回転速度の信号を制御部51に出力する。左速度センサ322は、左側の牽引装置316Lの回転速度を検知し、検知した牽引装置316Lの回転速度の信号を制御部51に出力する。
図16に示されるように、制御部51は、トリガ出力部52と、自動制御指令部58と、ステアリング制御部54とを有する。
トリガ出力部52は、レバーセンサ32からのステアリングレバー42の操作信号に基づいて、操向機構66の制御を開始または停止するためのトリガを出力する。
自動制御指令部58は、車両位置・方位取得部56と、進行方向特定部55と、経路生成部53とを有する。
車両位置・方位取得部56は、GNSSレシーバ35からブルドーザ300の位置および方位データを取得する。進行方向特定部55は、右速度センサ321からの牽引装置316Rの回転速度の信号と、左速度センサ322からの牽引装置316Lの回転速度の信号とに基づいて、ブルドーザ300の進行方向を特定する。経路生成部53は、トリガ出力部52からの開始トリガが入力された場合に、車両位置・方位取得部56において取得されたブルドーザ300の位置および方位データと、進行方向特定部55において特定されたブルドーザ300の進行方向とに基づいて、ブルドーザ300の走行経路を生成する。
ステアリング制御部54は、ブルドーザ300が、経路生成部53において生成された走行経路に沿って走行するように、操向機構66を制御する。具体的には、ステアリング制御部54は、ブルドーザ300が、経路生成部53において生成された走行経路に沿って走行するように、電気流体圧制御弁73に制御信号を出力する。電気流体圧制御弁73は、ステアリング制御部54から信号に基づいて、駆動装置331に圧油を供給し、右側の牽引装置316Rの回転速度と、左側の牽引装置316Lの回転速度とを制御する。
このように構成されたブルドーザ300によれば、実施の形態1に記載の効果を同様に奏することができる。
今回開示された実施の形態はすべての点で例示であって制限的なものではないと考えられるべきである。本発明の範囲は上記した説明ではなくて請求の範囲によって示され、請求の範囲と均等の意味および範囲内でのすべての変更が含まれることが意図される。
11,341 キャブ、12,313 作業機、13,342 エンジン室、14 フロントフレーム、14p 基端部、14q 先端部、15 リアフレーム、16 前輪、17 後輪、18 車体フレーム、21,318 ブレード、22 ドローバ、23 旋回サークル、25 リフトシリンダ、28 アーティキュレートシリンダ、31 ハンドルセンサ、32 レバーセンサ、33 ステアリング角度センサ、34 アーティキュレート角度センサ、35 GNSSレシーバ、35g アンテナ、36 ステアリングシリンダ、37 切り替えスイッチ、38 IMU、41 ステアリングハンドル、42 ステアリングレバー、51,251 制御部、52 トリガ出力部、53 経路生成部、54 ステアリング制御部、55 進行方向特定部、56 車両位置・方位取得部、57 変化率算出部、58 自動制御指令部、59 位置および方向算出部、61 第1検知部、62 第2検知部、63 第3検知部、66 操向機構、67 操作部、71 軌道バルブ、72 ステアリングバルブ、73 電気流体圧制御弁、100 モータグレーダ、121 回動中心、160 堆積物、210,220 走行経路、300 ブルドーザ、311 車体、316,316L,316R 牽引装置、321 右速度センサ、322 左速度センサ、331 駆動装置。
Claims (20)
- 作業車両の操向機構を制御する制御システムであって、
前記作業車両の位置および方位と、前記作業車両の進行方向とに基づいて、前記作業車両の走行経路を生成し、前記作業車両が生成された前記走行経路に沿って走行するように、前記作業車両の操向機構を制御する制御部を備える、制御システム。 - 前記制御部は、前記作業車両の操向機構の制御を開始するためのトリガが入力された場合に、前記作業車両の位置および方位と、前記作業車両の進行方向とに基づいて、前記作業車両の走行経路を生成し、前記作業車両が生成された前記走行経路に沿って走行するように、前記作業車両の操向機構を制御する、請求項1に記載の制御システム。
- 前記作業車両の操向機構を動作させるために操作される操作部をさらに備え、
前記制御部は、前記操作部の操作が停止された場合に前記作業車両の操向機構の制御を開始する、請求項2に記載の制御システム。 - 前記制御部は、前記操作部の操作が停止された状態が所定期間継続された後に、前記作業車両の操向機構の制御を開始する、請求項3に記載の制御システム。
- 前記制御部は、前記所定期間の間に、前記作業車両の走行経路を生成する、請求項4に記載の制御システム。
- 前記制御部は、前記操作部の操作が再開された場合に前記作業車両の操向機構の制御を停止する、請求項3から5のいずれか1項に記載の制御システム。
- 前記制御部による前記作業車両の操向機構の制御の開始および停止を切り替えるためのスイッチをさらに備える、請求項2に記載の制御システム。
- 操向機構を含む作業車両の制御方法であって、
前記作業車両の位置および方位と、前記作業車両の進行方向とに基づいて、前記作業車両の走行経路を生成するステップと、
前記作業車両が生成された前記走行経路に沿って走行するように、前記操向機構を制御するステップとを備える、作業車両の制御方法。 - 前記生成するステップは、前記操向機構の制御を開始するためのトリガが入力された場合に、前記作業車両の位置および方位と、前記作業車両の進行方向とに基づいて、前記作業車両の走行経路を生成するステップを含む、請求項8に記載の作業車両の制御方法。
- 前記操向機構は、ステアリングシリンダと、前記ステアリングシリンダを制御するステアリングバルブとを含み、
前記ステアリングシリンダは、前記ステアリングバルブからの圧油により、前後方向に対して操向輪がなす角度が変化するように前記操向輪を動作させる、請求項8または9に記載の作業車両の制御方法。 - 前記操向機構は、左右一対の第1牽引装置および第2牽引装置を回転駆動させる駆動装置を含み、
前記駆動装置は、前記第1牽引装置の回転速度と、前記第2牽引装置の回転速度とを互いに独立して制御する、請求項8または9に記載の作業車両の制御方法。 - 作業車両であって、
操向機構と、
前記作業車両の位置および方位と、前記作業車両の進行方向とに基づいて、前記作業車両の走行経路を生成し、前記作業車両が生成された前記走行経路に沿って走行するように、前記操向機構を制御する制御部とを備える、作業車両。 - 前記制御部は、前記操向機構の制御を開始するためのトリガが入力された場合に、前記作業車両の位置および方位と、前記作業車両の進行方向とに基づいて、前記作業車両の走行経路を生成し、前記作業車両が生成された前記走行経路に沿って走行するように、前記操向機構を制御する、請求項12に記載の作業車両。
- 前記操向機構を動作させるために操作される操作部をさらに備え、
前記制御部は、前記操作部の操作が停止された場合に前記操向機構の制御を開始する、請求項13に記載の作業車両。 - 前記作業車両の位置および方位に関する情報を検知する第1検知部と、
前記作業車両の進行方向に関する情報を検知する第2検知部とをさらに備える、請求項12から14のいずれか1項に記載の作業車両。 - 前記第1検知部は、GNSSレシーバを含み、
前記制御部は、前記GNSSレシーバによって、前記作業車両の位置および方位を取得する、請求項15に記載の作業車両。 - 前輪が設けられる車体フレームをさらに備え、
記第2検知部は、前記前輪のステアリング角度を検知するステアリング角度センサを含み、
前記制御部は、前記ステアリング角度センサにより検知された前記ステアリング角度に基づいて、前記作業車両の進行方向を特定する、請求項15または16に記載の作業車両。 - 前記車体フレームは、前記前輪が設けられるフロントフレームと、後輪が設けられ、前記フロントフレームに回動可能に連結されるリアフレームとを含み、
前記第2検知部は、前記フロントフレームと前記リアフレームとのアーティキュレート角度を検知するアーティキュレート角度センサをさらに含み、
前記制御部は、さらに前記ステアリング角度センサにより検知された前記ステアリング角度に基づいて、前記作業車両の進行方向を特定する、請求項17に記載の作業車両。 - 前記操向機構は、ステアリングシリンダと、前記ステアリングシリンダを制御するステアリングバルブとを含み、
前記ステアリングシリンダは、前記ステアリングバルブからの圧油により、前後方向に対して操向輪がなす角度が変化するように前記操向輪を動作させる、請求項12から18のいずれか1項に記載の作業車両。 - 前記操向機構は、左右一対の第1牽引装置および第2牽引装置を回転駆動させる駆動装置を含み、
前記駆動装置は、前記第1牽引装置の回転速度と、前記第2牽引装置の回転速度とを互いに独立して制御する、請求項12から18のいずれか1項に記載の作業車両。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US17/638,244 US20220325499A1 (en) | 2019-09-30 | 2020-07-07 | Control system, method of controlling work vehicle, and work vehicle |
CN202080056874.2A CN114206703A (zh) | 2019-09-30 | 2020-07-07 | 控制系统、作业车辆的控制方法以及作业车辆 |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019-179561 | 2019-09-30 | ||
JP2019179561A JP7358163B2 (ja) | 2019-09-30 | 2019-09-30 | 制御システム、作業車両の制御方法、および、作業車両 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2021065136A1 true WO2021065136A1 (ja) | 2021-04-08 |
Family
ID=75269580
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2020/026509 WO2021065136A1 (ja) | 2019-09-30 | 2020-07-07 | 制御システム、作業車両の制御方法、および、作業車両 |
Country Status (4)
Country | Link |
---|---|
US (1) | US20220325499A1 (ja) |
JP (1) | JP7358163B2 (ja) |
CN (1) | CN114206703A (ja) |
WO (1) | WO2021065136A1 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2024089987A1 (ja) * | 2022-10-25 | 2024-05-02 | 株式会社小松製作所 | 作業機械及び作業機械を制御するための方法 |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2023013529A (ja) * | 2021-07-16 | 2023-01-26 | 株式会社小松製作所 | 作業機械、及び、作業機械を制御するための方法 |
JP2023028922A (ja) * | 2021-08-20 | 2023-03-03 | 株式会社小松製作所 | 作業機械、及び、作業機械を制御するための方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS53115828U (ja) * | 1977-02-23 | 1978-09-14 | ||
JPH07172334A (ja) * | 1993-12-21 | 1995-07-11 | Kubota Corp | ステアリング制御装置 |
JP2003237619A (ja) * | 2002-02-21 | 2003-08-27 | Mitsubishi Heavy Ind Ltd | ディファレンシャルロック切換装置 |
JP2007060982A (ja) * | 2005-08-31 | 2007-03-15 | Iseki & Co Ltd | 作業車両の自動操縦装置 |
JP2013201958A (ja) * | 2012-03-28 | 2013-10-07 | National Agriculture & Food Research Organization | 走行制御装置 |
JP2016010336A (ja) * | 2014-06-27 | 2016-01-21 | 株式会社クボタ | 植播系圃場作業機 |
Family Cites Families (27)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2003026385A1 (en) * | 2001-09-07 | 2003-04-03 | Dillon Ben N | Articulated combine |
US6539303B2 (en) * | 2000-12-08 | 2003-03-25 | Mcclure John A. | GPS derived swathing guidance system |
JP2002358122A (ja) * | 2001-05-31 | 2002-12-13 | Yanmar Agricult Equip Co Ltd | 農業用作業車 |
JP5080855B2 (ja) * | 2007-05-14 | 2012-11-21 | 株式会社クボタ | 作業車 |
US9051006B2 (en) * | 2007-09-06 | 2015-06-09 | Tsd Integrated Controls, Llc | Method and apparatus for vehicle auto-guidance |
AU2011349103A1 (en) * | 2010-12-23 | 2013-06-20 | Leica Geosystems Ag | Method and system for the determination of a steering angle |
US8807261B2 (en) * | 2012-01-31 | 2014-08-19 | Caterpillar Inc. | Articulation control system having steering path tracking |
US9108675B2 (en) * | 2012-11-30 | 2015-08-18 | Deere & Company | Single pedal propulsion system for straight travel of work vehicle |
US8880287B2 (en) * | 2013-03-06 | 2014-11-04 | GM Global Technology Operations LLC | Steering-wheel-hold detection for lane keeping assist feature |
JP6253678B2 (ja) * | 2014-02-06 | 2017-12-27 | ヤンマー株式会社 | 併走作業システム |
CN104019815B (zh) * | 2014-06-04 | 2017-01-25 | 中国农业大学 | 基于铲车载荷监测的gnss平地作业路径动态规划与导航方法 |
JP6454513B2 (ja) | 2014-10-15 | 2019-01-16 | Ckd株式会社 | 多機能電磁開閉弁 |
JP6438368B2 (ja) * | 2015-09-18 | 2018-12-12 | ヤンマー株式会社 | 作業車両 |
WO2017073614A1 (ja) * | 2015-10-30 | 2017-05-04 | 株式会社小松製作所 | 作業車両および作業車両の制御方法 |
TW201718297A (zh) * | 2015-11-27 | 2017-06-01 | 鴻海精密工業股份有限公司 | 車輛駕駛模式切換系統和方法 |
KR102691393B1 (ko) * | 2015-12-25 | 2024-08-05 | 가부시끼 가이샤 구보다 | 작업차 |
CN114995427A (zh) * | 2016-05-10 | 2022-09-02 | 洋马动力科技有限公司 | 自主行驶路径生成系统 |
JP6666795B2 (ja) * | 2016-05-31 | 2020-03-18 | 株式会社小松製作所 | 作業車両 |
JP6770839B2 (ja) * | 2016-07-08 | 2020-10-21 | 株式会社クボタ | 経路探索プログラムと、経路探索システムと、この経路探索システムを組み込んだ作業車 |
JP6805946B2 (ja) * | 2017-04-12 | 2020-12-23 | 井関農機株式会社 | 作業車両 |
WO2019054057A1 (ja) * | 2017-09-14 | 2019-03-21 | ヤンマー株式会社 | 作業車両用の自律走行システム |
JP6900291B2 (ja) * | 2017-10-10 | 2021-07-07 | 井関農機株式会社 | 自動操舵システム |
JP6881233B2 (ja) * | 2017-10-27 | 2021-06-02 | 井関農機株式会社 | 作業車両 |
JP6908510B2 (ja) * | 2017-12-07 | 2021-07-28 | ヤンマーパワーテクノロジー株式会社 | 走行経路設定装置 |
JP7212460B2 (ja) * | 2018-06-06 | 2023-01-25 | 株式会社小松製作所 | 作業車両 |
CN109109973A (zh) * | 2018-07-23 | 2019-01-01 | 荣嫚丽 | 一种农业机械车自动控制系统、农业机械车及控制方法 |
CN109141460A (zh) * | 2018-09-30 | 2019-01-04 | 佳都新太科技股份有限公司 | 车辆行驶路径优化方法、装置、计算设备及存储介质 |
-
2019
- 2019-09-30 JP JP2019179561A patent/JP7358163B2/ja active Active
-
2020
- 2020-07-07 WO PCT/JP2020/026509 patent/WO2021065136A1/ja active Application Filing
- 2020-07-07 US US17/638,244 patent/US20220325499A1/en active Pending
- 2020-07-07 CN CN202080056874.2A patent/CN114206703A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS53115828U (ja) * | 1977-02-23 | 1978-09-14 | ||
JPH07172334A (ja) * | 1993-12-21 | 1995-07-11 | Kubota Corp | ステアリング制御装置 |
JP2003237619A (ja) * | 2002-02-21 | 2003-08-27 | Mitsubishi Heavy Ind Ltd | ディファレンシャルロック切換装置 |
JP2007060982A (ja) * | 2005-08-31 | 2007-03-15 | Iseki & Co Ltd | 作業車両の自動操縦装置 |
JP2013201958A (ja) * | 2012-03-28 | 2013-10-07 | National Agriculture & Food Research Organization | 走行制御装置 |
JP2016010336A (ja) * | 2014-06-27 | 2016-01-21 | 株式会社クボタ | 植播系圃場作業機 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2024089987A1 (ja) * | 2022-10-25 | 2024-05-02 | 株式会社小松製作所 | 作業機械及び作業機械を制御するための方法 |
Also Published As
Publication number | Publication date |
---|---|
JP2021054269A (ja) | 2021-04-08 |
JP7358163B2 (ja) | 2023-10-10 |
US20220325499A1 (en) | 2022-10-13 |
CN114206703A (zh) | 2022-03-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8807261B2 (en) | Articulation control system having steering path tracking | |
WO2021065136A1 (ja) | 制御システム、作業車両の制御方法、および、作業車両 | |
EP3788204B1 (en) | Automated coupling of an implement to an implement carrier of a power machine | |
WO2018051742A1 (ja) | 作業車両の制御システム、作業車両の制御システムの制御方法および作業車両 | |
JP2018135649A (ja) | 作業車両および作業車両の制御方法 | |
JP7490127B2 (ja) | モータグレーダおよび表示制御方法 | |
JP2017171091A (ja) | モータグレーダにおける制御方法およびモータグレーダ | |
WO2021065135A1 (ja) | 制御システム、作業車両の制御方法、および、作業車両 | |
WO2020122044A1 (ja) | 作業機械、作業機械を含むシステム、および作業機械の制御方法 | |
JP6689639B2 (ja) | モータグレーダにおける制御方法およびモータグレーダ | |
WO2022209176A1 (ja) | 作業機械の走行システムおよび作業機械の制御方法 | |
JP6991090B2 (ja) | 作業車 | |
US20240337089A1 (en) | Work machine and method for controlling work machine | |
WO2022209177A1 (ja) | 作業機械の操向制御システムおよび作業機械の操向制御方法 | |
US20190186100A1 (en) | Work vehicle and method for controlling work vehicle | |
JP7422570B2 (ja) | 作業車両および制御方法 | |
WO2023286443A1 (ja) | 作業機械、及び、作業機械を制御するための方法 | |
WO2023053700A1 (ja) | 作業機械を制御するためのシステムおよび方法 | |
WO2024043075A1 (ja) | 作業機械、作業機械を含むシステム、および作業機械の制御方法 | |
WO2024157918A1 (ja) | 積込機械の制御装置、積込機械の制御方法および積込機械の制御システム | |
WO2024089987A1 (ja) | 作業機械及び作業機械を制御するための方法 | |
WO2023112563A1 (ja) | 作業機械、作業機械を制御するための方法、及びシステム | |
WO2023112560A1 (ja) | 作業機械、作業機械を制御するための方法、及びシステム | |
WO2023286442A1 (ja) | 作業機械、及び、作業機械を制御するための方法 | |
WO2024053259A1 (ja) | 作業機械、及び、作業機械を制御するための方法 |
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: 20871655 Country of ref document: EP Kind code of ref document: A1 |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 20871655 Country of ref document: EP Kind code of ref document: A1 |