KR20200121224A - Work vehicle - Google Patents
Work vehicle Download PDFInfo
- Publication number
- KR20200121224A KR20200121224A KR1020190170745A KR20190170745A KR20200121224A KR 20200121224 A KR20200121224 A KR 20200121224A KR 1020190170745 A KR1020190170745 A KR 1020190170745A KR 20190170745 A KR20190170745 A KR 20190170745A KR 20200121224 A KR20200121224 A KR 20200121224A
- Authority
- KR
- South Korea
- Prior art keywords
- turning
- operation mode
- turning operation
- mode
- automatic
- Prior art date
Links
- 238000000034 method Methods 0.000 claims description 23
- 238000001514 detection method Methods 0.000 claims description 9
- 230000007704 transition Effects 0.000 claims 1
- 230000005540 biological transmission Effects 0.000 description 28
- 230000007246 mechanism Effects 0.000 description 12
- 239000003550 marker Substances 0.000 description 10
- 230000008569 process Effects 0.000 description 10
- 238000010586 diagram Methods 0.000 description 9
- 230000003028 elevating effect Effects 0.000 description 4
- 230000004720 fertilization Effects 0.000 description 4
- 238000004806 packaging method and process Methods 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 238000004590 computer program Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000002159 abnormal effect Effects 0.000 description 1
- 230000002730 additional effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000008602 contraction Effects 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000000994 depressogenic effect Effects 0.000 description 1
- 239000002828 fuel tank Substances 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000002706 hydrostatic effect Effects 0.000 description 1
- 230000000977 initiatory effect Effects 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 230000002250 progressing effect Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000009331 sowing Methods 0.000 description 1
Images
Classifications
-
- 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/04—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear
- B62D5/0457—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear characterised by control features of the drive means as such
- B62D5/046—Controlling the motor
- B62D5/0463—Controlling the motor calculating assisting torque from the motor based on driver input
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/02—Control of vehicle driving stability
- B60W30/045—Improving turning performance
-
- 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
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W10/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/04—Conjoint control of vehicle sub-units of different type or different function including control of propulsion units
- B60W10/08—Conjoint control of vehicle sub-units of different type or different function including control of propulsion units including control of electric propulsion units, e.g. motors or generators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W10/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/20—Conjoint control of vehicle sub-units of different type or different function including control of steering systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/18—Propelling the vehicle
- B60W30/182—Selecting between different operative modes, e.g. comfort and performance modes
-
- 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/04—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear
- B62D5/0457—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear characterised by control features of the drive means as such
- B62D5/046—Controlling the motor
-
- 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/28—Wheel speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
- B60Y2200/00—Type of vehicle
- B60Y2200/40—Special vehicles
- B60Y2200/41—Construction vehicles, e.g. graders, excavators
- B60Y2200/414—Pavers
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
- B60Y2300/00—Purposes or special features of road vehicle drive control systems
- B60Y2300/02—Control of vehicle driving stability
- B60Y2300/045—Improving turning performance, e.g. agility of a vehicle in a curve
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Transportation (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Life Sciences & Earth Sciences (AREA)
- Automation & Control Theory (AREA)
- Soil Sciences (AREA)
- Environmental Sciences (AREA)
- Guiding Agricultural Machines (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Control Of Throttle Valves Provided In The Intake System Or In The Exhaust System (AREA)
- Eye Examination Apparatus (AREA)
Abstract
Description
본 발명은 작업 차량에 관한 것이다.The present invention relates to a work vehicle.
종래, 포장을 주행하면서 작업을 행하는 작업 차량에는 작업 개시 위치와 작업 종료 위치의 위치 정보를 취득하고, 취득한 위치 정보로부터 기준선을 작성하고, 작성한 기준선을 따라 자동주행하는 것이 있다(예를 들면, 특허문헌 1 참조).BACKGROUND ART Conventionally, in a work vehicle that performs work while traveling on a pavement, there is one that acquires the position information of the work start position and the work end position, creates a reference line from the acquired position information, and automatically runs along the created reference line (for example, patent See document 1).
상기한 바와 같은 작업 차량에 있어서, 취득한 위치 정보에 의거하여 자동 선회시키는 것이 고려된다. 그러나, 자동 선회시킬 경우, 선회행정의 전체에 걸쳐 위치 정보를 사용할 필요가 있어 제어가 복잡해진다.In the work vehicle as described above, it is considered to automatically turn based on the acquired positional information. However, in the case of automatic turning, it is necessary to use the positional information throughout the turning stroke, thus complicating control.
본 발명은 상기를 감안하여 이루어진 것으로서, 간소한 제어로 자동 선회를 행할 수 있는 작업 차량을 제공하는 것을 목적으로 한다.The present invention has been made in view of the above, and an object of the present invention is to provide a work vehicle capable of automatically turning with simple control.
상술한 과제를 해결하여 목적을 달성하기 위해서, 제 1 항에 기재된 작업 차량(1)은 주행차체(2)에 부착된 주행차륜(10,11)과, 상기 주행차륜(10)의 조타량을 조정하는 스티어링 장치(35)와, 상기 스티어링 장치(35)를 구동하는 모터(95)와, 측위수단으로부터 측위정보를 수취하고, 수취한 측위정보에 의거하여 기체의 현재의 위치 정보를 취득하는 위치 취득 장치(150)와, 상기 모터(95)를 제어하는 제어 장치(100)를 구비하고, 상기 제어 장치(100)는 기체의 선회중에 있어서, 상기 위치 정보에 상관없이 상기 조타량이 소정의 값이 되도록 상기 모터(95)를 제어해서 실행하는 제 1 선회 동작 모드와, 상기 위치 정보에 의거하여 선회 주행 경로(L2) 상에 있어서의 원하는 방위에 기체가 도달하도록 상기 모터(95)를 제어해서 실행하는 제 2 선회 동작 모드를 갖는 것을 특징으로 한다.In order to solve the above-described problem and achieve the object, the
제 2 항에 기재된 작업 차량(1)은 제 1 항에 기재된 작업 차량(1)에 있어서, 상기 제어 장치(100)는 기체의 선회 개시시에는 상기 제 1 선회 동작 모드를 실행하고, 상기 제 1 선회 동작 모드가 종료하면 상기 제 2 선회 동작 모드를 실행하는 것을 특징으로 한다.The work vehicle (1) according to claim 2 is the work vehicle (1) according to
제 3 항에 기재된 작업 차량(1)은 제 1 항 또는 제 2 항에 기재된 작업 차량(1)에 있어서, 상기 주행차륜(11)의 회전수를 검출하는 검출 장치(90)를 더 구비하고, 상기 검출 장치(90)는 상기 제 1 선회 동작 모드의 개시에 따라 상기 회전수의 검출을 개시하고, 상기 제어 장치(100)는 상기 회전수가 소정의 값이 되면 상기 제 2 선회 동작 모드로 이행하는 것을 특징으로 한다.The work vehicle (1) according to claim 3, in the work vehicle (1) according to
제 4 항에 기재된 작업 차량(1)은 제 1 항 내지 제 3 항 중 어느 한 항에 기재된 작업 차량(1)에 있어서, 상기 제어 장치(100)는 직진 주행 경로(L1)를 따라 기체를 주행시키는 자동 직진 모드를 갖고, 원하는 선회 종료 위치(P2)를 향한 상기 제 2 선회 동작 모드가 종료하면 상기 자동 직진 모드로 이행하는 것을 특징으로 한다.The work vehicle (1) according to claim 4 is the work vehicle (1) according to any one of
제 1 항에 기재된 발명에 의하면, 기체의 선회중에 있어서 위치 정보에 의거한 동작 모드가 아닌 제 1 선회 동작 모드를 실행하므로, 자동 선회에 따른 제어 전체에 위치 정보를 사용할 필요가 없어지고, 즉, 자동 선회중에 위치 정보를 사용하는 제어가 일부이어도 되게 되어 간소한 제어로 자동 선회를 행할 수 있다.According to the invention described in
제 2 항에 기재된 발명에 의하면, 제 1 항에 기재된 발명의 효과에 추가해서, 기체의 선회 개시시에는 제 1 선회 동작 모드를 실행하고, 선회 종료시에는 제 2 선회 동작 모드를 실행함으로써 보다 간소한 제어로 자동 선회를 행할 수 있다.According to the invention described in claim 2, in addition to the effect of the invention described in
제 3 항에 기재된 발명에 의하면, 제 1 항 또는 제 2 항에 기재된 발명의 효과에 추가해서, 제 1 선회 동작 모드의 개시에 따라 주행차륜의 회전수의 검출(카운트)을 개시하고, 주행차륜의 회전수가 소정의 값이 되면 제 2 선회 동작 모드로 이행하므로, 상기와 마찬가지로, 자동 선회중에 위치 정보를 사용하는 제어가 일부이어도 되게 되어 간소한 제어로 자동 선회를 행할 수 있다.According to the invention described in claim 3, in addition to the effect of the invention described in
제 4 항에 기재된 발명에 의하면, 제 1 항 내지 제 3 항 중 어느 한 항에 기재된 발명의 효과에 추가해서, 원하는 선회 종료 위치를 향한 제 2 선회 동작 모드(기체의 선회중에 있어서 제 2 선회 동작 모드를 2회 이상 행하는 경우에는 최후의 제 2 선회 동작 모드)가 종료하면 그대로 자동 직진 모드로 이행해서 자동 직진을 개시하므로, 작업을 계속적으로 행할 수 있어 작업성을 향상시킬 수 있다.According to the invention according to claim 4, in addition to the effect of the invention according to any one of
도 1은 작업 차량의 일례를 나타내는 측면도이다.
도 2는 작업 차량의 일례를 나타내는 평면도이다.
도 3은 제어 장치를 중심으로 한 제어계를 나타내는 블록도이다.
도 4는 작업 차량의 포장에 있어서의 자율 주행의 설명도이다.
도 5는 제 1 실시형태에 따른 자동 선회 제어의 설명도이다.
도 6은 제 1 실시형태에 따른 자동 선회 제어의 처리 순서를 나타내는 플로우차트이다.
도 7은 자동 선회 제어를 개시하는 제어의 처리 순서를 나타내는 플로우차트이다.
도 8은 제 1 선회 동작 모드로부터 제 2 선회 동작 모드로 이행하는 제어의 처리 순서를 나타내는 플로우차트이다.
도 9는 제 2 실시형태에 따른 자동 선회 제어의 설명도이다.
도 10은 제 2 실시형태에 따른 자동 선회 제어의 처리 순서를 나타내는 플로우차트이다.
도 11은 제 3 실시형태에 따른 자동 선회 제어의 설명도이다.
도 12는 제 3 실시형태에 따른 자동 선회 제어의 처리 순서를 나타내는 플로우차트이다.1 is a side view showing an example of a work vehicle.
2 is a plan view showing an example of a work vehicle.
3 is a block diagram showing a control system centered on a control device.
4 is an explanatory diagram of autonomous driving in pavement of a work vehicle.
5 is an explanatory diagram of automatic turning control according to the first embodiment.
6 is a flowchart showing a processing procedure of automatic turning control according to the first embodiment.
7 is a flowchart showing the processing procedure of control for starting automatic turning control.
Fig. 8 is a flowchart showing a control procedure for transitioning from the first turning operation mode to the second turning operation mode.
9 is an explanatory diagram of automatic turning control according to the second embodiment.
Fig. 10 is a flowchart showing a processing procedure of automatic turning control according to the second embodiment.
11 is an explanatory diagram of automatic turning control according to the third embodiment.
12 is a flowchart showing the processing procedure of automatic turning control according to the third embodiment.
이하, 첨부된 도면을 참조해서 본원이 개시하는 작업 차량의 실시형태를 상세하게 설명한다. 또, 이하에 나타내는 실시형태에 의해 본 발명이 한정되는 것은 아니다.Hereinafter, an embodiment of a work vehicle disclosed by the present application will be described in detail with reference to the accompanying drawings. In addition, the present invention is not limited by the embodiments shown below.
<작업 차량의 개요><Overview of work vehicle>
우선, 도 1 및 도 2를 참조해서 실시형태에 따른 작업 차량(1)의 개요에 대해서 설명한다.First, an outline of the
도 1은 작업 차량(1)을 나타내는 측면(좌측면)도이다. 도 2는 작업 차량(1)을 나타내는 평면도이다.1 is a side (left side) view showing a
또, 이하의 설명에서는 전후 방향이란 작업 차량(1)의 직진시에 있어서의 진행 방향이며, 진행 방향의 전방측을 「전」, 후방측을 「후」라고 규정한다. 작업 차량(1)의 진행 방향이란 직진시에 있어서, 조종석(41)으로부터 핸들(35)을 향하는 방향이다(도 1 및 도 2 참조).In addition, in the following description, the front-rear direction is the advancing direction when the
좌우 방향이란 전후 방향에 대해서 수평으로 직교하는 방향이며, 「전」측을 향해서 좌우를 규정한다. 즉, 조종자(작업자라고도 한다)가 조종석(41)에 착석해서 전방을 향한 상태에서, 왼쪽손측이 「좌」, 오른쪽손측이 「우」이다.The left and right direction is a direction horizontally orthogonal to the front-rear direction, and the left and right are defined toward the "front" side. That is, in the state where the manipulator (also referred to as a worker) is seated in the
상하 방향이란 연직방향이다. 전후 방향, 좌우 방향 및 상하 방향은 서로 직교한다. 각 방향은 설명의 편의상 정의한 것이며, 이들 방향에 의해 본 발명이 한정되는 것은 아니다.The vertical direction is a vertical direction. The forward and backward directions, the left and right directions, and the up and down directions are orthogonal to each other. Each direction is defined for convenience of description, and the present invention is not limited by these directions.
또한 이하의 설명에서는 작업 차량(1)을 가리켜서 「기체」라고 하는 경우가 있다. 실시형태에서는 작업 차량을 작업 장치로서 모종식부부(4)를 구비하고, 포장에 모종을 접수하는 승용형의 모종이식기(1)로서 설명한다. 도 1 및 도 2에 나타내듯이 모종이식기(1)는 주행차체(2)의 후방측에 승강 링크 기구(3)를 통해 포장에 모종을 식부하는 승강가능한 모종식부부(4)(작업 장치)를 구비한다.In addition, in the following description, the
주행차체(2)의 후방부 상측에는 시비 장치(5)의 본체부분이 배치된다. 또, 작업 차량이 모종이식기(1)가 아닌 경우, 종자를 공급하는 파종 장치 등을 작업 장치로서 구비하는 경우가 있다.A body portion of the fertilizing
주행차체(2)는 주행차륜이며 구동륜인 좌우의 전륜(10) 및 후륜(11)을 구비하는 사륜 구동 차량이다. 주행차체(2)의 차체골격을 구성하는 메인프레임(15)의 전방측에는 모종식부부(4) 등에 구동력을 전달하는 미션 케이스(13)와, 엔진(30)으로부터 공급되는 구동력, 즉, 엔진(30)에서 발생한 회전을 미션 케이스(13)에 출력하는 유압식의 무단 변속 장치(14)(주변속 기구)가 설치된다.The running vehicle body 2 is a four-wheel drive vehicle having left and right
무단 변속 장치(14)는 소위 HST(Hydro Static Transmission)라고 불리는 정유압식의 무단 변속기이다. 이하에서는 무단 변속 장치가 HST(14)인 경우를 설명한다.The continuously
미션 케이스(13)내에는 고속 모드에서의 노상 주행시나, 저속 모드에서의 모종의 식부시 등에 있어서의 주행차체(2)의 주행 모드를 스위칭하는 부변속 기구(16)가 설치된다. In the
미션 케이스(13)의 좌우측방에는 전륜 파이널 케이스(10a)가 설치되고, 좌우의 전륜 파이널 케이스(10a)의 조향 방향을 변경 가능한 전륜 지지부로부터 각각 외향으로 돌출하는 좌우의 전방차축(10b)에 전륜(10)이 부착된다.Front wheel
또한 메인프레임(15)의 후방부측에는 기체 횡방향으로 설치된 후방부 프레임(22)(도 2 참조)의 좌우 양측에 후륜 기어 케이스(11a)가 부착되며, 후륜 기어 케이스(11a)로부터 각각 외향으로 돌출하는 좌우의 후방차축(11b)에 후륜(11)(주행차륜)이 각각 부착된다.In addition, on the rear side of the
또한 후방부 프레임(22)의 상부에는 승강 링크 기구(3)를 지지하는 좌우의 링크 지지 프레임(23)이 상방을 향해서 돌출된다. 좌우의 링크 지지 프레임(23)의 하부측이며, 또한, 좌우의 사이에는 좌우 한쌍의 하측 링크 암(24)이 설치된다. 좌우의 하측 링크 암(24)의 좌우의 사이에 유압에 의해 작동하는 승강 실린더(25) (승강 장치)가 설치된다.Further, on the upper part of the
승강 실린더(25)의 상방에는 상측 링크 암(26)이 설치되며, 평행 링크 기구인 승강 링크 기구(3)가 구성된다. 또, 각각 일단이 주행차체(2)측에 연결된 좌우의 하측 링크 암(24)과, 승강 실린더(25)와, 상측 링크 암(26)의 타단측은 모종식부부(4)의 전방부에 장착된다.An upper link arm 26 is provided above the lifting
또한 메인프레임(15) 상에는 엔진(30)이 탑재된다. 엔진(30)의 회전 동력이 벨트 전동 장치(21) 및 HST(14)를 통해 미션 케이스(13)에 전달된다. 미션 케이스(13)에 전달된 회전 동력은 미션 케이스(13)내의 부변속 기구(16)에 의해 변속된 후, 주행 동력과 외부 인출 동력으로 나뉘어진다.Also, the
또한 엔진(30)의 회전 동력은 도시하지 않은 유압펌프에 전달된다. 유압펌프에서 발생한 유압은 HST(14)나, 핸들(35)의 파워스티어링 기구(88)(도 3 참조)나, 승강 실린더(25) 등에 공급된다.In addition, the rotational power of the
미션 케이스(13)에 전달된 회전 동력으로부터 인출되는 외부 인출 동력은 주행차체(2)의 후방부에 설치된 식부 클러치 케이스(27)에 전달되고, 식부 클러치 케이스(27)로부터 식부 전동축(67)에 의해 모종식부부(4)에 전달된다.The external withdrawal power drawn from the rotational power transmitted to the
한편, 미션 케이스(13)의 후방부에는 좌우의 드라이브 샤프트(42)가 설치된다. 엔진(30)으로부터의 회전 동력은 미션 케이스(13) 및 드라이브 샤프트(42)를 통해 좌우의 후륜 기어 케이스(11a)에 전동된다.On the other hand, left and
또, 좌우의 드라이브 샤프트(42)보다 전동 방향 상측에는 좌우의 드라이브 샤프트(42)에 대한 동력전달을 온오프하는 사이드 클러치(44)(도 3 참조)가 배치된다. 도 1에 나타내듯이 조종석(41)의 전방측 하부이며, 또한, 좌우 일측에는 좌우의 사이드 클러치(44)를 온오프 조작하는 사이드 클러치 페달(43a)이 설치된다.Further, a side clutch 44 (see Fig. 3) for turning on and off power transmission to the left and
좌우의 사이드 클러치 페달(43a) 중, 선회 내측의 사이드 클러치 페달(43a)을 밟아서 사이드 클러치(44)를 오프상태로 하고 나서 핸들(35)을 조작해서 선회 주행하면, 선회 내측의 후륜(11)의 구동 회전을 완전하게 차단할 수 있다.Of the side
이것에 의해, 핸들(35) 단독의 조작에 의한 선회 주행보다 선회 반경을 작게 할 수 있고, 포장조건에 적합한 작업 조의 작업 개시 위치를 적절하게 선택 가능하게 되어 작업 정밀도가 향상된다.As a result, the turning radius can be made smaller than that of turning travel by operating the
이렇게, 선회시에 선회 내측의 후륜(11)으로의 전동을 정지시켜서 선회 반경을 작게 할 수 있고, 선회전의 작업 위치와 선회후의 작업 위치가 멀어지는 것을 방지할 수 있으므로, 선회후의 작업 개시 위치의 조정을 다시 하는 조작이 불필요하게 되어 작업 효율이나 작업 정밀도가 향상된다.In this way, the turning radius can be reduced by stopping the transmission to the
또, 실시형태에서는 후술하는 자동 선회 제어에 있어서, 핸들(35)의 조작에 의해 주행차체(2)를 선회 조작시키면, 선회 내측에 위치하는 사이드 클러치(44)가 오프상태로 되어 선회 내측의 후륜(11)으로의 전동을 정지시키도록 구성되어 있다.In addition, in the embodiment, in the automatic turning control to be described later, when the driving vehicle body 2 is turned by the operation of the
주행차체(2)의 전방측 상부에는 각 부의 조작을 행하는 조종 패널(38)이 상부에 배치된 보닛(39)이 설치된다. 조종 패널(38)에는 후술하는 자동 선회 제어를 행할지의 여부를 스위칭하는 자동 선회 스위치(48)나, 모니터(86)(도 3 참조) 등이 설치된다.A
또한 보닛(39)에는 기체를 조타하는 핸들(35), HST(14)나 모종식부부(4)를 조작하는 변속 조작 레버(36), 부변속 기구(16)를 조작하는 부변속 조작 레버(37) 등이 설치된다.In addition, the
또한 보닛(39)의 전방측에는 개폐 가능한 프론트 커버(40)가 설치된다. 프론트 커버(40)의 내부에는 연료탱크나 배터리, 핸들(35)의 조타에 좌우의 전륜(10) 및 좌우의 전륜 파이널 케이스(10a)의 하부측을 회동시키는 연동 기구가 설치된다.In addition, a
보닛(39)보다 기체 후방측이며, 또한, 엔진(30)의 상방위치에는 엔진(30)의 상부 및 측부를 덮는 엔진 커버(30a)가 설치되고, 엔진 커버(30a)의 상부에는 조종자가 착석하는 조종석(41)이 설치된다.The
조종석(41)의 후방측이며, 메인프레임(15)의 후단측에는 시비 장치(5)가 설치된다. 시비 장치(5)의 구동력은 좌우의 후륜 기어 케이스(11a)의 좌우 일측으로부터 시비 장치(5)에 임하도록 설치되는 시비 전동 기구에 의해 전달된다.It is the rear side of the
그런데, 엔진 커버(30a) 및 보닛(39)의 하부에 있어서의 좌우 양측은 대략 수평한 플로어 스텝(33)이 형성된다. 플로어 스텝(33)은 도 2에 나타내듯이 일부 격자상이며, 예를 들면, 플로어 스텝(33)을 걷는 조종자의 신발 등에 붙은 진흙이 떨어져도, 떨어진 진흙 등이 포장에 낙하한다.By the way, the floor steps 33 which are substantially horizontal are formed on both left and right sides in the lower part of the
또한 도 1에 나타내듯이 모종이식기(1)는 위치 취득 장치(150)를 구비한다. 위치 취득 장치(150)는 GPS(Global Positioning System)나 GNSS(Global Navigation Satellite System) 등의 측위수단으로부터 측위정보를 수취하고, 수취한 측위정보에 의거하여 기체의 현재의 위치 정보를 작성하고, 취득한다. 위치 취득 장치(150)는 예를 들면, 부착 스테이(59)에 부착되며, 주행차체(2)의 상방에 배치된다.Further, as shown in FIG. 1, the
위치 취득 장치(150)에 의한 위치 정보에 의거하여 작성되는 직진 제어용 프로그램과, 선회 제어용 프로그램은 서로 별도의 장소에 격납된다. 직진 제어용 프로그램은 예를 들면, 위치 취득 장치(150)내의 직진 제어용 ECU(Electronic Control Unit)(100a)에 격납되고, 선회 제어용 프로그램은 예를 들면, 보닛(39)에 수용된 선회 제어용 ECU(100b)에 격납된다. 또, 직진 제어용 ECU(100a) 및 선회 제어용 ECU(100b)는 후술하는 제어 장치(100)(도 3 참조)에 포함된다.The program for straightening control and the program for turning control, which are created based on the positional information by the
<작업 차량의 제어계><Control system of work vehicle>
다음에 도 3을 참조해서 모종이식기(1)의 제어계(C)에 대해서 설명한다. 도 3은 모종이식기(1)에 있어서의 제어 장치(100)를 중심으로 한 제어계(C)를 나타내는 블록도이다. 모종이식기(1)는 전자제어에 의해 각 부를 제어하는 것이 가능한 것이며, 각 부를 제어하는 제어 장치(이하, 컨트롤러라고 한다)(100)를 구비한다.Next, the control system C of the
컨트롤러(100)는 CPU(Central Processing Unit) 등을 갖는 처리부나, ROM(Read Only Memory), RAM(Random Access Memory) 등의 기억부, 또한 입출력부가 설치되며, 이들은 서로 접속되어서 서로 신호의 주고받음이 가능하다. 기억부에는 모종이식기(1)를 제어하는 컴퓨터 프로그램 등이 격납된다. 컨트롤러(100)는 기억부에 격납된 컴퓨터 프로그램 등을 읽어냄으로써 각 기능을 발휘시킨다.The
컨트롤러(100)에는 예를 들면, 액츄에이터류로서 스로틀 모터(80), 유압 제어 밸브(81,82), 식부 클러치 작동 솔레노이드(83), 사이드 클러치 작동 솔레노이드(84), HST 모터(85), 선그리기 마커 승강 모터(87), 스티어링 모터(95) 등이 접속된다.The
스로틀 모터(80)는 엔진(30)의 흡기량을 조절하는 스로틀을 작동시킴으로써, 엔진(30)의 출력축의 회전수를 증감시킨다. 유압 제어 밸브(81)는 승강 실린더(25)의 신축 동작을 제어한다. 유압 제어 밸브(82)는 파워스티어링 기구(88)를 제어한다. 식부 클러치 작동 솔레노이드(83)는 식부 클러치(27a)를 작동시킨다.The
사이드 클러치 작동 솔레노이드(84)는 후륜(11)으로의 동력전달상태를 스위칭하는 사이드 클러치(44)를 작동시킨다. 또, 사이드 클러치(44)는 좌우의 후륜(11)에 각각 설치되고, 사이드 클러치 작동 솔레노이드(84)는 각 사이드 클러치(44)에 대응해서 2개 설치된다.The side
HST 모터(85)는 HST(14)의 트라니온의 회동각도를 변경함으로써 HST(14)의 사판의 경사각을 변경한다. 스티어링 모터(95)는 자동 선회 제어가 행해지는 경우에, 주행차륜인 전륜(10)(도 1 참조)의 조타량(타각)을 조정하는 스티어링 장치인 핸들(35)을 구동하는 모터이다. 스티어링 모터(95)는 핸들(35)을 회동시킨다. 선그리기 마커 승강 모터(87)는 선그리기 마커(65)를 승강시킨다.The
또한 컨트롤러(100)에는 검출 장치인 회전수 센서(90), 조타량 센서(91), 경사 센서(92) 등이 접속된다. 회전수 센서(90)는 주행차륜인 좌우의 후륜(11)에 대응해서 2개 설치되고, 좌우의 후륜(11)의 회전수를 각각 검출한다. 또, 회전수 센서(90)는 좌우의 전륜(10)의 회전수를 검출해도 좋다.Further, the
조타량 센서(91)는 스티어링 장치인 핸들(35)의 조작량, 즉, 전륜(10)의 조타량(타각)을 검출한다. 또, 조타량은 핸들(35)의 조작량이 제로인 경우를 기준으로 해서 즉, 주행차체(2)의 직진 주행시를 기준으로 해서, 좌우 방향 각각에서 검출된다. 경사 센서(92)는 주행차체(2)의 기울기인 경사각을 검출한다.The
또한 컨트롤러(100)에는 조작 신호로서 변속 조작 레버(36), 부변속 조작 레버(37), 식부부 자동 승강 스위치(47), 자동 선회 스위치(48), 선그리기 마커 자동 승강 스위치(49) 등으로부터 신호가 입력된다.In addition, as an operation signal to the
식부부 자동 승강 스위치(47)는 핸들(35)의 조작량, 즉, 전륜(10)의 조타량에 연동해서 모종식부부(4)를 자동적으로 승강시킬지의 여부를 스위칭하는 스위치이다. 식부부 자동 승강 스위치(47)가 「온」인 경우에는 조타량에 연동해서 모종식부부(4)를 자동적으로 승강시키는 제어가 실행된다. 한편, 식부부 자동 승강 스위치(47)가 「오프」인 경우에는 조타량에 연동해서 모종식부부(4)를 자동적으로 승강시키는 제어는 실행되지 않는다.The planting part automatic raising/lowering switch 47 is a switch for switching whether or not the seedling planting part 4 is automatically raised or lowered in conjunction with the operation amount of the
선그리기 마커 자동 승강 스위치(49)는 핸들(35)의 조작량, 즉, 전륜(10)의 조타량에 연동해서 선그리기 마커(65)를 자동적으로 승강시킬지의 여부를 스위칭하는 스위치이다. 선그리기 마커 자동 승강 스위치(49)가 「온」인 경우에는 조타량에 연동해서 선그리기 마커(65)를 자동적으로 승강시키는 제어가 실행된다. 한편, 선그리기 마커 자동 승강 스위치(49)가 「오프」인 경우에는 조타량에 연동해서 선그리기 마커(65)를 자동적으로 승강시키는 제어는 실행되지 않는다.The line drawing marker
자동 선회 스위치(48)는 램프 부착한 튀어오름 스위치이며, 자동 선회를 개시 또는 중지할지를 스위칭하는 스위치이다. 자동 선회 스위치(48)는 조종자에 의해 「온」으로 되어서 자동 선회가 행해지고 있는 동안에는 점등하고, 자동 선회가 종료하면, 「오프」로 되어 소등한다. 또한 자동 선회 스위치(48)는 자동 선회중에 조종자에 의해 「오프」로 되고, 자동 선회가 중지되면 소등한다. 이것에 의해 자동 선회를 행하고 있는지의 여부를 조종자가 인식 가능해진다.The
또한 컨트롤러(100)에는 위치 취득 장치(150)로부터 기체의 현재의 위치 정보가 입력된다. 컨트롤러(100)는 위치 정보에 의거하여 기체가 자동으로 주행하면서 작업을 행하는 자율 주행 모드를 실행한다. 컨트롤러(100)를 중심으로 해서 자동 선회 스위치(48), 회전수 센서(90), 조타량 센서(91), 스티어링 모터(95), 핸들(35) 및 위치 취득 장치(150)는 후술하는 자동 선회 모드의 제어계(C)를 구성하고 있다.In addition, the current position information of the aircraft is input to the
<자율 주행 모드><Autonomous driving mode>
여기에서, 도 4를 참조해서 모종이식기(1)에 의한, 포장에 있어서의 자동 선회를 포함하는 자동주행(자율 주행)에 대해서 설명한다. 도 4는 작업 차량(모종이식기(1))의 포장에 있어서의 자율 주행의 설명도이다. 컨트롤러(100)(도 3 참조)는 전륜(10)(도 1 참조)의 조타량을 피드백하면서 스티어링 모터(95)(도 3 참조)를 제어해서 핸들(35)(도 3 참조)을 조작하는 자율 주행 모드를 갖는다. 자율 주행 모드는 자동 직진 모드와, 자동 선회 모드를 포함한다.Here, with reference to FIG. 4, the automatic running (autonomous running) including the automatic turning in the pavement by the
도 4에 나타내듯이 자율 주행 모드에 있어서는 모종이식기(1)는 포장(F)에 있어서, 예정 주행 경로를 따라 직진 및 선회를 반복하면서 모종의 식부 작업을 자동으로 행한다. 또, 컨트롤러(100)는 상기한 바와 같이, 주행차체(2)의 상방에 배치된 위치 취득 장치(150)에 의해 모종이식기(1)의 현재의 위치 정보를 취득한다.As shown in FIG. 4, in the autonomous driving mode, the
모종이식기(1)는 포장(F)에 있어서의 소정의 작업 영역내를 왕복하면서, 모종의 식부를 행한다. 이 경우, 직진 주행에 대해서는 컨트롤러(100)가 자동 직진 모드를 실행함으로써, 설정된 직진 주행 경로(L1)를 따라 자동주행을 행한다. 또한 선회 주행에 대해서는 컨트롤러(100)가 자동 선회 모드를 실행함으로써, 설정된 선회 주행 경로(L2)를 따라 자동 선회를 행한다.The
직진 주행 경로(L1)는 주행기준이 되는 기준선(L0)에 대해서 평행하다. 기준선(L0)은 모종의 식부 방향에 맞춰서 포장(F)에 있어서 설정된다. 컨트롤러(100)는 직진 주행의 개시 위치 및 종료 위치를 각각 기준시점(A점) 및 기준종점(B점)으로서 취득하고, A점 및 B점을 연결하는 선분을 기준선(L0)으로서 등록한다.The straight travel path L1 is parallel to the reference line L0 serving as a driving reference. The reference line L0 is set in the packaging F according to the planting direction of the seedling. The
또한 컨트롤러(100)는 자동 선회 모드로서 제 1 선회 동작 모드와, 제 2 선회 동작 모드를 갖는다. 컨트롤러(100)는 제 1 선회 동작 모드 및 제 2 선회 동작 모드를 조합함으로써 자동 선회 모드로서 실행한다. 또, 컨트롤러(100)는 자동 선회 스위치(48)가 조종자에 의해 「온」되면, 자동 선회 모드를 실행한다.In addition, the
제 1 선회 동작 모드에서는 컨트롤러(100)는 모종이식기(1)의 선회중에 있어서, 핸들(35)의 조타량이 소정의 값이 되도록 스티어링 모터(95)를 제어한다. 이 경우, 컨트롤러(100)는 위치 취득 장치(150)가 취득한 위치 정보에 상관없이 처리를 실행한다.In the first turning operation mode, the
제 2 선회 동작 모드에서는 컨트롤러(100)는 모종이식기(1)의 선회중에 있어서, 위치 취득 장치(150)가 취득한 위치 정보에 의거하여 선회 주행 경로(L2) 상 중 어느 하나의 원하는 위치에 모종이식기(1)가 도달하도록 스티어링 모터(95)를 제어한다.In the second turning operation mode, the
이렇게, 컨트롤러(100)가 제 1 선회 동작 모드 및 제 2 선회 동작 모드를 갖고, 기체의 선회중에 있어서 위치 정보에 의거한 동작 모드가 아닌 제 1 선회 동작 모드를 실행하므로, 자동 선회에 따른 제어 전체에 위치 정보를 사용할 필요가 없다. 이 때문에, 자동 선회중에 위치 정보를 사용하는 제어가 일부이어도 되게 되어 간소한 제어로 자동 선회를 행할 수 있다.In this way, since the
또, 컨트롤러(100)는 자동 선회 모드에서는 모종이식기(1)의 선회중에 있어서 선회 주행 경로(L2)로부터 어긋나서 선회(크게 회전함 또는 작게 회전함)하고 있는 경우에는 위치 취득 장치(150)가 취득한 위치 정보에 의거하여 보정한다.In addition, in the automatic turning mode, when the
<제 1 실시형태에 따른 자동 선회 모드><Automatic turning mode according to the first embodiment>
다음에 도 5∼도 8을 참조해서 제 1 실시형태에 따른 자동 선회 모드에 대해서 설명한다. 도 5는 제 1 실시형태에 따른 자동 선회 제어(자동 선회 모드)의 설명도이다. 도 6은 제 1 실시형태에 따른 자동 선회 제어(자동 선회 모드)의 처리 순서를 나타내는 플로우차트이다.Next, an automatic turning mode according to the first embodiment will be described with reference to FIGS. 5 to 8. 5 is an explanatory diagram of automatic turning control (automatic turning mode) according to the first embodiment. 6 is a flowchart showing a processing procedure of automatic turning control (automatic turning mode) according to the first embodiment.
또한 도 7은 자동 선회 제어(자동 선회 모드)를 개시하는 제어의 처리 순서를 나타내는 플로우차트이다. 도 8은 제 1 선회 동작 모드로부터 제 2 선회 동작 모드로 이행하는 제어의 처리 순서를 나타내는 플로우차트이다.7 is a flowchart showing the processing procedure of control for starting the automatic turning control (automatic turning mode). Fig. 8 is a flowchart showing a control procedure for transitioning from the first turning operation mode to the second turning operation mode.
도 5에 나타내듯이 제 1 실시형태에 따른 자동 선회 모드에서는 자동 직진 모드에서 진행해 온 모종이식기(1)는 미리 설정된 원하는 선회 개시 위치(모종이식기(1) 등의 농업기계의 경우에는 1조에 있어서의 작업 종료 위치이기도 하다)(P1)에 근접한 위치에서 조종자에 의해 자동 선회 스위치(48)(도 3 참조)가 눌러지면 자동 선회를 개시한다.As shown in Fig. 5, in the automatic turning mode according to the first embodiment, the
자동 선회를 개시하면, 모종이식기(1)는 제 1 선회 동작 모드에 의한 진행을 개시한다. 제 1 선회 동작 모드에서는 모종이식기(1)는 선회 주행 경로(L2)를 따라 진행하고, 선회 주행 경로(L2) 상의 종료 위치(모드 종료 위치)(P3)에서 제 1 선회 동작 모드에 의한 진행을 종료한다. 모종이식기(1)는 제 1 선회 동작 모드에 의한 진행을 종료하면, 제 2 선회 동작 모드에 의한 진행을 개시한다.Upon starting the automatic turning, the
제 2 선회 동작 모드에서는 모종이식기(1)는 미리 설정된 원하는 선회 종료 위치(모종이식기(1) 등의 농업기계의 경우에는 다음 조에 있어서의 작업 개시 위치이기도 하다)(P2)에 있어서 다음 조의 직진 주행 경로(L1)를 따르도록 서서히 위치를 보정하면서 진행(직진)하고, 제 2 선회 동작 모드에 의한 진행을 종료하면, 자동 직진 모드에서 다음 조에 있어서의 진행을 개시한다.In the second turning operation mode, the
도 6에 나타내듯이 제 1 실시형태에서는 컨트롤러(100)는 자동 선회 스위치(48)가 「온」조작된 것인지의 여부를 판정한다(스텝S101). 컨트롤러(100)는 자동 선회 스위치(48)가 「온」조작되었을 경우(스텝S101:Yes), 모종이식기(1)가 선회 개시 위치(P1)에 도달했는지의 여부를 판정한다(스텝S102). 컨트롤러(100)는 선회 개시 위치(P1)에 도달했다고 판정하면(스텝S102:Yes), 제 1 선회 동작 모드의 실행을 개시한다(스텝S103).As shown in Fig. 6, in the first embodiment, the
컨트롤러(100)는 (스텝S101)의 처리에 있어서 자동 선회 스위치(48)가 「온」조작되지 않는 경우(스텝S101:No), 「온」조작될 때까지 걸리는 처리를 반복한다. 또한 컨트롤러(100)는 (스텝S102)의 처리에 있어서 모종이식기(1)가 선회 개시 위치(P1)에 도달하지 않은 경우(스텝S102:No), 선회 개시 위치(P1)에 도달할 때까지 걸리는 처리를 반복한다.When the
이어서, 컨트롤러(100)는 모종이식기(1)가 제 1 선회 동작 모드의 종료 위치(모드 종료 위치)(P3)에 도달했는지의 여부를 판정한다(스텝S104). 컨트롤러(100)는 모드 종료 위치(P3)에 도달한 경우(스텝S104:Yes), 제 1 선회 동작 모드의 실행을 종료하고(스텝S105), 제 2 선회 동작 모드의 실행을 개시한다(스텝S106).Next, the
컨트롤러(100)는 (스텝S104)의 처리에 있어서 모종이식기(1)가 모드 종료 위치(P3)에 도달하지 않은 경우(스텝S104:No), 모드 종료 위치(P3)에 도달할 때까지 걸리는 처리를 반복한다.When the
이어서, 컨트롤러(100)는 모종이식기(1)가 제 2 선회 동작 모드의 종료 위치이기도 한 선회 종료 위치(P2)에 도달했는지의 여부를 판정한다(스텝S107). 컨트롤러(100)는 선회 종료 위치(P2)에 도달한 경우(스텝S107:Yes), 제 2 선회 동작 모드의 실행을 종료하고(스텝S108), 선회 동작 모드를 종료한다.Next, the
여기에서, 컨트롤러(100)는 제 1 선회 동작 모드에 있어서, 예를 들면, 기체의 방향이 직진 주행시를 0도로 해서 좌우 어느 한쪽 선회하는 측에, 예를 들면 70도가 되도록 스티어링 모터(95)(도 3 참조)를 제어한다. 컨트롤러(100)는 기체의 방향이 70도가 되면, 직진 주행으로 되돌리기 시작하도록, 즉, 기체의 방향이 90도가 되도록 스티어링 모터(95)를 제어한다.Here, in the first turning operation mode, in the first turning operation mode, for example, the steering motor 95 ( 3). When the direction of the aircraft is 70 degrees, the
컨트롤러(100)는 제 1 선회 동작 모드로부터 제 2 선회 동작 모드로 이행할 경우, 기체의 방향이 다음 조의 직진 주행 경로(L1)에 대해서, 예를 들면 0∼20도 범위내에 들어가도록 스티어링 모터(95)를 제어한다. 컨트롤러(100)는 제 2 선회 동작 모드의 개시시에 기체의 방향을 0∼20도 범위내에 들어가게 함으로써 제 2 선회 동작 모드에 있어서 위치 취득 장치(150)(도 3 참조)가 취득하는 위치 정보에 의거하여 직진 주행 경로(L1)를 따르도록 기체의 방향을 보정해서 선회 동작을 완료한다.When the
컨트롤러(100)는 (스텝S107)의 처리에 있어서 모종이식기(1)가 선회 종료 위치(P2)에 도달하지 않은 경우(스텝S107:No), 선회 종료 위치(P2)에 도달할 때까지 걸리는 처리를 반복한다. 컨트롤러(100)는 선회 동작 모드를 종료하면, 자동 직진 모드의 실행을 개시한다.In the case where the
또한 도 7에 나타내듯이 컨트롤러(100)는 도 6에 나타내는 (스텝S101)의 처리에 있어서, 자동 직진 모드에 의한 진행중, 위치 취득 장치(150)가 취득한 위치 정보에 의거하여 모종이식기(1)의 현재위치로부터 선회 개시 위치(P1)까지의 거리가 소정의 거리(D) 이하인지의 여부를 판정한다(스텝S1011). 컨트롤러(100)는 측위정보에 의거하여 주행거리를 산출하고, 모종이식기(1)의 현재위치로부터 선회 개시 위치(P1)까지의 거리가 소정의 거리(D) 이하인지의 여부를 판정한다. 또, 컨트롤러(100)는 주행차륜의 회전수에 의거하여 주행거리를 산출해도 좋다.In addition, as shown in FIG. 7, in the processing of (step S101) shown in FIG. 6, the
컨트롤러(100)는 금회의 직진 주행시에 있어서의 식부 공정보다 하나앞의 식부 공정인 앞공정에 있어서의 주행거리에 의거하여 상기 판정을 행한다.The
금회의 식부 공정에 있어서의 선회 개시 위치(P1)는 금회의 식부 공정에 있어서, 앞공정에 있어서의 주행거리분, 진행한 부근이라고 예측할 수 있다. 예를 들면 금회의 식부 공정에 있어서 실제로 선회가 개시되는 위치는 앞공정에 있어서의 주행거리에 대해서±5m 정도의 범위내라고 예측할 수 있다.It can be predicted that the turning start position P1 in this planting process is the mileage in the preceding process in this planting process, and the vicinity which advanced. For example, in this planting process, the position where the turn is actually started can be predicted to be within a range of about ±5m with respect to the mileage in the preceding process.
그 때문에 컨트롤러(100)는 앞공정에 있어서의 주행거리에 의거하여 선회 개시 위치(P1)를 예측한다. 구체적으로는 컨트롤러(100)는 금회의 식부 공정에 있어서 직진한 거리가 앞공정에 있어서의 주행거리가 되는 위치를 선회 개시 위치(P1)라고 예측하고, 모종이식기(1)의 현재위치로부터 선회 개시 위치(P1)까지의 거리가 소정의 거리(D) 이하인 경우에, 선회 위치 부근, 즉 두렁가라고 판정한다.Therefore, the
또, 선회 개시 위치(P1)는 측위정보에 의거한 좌표에 의해 인식되어도 좋다.Further, the turning start position P1 may be recognized by coordinates based on the positioning information.
컨트롤러(100)는 선회 개시 위치(P1)까지의 거리가 소정의 거리(D) 이하인 경우(스텝S1011:Yes), 자동 선회 스위치(48)가 「온」조작되면, 제 1 선회 동작 모드를 실행한다(스텝S1012).The
컨트롤러(100)는 (스텝S1011)의 처리에 있어서 선회 개시 위치(P1)까지의 거리가 소정의 거리(D)를 초과할 경우(스텝S1011:No), 자동 선회 스위치(48)가 「온」조작되어도, 제 1 선회 동작 모드를 실행하지 않고(스텝S1013), 자동 직진 모드를 계속한다.When the distance to the turning start position P1 exceeds a predetermined distance D in the processing of (step S1011) (step S1011: No), the
또한 제 1 선회 동작 모드의 종료 위치(P3)는 회전수 센서(90)(도 3 참조)에 의해 검출(카운트)된 후륜(11)(도 1 참조)의 회전수에 의거하여 설정된다. 도 8에 나타내듯이 컨트롤러(100)는 도 6에 나타내는 (스텝S103)의 처리에 있어서, 제 1 선회 동작 모드의 실행을 개시하면, 이것에 따라, 후륜(11)의 회전수의 카운트를 개시하고(스텝S1031), 후륜(11)의 회전수가 소정의 값(카운트 값)으로 되었는지의 여부를 판정한다(스텝S1032).In addition, the end position P3 of the first turning operation mode is set based on the number of revolutions of the rear wheels 11 (see Fig. 1) detected (counted) by the number of revolutions sensor 90 (see Fig. 3). As shown in Fig. 8, when the execution of the first turning operation mode is started in the processing of (step S103) shown in Fig. 6, the
컨트롤러(100)는 후륜(11)의 회전수가 소정의 카운트 값으로 된 경우(스텝S1032:Yes), 종료 위치(P3)에 도달했다고 판단해서 제 1 선회 동작 모드의 실행을 종료함과 아울러 제 2 선회 동작 모드를 실행한다(스텝S1033). 컨트롤러(100)는 (스텝S1032)의 처리에 있어서 후륜(11)의 회전수가 소정의 카운트 값이 아닌 경우(스텝S1032:No), 소정의 카운트 값이 될 때까지 걸리는 처리를 반복한다.When the number of rotations of the
이상에서 설명한 제 1 실시형태에 의하면, 모종이식기(1)의 선회 개시시에는 제 1 선회 동작 모드를 실행하고, 선회 종료시에는 제 2 선회 동작 모드를 실행함으로써, 보다 간소한 제어로 자동 선회를 행할 수 있다.According to the first embodiment described above, by executing the first turning operation mode at the start of turning of the
또한 제 1 선회 동작 모드의 개시에 따라 후륜(11)의 회전수의 카운트를 개시하고, 후륜(11)의 회전수가 소정의 카운트 값이 되면 제 2 선회 동작 모드로 이행하므로, 자동 선회중에 위치 정보를 사용하는 제어가 일부이어도 되게 되어 간소한 제어로 자동 선회를 행할 수 있다.In addition, counting of the number of revolutions of the
또한 모종이식기(1)의 현재위치로부터 선회 개시 위치(P1)까지 거리가 짧은 경우에는 자동 선회 스위치(48)가 「온」조작되면 제 1 선회 동작 모드를 실행한다. 한편, 모종이식기(1)의 현재위치로부터 선회 개시 위치(P1)까지 거리가 긴 경우에는 자동 선회 스위치(48)가 조작되어도 제 1 선회 동작 모드를 실행하지 않는다. 이렇게, 예를 들면, 포장의 중앙부근 등의 선회 개시 위치(P1) 이외에서 자동 선회 스위치(48)가 조작(즉, 오조작)되어도 제 1 선회 동작 모드를 실행하지 않음으로써 오조작을 방지할 수 있다.In addition, when the distance from the current position of the
또한 선회 종료 위치(P2)를 향한 제 2 선회 동작 모드가 종료하면 그대로 자동 직진 모드로 이행해서 자동 직진을 개시하므로 작업을 계속적으로 행할 수 있고, 작업성을 향상시킬 수 있다.In addition, when the second turning operation mode toward the turning end position P2 ends, the automatic straight forward mode is shifted to the automatic straight forward mode and the automatic straight forward is started, so that the work can be continued and workability can be improved.
또, 제 1 실시형태에서는 제 1 선회 동작 모드를 실행하고 나서 제 2 선회 동작 모드를 실행하지만, 변형예로서, 예를 들면, 제 2 선회 동작 모드를 실행하고 나서 제 1 선회 동작 모드를 실행해서 선회 종료 위치(P2)에 도달시켜도 좋다.In addition, in the first embodiment, the first turning operation mode is executed and then the second turning operation mode is executed, but as a modification, for example, after executing the second turning operation mode, the first turning operation mode is executed. You may reach the turning end position P2.
<제 2 실시형태에 따른 자동 선회 모드><Automatic turning mode according to the second embodiment>
다음에 도 9 및 도 10을 참조해서 제 2 실시형태에 따른 자동 선회 모드에 대해서 설명한다. 도 9는 제 2 실시형태에 따른 자동 선회 제어(자동 선회 모드)의 설명도이다. 도 10은 제 2 실시형태에 따른 자동 선회 제어(자동 선회 모드)의 처리 순서를 나타내는 플로우차트이다.Next, an automatic turning mode according to the second embodiment will be described with reference to Figs. 9 and 10. 9 is an explanatory diagram of automatic turning control (automatic turning mode) according to the second embodiment. Fig. 10 is a flowchart showing a processing procedure of automatic turning control (automatic turning mode) according to the second embodiment.
도 9에 나타내듯이 제 2 실시형태에 따른 자동 선회 모드에서는 상기한 제 1 실시형태와 마찬가지로, 자동 직진 모드에서 진행해 온 모종이식기(1)는 미리 설정된 원하는 선회 개시 위치(P1)에 근접한 위치에서 조종자에 의해 자동 선회 스위치(48)(도 3 참조)가 눌려지면 자동 선회를 개시한다.As shown in Fig. 9, in the automatic turning mode according to the second embodiment, as in the first embodiment, the
자동 선회를 개시하면, 모종이식기(1)는 제 2 선회 동작 모드(1회째)에 의한 진행을 개시하고, 선회 주행 경로(L2)를 따라 진행한다. 모종이식기(1)는 선회 주행 경로(L2) 상의 종료 위치(모드 종료 위치)(P4)에서 1회째의 제 2 선회 동작 모드에 의한 진행을 종료한다.When the automatic turning is started, the
모종이식기(1)는 1회째의 제 2 선회 동작 모드에 의한 진행을 종료하면, 제 1 선회 동작 모드에 의한 진행을 개시한다. 모종이식기(1)는 선회 주행 경로(L2) 상의 모드 종료 위치(P5)에서 제 1 선회 동작 모드에 의한 진행을 종료한다. 모종이식기(1)는 제 1 선회 동작 모드에 의한 진행을 종료하면, 다시 제 2 선회 동작 모드(2회째)에 의한 진행을 개시한다.When the
2회째의 제 2 선회 동작 모드에서는 모종이식기(1)는 미리 설정된 원하는 선회 종료 위치(P2)에 있어서 다음 조의 직진 주행 경로(L1)를 따르도록 서서히 위치를 보정하면서 진행(직진)하고, 2회째의 제 2 선회 동작 모드에 의한 진행을 종료하면, 자동 직진 모드에서 다음 조에 있어서의 진행을 개시한다.In the second second turning operation mode, the
도 10에 나타내듯이 제 2 실시형태에서는 컨트롤러(100)는 자동 선회 스위치(48)가 「온」조작되었는지의 여부를 판정한다(스텝S201). 컨트롤러(100)는 자동 선회 스위치(48)가 「온」조작되었을 경우(스텝S201:Yes), 모종이식기(1)가 선회 개시 위치(P1)에 도달했는지의 여부를 판정한다(스텝S202). 컨트롤러(100)는 선회 개시 위치(P1)에 도달했다고 판정하면(스텝S202:Yes), 제 2 선회 동작 모드(1회째)의 실행을 개시한다(스텝S203).As shown in Fig. 10, in the second embodiment, the
컨트롤러(100)는 (스텝S201)의 처리에 있어서 자동 선회 스위치(48)가 「온」조작되지 않은 경우(스텝S201:No), 「온」조작될 때까지 걸리는 처리를 반복한다. 또한 컨트롤러(100)는 (스텝S202)의 처리에 있어서 모종이식기(1)가 선회 개시 위치(P1)에 도달하지 않은 경우(스텝S202:No), 선회 개시 위치(P1)에 도달할 때까지 걸리는 처리를 반복한다.When the
이어서, 컨트롤러(100)는 모종이식기(1)가 1회째의 제 2 선회 동작 모드의 종료 위치(모드 종료 위치)(P4)에 도달했는지의 여부를 판정한다(스텝S204). 컨트롤러(100)는 모드 종료 위치(P4)에 도달했을 경우(스텝S204:Yes), 1회째의 제 2 선회 동작 모드의 실행을 종료하고(스텝S205), 제 1 선회 동작 모드의 실행을 개시한다(스텝S206).Next, the
컨트롤러(100)는 (스텝S204)의 처리에 있어서 모종이식기(1)가 모드 종료 위치(P4)에 도달하지 않은 경우(스텝S204:No), 모드 종료 위치(P4)에 도달할 때까지 걸리는 처리를 반복한다.In the case where the
이어서, 컨트롤러(100)는 모종이식기(1)가 제 1 선회 동작 모드의 종료 위치(모드 종료 위치)(P5)에 도달했는지의 여부를 판정한다(스텝S207). 컨트롤러(100)는 모드 종료 위치(P5)에 도달했을 경우(스텝S207:Yes), 제 1 선회 동작 모드의 실행을 종료하고(스텝S208), 제 2 선회 동작 모드(2회째)의 실행을 개시한다(스텝S209).Subsequently, the
컨트롤러(100)는 스텝S207의 처리에 있어서 모종이식기(1)가 모드 종료 위치(P5)에 도달하지 않은 경우(스텝S207:No), 모드 종료 위치(P5)에 도달할 때까지 걸리는 처리를 반복한다.When the
이어서, 컨트롤러(100)는 모종이식기(1)가 2회째의 제 2 선회 동작 모드의 종료 위치이기도 한 선회 종료 위치(P2)에 도달했는지의 여부를 판정한다(스텝S210). 컨트롤러(100)는 선회 종료 위치(P2)에 도달했을 경우(스텝S210:Yes), 2회째의 제 2 선회 동작 모드의 실행을 종료하고(스텝S211), 선회 동작 모드를 종료한다.Subsequently, the
컨트롤러(100)는 (스텝S210)의 처리에 있어서 모종이식기(1)가 선회 종료 위치(P2)에 도달하지 않은 경우(스텝S210:No), 선회 종료 위치(P2)에 도달할 때까지 걸리는 처리를 반복한다. 컨트롤러(100)는 선회 동작 모드를 종료하면, 자동 직진 모드의 실행을 개시한다.When the
여기에서, 컨트롤러(100)는 제 1 선회 동작 모드로부터 2회째의 제 2 선회 동작 모드로 이행할 경우, 기체의 방향이 다음 조의 직진 주행 경로(L1)에 대해서, 예를 들면 0∼20도 범위내에 들어가도록 스티어링 모터(95)를 제어한다. 컨트롤러(100)는 2회째의 제 2 선회 동작 모드의 개시시에 기체의 방향을 0∼20도 범위내에 들어가게 함으로써 2회째의 제 2 선회 동작 모드에 있어서 위치 취득 장치(150)(도 3 참조)가 취득하는 위치 정보에 의거하여 직진 주행 경로(L1)를 따르도록 기체의 방향을 보정해서 선회 동작을 완료한다.Here, when the
또한 제 2 실시형태에 있어서도, 제 1 실시형태와 마찬가지로, 컨트롤러(100)는 도 10에 나타내는 (스텝S201)의 처리에 있어서, 자동 직진 모드에 의한 진행중, 위치 취득 장치(150)(도 3 참조)가 취득한 위치 정보에 의거하여 모종이식기(1)의 현재위치가 선회 개시 위치(P1)까지의 거리가 소정의 거리(D) 이하인지의 여부를 판정한다.Also in the second embodiment, similarly to the first embodiment, in the processing of (step S201) shown in FIG. 10, the
컨트롤러(100)는 선회 개시 위치(P1)까지의 거리가 소정의 거리(D) 이하인 경우, 자동 선회 스위치(48)가 「온」조작되면, 1회째의 제 2 선회 동작 모드를 실행한다.When the distance to the turning start position P1 is less than or equal to the predetermined distance D, the
컨트롤러(100)는 선회 개시 위치(P1)까지의 거리가 소정의 거리(D)를 초과할 경우, 자동 선회 스위치(48)가 「온」조작되어도, 제 1 선회 동작 모드를 실행하지 않고, 자동 직진 모드를 계속한다.The
또한 제 2 실시형태에 있어서도, 제 1 실시형태와 마찬가지로, 제 1 선회 동작 모드의 종료 위치(P5)는 회전수 센서(90)(도 3 참조)에 의해 카운트된 후륜(11)(도 1 참조)의 회전수에 의거하여 설정된다. 컨트롤러(100)는 도 10에 나타내는 (스텝S206)의 처리에 있어서, 제 1 선회 동작 모드의 실행을 개시하면, 이것에 따라, 후륜(11)의 회전수의 카운트를 개시하고, 후륜(11)의 회전수가 소정의 카운트 값이 되었는지의 여부를 판정한다.Also in the second embodiment, as in the first embodiment, the end position P5 of the first turning operation mode is the rear wheel 11 (see Fig. 1) counted by the rotation speed sensor 90 (see Fig. 3). ) Is set based on the number of rotations. When the
컨트롤러(100)는 후륜(11)의 회전수가 소정의 카운트 값이 되었을 경우, 모드 종료 위치(P5)에 도달했다고 판단해서 제 1 선회 동작 모드의 실행을 종료함과 아울러 2회째의 제 2 선회 동작 모드를 실행한다. 컨트롤러(100)는 후륜(11)의 회전수가 소정의 카운트 값이 아닌 경우, 소정의 카운트 값이 될 때까지 걸리는 처리를 반복한다.When the number of rotations of the
이상에서 설명한 제 2 실시형태에 의하면, 모종이식기(1)의 선회 개시시에는 제 1 선회 동작 모드를 실행하고, 선회 종료시에는 제 2 선회 동작 모드를 실행함으로써 보다 간소한 제어로 자동 선회를 행할 수 있다.According to the second embodiment described above, the first turning operation mode is executed at the start of turning of the
또한 1회째의 제 2 선회 동작 모드의 종료후인 선회 도중의 기체 직진시에 제 1 선회 동작 모드를 실행하므로, 제 1 선회 동작 모드에 있어서의 후륜(11)의 슬립에 의한 주행오차를 줄일 수 있어 선회 행정의 전체로서 자동 선회를 정확하게 행할 수 있다.In addition, since the first turning operation mode is executed when the aircraft goes straight during the turning after the end of the first second turning operation mode, it is possible to reduce a running error due to slip of the
또한 제 1 선회 동작 모드의 개시에 따라 후륜(11)의 회전수의 카운트를 개시하고, 후륜(11)의 회전수가 소정의 카운트 값이 되면 2회째의 제 2 선회 동작 모드로 이행하므로, 자동 선회중에 위치 정보를 사용하는 제어가 일부이어도 되게 되어 간소한 제어로 자동 선회를 행할 수 있다.In addition, counting of the number of revolutions of the
또한 모종이식기(1)의 현재위치로부터 선회 개시 위치(P1)까지 거리가 짧은 경우에는 자동 선회 스위치(48)가 「온」조작되면 제 1 선회 동작 모드를 실행한다. 한편, 모종이식기(1)의 현재위치로부터 선회 개시 위치(P1)까지 거리가 긴 경우에는 자동 선회 스위치(48)가 조작되어도 제 1 선회 동작 모드를 실행하지 않는다. 이렇게, 예를 들면, 포장의 중앙 부근 등의 선회 개시 위치(P1) 이외에서 자동 선회 스위치(48)가 조작(즉, 오조작)되어도 제 1 선회 동작 모드를 실행하지 않음으로써 오조작을 방지할 수 있다.In addition, when the distance from the current position of the
또한 선회 종료 위치(P2)를 향한 2회째의 제 2 선회 동작 모드가 종료하면 그대로 자동 직진 모드로 이행해서 자동 직진을 개시하므로 작업을 계속적으로 행할 수 있어 작업성을 향상시킬 수 있다.In addition, when the second second turning operation mode toward the turning end position P2 is ended, the automatic straight forward mode is shifted to the automatic straight forwarding mode and the automatic straight forwarding is started, so that the work can be continuously performed and workability can be improved.
또, 제 2 실시형태에서는 제 2 선회 동작 모드를 실행하고 나서 제 1 선회 동작 모드를 실행하고, 다시 제 2 선회 동작 모드를 실행하지만, 변형예로서, 예를 들면, 제 1 선회 동작 모드를 실행하고 나서 제 2 선회 동작 모드를 실행하고, 다시 제 1 선회 동작 모드를 실행해서 선회 종료 위치(P2)에 도달시켜도 좋다.Further, in the second embodiment, after executing the second turning operation mode, the first turning operation mode is executed, and then the second turning operation mode is again executed. As a modified example, for example, the first turning operation mode is executed. After that, the second turning operation mode may be executed, and the first turning operation mode may be executed again to reach the turning end position P2.
또한 제 1 선회 동작 모드 및 제 2 선회 동작 모드를 각각 2회 이상 실행하는 자동 선회 모드로 해도 좋다.Further, the first turning operation mode and the second turning operation mode may be set as an automatic turning mode in which each is executed two or more times.
<제 3 실시형태에 따른 자동 선회 모드><Automatic turning mode according to the third embodiment>
다음에 도 11 및 도 12를 참조해서 제 3 실시형태에 따른 자동 선회 모드에 대해서 설명한다. 도 11은 제 3 실시형태에 따른 자동 선회 제어(자동 선회 모드)의 설명도이다. 도 12는 제 3 실시형태에 따른 자동 선회 제어(자동 선회 모드)의 처리 순서를 나타내는 플로우차트이다.Next, an automatic turning mode according to the third embodiment will be described with reference to Figs. 11 and 12. Fig. 11 is an explanatory diagram of automatic turning control (automatic turning mode) according to the third embodiment. Fig. 12 is a flowchart showing a processing procedure of automatic turning control (automatic turning mode) according to the third embodiment.
도 11에 나타내듯이 제 3 실시형태는 모종이식기(1)가 두렁까지 전진하고, 소정의 거리 후진하고 나서 선회하는, 소위 막다른 길의 백 선회의 경우에 있어서의 자동 선회 모드이다.As shown in Fig. 11, the third embodiment is an automatic turning mode in the case of a so-called back turn of a dead end, in which the
제 3 실시형태에 따른 자동 선회 모드에서는 자동 직진 모드에서 두렁가까지 진행한 모종이식기(1)는 조종자에 의해 변속 조작 레버(HST 레버라고 한다)(36)(도 3 참조)가 후진측으로 조작되면, 다음 조에 있어서의 작업 라인(선회 주행 경로(L2) 및 다음의 조의 직진 주행 경로(L1))을 취득하고, 후진 동작을 포함하는 자동 선회를 개시한다.In the automatic turning mode according to the third embodiment, when the shift operation lever (referred to as HST lever) 36 (refer to Fig. 3) is operated to the reverse side of the
자동 선회를 개시하면, 모종이식기(1)는 소정의 거리 후진한 후, 제 2 선회 동작 모드(1회째)에 의한 진행을 개시하고, 선회 주행 경로(L2)를 따라 진행한다. 모종이식기(1)는 선회 주행 경로(L2) 상의 종료 위치(모드 종료 위치)(P6)에서 1회째의 제 2 선회 동작 모드에 의한 진행을 종료한다.When the automatic turning is started, the
모종이식기(1)는 1회째의 제 2 선회 동작 모드에 의한 진행을 종료하면, 제 1 선회 동작 모드에 의한 진행을 개시한다. 모종이식기(1)는 선회 주행 경로(L2) 상의 모드 종료 위치(P7)에서 제 1 선회 동작 모드에 의한 진행을 종료한다. 모종이식기(1)는 제 1 선회 동작 모드에 의한 진행을 종료하면, 다시 제 2 선회 동작 모드(2회째)에 의한 진행을 개시한다.When the
2회째의 제 2 선회 동작 모드에서는 모종이식기(1)는 미리 설정된 원하는 선회 종료 위치(P2)에 있어서 다음 조의 직진 주행 경로(L1)를 따르도록 서서히 위치를 보정하면서 진행(직진)하고, 2회째의 제 2 선회 동작 모드에 의한 진행을 종료하면, 자동 직진 모드에서 다음 조에 있어서의 진행을 개시한다.In the second second turning operation mode, the
도 12에 나타내듯이 제 3 실시형태에서는 컨트롤러(100)는 HST 레버(36)가 「후진」측으로 조작되었는지의 여부를 판정한다(스텝S301). 컨트롤러(100)는 HST 레버(36)가 「후진」측으로 조작된 경우(스텝S301:Yes), 모종이식기(1)의 후진을 개시한다(스텝S302).As shown in Fig. 12, in the third embodiment, the
컨트롤러(100)는 모종이식기(1)가 선회 개시 위치(P1)에 도달했는지의 여부를 판정한다(스텝S303). 컨트롤러(100)는 선회 개시 위치(P1)에 도달했다고 판정하면(스텝S303:Yes), 모종이식기(1)의 후진을 종료하고(스텝S304), 제 2 선회 동작 모드(1회째)의 실행을 개시한다(스텝S305).The
컨트롤러(100)는 (스텝S301)의 처리에 있어서 HST 레버(36)가 「후진」측으로 조작되지 않는 경우(스텝S301:No), 「후진」측으로 조작될 때까지 걸리는 처리를 반복한다. 또한 컨트롤러(100)는 (스텝S303)의 처리에 있어서 모종이식기(1)가 선회 개시 위치(P1)에 도달하지 않은 경우(스텝S303:No), 선회 개시 위치(P1)에 도달할 때까지 걸리는 처리를 반복한다.When the
이어서, 컨트롤러(100)는 모종이식기(1)가 1회째의 제 2 선회 동작 모드의 종료 위치(모드 종료 위치)(P6)에 도달했는지의 여부를 판정한다(스텝S306). 컨트롤러(100)는 모드 종료 위치(P6)에 도달한 경우(스텝S306:Yes), 1회째의 제 2 선회 동작 모드의 실행을 종료하고(스텝S307), 제 1 선회 동작 모드의 실행을 개시한다(스텝S308).Next, the
컨트롤러(100)는 (스텝S306)의 처리에 있어서 모종이식기(1)가 모드 종료 위치(P5)에 도달하지 않은 경우(스텝S306:No), 모드 종료 위치(P6)에 도달할 때까지 걸리는 처리를 반복한다. In the case where the
이어서, 컨트롤러(100)는 모종이식기(1)가 제 1 선회 동작 모드의 종료 위치(모드 종료 위치)(P7)에 도달했는지의 여부를 판정한다(스텝S309). 컨트롤러(100)는 모드 종료 위치(P7)에 도달한 경우(스텝S309:Yes), 제 1 선회 동작 모드의 실행을 종료하고(스텝S310), 제 2 선회 동작 모드(2회째)의 실행을 개시한다(스텝S311).Subsequently, the
컨트롤러(100)는 (스텝S309)의 처리에 있어서 모종이식기(1)가 모드 종료 위치(P7)에 도달하지 않은 경우(스텝S309:No), 모드 종료 위치(P7)에 도달할 때까지 걸리는 처리를 반복한다.When the
이어서, 컨트롤러(100)는 모종이식기(1)가 2회째의 제 2 선회 동작 모드의 종료 위치이기도 한 선회 종료 위치(P2)에 도달했는지의 여부를 판정한다(스텝S312). 컨트롤러(100)는 선회 종료 위치(P2)에 도달한 경우(스텝S312:Yes), 2회째의 제 2 선회 동작 모드의 실행을 종료하고(스텝S313), 선회 동작 모드를 종료한다.Next, the
컨트롤러(100)는 (스텝S312)의 처리에 있어서 모종이식기(1)가 선회 종료 위치(P2)에 도달하지 않은 경우(스텝S312:No), 선회 종료 위치(P2)에 도달할 때까지 걸리는 처리를 반복한다. 컨트롤러(100)는 선회 동작 모드를 종료하면, 자동 직진 모드의 실행을 개시한다.In the case where the
여기에서, 컨트롤러(100)는 제 1 선회 동작 모드로부터 2회째의 제 2 선회 동작 모드로 이행할 경우, 기체의 방향이 다음 조의 직진 주행 경로(L1)에 대해서, 예를 들면 0∼20도 범위내에 들어가도록 스티어링 모터(95)를 제어한다. 컨트롤러(100)는 2회째의 제 2 선회 동작 모드의 개시시에 기체의 방향을 0∼20도 범위내에 들어가게 함으로써 2회째의 제 2 선회 동작 모드에 있어서 위치 취득 장치(150)(도 3 참조)가 취득하는 위치 정보에 의거하여 직진 주행 경로(L1)를 따르도록 기체의 방향을 보정해서 선회 동작을 완료한다.Here, when the
또한 제 3 실시형태에 있어서도, 제 1 및 제 2 실시형태와 마찬가지로, 제 1 선회 동작 모드의 종료 위치(P7)는 회전수 센서(90)(도 3 참조)에 의해 카운트된 후륜(11)(도 1 참조)의 회전수에 의거하여 설정된다. 컨트롤러(100)는 도 12에 나타내는 (스텝S308)의 처리에 있어서, 제 1 선회 동작 모드의 실행을 개시하면, 이것에 따라, 후륜(11)의 회전수의 카운트를 개시하고, 후륜(11)의 회전수가 소정의 카운트 값이 되었는지의 여부를 판정한다.Also in the third embodiment, as in the first and second embodiments, the end position P7 of the first turning operation mode is the rear wheel 11 ( 1)). When the
컨트롤러(100)는 후륜(11)의 회전수가 소정의 카운트 값이 된 경우, 모드 종료 위치(P7)에 도달했다고 판단해서 제 1 선회 동작 모드의 실행을 종료함과 아울러 2회째의 제 2 선회 동작 모드를 실행한다. 컨트롤러(100)는 후륜(11)의 회전수가 소정의 카운트 값이 아닌 경우, 소정의 카운트 값이 될 때까지 걸리는 처리를 반복한다.When the number of rotations of the
또, 컨트롤러(100)는 선회 동작 초기의 후진 주행에 있어서도, 주행차륜인 후륜(11)의 회전수에 의거하여 선회 개시 위치(P1)에 도달했는지의 여부를 판정한다.In addition, the
이상에서 설명한 제 3 실시형태에 의하면, 제 1 및 제 2 실시형태와 마찬가지로, 모종이식기(1)의 선회 개시시에는 제 1 선회 동작 모드를 실행하고, 선회 종료시에는 제 2 선회 동작 모드를 실행함으로써 보다 간소한 제어로 자동 선회를 행할 수 있다.According to the third embodiment described above, as in the first and second embodiments, the first turning operation mode is executed at the start of turning of the
또한 1회째의 제 2 선회 동작 모드의 종료 후인 선회 도중의 기체 직진시에 제 1 선회 동작 모드를 실행하므로, 제 1 선회 동작 모드에 있어서의 후륜(11)의 슬립에 의한 주행오차를 줄일 수 있고, 선회 행정의 전체로서 자동 선회를 정확하게 행할 수 있다.In addition, since the first turning operation mode is executed when the aircraft goes straight during the turning after the end of the first second turning operation mode, it is possible to reduce a running error due to slip of the
또한 제 1 선회 동작 모드의 개시에 따라 후륜(11)의 회전수의 카운트를 개시하고, 후륜(11)의 회전수가 소정의 카운트 값이 되면 2회째의 제 2 선회 동작 모드로 이행하므로, 자동 선회중에 위치 정보를 사용하는 제어가 일부이어도 되게 되어 간소한 제어로 자동 선회를 행할 수 있다.In addition, counting of the number of revolutions of the
또한 선회 종료 위치(P2)를 향한 2회째의 제 2 선회 동작 모드가 종료하면 그대로 자동 직진 모드로 이행해서 자동 직진을 개시하므로, 작업을 계속적으로 행할 수 있어 작업성을 향상시킬 수 있다.In addition, when the second second turning operation mode toward the turning end position P2 is ended, the automatic straight forward mode is shifted to the automatic straight forward mode as it is, and the automatic straight forwarding is started, so that the work can be continued and workability can be improved.
또, 제 3 실시형태에 있어서도, 변형예로서, 예를 들면, 제 1 선회 동작 모드를 실행하고 나서 제 2 선회 동작 모드를 실행하고, 다시 제 1 선회 동작 모드를 실행해서 선회 종료 위치(P2)에 도달시켜도 좋다.Also in the third embodiment, as a modified example, for example, after the first turning operation mode is executed, the second turning operation mode is executed, the first turning operation mode is again executed, and the turning end position (P2) You may reach
또한 제 1 선회 동작 모드 및 제 2 선회 동작 모드를 각각 2회 이상 실행하는 자동 선회 모드로 해도 좋다.Further, the first turning operation mode and the second turning operation mode may be set as an automatic turning mode in which each is executed two or more times.
또, 제 1∼제 3 실시형태에 있어서, 컨트롤러(100)는 자동 선회 모드에서는 모종이식기(1)의 주행속도에 상한값을 설정해서 차속을 제한하는 것이 바람직하다. 이것에 의해 선회 동작이 안정되어 안전성을 확보할 수 있다. 또한 컨트롤러(100)는 위치 취득 장치(150)로부터의 위치 정보에 의거하여 선회 종료라고 판단하면, 차속의 제한을 해제해서 변속 조작 레버(HST 레버)(36)의 위치에 따른 차속으로 한다.In addition, in the first to third embodiments, it is preferable that the
또한 제 1∼제 3 실시형태에 있어서, 컨트롤러(100)는 후륜(11)의 회전수를 변경 가능하게 설정한다. 또한 컨트롤러(100)는 자동 직진 모드 또는 자동 선회 모드의 실행중에 조종자에 의해 어시스트 레버가 「올림」 조작되었을 경우에는 각각의 모드를 해제한다.In addition, in the first to third embodiments, the
또한 제 1∼제 3 실시형태에 있어서, 컨트롤러(100)는 자동 선회 모드의 실행중에 있어서 조종자에 의해 Z턴을 「오프」로 하도록 조작된 경우에는 자동 선회 모드를 해제한다. 또한 컨트롤러(100)는 자동 선회 모드의 실행중에 있어서 조종자에 의해 선그리기 마커 자동 승강 스위치(49)(도 3 참조)가 「오프」조작된 경우에는 자동 선회 모드를 해제한다.In addition, in the first to third embodiments, the
또한 제 1∼제 3 실시형태에 있어서, 컨트롤러(100)는 자동 선회 모드의 실행중에 있어서 조종자에 의해 HST 레버(변속 조작 레버)(36)(도 3 참조)가 「후진」측으로 조작된 경우에는 자동 선회 모드를 해제한다. 또한 컨트롤러(100)는 자동 선회 모드의 실행중에 있어서 조종자에 의해 핸들(35)(도 3 참조)이 조작된 경우에는 자동 선회 모드를 해제한다.In addition, in the first to third embodiments, in the case where the
또한 제 1∼제 3 실시형태에 있어서, 컨트롤러(100)는 자동 선회 모드의 실행중에 있어서 모종이식기(1)가 정지하거나 엔진(30)(도 1 참조)이 정지한 경우에는 자동 선회 모드를 일시 중단(보류)한다. 또한 컨트롤러(100)는 자동 선회 모드의 실행중에 있어서 모종이식기(1)가 정지하거나 엔진(30)이 정지한 경우에 자동 선회 모드를 중지하도록 제어해도 좋다.In addition, in the first to third embodiments, the
또한 제 1∼제 3 실시형태에 있어서, 컨트롤러(100)는 두렁가 경보 해제 스위치가 눌려지면 두렁가 경보 작동시에 두렁가 정지를 해제한다. 또한 컨트롤러(100)는 자동 선회가 가능한지의 여부를 모니터(86)(도 3 참조)에 표시시켜도 좋다. 또, 컨트롤러(100)는 자동 선회가 불가능한 경우에는 예를 들면, 모니터(86)에 알러트를 표시시켜도 좋다.In addition, in the first to third embodiments, when the headland alarm release switch is pressed, the
또한 제 3 실시형태에 있어서, 컨트롤러(100)는 모종이식기(1)가 후진중에 정차해도, 자동 선회 모드를 중지하지 않는다. 이것에 의해 예를 들면, 모종 이음 등의 이변에 의해 후진시에 정차해도, 자동 선회를 계속할 수 있다.Further, in the third embodiment, the
또한 제 1∼제 3 실시형태에 있어서, 자동 선회 모드(제 3 실시형태에 있어서는 자동 선회 모드 중 후진 동작을 제외한 동작)를 제 1 선회 동작 모드에서만 완료하도록 구성해도 좋고, 제 2 선회 동작 모드에서만 완료하도록 구성해도 좋다.Further, in the first to third embodiments, the automatic turning mode (in the third embodiment, the operation excluding the reverse operation of the automatic turning mode) may be configured to be completed only in the first turning operation mode, and only in the second turning operation mode. You may configure it to complete.
또한 제 1∼제 3 실시형태에 있어서, 자동 선회의 개시는 모종식부부(4)를 승강시키는 승강 동작의 「올림 동작」이 행해지는 타이밍이어도 좋다. 즉, 자동 선회 스위치(48)는 조종자의 조작에 의해 모종식부부(4)를 상승시키는 스위치이어도 좋고, 모종식부부(4)의 상승을 검지, 또는 모종식부부(4)를 상승시키는 제어의 개시를 검지하는 검지부이어도 좋다.Further, in the first to third embodiments, the start of the automatic turning may be a timing at which the "raising operation" of the lifting operation for lifting the seedling unit 4 is performed. In other words, the
또한 자동 선회의 개시는 모종식부 장치(55)로의 동력전달이 「오프」가 되는 타이밍이나, 시비 장치(5)의 조출 장치(71)가 정지하는 타이밍이나, 정지(整地) 로터(63)에의 동력전달이 「오프」가 되는 타이밍이어도 좋다.In addition, the start of the automatic turning is a timing at which power transmission to the
이렇게, 자동 선회를 개시하는 타이밍은 모종식부부(4) 등의 포장 작업 장치의 구동이 「오프」가 되는 타이밍이면 좋다.In this way, the timing of starting the automatic turning may be a timing at which the driving of the packaging work device such as the seedling unit 4 is turned "off".
또한 작업 차량(1)은 트랙터이어도 좋다. 이 경우, 포장 작업 장치는 로터리 등이다. 트랙터의 선회에 있어서도, 상기 선회 제어를 적용할 수 있다.Further, the
추가적인 효과나 변형예는 당업자에 의해 용이하게 도출할 수 있다. 이 때문에, 본 발명의 보다 광범위한 형태는 이상과 같이 나타내고 또한 기술한 특정 상세 및 대표적인 실시형태에 한정되는 것은 아니다. 따라서, 첨부의 특허청구의 범위 및 그 균등물에 의해 정의되는 총괄적인 발명의 개념의 정신 또는 범위로부터 일탈하는 않고 여러가지 변경이 가능하다.Additional effects or modifications can be easily derived by those skilled in the art. For this reason, the broader aspects of the present invention are not limited to the specific details and representative embodiments shown and described above. Accordingly, various changes can be made without departing from the spirit or scope of the concept of the general invention defined by the scope of the appended claims and their equivalents.
1: 모종이식기(작업 차량)
2: 주행차체
10: 전륜(주행차륜)
35: 핸들(스티어링 장치)
90: 회전수 센서(검출 장치)
95: 스티어링 모터(모터)
100: 컨트롤러(제어 장치)
150: 위치 취득 장치
L1: 직진 주행 경로
L2: 선회 주행 경로
P2: 선회 종료 위치1: seedling transplanter (work vehicle)
2: running body
10: front wheel (driving wheel)
35: handle (steering device)
90: rotation speed sensor (detector)
95: steering motor (motor)
100: controller (control unit)
150: position acquisition device
L1: straight driving route
L2: turning travel path
P2: Turn end position
Claims (4)
상기 제어 장치(100)는 기체의 선회 개시시에는 상기 제 2 선회 동작 모드를 실행하고, 상기 제 2 선회 동작 모드가 종료하면 상기 제 1 선회 동작 모드를 실행하고, 상기 제 1 선회 동작 모드가 종료하면 상기 제 2 선회 동작 모드를 실행하는 것을 특징으로 하는 작업 차량.The method of claim 1,
The control device 100 executes the second turning operation mode when the aircraft starts turning, and when the second turning operation mode ends, executes the first turning operation mode, and the first turning operation mode ends. When the operation vehicle, characterized in that to execute the second turning operation mode.
상기 주행차륜(11)의 회전수를 검출하는 검출 장치(90)를 더 구비하고, 상기 검출 장치(90)는 상기 제 1 선회 동작 모드의 개시에 따라 상기 회전수의 검출을 개시하고, 상기 제어 장치(100)는 상기 회전수가 소정의 값이 되면 상기 제 2 선회 동작 모드로 이행하는 것을 특징으로 하는 작업 차량.The method according to claim 1 or 2,
A detection device 90 for detecting the rotation speed of the traveling wheel 11 is further provided, and the detection device 90 starts detection of the rotation speed at the start of the first turning operation mode, and the control The device (100) is a work vehicle, characterized in that the transition to the second turning operation mode when the number of revolutions reaches a predetermined value.
상기 제어 장치(100)는 직진 주행 경로(L1)를 따라 기체를 주행시키는 자동 직진 모드를 갖고, 원하는 선회 종료 위치(P2)를 향한 상기 제 2 선회 동작 모드가 종료하면 상기 자동 직진 모드로 이행하는 것을 특징으로 하는 작업 차량.The method according to any one of claims 1 to 3,
The control device 100 has an automatic straight forward mode for driving the aircraft along the straight travel path L1, and when the second turning operation mode toward the desired turning end position P2 ends, the automatic straight forward mode is transferred. Work vehicle, characterized in that.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JPJP-P-2019-077201 | 2019-04-15 | ||
JP2019077201A JP6835130B2 (en) | 2019-04-15 | 2019-04-15 | Work vehicle |
Publications (1)
Publication Number | Publication Date |
---|---|
KR20200121224A true KR20200121224A (en) | 2020-10-23 |
Family
ID=72912050
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020190170745A KR20200121224A (en) | 2019-04-15 | 2019-12-19 | Work vehicle |
Country Status (4)
Country | Link |
---|---|
JP (1) | JP6835130B2 (en) |
KR (1) | KR20200121224A (en) |
CN (1) | CN111824243A (en) |
TW (1) | TWI810418B (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2022091522A (en) * | 2020-12-09 | 2022-06-21 | 井関農機株式会社 | Work vehicle |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2016021890A (en) | 2014-07-17 | 2016-02-08 | 株式会社クボタ | Planting and sowing type field work machine and automatic steering system used for the same |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009245003A (en) * | 2008-03-28 | 2009-10-22 | Kubota Corp | Travel controller for working vehicle |
JP6945279B2 (en) * | 2016-06-28 | 2021-10-06 | 株式会社クボタ | Work platform |
JP6851589B2 (en) * | 2016-12-22 | 2021-03-31 | 株式会社クボタ | Work platform |
JP6832719B2 (en) * | 2017-01-24 | 2021-02-24 | 株式会社クボタ | Work vehicle |
-
2019
- 2019-04-15 JP JP2019077201A patent/JP6835130B2/en active Active
- 2019-12-16 TW TW108145978A patent/TWI810418B/en active
- 2019-12-17 CN CN201911303573.0A patent/CN111824243A/en active Pending
- 2019-12-19 KR KR1020190170745A patent/KR20200121224A/en unknown
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2016021890A (en) | 2014-07-17 | 2016-02-08 | 株式会社クボタ | Planting and sowing type field work machine and automatic steering system used for the same |
Also Published As
Publication number | Publication date |
---|---|
JP2020174535A (en) | 2020-10-29 |
CN111824243A (en) | 2020-10-27 |
JP6835130B2 (en) | 2021-02-24 |
TW202038698A (en) | 2020-11-01 |
TWI810418B (en) | 2023-08-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5040974B2 (en) | Farm work vehicle | |
JP7184123B2 (en) | work vehicle | |
JP2022097701A (en) | Work vehicle | |
EP3918893A1 (en) | Work vehicle automated travel system | |
JP7151669B2 (en) | work vehicle | |
JP7120878B2 (en) | Work equipment lifting control device | |
JP5664634B2 (en) | Rice transplanter | |
KR20200121224A (en) | Work vehicle | |
JP6904409B2 (en) | Work vehicle | |
JP2005198594A (en) | Controller for controlling lifting and lowering of transplanted seedling in seedling transplanter | |
JP4479245B2 (en) | Farm work vehicle | |
JP2020080686A5 (en) | ||
JP2020080686A (en) | Work vehicle | |
JP2019041620A (en) | Work vehicle | |
EP3918894A1 (en) | Autonomous travel system for work vehicle | |
JP2022085468A (en) | Work vehicle | |
JP7447881B2 (en) | work vehicle | |
JP2021122182A (en) | Work vehicle | |
JP7392689B2 (en) | work vehicle | |
JP7160072B2 (en) | work vehicle | |
JP7259814B2 (en) | work vehicle | |
JP7088346B1 (en) | Control device | |
CN117204181A (en) | paddy field working machine | |
JP2023176884A (en) | work vehicle | |
CN115136775A (en) | Working vehicle |