KR20220142373A - Path generating system - Google Patents
Path generating system Download PDFInfo
- Publication number
- KR20220142373A KR20220142373A KR1020220045594A KR20220045594A KR20220142373A KR 20220142373 A KR20220142373 A KR 20220142373A KR 1020220045594 A KR1020220045594 A KR 1020220045594A KR 20220045594 A KR20220045594 A KR 20220045594A KR 20220142373 A KR20220142373 A KR 20220142373A
- Authority
- KR
- South Korea
- Prior art keywords
- marker
- area
- path
- region
- combine
- Prior art date
Links
- 239000003550 marker Substances 0.000 claims abstract description 366
- 238000003860 storage Methods 0.000 claims description 56
- 238000000034 method Methods 0.000 claims description 4
- 230000002441 reversible effect Effects 0.000 claims description 2
- 230000002093 peripheral effect Effects 0.000 abstract description 9
- 238000003306 harvesting Methods 0.000 description 86
- 235000013339 cereals Nutrition 0.000 description 29
- 238000001514 detection method Methods 0.000 description 25
- 238000004806 packaging method and process Methods 0.000 description 18
- 239000000758 substrate Substances 0.000 description 16
- 238000013459 approach Methods 0.000 description 7
- 238000010586 diagram Methods 0.000 description 5
- 238000009826 distribution Methods 0.000 description 4
- 238000000691 measurement method Methods 0.000 description 4
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 4
- 238000005259 measurement Methods 0.000 description 3
- 230000002123 temporal effect Effects 0.000 description 3
- 239000011435 rock Substances 0.000 description 2
- 240000007594 Oryza sativa Species 0.000 description 1
- 235000007164 Oryza sativa Nutrition 0.000 description 1
- 244000131316 Panax pseudoginseng Species 0.000 description 1
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 description 1
- 235000003140 Panax quinquefolius Nutrition 0.000 description 1
- 244000061456 Solanum tuberosum Species 0.000 description 1
- 235000002595 Solanum tuberosum Nutrition 0.000 description 1
- 240000008042 Zea mays Species 0.000 description 1
- 235000005824 Zea mays ssp. parviglumis Nutrition 0.000 description 1
- 235000002017 Zea mays subsp mays Nutrition 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000008602 contraction Effects 0.000 description 1
- 235000005822 corn Nutrition 0.000 description 1
- 238000005520 cutting process Methods 0.000 description 1
- 235000008434 ginseng Nutrition 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
- 235000009566 rice Nutrition 0.000 description 1
- 230000002747 voluntary effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3407—Route searching; Route guidance specially adapted for specific applications
-
- 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
- A01B69/007—Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow
- A01B69/008—Steering or guiding of agricultural vehicles, e.g. steering of the tractor to keep the plough in the furrow automatic
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01D—HARVESTING; MOWING
- A01D41/00—Combines, i.e. harvesters or mowers combined with threshing devices
- A01D41/02—Self-propelled combines
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3407—Route searching; Route guidance specially adapted for specific applications
- G01C21/3415—Dynamic re-routing, e.g. recalculating the route when the user deviates from calculated route or after detecting real-time traffic data or accidents
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0234—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons
-
- G05D2201/0201—
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Life Sciences & Earth Sciences (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Environmental Sciences (AREA)
- Mechanical Engineering (AREA)
- Soil Sciences (AREA)
- Guiding Agricultural Machines (AREA)
- Aviation & Aerospace Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Electromagnetism (AREA)
Abstract
Description
본 발명은, 작업 차의 자동 주행을 위한 목표 주행 경로를 생성하는 경로 생성부를 구비하는 경로 생성 시스템에 관한 것이다.BACKGROUND OF THE
작업 차의 자동 주행을 위한 목표 주행 경로를 생성하는 시스템으로서, 예를 들어 특허문헌 1에 기재된 것이 이미 알려져 있다. 이 시스템에서는, 작업 차(특허문헌 1에서는 「자율 주행 작업 차량」)는, 미리 설정된 목표 주행 경로(특허문헌 1에서는 「설정 경로」)를 따라, 포장에서 자동 주행을 행한다.As a system for generating a target travel route for automatic travel of a work vehicle, for example, the one described in
특허문헌 1에는, 목표 주행 경로가 충족해야 하는 조건에 대해서는 상세하게 설명되어 있지 않다. 여기서, 평면으로 보아 작업 차를 둘러싸는 프레임상의 가상적인 마커를 설정함과 함께, 포장에 있어서의 주행 가능한 영역을 규정하여, 작업 차가 목표 주행 경로를 따라 자동 주행한 경우에 당해 마커가 당해 영역의 외측으로 나오지 않도록, 목표 주행 경로를 생성하는 것을 생각할 수 있다.
그러나, 이 구성에서는, 작업 차가 실제로는 통과할 수 있는 개소가, 통과할 수 없는 개소로서 판정되는 경우가 상정된다. 그 결과, 당해 개소를 우회하도록 목표 주행 경로가 생성됨으로써, 목표 주행 경로를 따른 자동 주행의 효율이 저하되어버리는 사태가 상정된다.However, in this configuration, it is assumed that a location through which the working vehicle can actually pass is determined as a location through which the work vehicle cannot pass. As a result, it is assumed that the target travel route is generated so as to detour the location, whereby the efficiency of automatic travel along the target travel route is reduced.
본 발명의 목적은, 생성되는 목표 주행 경로가 효율적인 것으로 되기 쉬운 경로 생성 시스템을 제공하는 것이다.SUMMARY OF THE INVENTION It is an object of the present invention to provide a route generating system in which a generated target travel route tends to be efficient.
본 발명의 특징은, 작업 차의 자동 주행을 위한 목표 주행 경로를 생성하는 경로 생성부를 구비하는 경로 생성 시스템이며, 상기 작업 차의 기체에 대한 상대 위치가 설정된 가상적인 제1 기준 마커를 기억하는 제1 기억부와, 상기 기체에 대한 상대 위치가 설정된 가상적인 제2 기준 마커를 기억하는 제2 기억부와, 포장을 둘러싸는 상태로 마련된 포장 외연부와 상기 포장의 경계의 주변에 설정된 제1 영역을 기억하는 제3 기억부와, 상기 경계의 주변에 설정된 제2 영역을 기억하는 제4 기억부를 구비하고, 상기 경로 생성부는, 상기 작업 차가 상기 목표 주행 경로를 따라 자동 주행한 경우에, 상기 제1 기준 마커가 상기 제1 영역의 외측으로 나오지 않고, 또한, 상기 제2 기준 마커가 상기 제2 영역의 외측으로 나오지 않도록, 상기 목표 주행 경로를 생성하는 것에 있다.A feature of the present invention is a path generating system including a path generating unit for generating a target travel path for automatic driving of a working vehicle, wherein a first reference marker having a relative position of the working vehicle with respect to the body of the working vehicle is set; A first storage unit, a second storage unit for storing a second virtual reference marker having a position relative to the body set, and a first area set around the boundary between the pavement outer edge and the pavement provided in a state of enclosing the pavement and a fourth storage unit for storing a second area set in the periphery of the boundary, wherein the path generating unit is configured to: The target travel route is generated so that the first reference marker does not come out of the first area and the second reference marker does not come out of the second area.
본 발명이라면, 제1 기준 마커 및 제2 기준 마커의 2가지의 가상적인 마커가 설정된다. 그리고, 경로 생성부는, 작업 차가 목표 주행 경로를 따라 자동 주행한 경우에, 제1 기준 마커가 제1 영역의 외측으로 나오지 않고, 또한, 제2 기준 마커가 제2 영역의 외측으로 나오지 않도록, 목표 주행 경로를 생성한다.According to the present invention, two hypothetical markers are set: a first fiducial marker and a second fiducial marker. The path generating unit is configured to prevent the first reference marker from coming out of the first area and the second reference marker from coming out of the second area when the work vehicle automatically travels along the target travel path. Create a driving route.
이에 의해, 목표 주행 경로의 생성 시, 제1 기준 마커가 제2 영역의 외측으로 나오는 것은 허용됨과 함께, 제2 기준 마커가 제1 영역의 외측으로 나오는 것은 허용되게 된다. 따라서, 제1 기준 마커 및 제2 기준 마커를, 작업 차의 입체 형상에 맞춰서 적절히 설정함과 함께, 이들 마커에 대응시켜서 2개의 영역을 설정함으로써, 생성되는 목표 주행 경로가 효율적인 것으로 되기 쉬워진다.Accordingly, when the target travel route is generated, the first fiducial marker is allowed to come out of the second region, and the second fiducial marker is allowed to come out of the first region. Accordingly, by appropriately setting the first reference marker and the second reference marker in accordance with the three-dimensional shape of the work vehicle, and setting two regions in correspondence with these markers, the generated target travel route is likely to be efficient.
예를 들어, 일반적으로, 포장 외연부는, 외측일수록 높아지게 경사져 있다. 여기서, 작업 차에 있어서의 높이(X)(X는 임의의 값)보다 하측 부분의 외형에 대응하도록 제1 기준 마커를 설정하고, 작업 차에 있어서의 높이(X) 이상의 부분의 외형에 대응하도록 제2 기준 마커를 설정하고, 포장 외연부와 포장의 경계에 대응하도록 제1 영역을 설정하고, 포장 외연부 중 높이(X)에 위치하는 각 지점을 연결한 선에 대응하도록 제2 영역을 설정하면, 목표 주행 경로는, 작업 차에 있어서의 높이(X)보다 하측 부분이 포장 외연부와 포장의 경계로부터 외측으로 나오지 않고, 또한, 작업 차에 있어서의 높이(X) 이상의 부분이 포장 외연부 중 높이(X)에 위치하는 각 지점을 연결한 선으로부터 외측으로 나가지 않도록 생성된다.For example, in general, the outer edge of the pavement is inclined to be higher toward the outside. Here, the first reference marker is set so as to correspond to the outer shape of the portion lower than the height X (X is an arbitrary value) in the work vehicle, and corresponds to the outer shape of the portion above the height X in the work vehicle. Set the second reference marker, set the first area to correspond to the boundary between the outer edge of the pavement and the pavement, and set the second area to correspond to the line connecting each point located at the height (X) of the outer edge of the pavement Then, in the target travel path, the portion lower than the height X in the work vehicle does not protrude outward from the boundary between the pavement outer edge and the pavement, and the portion above the height X in the work vehicle is the pavement outer edge. It is created so as not to go outward from the line connecting each point located at the middle height (X).
이때, 작업 차에 있어서의 높이(X) 이상의 부분이 포장 외연부와 포장의 경계로부터 외측으로 나오는 것은 허용된다. 따라서, 작업 차에 있어서의 높이(X) 이상의 부분이 포장 외연부와 포장의 경계로부터 외측으로 나오는 것이 회피되도록 목표 주행 경로가 생성되는 구성에 비하여, 목표 주행 경로가 충족해야 하는 조건이 완화된다. 그 때문에, 생성되는 목표 주행 경로가 효율적인 것으로 되기 쉬워진다.At this time, it is permissible for the part of the height (X) or more in the work vehicle to come out from the boundary between the outer edge of the pavement and the pavement. Accordingly, compared to a configuration in which the target travel path is generated so that a portion of the work vehicle with a height X or higher is avoided from coming out from the boundary between the pavement outer edge and the pavement, the condition that the target travel path must satisfy is relaxed. Therefore, the generated target travel route tends to be efficient.
이와 같이, 본 발명이라면, 목표 주행 경로가 충족해야 하는 조건이 비교적 완화된다. 그 결과, 생성되는 목표 주행 경로가 효율적인 것으로 되기 쉬운 경로 생성 시스템을 실현할 수 있다.In this way, with the present invention, the condition that the target travel path must satisfy is relatively relaxed. As a result, it is possible to realize a route generating system in which the generated target travel route tends to be efficient.
또한, 본 발명에 있어서, 상기 제1 기준 마커는, 상기 기체 중 제1 부분의 평면으로 보았을 때의 외형에 대응하고 있고, 상기 제2 기준 마커는, 상기 기체 중 제2 부분의 평면으로 보았을 때의 외형에 대응하고 있어, 상기 제1 부분과 상기 제2 부분은 서로 다른 높이에 위치하고 있으면 적합하다.Further, in the present invention, the first reference marker corresponds to the outline of a first portion of the aircraft in a plan view, and the second reference marker corresponds to a planar view of a second portion of the aircraft. Corresponding to the outer shape of , it is suitable if the first part and the second part are located at different heights.
이 구성에 의하면, 제1 부분의 평면으로 보았을 때의 외형과, 제2 부분의 평면으로 보았을 때의 외형이 다른 경우에, 각각의 외형의 차이를 이용하여, 포장을 넓게 사용해서 자동 주행할 수 있는 목표 주행 경로를 생성하는 것이 가능하게 된다.According to this configuration, when the planar appearance of the first part is different from the planar appearance of the second part, it is possible to automatically drive by using the difference in the respective external appearances and using a wide pavement. It becomes possible to generate a target travel route in which there is
예를 들어, 일반적으로, 포장 외연부는, 외측일수록 높아지게 경사져 있다. 여기서, 평면으로 보아, 제2 부분의 외형이 제1 부분의 외형보다도 기체 외측으로 돌출되어 있고, 또한, 제2 부분이 제1 부분보다도 높은 위치에 위치하고 있을 경우, 적어도 제2 부분은, 포장 외연부와 포장의 경계의 외측으로 나올 수 있다. 상기 구성이라면, 적어도 제2 부분이 포장 외연부와 포장의 경계의 외측으로 나올 수 있는 것을 이용하여, 포장을 넓게 사용해서 자동 주행할 수 있는 목표 주행 경로를 생성하는 것이 가능하게 된다.For example, in general, the outer edge of the pavement is inclined to be higher toward the outside. Here, in a planar view, when the outer shape of the second part protrudes to the outside of the body more than the outer shape of the first part, and the second part is located at a position higher than the first part, at least the second part is the outer edge of the package It may come out of the boundary between wealth and packaging. With the above configuration, it becomes possible to create a target travel route capable of automatically traveling by using the pavement widely by using that at least the second portion can protrude outside the boundary between the pavement outer edge and the pavement.
또한, 본 발명에 있어서, 상기 제1 부분은 기체 프레임이며, 상기 제2 부분은, 상기 기체 프레임에 지지된 작업 장치이면 적합하다.Moreover, in this invention, if the said 1st part is a base frame, and the said 2nd part is a working device supported by the said base frame, it is suitable.
이 구성에 의하면, 제1 부분의 평면으로 보았을 때의 외형과, 제2 부분의 평면으로 보았을 때의 외형이 다른 것으로 된다. 그리고, 각각의 외형의 차이를 이용하여, 포장을 넓게 사용해서 자동 주행할 수 있는 목표 주행 경로를 생성하는 것이 가능하게 된다.According to this configuration, the planar appearance of the first portion is different from the planar appearance of the second portion. Then, by using the difference in the respective external appearances, it becomes possible to generate a target travel route that can be automatically driven using a wide pavement.
예를 들어, 일반적으로, 포장 외연부는, 외측일수록 높아지게 경사져 있다. 여기서, 평면으로 보아, 작업 장치의 외형이 기체 프레임의 외형보다도 기체 외측으로 돌출되어 있고, 또한, 작업 장치가 기체 프레임보다도 높은 위치에 위치하고 있을 경우, 적어도 작업 장치는, 포장 외연부와 포장의 경계의 외측으로 나올 수 있다. 상기 구성이라면, 적어도 작업 장치가 포장 외연부와 포장의 경계의 외측으로 나올 수 있는 것을 이용하여, 포장을 넓게 사용해서 자동 주행할 수 있는 목표 주행 경로를 생성하는 것이 가능하게 된다.For example, in general, the outer edge of the pavement is inclined to be higher toward the outside. Here, in a plan view, when the outer shape of the working device protrudes outside the body rather than the external shape of the body frame, and the working device is located at a position higher than the body frame, at least the working device is at least the boundary between the outer edge of the packaging and the packaging. can come out of With the above configuration, it becomes possible to generate a target travel route capable of automatically traveling using a wide pavement by using at least that the working device can come out of the boundary between the pavement periphery and the pavement.
또한, 본 발명에 있어서, 상기 작업 장치는 상기 기체 프레임에 대하여 승강 가능하게 구성되어 있고, 상기 제2 기준 마커는, 상기 작업 장치가 소정 높이 이상까지 상승한 상태에서의, 상기 작업 장치의 평면으로 보았을 때의 외형에 대응하고 있으면 적합하다.In addition, in the present invention, the working device is configured to be able to move up and down with respect to the base frame, and the second reference marker is viewed from a plane of the working device when the working device is raised to a predetermined height or more. It is suitable if it corresponds to the appearance of the time.
이 구성에 의하면, 작업 장치가 소정 높이 이상까지 상승한 상태에서는, 작업 장치가 기체 프레임보다도 높은 위치에 위치하기 쉽다. 이에 의해, 기체 프레임과 작업 장치 각각의 평면으로 보았을 때의 외형의 차이 및 높이의 차이를 이용하여, 포장을 넓게 사용해서 자동 주행할 수 있는 목표 주행 경로를 생성하는 것이 가능하게 된다.According to this configuration, when the working device is raised to a predetermined height or more, the working device is easily positioned at a position higher than the base frame. Thereby, it becomes possible to generate a target travel route capable of automatically traveling by using a wide pavement by using the difference in the external shape and the difference in height when viewed in a plane view between the body frame and the working device.
예를 들어, 일반적으로, 포장 외연부는, 외측일수록 높아지게 경사져 있다. 여기서, 평면으로 보아, 작업 장치의 외형이 기체 프레임의 외형보다도 기체 외측으로 돌출되어 있고, 또한, 작업 장치가 기체 프레임보다도 높은 위치에 위치하고 있을 경우, 적어도 작업 장치는, 포장 외연부와 포장의 경계의 외측으로 나올 수 있다. 상기 구성이라면, 적어도 작업 장치가 포장 외연부와 포장의 경계의 외측으로 나올 수 있는 것을 이용하여, 포장을 넓게 사용해서 자동 주행할 수 있는 목표 주행 경로를 생성하는 것이 가능하게 된다.For example, in general, the outer edge of the pavement is inclined to be higher toward the outside. Here, in a plan view, when the outer shape of the working device protrudes outside the body rather than the external shape of the body frame, and the working device is located at a position higher than the body frame, at least the working device is at least the boundary between the outer edge of the packaging and the packaging. can come out of With the above configuration, it becomes possible to generate a target travel route capable of automatically traveling using a wide pavement by using at least that the working device can come out of the boundary between the pavement periphery and the pavement.
또한, 본 발명에 있어서, 상기 작업 장치의 형상에 기초하여 상기 제2 기준 마커를 설정하는 마커 설정부를 구비하면 적합하다.Moreover, in this invention, it is suitable if the marker setting part which sets the said 2nd reference marker based on the shape of the said work apparatus is provided.
작업 차에 설치 가능한 작업 장치가 복수 종류 존재하는 경우에, 작업 장치의 종류에 따라서 작업 장치의 형상이 다른 사태가 상정된다. 작업 장치의 종류에 따라서 작업 장치의 형상이 다른 경우, 제2 기준 마커의 적절한 위치나 형상 등도, 작업 장치의 종류에 따라서 다른 것으로 된다.When there are a plurality of types of working devices that can be installed in the working vehicle, it is assumed that the shape of the working device differs depending on the type of the working device. When the shape of the working device differs depending on the type of the working device, the appropriate position and shape of the second reference marker also differs depending on the type of the working device.
여기서, 상기 구성이라면, 작업 장치의 형상에 기초하여 제2 기준 마커가 설정된다. 그 때문에, 작업 차에 설치 가능한 작업 장치가 복수 종류 존재하는 경우라도, 제2 기준 마커의 위치나 형상 등이 적절한 것으로 되기 쉽다.Here, if it is the said structure, a 2nd reference marker is set based on the shape of a work device. Therefore, even when there are a plurality of types of working devices that can be installed on the working vehicle, the position, shape, and the like of the second reference marker are likely to be appropriate.
또한, 본 발명에 있어서, 상기 포장 외연부의 위치 및 높이를 나타내는 외연부 정보를 취득하는 취득부와, 상기 제1 부분의 높이 위치와, 상기 제2 부분의 높이 위치와, 상기 외연부 정보에 기초하여, 상기 제1 영역 및 상기 제2 영역을 설정하는 영역 설정부를 구비하면 적합하다.In addition, in the present invention, based on the acquisition unit for acquiring the outer edge information indicating the position and height of the packaging outer edge, the height position of the first part, the height position of the second part, and the outer edge information Accordingly, it is preferable to provide a region setting unit for setting the first region and the second region.
이 구성에 의하면, 제1 영역이 포장 외연부 중 제1 부분의 높이 위치에 위치하는 부분에 대응해서 설정됨과 함께, 제2 영역이 포장 외연부 중 제2 부분의 높이 위치에 위치하는 부분에 대응해서 설정되는 구성을 실현할 수 있다. 이에 의해, 제1 영역 및 제2 영역이 적절하게 설정되기 쉬운 경로 생성 시스템을 실현할 수 있다.According to this structure, while a 1st area|region is set corresponding to the part located in the height position of the 1st part among pavement outer edges, a 2nd area|region corresponds to the part located in the height position of the 2nd part among pavement outer edges. Thus, the set configuration can be realized. Thereby, it is possible to realize a path generating system in which the first area and the second area are easily set appropriately.
또한, 본 발명에 있어서, 상기 경로 생성부는, 상기 작업 차가 후진하기 위한 부분을 포함하는 상기 목표 주행 경로를 생성 가능하면 적합하다.Further, in the present invention, it is preferable if the path generating unit is capable of generating the target travel path including a portion for the work vehicle to reverse.
이 구성에 의하면, 전진인지 후진인지에 관계없이, 제1 기준 마커가 제1 영역의 외측으로 나오지 않고, 또한, 제2 기준 마커가 제2 영역의 외측으로 나오지 않도록, 목표 주행 경로를 생성 가능하게 된다. 그 때문에, 전진인지 후진인지에 관계없이, 작업 차가 포장 외연부에 간섭하지 않고 효율적으로 주행할 수 있는 목표 주행 경로를 생성 가능한 경로 생성 시스템을 실현할 수 있다.According to this configuration, the target travel path can be created so that the first reference marker does not come out of the first area and the second reference marker does not come out of the second area, regardless of whether it is moving forward or backward. do. Therefore, it is possible to realize a route generating system capable of generating a target travel route in which the work vehicle can travel efficiently without interfering with the pavement periphery, regardless of whether the vehicle is moving forward or backward.
도 1은 콤바인의 좌측면도이다.
도 2는 콤바인의 평면도이다.
도 3은 제1 작업 주행을 도시하는 도면이다.
도 4는 제2 작업 주행을 도시하는 도면이다.
도 5는 제어부에 관한 구성을 도시하는 블록도이다.
도 6은 외연부 맵의 일례를 도시하는 도면이다.
도 7은 제1 영역, 제2 영역, 제3 영역의 일례를 도시하는 도면이다.
도 8은 제1 마커, 제2 마커, 제3 마커를 도시하는 도면이다.
도 9는 제1 영역, 제2 영역, 제3 영역의 위치 등을 도시하는 도면이다.
도 10은 제어 루틴의 흐름도이다.
도 11은 포장을 주행 중인 콤바인이 포장 외연부에 접근해 갈 경우의 예를 도시하는 평면도이다.
도 12는 포장을 주행 중인 콤바인이 포장 외연부에 접근해 갈 경우의 예를 도시하는 평면도이다.
도 13은 콤바인이 예취 주행 중에 방향 전환할 때 제2 경로 생성부에 의해 목표 주행 경로가 생성될 경우의 예를 도시하는 평면도이다.
도 14는 콤바인이 예취 주행 중에 방향 전환할 때 제2 경로 생성부에 의해 목표 주행 경로가 생성될 경우의 예를 도시하는 평면도이다.
도 15는 콤바인이 예취 주행 중에 방향 전환할 때 제2 경로 생성부에 의해 목표 주행 경로가 생성될 경우의 예를 도시하는 평면도이다.
도 16은 콤바인이 예취 주행 중에 방향 전환할 때 제2 경로 생성부에 의해 목표 주행 경로가 생성될 경우의 예를 도시하는 평면도이다.
도 17은 콤바인이 배출 지점으로 이동할 때 제2 경로 생성부에 의해 목표 주행 경로가 생성될 경우의 예를 도시하는 평면도이다.
도 18은 콤바인이 배출 지점으로 이동할 때 제2 경로 생성부에 의해 목표 주행 경로가 생성될 경우의 예를 도시하는 평면도이다.1 is a left side view of a combine.
2 is a plan view of the combine.
3 is a diagram illustrating a first working run.
Fig. 4 is a view showing a second working run;
Fig. 5 is a block diagram showing the configuration of the control unit.
It is a figure which shows an example of an outer edge part map.
7 is a diagram illustrating an example of a first area, a second area, and a third area.
8 is a diagram illustrating a first marker, a second marker, and a third marker.
9 is a diagram illustrating positions of a first region, a second region, and a third region.
10 is a flowchart of a control routine.
11 is a plan view showing an example of a case in which the combine driving the pavement approaches the pavement outer edge.
12 is a plan view showing an example of a case in which the combine driving the pavement approaches the pavement outer edge.
13 is a plan view illustrating an example of a case in which a target travel route is generated by the second route generating unit when the combine changes direction during the harvesting travel.
14 is a plan view illustrating an example of a case in which a target travel route is generated by the second route generating unit when the combine changes direction during the harvesting travel.
15 is a plan view illustrating an example of a case in which a target travel route is generated by the second route generating unit when the combine changes direction during the harvesting travel.
16 is a plan view showing an example of a case in which a target travel route is generated by the second route generating unit when the combine changes direction during the harvesting travel.
17 is a plan view illustrating an example of a case in which a target travel path is generated by the second path generating unit when the combine moves to a discharge point.
18 is a plan view illustrating an example of a case in which a target travel path is generated by the second path generating unit when the combine moves to a discharge point.
본 발명을 실시하기 위한 형태에 대해서, 도면에 기초하여 설명한다. 또한, 이하의 설명에서는, 특별히 언급이 없는 한, 도 1 및 도 2에 도시하는 화살표 F의 방향을 「전」, 화살표 B의 방향을 「후」로 하고, 도 2에 도시하는 화살표 L의 방향을 「좌」, 화살표 R의 방향을 「우」로 한다. 또한, 도 1에 도시하는 화살표 U의 방향을 「상」, 화살표 D의 방향을 「하」로 한다.EMBODIMENT OF THE INVENTION The form for implementing this invention is demonstrated based on drawing. In the following description, unless otherwise specified, the direction of the arrow F shown in FIGS. 1 and 2 is "front" and the direction of the arrow B is "back", and the direction of the arrow L shown in FIG. 2 is Let 'left' and the direction of arrow R be 'right'. In addition, let the direction of the arrow U shown in FIG. 1 be "upward", and let the direction of the arrow D be "down".
〔콤바인의 전체 구성〕[Overall composition of the combine]
본 실시 형태에서의 보통형 콤바인(1)(본 발명에 관한 「작업 차」에 상당)에 대해서 설명한다. 도 1 및 도 2에 도시하는 바와 같이, 콤바인(1)의 기체(10)는, 기체 프레임(9), 수확부(H)(본 발명에 관한 「작업 장치」에 상당), 크롤러식 주행 장치(11), 운전부(12), 탈곡 장치(13), 곡립 탱크(14), 반송부(16), 곡립 배출 장치(18), 위성 측위 모듈(80)을 구비하고 있다.The ordinary combine 1 (corresponding to the "work car" which concerns on this invention) in this embodiment is demonstrated. 1 and 2, the
주행 장치(11)는, 콤바인(1)의 기체(10)에서의 하부에 구비되어 있다. 또한, 주행 장치(11)는, 엔진(도시하지 않음)으로부터의 동력에 의해 구동한다. 그리고, 콤바인(1)은, 주행 장치(11)에 의해 자주 가능하다.The traveling
또한, 운전부(12), 탈곡 장치(13), 곡립 탱크(14)는, 주행 장치(11)의 상측에 구비되어 있다. 또한, 운전부(12), 탈곡 장치(13), 곡립 탱크(14)는, 기체 프레임(9)에 지지되어 있다. 운전부(12)에는, 콤바인(1)의 작업을 감시하는 오퍼레이터가 탑승 가능하다. 또한, 오퍼레이터는, 콤바인(1)의 기외로부터 콤바인(1)의 작업을 감시하고 있어도 된다.In addition, the driving
기체 프레임(9)(도 8 참조)은, 복수의 금속제의 긴 부재를 격자상으로 연결함으로써 구성되어 있다.The base frame 9 (refer FIG. 8) is comprised by connecting several metal elongate members in grid|lattice form.
도 1 및 도 2에 도시하는 바와 같이, 곡립 배출 장치(18)는, 곡립 탱크(14)의 상측에 마련되어 있다. 또한, 위성 측위 모듈(80)은, 운전부(12)의 상면에 설치되어 있다.As shown in FIG. 1 and FIG. 2, the
수확부(H)는, 기체(10)에서의 전방부에 구비되어 있다. 그리고, 반송부(16)는, 수확부(H)의 후방측에 마련되어 있다. 또한, 수확부(H)는, 예취 장치(15) 및 릴(17)을 포함하고 있다.The harvesting part H is provided in the front part in the
예취 장치(15)는, 포장(5)(도 3 참조)의 식립 곡간을 예취한다. 또한, 릴(17)은, 기체 좌우 방향을 따르는 릴 축심(17b) 주위로 회전 구동하면서 수확 대상인 식립 곡간을 긁어 모은다. 예취 장치(15)에 의해 예취된 예취 곡간은, 반송부(16)에 보내진다.The
이 구성에 의해, 수확부(H)는, 포장(5)의 작물을 수확한다. 그리고, 콤바인(1)은, 예취 장치(15)에 의해 포장(5)의 식립 곡간을 예취하면서 주행 장치(11)에 의해 주행하는 예취 주행이 가능하다.With this configuration, the harvesting unit H harvests the crops in the
수확부(H)에 의해 수확된 예취 곡간은, 반송부(16)에 의해 기체 후방으로 반송된다. 이에 의해, 예취 곡간은 탈곡 장치(13)에 반송된다.The harvesting grain stem harvested by the harvesting part H is conveyed by the
탈곡 장치(13)에 있어서, 예취 곡간은 탈곡 처리된다. 탈곡 처리에 의해 얻어진 곡립은, 곡립 탱크(14)에 저류된다. 곡립 탱크(14)에 저류된 곡립은, 필요에 따라 곡립 배출 장치(18)에 의해 기외로 배출된다.In the threshing
여기서, 콤바인(1)은, 도 3 및 도 4에 도시하는 바와 같이, 포장 외연부(6)의 내측에 위치하는 포장(5)에 있어서, 작물을 수확하도록 구성되어 있다. 또한, 포장 외연부(6)는, 포장(5)을 둘러싸는 상태로 마련되어 있다. 포장 외연부(6)에는, 예를 들어 두렁(61)이나 급배수 펌프(62)(도 6 참조) 등이 포함되어 있다.Here, the
콤바인(1)은, 도 3에 도시한 바와 같이, 제1 작업 주행을 실행 가능하게 구성되어 있다. 제1 작업 주행이란, 포장(5)의 외주 영역(SA)에서 행하여지는 작업 주행이다. 또한, 외주 영역(SA)이란, 도 4에 도시하는 바와 같이, 포장(5) 내의 외주부에 위치하는 영역이다.As shown in FIG. 3, the
본 실시 형태에 있어서, 제1 작업 주행에서의 주회수는 1회이다. 그러나, 본 발명은 이것에 한정되지 않고, 제1 작업 주행에서의 주회수는, 2회 이상의 어떠한 횟수이어도 된다.In the present embodiment, the number of laps in the first work run is one. However, the present invention is not limited to this, and the number of laps in the first work run may be any number of two or more times.
그리고, 콤바인(1)은, 제1 작업 주행을 행한 후, 도 4에 도시하는 바와 같이 제2 작업 주행을 행함으로써, 포장(5)에서의 작업 주행을 실행 가능하다. 제2 작업 주행이란, 제1 작업 주행 후에 외주 영역(SA)보다도 내측의 작업 대상 영역(CA)에서 행하여지는 작업 주행이다.And after performing a 1st work run, the
또한, 본 실시 형태에서의 「작업 주행」은, 구체적으로는, 식립 곡간을 예취하면서 주행하는 예취 주행이다. 그러나, 본 발명은 이것에 한정되지 않고, 상술한 「작업 주행」으로서, 주행하면서 식립 곡간의 예취 이외의 작업이 행하여져도 된다.In addition, the "work run" in this embodiment is a mowing run which drive|works, specifically mowing a planting grain culm. However, this invention is not limited to this, As "work traveling" mentioned above, the operation|work other than mowing of a planted grain culm may be performed, driving|running|working.
본 실시 형태에서는, 도 3에 도시하는 제1 작업 주행은 수동 주행에 의해 행하여진다. 또한, 도 4에 도시하는 제2 작업 주행은 자동 주행에 의해 행하여진다. 그러나, 본 발명은 이것에 한정되지 않고, 제1 작업 주행은 자동 주행에 의해 행하여져도 된다. 또한, 제2 작업 주행은 수동 주행에 의해 행하여져도 된다.In this embodiment, the 1st work travel shown in FIG. 3 is performed by manual travel. In addition, the 2nd work travel shown in FIG. 4 is performed by automatic travel. However, the present invention is not limited to this, and the first working travel may be performed by automatic travel. In addition, the 2nd work travel may be performed by manual travel.
〔제어부에 관한 구성〕[Configuration of control unit]
도 5에 도시한 바와 같이, 콤바인(1)은, 제어부(20)를 구비하고 있다. 제어부(20)는, 자차 위치 산출부(21), 작업 영역 산출부(22), 제1 경로 생성부(23), 자동 주행 제어부(24)를 갖고 있다. 자동 주행 제어부(24)는, 콤바인(1)의 자동 주행을 제어한다. 또한, 자동 주행 제어부(24)는, 경로 선택부(27) 및 주행 제어부(29)를 포함하고 있다.As shown in FIG. 5, the
도 1에 도시하는 바와 같이, 위성 측위 모듈(80)은, GPS(글로벌·포지셔닝·시스템)에서 사용되는 인공 위성(GS)으로부터의 GPS 신호를 수신한다. 그리고, 도 5에 도시한 바와 같이, 위성 측위 모듈(80)은, 수신한 GPS 신호에 기초하여, 콤바인(1)의 자차 위치를 나타내는 측위 데이터를 자차 위치 산출부(21)에 보낸다.As shown in Fig. 1, the
또한, 본 발명은 이것에 한정되지 않는다. 위성 측위 모듈(80)은, GPS를 이용하는 것이 아니어도 된다. 예를 들어, 위성 측위 모듈(80)은, GPS 이외의 GNSS(GLONASS, Galileo, 미치비키, BeiDou 등)를 이용하는 것이어도 된다.In addition, this invention is not limited to this. The
자차 위치 산출부(21)는, 위성 측위 모듈(80)에 의해 출력된 측위 데이터에 기초하여, 콤바인(1)의 위치 좌표를 경시적으로 산출한다. 산출된 콤바인(1)의 경시적인 위치 좌표는, 작업 영역 산출부(22) 및 자동 주행 제어부(24)에 보내진다.The host vehicle
작업 영역 산출부(22)는, 자차 위치 산출부(21)로부터 수취한 콤바인(1)의 경시적인 위치 좌표에 기초하여, 도 4에 도시하는 바와 같이, 외주 영역(SA) 및 작업 대상 영역(CA)을 산출한다.Based on the temporal position coordinates of the
보다 구체적으로는, 작업 영역 산출부(22)는, 자차 위치 산출부(21)로부터 수취한 콤바인(1)의 경시적인 위치 좌표에 기초하여, 포장(5)에서의 제1 작업 주행에서의 콤바인(1)의 주행 궤적을 산출한다. 그리고, 작업 영역 산출부(22)는, 산출된 콤바인(1)의 주행 궤적에 기초하여, 콤바인(1)이 제1 작업 주행을 행한 영역을 외주 영역(SA)으로서 산출한다. 또한, 작업 영역 산출부(22)는, 산출된 외주 영역(SA)에 의해 둘러싸인 영역을, 작업 대상 영역(CA)으로서 산출한다.More specifically, the work
예를 들어, 도 3에서는, 포장(5)에서의 제1 작업 주행에서의 콤바인(1)의 주행 경로가 화살표로 나타내지고 있다. 이 주행 경로를 따른 예취 주행이 완료되면, 포장(5)은, 도 4에 도시하는 상태로 된다.For example, in FIG. 3 , the travel route of the
도 4에 도시하는 바와 같이, 작업 영역 산출부(22)는, 콤바인(1)이 제1 작업 주행을 행한 영역을 외주 영역(SA)으로서 산출한다. 또한, 작업 영역 산출부(22)는, 산출된 외주 영역(SA)에 의해 둘러싸인 영역을, 작업 대상 영역(CA)으로서 산출한다.As shown in FIG. 4, the work
그리고, 도 5에 도시한 바와 같이, 작업 영역 산출부(22)에 의한 산출 결과는, 제1 경로 생성부(23)에 보내진다.Then, as shown in FIG. 5 , the calculation result by the work
제1 경로 생성부(23)는, 작업 영역 산출부(22)로부터 수취한 산출 결과에 기초하여, 도 4에 도시하는 바와 같이, 작업 대상 영역(CA)에서의 예취 주행을 위한 주행 경로인 예취 주행 경로(LI)를 생성한다. 또한, 도 4에 도시하는 바와 같이, 본 실시 형태에서는, 예취 주행 경로(LI)는, 종횡 방향으로 연장되는 복수의 메쉬 선이다. 또한, 복수의 메쉬 선은 직선이 아니어도 되고, 만곡되어 있어도 된다.Based on the calculation result received from the work
도 5에 도시한 바와 같이, 제1 경로 생성부(23)에 의해 생성된 복수의 예취 주행 경로(LI)는, 자동 주행 제어부(24)에 보내진다.As shown in FIG. 5 , the plurality of harvesting travel routes LI generated by the first
자동 주행 제어부(24)에서의 경로 선택부(27)는, 자차 위치 산출부(21)로부터 수취한 콤바인(1)의 위치 좌표와, 제1 경로 생성부(23)로부터 수취한 복수의 예취 주행 경로(LI)에 기초하여, 콤바인(1)이 다음에 주행해야 할 예취 주행 경로(LI)를 선택한다. 경로 선택부(27)에 의해 선택된 예취 주행 경로(LI)를 나타내는 정보는, 주행 제어부(29)에 보내진다.The
주행 제어부(29)는, 주행 장치(11)를 제어 가능하게 구성되어 있다. 그리고, 주행 제어부(29)는, 자차 위치 산출부(21)로부터 수취한 콤바인(1)의 위치 좌표와, 경로 선택부(27)에 의해 선택된 예취 주행 경로(LI)를 나타내는 정보에 기초하여, 콤바인(1)의 자동 주행을 제어한다. 보다 구체적으로는, 주행 제어부(29)는, 도 4에 도시하는 바와 같이, 예취 주행 경로(LI)를 따른 자동 주행에 의해 예취 주행이 행해지도록, 콤바인(1)의 주행을 제어한다.The traveling
이 자동 주행에 있어서, 주행 제어부(29)는, 현재 주행하고 있는 예취 주행 경로(LI) 다음에, 경로 선택부(27)에 의해 선택된 예취 주행 경로(LI)를 따른 예취 주행이 행해지도록, 콤바인(1)의 주행을 제어한다.In this automatic running, the
도 1 및 도 5에 도시한 바와 같이, 콤바인(1)은, 예취 실린더(15A)를 구비하고 있다. 예취 실린더(15A)는, 기체 프레임(9)에 접속되어 있다. 반송부(16) 및 수확부(H)는, 예취 실린더(15A)에 지지되어 있다. 즉, 반송부(16) 및 수확부(H)는, 예취 실린더(15A)를 통해서 기체 프레임(9)에 지지되어 있다.As shown in FIG.1 and FIG.5, the
또한, 반송부(16)의 후단부는, 탈곡 장치(13)에 접속되어 있다. 이 구성에 의해, 반송부(16) 및 수확부(H)는, 탈곡 장치(13)를 통해서 기체 프레임(9)에 지지되어 있다.Moreover, the rear end of the
주행 제어부(29)는, 예취 실린더(15A)를 제어 가능하게 구성되어 있다. 주행 제어부(29)가 예취 실린더(15A)를 신장 방향으로 제어하면, 반송부(16) 및 수확부(H)는, 일체적으로 수확부(H)가 상승하는 방향으로 요동한다. 이에 의해, 수확부(H)는 기체 프레임(9)에 대하여 상승한다.The
또한, 주행 제어부(29)가 예취 실린더(15A)를 수축 방향으로 제어하면, 반송부(16) 및 수확부(H)는, 일체적으로 수확부(H)가 하강하는 방향으로 요동한다. 이에 의해, 수확부(H)는 기체 프레임(9)에 대하여 하강한다.Moreover, when the traveling
이 구성에 의해, 주행 제어부(29)는, 수확부(H)의 승강을 제어 가능하다. 또한, 수확부(H)는 기체 프레임(9)에 대하여 승강 가능하게 구성되어 있다.With this configuration, the
또한, 제어부(20) 및 제어부(20)에 포함되는 자차 위치 산출부(21) 등의 각 요소는, 마이크로컴퓨터 등의 물리적인 장치이어도 되고, 소프트웨어에 있어서의 기능부이어도 된다.In addition, each element, such as the
〔외연부 맵에 관한 구성〕[Configuration regarding the outer edge map]
도 1, 도 2, 도 5에 도시한 바와 같이, 콤바인(1)은, 검출 장치(31)를 구비하고 있다. 검출 장치(31)는, 포장 외연부(6) 중, 기체(10)의 진행 방향 전방에 위치하는 부분을 검출 대상으로 해서, 콤바인(1)의 포장 주행 중에, 포장 외연부(6)의 상태를 검출한다.As shown in FIG. 1, FIG. 2, FIG. 5, the
상세하게 설명하면, 본 실시 형태에서의 검출 장치(31)는, ToF(Time of flight) 측정 방식의 측정 장치인 이차원 스캔 LiDAR이다. 또한, 본 발명은 이것에 한정되지 않고, 검출 장치(31)는, 삼차원 스캔 LiDAR이어도 된다. 또한, 검출 장치(31)의 측정 방식은, ToF 측정 방식에 한정되지 않고, 스테레오 매칭 측정 방식 등이어도 된다.In detail, the
도 5에 도시한 바와 같이, 자차 위치 산출부(21)에 의해 산출된 콤바인(1)의 위치 좌표는, 검출 장치(31)에 보내진다. 그리고, 검출 장치(31)는, ToF 측정 방식의 측정 결과와, 자차 위치 산출부(21)로부터 수취한 콤바인(1)의 위치 좌표에 기초하여, 전방 영역(FA)(도 1 참조)에 존재하는 물체의 위치 및 높이를 나타내는 점군 데이터를 출력한다. 이 구성에 의해, 검출 장치(31)는, 포장 주행 중에, 기체(10)의 진행 방향 전방에 위치하는 영역인 전방 영역(FA)에 존재하는 물체의 위치 및 높이를 검출한다. 이에 의해, 검출 장치(31)는, 포장 외연부(6)의 입체 형상을 검출한다.As shown in FIG. 5 , the positional coordinates of the
또한, 본 발명은 이것에 한정되지 않고, 검출 장치(31)는, 포장 외연부(6)의 위치 및 높이를 검지 가능하면, 어떠한 종류의 장치이어도 된다.In addition, this invention is not limited to this, As long as the
도 5에 도시한 바와 같이, 제어부(20)는, 맵 생성부(25)(본 발명에 관한 「취득부」에 상당)를 갖고 있다. 검출 장치(31)에 의한 검출 결과는, 맵 생성부(25)에 보내진다.As shown in FIG. 5 , the
맵 생성부(25)는, 검출 장치(31)에 의한 검출 결과에 기초하여, 외연부 맵(본 발명에 관한 「외연부 정보」에 상당)을 생성한다. 이에 의해, 맵 생성부(25)는 외연부 맵을 취득한다. 외연부 맵이란, 포장 외연부(6)의 상태의 분포를 나타내는 맵이다. 본 실시 형태에서의 외연부 맵은, 포장 외연부(6)의 입체 형상의 분포를 나타내는 것이다. 즉, 외연부 맵은, 포장 외연부(6)의 위치 및 높이를 나타내는 것이다.The
도 6에는, 맵 생성부(25)에 의해 생성되는 외연부 맵의 일례가 도시되어 있다. 도 6에 도시하는 외연부 맵에는, 두렁(61)의 측면부(61a)의 위치 및 입체 형상과, 두렁(61)의 상면부(61b)의 위치 및 입체 형상과, 급배수 펌프(62)의 위치 및 입체 형상이 포함되어 있다.6 shows an example of an edge map generated by the
또한, 도 6에 도시하는 외연부 맵은, 포장 외연부(6)의 전체 둘레에 대응하고 있다. 즉, 이 외연부 맵은, 포장 외연부(6)의 전체 둘레에 걸친 상태의 분포를 나타내고 있다. 그러나, 본 발명은 이것에 한정되지 않는다.In addition, the outer edge part map shown in FIG. 6 respond|corresponds to the whole perimeter of the pavement
예를 들어, 포장 외연부(6)의 일부만의 상태가 검출 장치(31)에 의해 검출 완료일 때, 그 부분만의 상태의 분포를 나타내는 맵이, 외연부 맵으로서 생성되어도 된다. 또한, 이 경우, 콤바인(1)이 포장(5)을 주행하고, 검출 장치(31)에 의해 상태가 검출된 영역이 확대되어 감에 수반하여, 외연부 맵이 갱신되어 가도록 구성되어 있어도 된다. 이 경우, 콤바인(1)이 포장(5)에 있어서의 예취 주행을 진행해 감에 수반하여, 외연부 맵에 의해 나타내지는 영역이 확대되어 가게 된다.For example, when the state of only a part of the pavement
여기서, 콤바인(1)에 의한 작업 주행은, 도 5에 도시하는 작업 시스템(SY)(본 발명에 관한 「경로 생성 시스템」에 상당)에 의해 관리된다. 작업 시스템(SY)은, 제어부(20), 검출 장치(31), 위성 측위 모듈(80)을 포함하고 있다. 즉, 작업 시스템(SY)은, 포장 외연부(6)의 위치 및 높이를 나타내는 외연부 맵을 취득하는 맵 생성부(25)를 구비하고 있다.Here, the work travel by the
또한, 본 발명은 이것에 한정되지 않고, 작업 시스템(SY)은, 검출 장치(31)를 포함하고 있지 않아도 되고, 위성 측위 모듈(80)을 포함하고 있지 않아도 된다. 또한, 작업 시스템(SY)은, 콤바인(1)을 포함하고 있어도 된다.In addition, the present invention is not limited to this, and the operation system SY does not need to include the
도 5에 도시한 바와 같이, 작업 시스템(SY)은, 콤바인(1)의 주행을 제어하는 주행 제어부(29)를 구비하고 있다. 또한, 상세하게는 후술하지만, 작업 시스템(SY)은, 외연부 맵에 기초하여, 도 7에 도시하는 바와 같이 제1 영역(41), 제2 영역(42), 제3 영역(43)을 설정하도록 구성되어 있다.As shown in FIG. 5, the work system SY is equipped with the
또한, 상세하게는 후술하지만, 작업 시스템(SY)은, 도 8에 도시하는 바와 같이, 가상적인 복수의 제1 마커(51), 가상적인 복수의 제2 마커(52), 가상적인 복수의 제3 마커(53)를 기억하고 있다. 그리고, 주행 제어부(29)는, 제1 영역(41), 제2 영역(42), 제3 영역(43), 복수의 제1 마커(51), 복수의 제2 마커(52), 복수의 제3 마커(53)에 기초하여, 콤바인(1)의 주행을 제어하도록 구성되어 있다.In addition, although mentioned later in detail, as shown in FIG. 8, the working system SY is the some
이하에서는, 주행 제어부(29)에 의한 콤바인(1)의 주행 제어에 대해서 상세하게 설명한다.Below, the traveling control of the
〔제1 마커, 제2 마커, 제3 마커에 대해서〕[About the first marker, the second marker, and the third marker]
도 5에 도시한 바와 같이, 제어부(20)는, 마커 관리부(70)를 갖고 있다. 마커 관리부(70)는, 마커 기억부(71)(본 발명에 관한 「제1 기억부」, 「제2 기억부」에 상당)를 포함하고 있다. 마커 기억부(71)는, 도 8에 도시하는 복수의 제1 마커(51), 복수의 제2 마커(52), 복수의 제3 마커(53)를 기억하고 있다.As shown in FIG. 5 , the
각 제1 마커(51), 각 제2 마커(52), 각 제3 마커(53)는, 모두 기체(10)에 대한 상대 위치가 설정된 가상적인 것이다.Each of the
이와 같이, 작업 시스템(SY)은, 콤바인(1)의 기체(10)에 대한 상대 위치가 설정된 가상적인 제1 마커(51)를 기억하는 마커 기억부(71)를 구비하고 있다. 또한, 마커 기억부(71)는, 복수의 제1 마커(51)를 기억하고 있다. 또한, 작업 시스템(SY)은, 기체(10)에 대한 상대 위치가 설정된 가상적인 제2 마커(52)를 기억하는 마커 기억부(71)를 구비하고 있다. 또한, 마커 기억부(71)는, 복수의 제2 마커(52)를 기억하고 있다.Thus, the work system SY is equipped with the marker memory|
도 8에 도시하는 바와 같이, 각 제1 마커(51), 각 제2 마커(52), 각 제3 마커(53)는, 모두 프레임상이다. 즉, 제1 마커(51) 및 제2 마커(52)는, 모두 프레임상이다.As shown in FIG. 8, each
복수의 제1 마커(51)는, 제1 외측 마커(51a), 제1 중간 마커(51b), 제1 내측 마커(51c)(본 발명에 관한 「제1 기준 마커」에 상당)를 포함하고 있다. 또한, 제1 외측 마커(51a), 제1 중간 마커(51b), 제1 내측 마커(51c)는 모두 제1 마커(51)이다.The plurality of
제1 외측 마커(51a)는, 제1 내측 마커(51c)보다도 외측에 위치하고 있다. 제1 중간 마커(51b)는, 제1 내측 마커(51c)보다도 외측에 위치함과 함께 제1 외측 마커(51a)보다도 내측에 위치하고 있다.The first
즉, 복수의 제1 마커(51)는, 제1 내측 마커(51c)와, 제1 내측 마커(51c)보다도 외측에 위치하는 제1 외측 마커(51a)를 포함하고 있다. 또한, 복수의 제1 마커(51)는, 제1 내측 마커(51c)보다도 외측에 위치함과 함께 제1 외측 마커(51a)보다도 내측에 위치하는 제1 중간 마커(51b)를 포함하고 있다. 또한, 작업 시스템(SY)은, 콤바인(1)의 기체(10)에 대한 상대 위치가 설정된 가상적인 제1 내측 마커(51c)를 기억하는 마커 기억부(71)를 구비하고 있다.That is, the plurality of
복수의 제2 마커(52)는, 제2 외측 마커(52a), 제2 중간 마커(52b), 제2 내측 마커(52c)(본 발명에 관한 「제2 기준 마커」에 상당)를 포함하고 있다. 또한, 제2 외측 마커(52a), 제2 중간 마커(52b), 제2 내측 마커(52c)는 모두 제2 마커(52)이다.The plurality of
제2 외측 마커(52a)는, 제2 내측 마커(52c)보다도 외측에 위치하고 있다. 제2 중간 마커(52b)는, 제2 내측 마커(52c)보다도 외측에 위치함과 함께 제2 외측 마커(52a)보다도 내측에 위치하고 있다.The second
즉, 복수의 제2 마커(52)는, 제2 내측 마커(52c)와, 제2 내측 마커(52c)보다도 외측에 위치하는 제2 외측 마커(52a)를 포함하고 있다. 또한, 복수의 제2 마커(52)는, 제2 내측 마커(52c)보다도 외측에 위치함과 함께 제2 외측 마커(52a)보다도 내측에 위치하는 제2 중간 마커(52b)를 포함하고 있다. 또한, 작업 시스템(SY)은, 기체(10)에 대한 상대 위치가 설정된 가상적인 제2 내측 마커(52c)를 기억하는 마커 기억부(71)를 구비하고 있다.That is, the plurality of
복수의 제3 마커(53)는, 제3 외측 마커(53a), 제3 중간 마커(53b), 제3 내측 마커(53c)를 포함하고 있다. 또한, 제3 외측 마커(53a), 제3 중간 마커(53b), 제3 내측 마커(53c)는 모두 제3 마커(53)이다.The plurality of
제3 외측 마커(53a)는, 제3 내측 마커(53c)보다도 외측에 위치하고 있다. 제3 중간 마커(53b)는, 제3 내측 마커(53c)보다도 외측에 위치함과 함께 제3 외측 마커(53a)보다도 내측에 위치하고 있다.The third
본 실시 형태에서는, 도 8에 도시하는 바와 같이, 기체(10)를 높이 방향으로 3분할한 경우의 각 부분에 대응하여, 제1 마커(51), 제2 마커(52), 제3 마커(53)가 설정되어 있다. 보다 구체적으로는, 각 제1 마커(51)는, 기체(10) 중 제1 부분(10a)의 평면으로 보았을 때의 외형에 대응하고 있다. 또한, 각 제2 마커(52)는, 기체(10) 중 제2 부분(10b)의 평면으로 보았을 때의 외형에 대응하고 있다. 또한, 각 제3 마커(53)는, 기체(10) 중 제3 부분(10c)의 평면으로 보았을 때의 외형에 대응하고 있다.In this embodiment, as shown in FIG. 8, corresponding to each part when the
즉, 제1 내측 마커(51c)는, 기체(10) 중 제1 부분(10a)의 평면으로 보았을 때의 외형에 대응하고 있다. 또한, 제2 내측 마커(52c)는, 기체(10) 중 제2 부분(10b)의 평면으로 보았을 때의 외형에 대응하고 있다.That is, the 1st
도 8에 도시하는 바와 같이, 제3 부분(10c)은, 기체(10)를 높이 방향으로 3분할한 경우의 제일 아래에 위치하고 있다. 제1 부분(10a)은, 기체(10)를 높이 방향으로 3분할한 경우의 중앙에 위치하고 있다. 제2 부분(10b)은, 기체(10)를 높이 방향으로 3분할한 경우의 제일 위에 위치하고 있다.As shown in FIG. 8, the
즉, 제1 부분(10a)과 제2 부분(10b)은, 서로 다른 높이에 위치하고 있다.That is, the
본 실시 형태에 있어서, 제1 부분(10a)은 기체 프레임(9)이다. 또한, 제2 부분(10b)은 수확부(H)이다. 즉, 제2 부분(10b)은, 기체 프레임(9)에 지지된 수확부(H)이다. 또한, 제3 부분(10c)은 주행 장치(11)이다.In the present embodiment, the
여기서, 도 8에 도시하는 바와 같이, 각 제2 마커(52)는, 수확부(H)가 기준 높이(HA)(본 발명에 관한 「소정 높이」에 상당) 이상까지 상승한 상태에서의, 수확부(H)의 평면으로 보았을 때의 외형에 대응하고 있다. 즉, 제2 내측 마커(52c)는, 수확부(H)가 기준 높이(HA) 이상까지 상승한 상태에서의, 수확부(H)의 평면으로 보았을 때의 외형에 대응하고 있다.Here, as shown in FIG. 8 , each
본 실시 형태에 있어서, 기준 높이(HA)는, 기체 프레임(9)의 상단의 높이에 일치하고 있다. 그러나, 본 발명은 이것에 한정되지 않고, 기준 높이(HA)는, 기체 프레임(9)의 상단보다도 낮아도 되고, 기체 프레임(9)의 상단보다도 높아도 된다.In this embodiment, the reference height HA corresponds to the height of the upper end of the
또한, 수확부(H)의 높이는, 수확부(H) 중, 어느 부위의 높이이어도 된다. 예를 들어, 수확부(H)의 하단의 높이가 수확부(H)의 높이로서 취급되어도 되고, 수확부(H)의 전단부의 높이가 수확부(H)의 높이로서 취급되어도 된다.In addition, the height of the harvesting part H may be the height of any site|part among the harvesting parts H. For example, the height of the lower end of the harvesting part H may be handled as the height of the harvesting part H, and the height of the front end of the harvesting part H may be handled as the height of the harvesting part H.
그리고, 본 실시 형태에서는, 도 8에 도시하는 바와 같이, 각 제1 마커(51)는, 평면으로 보아 기체 프레임(9)을 둘러싸는 프레임상이다. 또한, 각 제2 마커(52)는, 평면으로 보아 수확부(H), 탈곡 장치(13), 곡립 탱크(14)를 둘러싸는 프레임상이다. 특히, 각 제2 마커(52)는, 평면으로 보아 수확부(H)를 둘러싸는 프레임상이다. 또한, 각 제3 마커(53)는, 평면으로 보아 주행 장치(11)를 둘러싸는 프레임상이다.And in this embodiment, as shown in FIG. 8, each
도 5에 도시한 바와 같이, 제어부(20)는, 기체 정보 기억부(33)를 갖고 있다. 기체 정보 기억부(33)는, 기체(10)에 관한 다양한 정보를 기억하고 있다. 예를 들어, 기체 정보 기억부(33)는, 수확부(H)의 형상을 나타내는 정보를 기억하고 있다. 수확부(H)의 형상을 나타내는 정보는, 예를 들어 수확부(H)의 종류나 형식을 나타내는 정보이어도 된다.As shown in FIG. 5 , the
또한, 마커 관리부(70)는, 마커 설정부(72)를 갖고 있다. 마커 관리부(70)는, 기체 정보 기억부(33)로부터, 기체 정보 기억부(33)에 기억되어 있는 정보를 취득한다. 취득한 정보에 기초하여, 마커 설정부(72)는, 각 제1 마커(51), 각 제2 마커(52), 각 제3 마커(53)를 설정한다.In addition, the
보다 구체적으로는, 마커 설정부(72)는, 기체 프레임(9)의 형상을 나타내는 정보, 및 기체(10)에서의 기체 프레임(9)의 위치를 나타내는 정보에 기초하여, 각 제1 마커(51)를 설정한다. 또한, 기체 프레임(9)의 형상을 나타내는 정보, 및 기체(10)에서의 기체 프레임(9)의 위치를 나타내는 정보는, 기체 정보 기억부(33)에 기억되어 있다.More specifically, the
또한, 마커 설정부(72)는, 수확부(H)의 형상을 나타내는 정보, 및 기체(10)에서의 수확부(H)의 위치를 나타내는 정보에 기초하여, 각 제2 마커(52)를 설정한다. 또한, 수확부(H)의 형상을 나타내는 정보, 및 기체(10)에서의 수확부(H)의 위치를 나타내는 정보는, 기체 정보 기억부(33)에 기억되어 있다.Further, the
또한, 마커 설정부(72)는, 주행 장치(11)의 형상을 나타내는 정보, 및 기체(10)에서의 주행 장치(11)의 위치를 나타내는 정보에 기초하여, 각 제3 마커(53)를 설정한다. 또한, 주행 장치(11)의 형상을 나타내는 정보, 및 기체(10)에서의 주행 장치(11)의 위치를 나타내는 정보는, 기체 정보 기억부(33)에 기억되어 있다.Further, the
이와 같이, 작업 시스템(SY)은, 수확부(H)의 형상에 기초하여 제2 마커(52)를 설정하는 마커 설정부(72)를 구비하고 있다. 또한, 작업 시스템(SY)은, 수확부(H)의 형상에 기초하여 제2 내측 마커(52c)를 설정하는 마커 설정부(72)를 구비하고 있다.Thus, the work system SY is equipped with the
마커 설정부(72)에 의해 설정된 각 제1 마커(51), 각 제2 마커(52), 각 제3 마커(53)는, 마커 기억부(71)에 기억된다.Each
〔제1 영역, 제2 영역, 제3 영역에 대해서〕[About the first region, the second region, and the third region]
도 5에 도시한 바와 같이, 제어부(20)는, 영역 관리부(75)를 갖고 있다. 영역 관리부(75)는, 영역 기억부(76)(본 발명에 관한 「제3 기억부」, 「제4 기억부」에 상당)를 갖고 있다. 영역 기억부(76)는, 도 7에 도시하는 바와 같은 제1 영역(41), 제2 영역(42), 제3 영역(43)을 기억하고 있다.As shown in FIG. 5 , the
도 5에 도시한 바와 같이, 영역 관리부(75)는, 영역 설정부(77)를 갖고 있다. 영역 설정부(77)는, 상술한 외연부 맵에 기초하여, 제1 영역(41), 제2 영역(42), 제3 영역(43)을 설정하도록 구성되어 있다. 영역 설정부(77)에 의해 설정된 제1 영역(41), 제2 영역(42), 제3 영역(43)은, 영역 기억부(76)에 기억된다.As shown in FIG. 5 , the
여기서, 도 7에 도시하는 제1 영역(41), 제2 영역(42), 제3 영역(43)은, 도 6에 도시하는 외연부 맵에 기초하여 설정된 것이다. 도 6, 도 7, 도 9에 도시하는 바와 같이, 제1 영역(41)의 외형 선, 제2 영역(42)의 외형 선, 제3 영역(43)의 외형 선은, 모두 포장 외연부(6)와 포장(5)의 경계의 주변에 설정된다.Here, the 1st area|
즉, 작업 시스템(SY)은, 포장(5)을 둘러싸는 상태로 마련된 포장 외연부(6)와 포장(5)의 경계의 주변에 설정된 제1 영역(41)을 기억하는 영역 기억부(76)를 구비하고 있다. 또한, 작업 시스템(SY)은, 당해 경계의 주변에 설정된 제2 영역(42)을 기억하는 영역 기억부(76)를 구비하고 있다.That is, the working system SY has an
여기서, 도 5에 도시한 바와 같이, 영역 관리부(75)는, 기체 정보 기억부(33)로부터, 기체 정보 기억부(33)에 기억되어 있는 정보를 취득한다. 또한, 영역 관리부(75)는, 맵 생성부(25)로부터 외연부 맵을 취득한다. 영역 관리부(75)가 기체 정보 기억부(33)로부터 취득한 정보, 및 외연부 맵에 기초하여, 영역 설정부(77)는, 제1 영역(41), 제2 영역(42), 제3 영역(43)을 설정한다.Here, as shown in FIG. 5, the area|
보다 구체적으로는, 영역 설정부(77)는, 기체 프레임(9)의 높이 위치를 나타내는 정보, 및 외연부 맵에 기초하여, 제1 영역(41)을 설정한다. 또한, 기체 프레임(9)의 높이 위치를 나타내는 정보는, 기체 정보 기억부(33)에 기억되어 있다.More specifically, the area|
본 실시 형태에 있어서, 영역 설정부(77)는, 도 9에 도시하는 바와 같이, 포장 외연부(6) 중, 기체 프레임(9)의 하단의 높이와 동일한 높이에 위치하는 각 지점을 연결한 선을, 제1 영역(41)의 외형 선으로서 설정한다.In this embodiment, as shown in FIG. 9, the
또한, 영역 설정부(77)는, 기준 높이(HA) 이상까지 상승한 상태의 수확부(H)의 높이 위치를 나타내는 정보, 및 외연부 맵에 기초하여, 제2 영역(42)을 설정한다. 또한, 기준 높이(HA) 이상까지 상승한 상태의 수확부(H)의 높이 위치를 나타내는 정보는, 기체 정보 기억부(33)에 기억되어 있다.Moreover, the
본 실시 형태에 있어서, 영역 설정부(77)는, 도 9에 도시하는 바와 같이, 포장 외연부(6) 중, 기준 높이(HA) 이상까지 상승한 상태의 수확부(H)의 하단의 높이와 동일한 높이에 위치하는 각 지점을 연결한 선을, 제2 영역(42)의 외형 선으로서 설정한다.In the present embodiment, as shown in FIG. 9 , the
이와 같이, 작업 시스템(SY)은, 제1 부분(10a)의 높이 위치와, 제2 부분(10b)의 높이 위치와, 외연부 맵에 기초하여, 제1 영역(41) 및 제2 영역(42)을 설정하는 영역 설정부(77)를 구비하고 있다.Thus, the work system SY is based on the height position of the
또한, 영역 설정부(77)는, 외연부 맵에 기초하여 제3 영역(43)을 설정한다.Moreover, the
본 실시 형태에 있어서, 영역 설정부(77)는, 도 9에 도시하는 바와 같이, 제3 영역(43)의 외형 선이, 포장 외연부(6)와 포장(5)의 경계에 일치하도록, 제3 영역(43)의 외형 선을 설정한다.In the present embodiment, the
이상에서 설명한 구성에 의해, 평면으로 보아, 각 제1 마커(51)가 제1 영역(41)의 외측으로 나와 있지 않을 경우, 기체 프레임(9)은 포장 외연부(6)에 간섭하지 않는다. 특히, 도 9에 도시하는 바와 같이, 콤바인(1)이 포장 외연부(6)에 접근해도, 제1 내측 마커(51c)가 제1 영역(41)의 외측으로 나와 있지 않을 경우, 기체 프레임(9)은 포장 외연부(6)에 간섭하지 않는다.According to the structure demonstrated above, in planar view, when each
또한, 평면으로 보아, 각 제2 마커(52)가 제2 영역(42)의 외측으로 나와 있지 않을 경우, 수확부(H)는 포장 외연부(6)에 간섭하지 않는다. 특히, 도 9에 도시하는 바와 같이, 콤바인(1)이 포장 외연부(6)에 접근해도, 제2 내측 마커(52c)가 제2 영역(42)의 외측으로 나와 있지 않을 경우, 수확부(H)는 포장 외연부(6)에 간섭하지 않는다.Further, in plan view, when each of the
또한, 평면으로 보아, 각 제3 마커(53)가 제3 영역(43)의 외측으로 나와 있지 않을 경우, 주행 장치(11)는 포장 외연부(6)에 간섭하지 않는다. 특히, 도 9에 도시하는 바와 같이, 콤바인(1)이 포장 외연부(6)에 접근해도, 제3 내측 마커(53c)가 제3 영역(43)의 외측으로 나와 있지 않을 경우, 주행 장치(11)는 포장 외연부(6)에 간섭하지 않는다.Moreover, in planar view, when each of the
즉, 각 제1 마커(51)가 제1 영역(41)의 외측으로 나와 있지 않고, 또한, 각 제2 마커(52)가 제2 영역(42)의 외측으로 나와 있지 않고, 또한, 각 제3 마커(53)가 제3 영역(43)의 외측으로 나와 있지 않을 경우, 기체(10)는 포장 외연부(6)에 간섭하지 않는다.That is, each of the
특히, 제1 내측 마커(51c)가 제1 영역(41)의 외측으로 나와 있지 않고, 또한, 제2 내측 마커(52c)가 제2 영역(42)의 외측으로 나와 있지 않고, 또한, 제3 내측 마커(53c)가 제3 영역(43)의 외측으로 나와 있지 않을 경우, 기체(10)는 포장 외연부(6)에 간섭하지 않는다.In particular, the first
또한, 도 6에는, 펌프 위치(Q)가 도시되어 있다. 펌프 위치(Q)는, 급배수 펌프(62)가 마련되어 있는 위치이다. 포장 외연부(6) 중, 급배수 펌프(62)가 존재하는 부분의 높이는 비교적 높아진다.In addition, the pump position Q is shown in FIG. 6 . The pump position Q is a position where the water supply/
그 때문에, 도 7에 도시하는 바와 같이, 제1 영역(41) 및 제2 영역(42)의 외형 선은, 펌프 위치(Q)에 있어서 포장(5)의 내측으로 움푹 들어가 있다.Therefore, as shown in FIG. 7, the outline of the 1st area|
〔주행 제어에 대해서〕[About travel control]
도 5에 도시한 바와 같이, 마커 기억부(71)에 기억되어 있는 복수의 제1 마커(51), 복수의 제2 마커(52), 복수의 제3 마커(53)는, 마커 관리부(70)로부터 자동 주행 제어부(24)에 보내진다.As shown in FIG. 5 , the plurality of
또한, 영역 기억부(76)에 기억되어 있는 제1 영역(41), 제2 영역(42), 제3 영역(43)은, 영역 관리부(75)로부터 자동 주행 제어부(24)에 보내진다.The
그리고, 자동 주행 제어부(24)에서의 주행 제어부(29)는, 복수의 제1 마커(51), 복수의 제2 마커(52), 복수의 제3 마커(53), 제1 영역(41), 제2 영역(42), 제3 영역(43)에 기초하여, 각 제1 마커(51)가 제1 영역(41)의 외측으로 나오는 것이 억제되고, 또한, 각 제2 마커(52)가 제2 영역(42)의 외측으로 나오는 것이 억제되고, 또한, 각 제3 마커(53)가 제3 영역(43)의 외측으로 나오는 것이 억제되도록, 콤바인(1)의 주행을 제어한다.In addition, the
즉, 주행 제어부(29)는, 제1 마커(51)가 제1 영역(41)의 외측으로 나오는 것이 억제되고, 또한, 제2 마커(52)가 제2 영역(42)의 외측으로 나오는 것이 억제되도록, 콤바인(1)의 주행을 제어한다.That is, the
이하에서는, 주행 제어부(29)에 의한 콤바인(1)의 주행 제어에 대해서 설명한다.Below, the traveling control of the
콤바인(1)이 자동 주행을 행하고 있을 때, 및 콤바인(1)이 수동 주행을 행하고 있을 때의 어느 것에 있어서든, 주행 제어부(29)는, 도 10에 도시하는 제어 루틴에 따라서 콤바인(1)의 주행을 제어한다.In either case when the
또한, 본 발명은 이것에 한정되지 않고, 주행 제어부(29)는, 콤바인(1)이 자동 주행을 행하고 있을 때만, 도 10에 도시하는 제어 루틴에 따라서 콤바인(1)의 주행을 제어하도록 구성되어 있어도 된다. 또한, 주행 제어부(29)는, 콤바인(1)이 수동 주행을 행하고 있을 때만, 도 10에 도시하는 제어 루틴에 따라서 콤바인(1)의 주행을 제어하도록 구성되어 있어도 된다.In addition, the present invention is not limited to this, and the
이 제어 루틴은, 주행 제어부(29)에 저장되어 있다. 주행 제어부(29)는, 이 제어 루틴을 일정 시간마다 반복 실행한다.This control routine is stored in the
제어 루틴이 개시되면, 먼저, 스텝 S01의 처리가 실행된다. 스텝 S01에서는, 제1 판정 조건, 제2 판정 조건, 제3 판정 조건 중 적어도 1개가 충족되었는지 여부가, 주행 제어부(29)에 의해 판정된다.When the control routine is started, first, the processing of step S01 is executed. In step S01 , it is determined by the
제1 판정 조건은, 제1 내측 마커(51c)의 적어도 일부가 제1 영역(41)의 외측으로 나오는 것이다. 또한, 제1 내측 마커(51c)가 실제로 제1 영역(41)의 외측으로 나왔을 경우뿐만 아니라, 제1 내측 마커(51c)가 제1 영역(41)의 외측으로 나올 것 같아진 시점에서, 제1 판정 조건이 충족된 것으로 판정되어도 된다. 본 실시 형태에서는, 제1 내측 마커(51c)가 제1 영역(41)의 외형 선에 접촉한 시점에서, 제1 판정 조건이 충족된 것으로 판정된다.The first determination condition is that at least a part of the first
이와 같이, 제1 판정 조건은, 제1 내측 마커(51c)가 제1 영역(41)의 외측으로 나오는 것이다.In this way, the first determination condition is that the first
여기서, 제1 내측 마커(51c)가 제1 영역(41)의 외측으로 나왔는지 여부의 판정에 대해서 상세하게 설명한다.Here, the determination of whether the first
도 5에 도시한 바와 같이, 자동 주행 제어부(24)는, 마커 위치 산출부(35)를 갖고 있다. 마커 위치 산출부(35)는, 자동 주행 제어부(24)가 자차 위치 산출부(21)로부터 수취한 콤바인(1)의 위치 좌표와, 자동 주행 제어부(24)가 마커 관리부(70)로부터 수취한 제1 내측 마커(51c)를 나타내는 정보에 기초하여, 제1 내측 마커(51c)의 현재 위치를 산출한다.As shown in FIG. 5 , the automatic
이때, 마커 위치 산출부(35)는, 콤바인(1)의 위치 좌표와, 기체(10)에 대한 제1 내측 마커(51c)의 상대 위치에 기초하여, 제1 내측 마커(51c)의 현재 위치를 산출한다. 또한, 이때 산출되는 제1 내측 마커(51c)의 현재 위치는, 포장(5)에서의 위치 좌표이어도 되고, 제1 영역(41)에 대한 상대 위치이어도 된다.At this time, the marker
마커 위치 산출부(35)에 의한 산출 결과는, 주행 제어부(29)에 보내진다. 그리고, 주행 제어부(29)는, 마커 위치 산출부(35)로부터 수취한 제1 내측 마커(51c)의 현재 위치를 나타내는 정보와, 자동 주행 제어부(24)가 영역 관리부(75)로부터 수취한 제1 영역(41)을 나타내는 정보에 기초하여, 제1 내측 마커(51c)가 제1 영역(41)의 외측으로 나왔는지 여부를 판정한다.The calculation result by the marker
또한, 여기서는 제1 내측 마커(51c)가 제1 영역(41)의 외측으로 나왔는지 여부의 판정에 대해서 설명했지만, 주행 제어부(29)는, 제1 내측 마커(51c) 이외의 각 제1 마커(51)가 제1 영역(41)의 외측으로 나왔는지 여부의 판정에 대해서도, 상기와 마찬가지로 행할 수 있다. 또한, 주행 제어부(29)는, 각 제2 마커(52)가 제2 영역(42)의 외측으로 나왔는지 여부의 판정, 및 각 제3 마커(53)가 제3 영역(43)의 외측으로 나왔는지 여부의 판정에 대해서도, 상기와 마찬가지로 행할 수 있다.In addition, although the determination of whether the 1st
제2 판정 조건은, 제2 내측 마커(52c)의 적어도 일부가 제2 영역(42)의 외측으로 나오는 것이다. 또한, 제2 내측 마커(52c)가 실제로 제2 영역(42)의 외측으로 나왔을 경우뿐만 아니라, 제2 내측 마커(52c)가 제2 영역(42)의 외측으로 나올 것 같아진 시점에서, 제2 판정 조건이 충족된 것으로 판정되어도 된다. 본 실시 형태에서는, 제2 내측 마커(52c)가 제2 영역(42)의 외형 선에 접촉한 시점에서, 제2 판정 조건이 충족된 것으로 판정된다.The second determination condition is that at least a part of the second
이와 같이, 제2 판정 조건은, 제2 내측 마커(52c)가 제2 영역(42)의 외측으로 나오는 것이다.In this way, the second determination condition is that the second
제3 판정 조건은, 제3 내측 마커(53c)의 적어도 일부가 제3 영역(43)의 외측으로 나오는 것이다. 또한, 제3 내측 마커(53c)가 실제로 제3 영역(43)의 외측으로 나왔을 경우뿐만 아니라, 제3 내측 마커(53c)가 제3 영역(43)의 외측으로 나올 것 같아진 시점에서, 제3 판정 조건이 충족된 것으로 판정되어도 된다. 본 실시 형태에서는, 제3 내측 마커(53c)가 제3 영역(43)의 외형 선에 접촉한 시점에서, 제3 판정 조건이 충족된 것으로 판정된다.The third determination condition is that at least a part of the third
제1 판정 조건, 제2 판정 조건, 제3 판정 조건 중 적어도 1개가 충족되어 있을 경우, 스텝 S01에서 "예"라고 판정되어, 처리는 스텝 S02로 이행한다. 또한, 제1 판정 조건, 제2 판정 조건, 제3 판정 조건 모두 충족되지 않았을 경우, 스텝 S01에서 "아니오"라고 판정되어, 처리는 스텝 S03으로 이행한다.When at least one of the first determination condition, the second determination condition, and the third determination condition is satisfied, it is determined as "Yes" in step S01, and the processing advances to step S02. In addition, when all of the first determination condition, the second determination condition, and the third determination condition are not satisfied, it is determined as NO in step S01, and the processing advances to step S03.
스텝 S02에서는, 주행 제어부(29)에 의해 정지 제어가 실행된다. 정지 제어란, 콤바인(1)의 주행을 정지시키는 제어이다. 그 후, 처리는 일단 종료된다.In step S02, stop control is executed by the
스텝 S03에서는, 제4 판정 조건, 제5 판정 조건, 제6 판정 조건 중 적어도 1개가 충족되었는지 여부가, 주행 제어부(29)에 의해 판정된다.In step S03 , it is determined by the
제4 판정 조건은, 제1 중간 마커(51b)의 적어도 일부가 제1 영역(41)의 외측으로 나오는 것이다. 또한, 제1 중간 마커(51b)가 실제로 제1 영역(41)의 외측으로 나왔을 경우뿐만 아니라, 제1 중간 마커(51b)가 제1 영역(41)의 외측으로 나올 것 같아진 시점에서, 제4 판정 조건이 충족된 것으로 판정되어도 된다. 본 실시 형태에서는, 제1 중간 마커(51b)의 적어도 일부가 실제로 제1 영역(41)의 외측으로 나왔을 경우, 제4 판정 조건이 충족된 것으로 판정된다.The fourth determination condition is that at least a part of the first
이와 같이, 제4 판정 조건은, 제1 중간 마커(51b)가 제1 영역(41)의 외측으로 나오는 것이다.In this way, the fourth determination condition is that the first
제5 판정 조건은, 제2 중간 마커(52b)의 적어도 일부가 제2 영역(42)의 외측으로 나오는 것이다. 또한, 제2 중간 마커(52b)가 실제로 제2 영역(42)의 외측으로 나왔을 경우뿐만 아니라, 제2 중간 마커(52b)가 제2 영역(42)의 외측으로 나올 것 같아진 시점에서, 제5 판정 조건이 충족된 것으로 판정되어도 된다. 본 실시 형태에서는, 제2 중간 마커(52b)의 적어도 일부가 실제로 제2 영역(42)의 외측으로 나왔을 경우, 제5 판정 조건이 충족된 것으로 판정된다.The fifth determination condition is that at least a part of the second
이와 같이, 제5 판정 조건은, 제2 중간 마커(52b)가 제2 영역(42)의 외측으로 나오는 것이다.In this way, the fifth determination condition is that the second
제6 판정 조건은, 제3 중간 마커(53b)의 적어도 일부가 제3 영역(43)의 외측으로 나오는 것이다. 또한, 제3 중간 마커(53b)가 실제로 제3 영역(43)의 외측으로 나왔을 경우뿐만 아니라, 제3 중간 마커(53b)가 제3 영역(43)의 외측으로 나올 것 같아진 시점에서, 제6 판정 조건이 충족된 것으로 판정되어도 된다. 본 실시 형태에서는, 제3 중간 마커(53b)의 적어도 일부가 실제로 제3 영역(43)의 외측으로 나왔을 경우, 제6 판정 조건이 충족된 것으로 판정된다.The sixth determination condition is that at least a part of the third
제4 판정 조건, 제5 판정 조건, 제6 판정 조건 중 적어도 1개가 충족되어 있을 경우, 스텝 S03에서 "예"라고 판정되어, 처리는 스텝 S04로 이행한다. 또한, 제4 판정 조건, 제5 판정 조건, 제6 판정 조건 모두 충족되지 않았을 경우, 스텝 S03에서 "아니오"라고 판정되어, 처리는 스텝 S05로 이행한다.When at least one of the fourth determination condition, the fifth determination condition, and the sixth determination condition is satisfied, it is determined as “Yes” in step S03, and the processing advances to step S04. Further, when all of the fourth determination condition, the fifth determination condition, and the sixth determination condition are not satisfied, it is determined No in step S03, and the processing proceeds to step S05.
스텝 S04에서는, 주행 제어부(29)에 의해 방향 변경 제어가 실행된다. 방향 변경 제어란, 콤바인(1)의 진행 방향을 변경시키는 제어이다. 그 후, 처리는 일단 종료된다.In step S04, direction change control is executed by the
방향 변경 제어의 내용은, 특별히 한정되지 않지만, 예를 들어 콤바인(1)이 포장 외연부(6)로부터 멀어지도록, 콤바인(1)의 진행 방향을 변경시키는 제어이어도 되고, 콤바인(1)의 전후진을 전환하는 제어이어도 된다.Although the content of direction change control is not specifically limited, For example, control which changes the advancing direction of the
스텝 S05에서는, 제7 판정 조건, 제8 판정 조건, 제9 판정 조건 중 적어도 1개가 충족되었는지 여부가, 주행 제어부(29)에 의해 판정된다.In step S05 , it is determined by the
제7 판정 조건은, 제1 외측 마커(51a)의 적어도 일부가 제1 영역(41)의 외측으로 나오는 것이다. 또한, 제1 외측 마커(51a)가 실제로 제1 영역(41)의 외측으로 나왔을 경우뿐만 아니라, 제1 외측 마커(51a)가 제1 영역(41)의 외측으로 나올 것 같아진 시점에서, 제7 판정 조건이 충족된 것으로 판정되어도 된다. 본 실시 형태에서는, 제1 외측 마커(51a)의 적어도 일부가 실제로 제1 영역(41)의 외측으로 나왔을 경우, 제7 판정 조건이 충족된 것으로 판정된다.The seventh determination condition is that at least a part of the first
이와 같이, 제7 판정 조건은, 제1 외측 마커(51a)가 제1 영역(41)의 외측으로 나오는 것이다.In this way, the seventh determination condition is that the first
제8 판정 조건은, 제2 외측 마커(52a)의 적어도 일부가 제2 영역(42)의 외측으로 나오는 것이다. 또한, 제2 외측 마커(52a)가 실제로 제2 영역(42)의 외측으로 나왔을 경우뿐만 아니라, 제2 외측 마커(52a)가 제2 영역(42)의 외측으로 나올 것 같아진 시점에서, 제8 판정 조건이 충족된 것으로 판정되어도 된다. 본 실시 형태에서는, 제2 외측 마커(52a)의 적어도 일부가 실제로 제2 영역(42)의 외측으로 나왔을 경우, 제8 판정 조건이 충족된 것으로 판정된다.The eighth determination condition is that at least a part of the second
이와 같이, 제8 판정 조건은, 제2 외측 마커(52a)가 제2 영역(42)의 외측으로 나오는 것이다.In this way, the eighth determination condition is that the second
제9 판정 조건은, 제3 외측 마커(53a)의 적어도 일부가 제3 영역(43)의 외측으로 나오는 것이다. 또한, 제3 외측 마커(53a)가 실제로 제3 영역(43)의 외측으로 나왔을 경우뿐만 아니라, 제3 외측 마커(53a)가 제3 영역(43)의 외측으로 나올 것 같아진 시점에서, 제9 판정 조건이 충족된 것으로 판정되어도 된다. 본 실시 형태에서는, 제3 외측 마커(53a)의 적어도 일부가 실제로 제3 영역(43)의 외측으로 나왔을 경우, 제9 판정 조건이 충족된 것으로 판정된다.The ninth determination condition is that at least a part of the third
제7 판정 조건, 제8 판정 조건, 제9 판정 조건 중 적어도 1개가 충족되어 있을 경우, 스텝 S05에서 "예"라고 판정되어, 처리는 스텝 S06으로 이행한다. 또한, 제7 판정 조건, 제8 판정 조건, 제9 판정 조건 모두 충족되지 않았을 경우, 스텝 S05에서 "아니오"라고 판정되고, 처리는 일단 종료된다.When at least one of the seventh determination condition, the eighth determination condition, and the ninth determination condition is satisfied, it is determined with “Yes” in step S05, and the processing advances to step S06. In addition, when all of the seventh determination condition, the eighth determination condition, and the ninth determination condition are not satisfied, it is determined as NO in step S05, and the processing is temporarily terminated.
스텝 S06에서는, 주행 제어부(29)에 의해 감속 제어가 실행된다. 감속 제어란, 콤바인(1)의 차속을 감소시키는 제어이다. 그 후, 처리는 일단 종료된다.In step S06, deceleration control is executed by the
이상에서 설명한 구성에 의해, 주행 제어부(29)는, 제7 판정 조건 및 제8 판정 조건의 적어도 한쪽이 충족되었을 경우, 감속 제어를 실행하도록 구성되어 있다. 또한, 주행 제어부(29)는, 제1 판정 조건 및 제2 판정 조건의 적어도 한쪽이 충족되었을 경우, 감속 제어와는 다른 내용의 제어인 정지 제어를 실행하도록 구성되어 있다. 또한, 주행 제어부(29)는, 제4 판정 조건 및 제5 판정 조건의 적어도 한쪽이 충족되었을 경우, 감속 제어와 정지 제어의 어느 것과도 다른 내용의 제어인 방향 변경 제어를 실행하도록 구성되어 있다.With the configuration described above, the
그리고, 감속 제어는, 콤바인(1)의 차속을 감소시키는 제어이다. 또한, 정지 제어는, 콤바인(1)의 주행을 정지시키는 제어이다. 또한, 방향 변경 제어는, 콤바인(1)의 진행 방향을 변경시키는 제어이다.And the deceleration control is control which reduces the vehicle speed of the
그리고, 감속 제어, 정지 제어, 방향 변경 제어에 의해, 각 제1 마커(51)가 제1 영역(41)의 외측으로 나오는 것이 억제되고, 또한, 각 제2 마커(52)가 제2 영역(42)의 외측으로 나오는 것이 억제되고, 또한, 각 제3 마커(53)가 제3 영역(43)의 외측으로 나오는 것이 억제되게 된다.And, by the deceleration control, the stop control, and the direction change control, it is suppressed that each
단, 도 10에 도시하는 바와 같이, 스텝 S03에서의 판정은, 스텝 S01에서 "아니오"라고 판정된 경우에만 행하여진다. 또한, 스텝 S05에서의 판정은, 스텝 S01 및 스텝 S03에서 "아니오"라고 판정된 경우에만 행하여진다.However, as shown in FIG. 10, the determination in step S03 is performed only when it is determined in step S01 as "No". In addition, the determination in step S05 is performed only when it determines with "no" in steps S01 and S03.
따라서, 방향 변경 제어 및 감속 제어는, 정지 제어가 실행되지 않을 경우에만 실행될 수 있다. 또한, 감속 제어는, 정지 제어와 방향 변경 제어가 모두 실행되지 않을 경우에만 실행될 수 있다.Accordingly, the direction change control and the deceleration control can be executed only when the stop control is not executed. Also, the deceleration control can be executed only when neither the stop control nor the direction change control is executed.
즉, 정지 제어는, 감속 제어 및 방향 변경 제어에 우선해서 실행된다. 특히, 정지 제어는, 감속 제어에 우선해서 실행된다. 또한, 방향 변경 제어는, 감속 제어에 우선해서 실행된다.That is, the stop control is executed prior to the deceleration control and the direction change control. In particular, the stop control is executed prior to the deceleration control. In addition, the direction change control is performed with priority over the deceleration control.
여기서, 도 10에 도시한 제어 루틴에 의해 감속 제어 및 정지 제어가 실행될 경우에 대해서, 예를 들어 설명한다.Here, a case where deceleration control and stop control are executed by the control routine shown in Fig. 10 will be described by way of example.
도 11에는, 포장(5)을 주행 중인 콤바인(1)이 포장 외연부(6)에 접근해 갈 경우의 예가, 평면도로 나타내져 있다. 또한, 도 11에서는, 콤바인(1)의 도시를 생략하고 있다. 또한, 이 예에서는, 설명을 이해하기 쉽게 하기 위해서, 제3 영역(43) 및 각 제3 마커(53)에 대해서는 생략하고 있다. 또한, 제1 중간 마커(51b) 및 제2 중간 마커(52b)에 대해서도 생략하고 있다.In FIG. 11, the example in the case where the
도 11에 도시하는 예에서는, 콤바인(1)은, 먼저, 제1 위치(P1)에 위치하고 있다. 이때, 제1 외측 마커(51a)는 제1 영역(41)의 외측으로 나와 있지 않지만, 제2 외측 마커(52a)가 제2 영역(42)의 외측으로 나와 있다. 즉, 상술한 제7 판정 조건은 충족되지 않았지만, 제8 판정 조건이 충족되어 있다. 또한, 이때, 제1 내측 마커(51c)는 제1 영역(41)의 외측으로 나와 있지 않고, 또한, 제2 내측 마커(52c)는 제2 영역(42)의 외측으로 나와 있지 않다.In the example shown in FIG. 11, the
그 때문에, 도 10에 도시한 제어 루틴의 스텝 S05에서 "예"라고 판정되어, 주행 제어부(29)에 의해 감속 제어가 실행된다.Therefore, it is determined as YES in step S05 of the control routine shown in FIG. 10 , and deceleration control is executed by the
이어서, 콤바인(1)은, 제2 위치(P2)에 도달한다. 이때, 제2 외측 마커(52a)가 제2 영역(42)의 외측으로 나와 있다. 즉, 상술한 제8 판정 조건이 충족되어 있다. 또한, 이때, 제1 외측 마커(51a)가 제1 영역(41)의 외측으로 나와 있다. 즉, 상술한 제7 판정 조건이 충족되어 있다. 또한, 이때, 제1 내측 마커(51c)는 제1 영역(41)의 외측으로 나와 있지 않고, 또한, 제2 내측 마커(52c)는 제2 영역(42)의 외측으로 나와 있지 않다.Next, the
이때, 주행 제어부(29)에 의한 제어 내용은 변화하지 않는다. 즉, 이미 실행 중인 감속 제어가 계속해서 행하여지게 된다.At this time, the control contents by the
이와 같이, 주행 제어부(29)는, 제7 판정 조건 및 제8 판정 조건 중 한쪽만이 충족되어 있는 상태에서, 제7 판정 조건 및 제8 판정 조건 양쪽이 충족되어 있는 상태로 변화한 것에 따라서 콤바인(1)의 주행의 제어 내용을 변화시키지 않도록 구성되어 있다.In this way, the
또한, 마찬가지로, 주행 제어부(29)는, 제1 판정 조건 및 제2 판정 조건 중 한쪽만이 충족되어 있는 상태에서, 제1 판정 조건 및 제2 판정 조건 양쪽이 충족되어 있는 상태로 변화한 것에 따라서 콤바인(1)의 주행의 제어 내용을 변화시키지 않도록 구성되어 있다.Similarly, the
또한, 도 11에서는 생략되어 있지만, 이것은, 제1 중간 마커(51b) 및 제2 중간 마커(52b)에도 마찬가지로 적용된다. 즉, 주행 제어부(29)는, 제4 판정 조건 및 제5 판정 조건 중 한쪽만이 충족되어 있는 상태에서, 제4 판정 조건 및 제5 판정 조건 양쪽이 충족되어 있는 상태로 변화한 것에 따라서 콤바인(1)의 주행의 제어 내용을 변화시키지 않도록 구성되어 있다.In addition, although it is abbreviate|omitted in FIG. 11, this applies similarly to the 1st
또한, 이것은, 제7 판정 조건, 제8 판정 조건, 제9 판정 조건의 3개의 조건에 대해서도 마찬가지이다. 즉, 주행 제어부(29)는, 제7 판정 조건, 제8 판정 조건, 제9 판정 조건 중 1개만이 충족되어 있는 상태에서, 2개만이 충족되어 있는 상태 또는 3개 모두가 충족되어 있는 상태로 변화한 것에 따라서 콤바인(1)의 주행의 제어 내용을 변화시키지 않도록 구성되어 있다. 또한, 주행 제어부(29)는, 제7 판정 조건, 제8 판정 조건, 제9 판정 조건 중 2개만이 충족되어 있는 상태에서, 3개 모두가 충족되어 있는 상태로 변화한 것에 따라서 콤바인(1)의 주행의 제어 내용을 변화시키지 않도록 구성되어 있다.In addition, this is also the same for three conditions of a 7th determination condition, an 8th determination condition, and a 9th determination condition. That is, the
이것은, 제1 판정 조건, 제2 판정 조건, 제3 판정 조건의 3개의 조건에 대해서도 마찬가지이다. 또한, 제4 판정 조건, 제5 판정 조건, 제6 판정 조건의 3개의 조건에 대해서도 마찬가지이다.This also applies to the three conditions of the first determination condition, the second determination condition, and the third determination condition. The same applies to the three conditions of the fourth determination condition, the fifth determination condition, and the sixth determination condition.
이어서, 콤바인(1)은, 제3 위치(P3)에 도달한다. 이때, 제2 내측 마커(52c)는 제2 영역(42)의 내측에 위치하고 있지만, 제1 내측 마커(51c)는 제1 영역(41)의 외형 선에 접촉하고 있다.Next, the
그 때문에, 도 10에 도시한 제어 루틴의 스텝 S01에서 "예"라고 판정되어, 주행 제어부(29)에 의해 정지 제어가 실행된다. 이에 의해, 콤바인(1)은 제3 위치(P3)에서 정지하게 된다.Therefore, in step S01 of the control routine shown in FIG. 10 , it is determined “YES”, and the
또한, 이상에서 설명한 주행 제어부(29)에 의한 제어는, 콤바인(1)의 전진 중뿐만 아니라, 후진 중에도 행하여진다. 즉, 주행 제어부(29)는, 콤바인(1)의 전진 중 및 후진 중의 어느 것에서든, 각 제1 마커(51)가 제1 영역(41)의 외측으로 나오는 것이 억제되고, 또한, 각 제2 마커(52)가 제2 영역(42)의 외측으로 나오는 것이 억제되고, 또한, 각 제3 마커(53)가 제3 영역(43)의 외측으로 나오는 것이 억제되도록, 콤바인(1)의 주행을 제어한다.In addition, the control by the traveling
이와 같이, 주행 제어부(29)는, 콤바인(1)의 전진 중 및 후진 중의 어느 것에서든, 제1 마커(51)가 제1 영역(41)의 외측으로 나오는 것이 억제되고, 또한, 제2 마커(52)가 제2 영역(42)의 외측으로 나오는 것이 억제되도록, 콤바인(1)의 주행을 제어한다.In this way, the
〔변경부에 대해서〕[About the change part]
도 5에 도시한 바와 같이, 콤바인(1)은, 차속 검지부(19)를 구비하고 있다. 또한, 차속 검지부(19)는, 작업 시스템(SY)에 포함되어 있어도 된다.As shown in FIG. 5 , the
차속 검지부(19)는, 주행 장치(11)의 구동 속도를 검지하는 센서이다. 차속 검지부(19)는, 주행 장치(11)의 구동 속도를 검지함으로써, 콤바인(1)의 차속을 검지한다.The vehicle
또한, 마커 관리부(70)는, 변경부(73)를 갖고 있다. 변경부(73)는, 차속 검지부(19)에 의한 검지 결과를 취득한다. 그리고, 변경부(73)는, 콤바인(1)의 차속에 따라, 제1 외측 마커(51a), 제1 중간 마커(51b), 제2 외측 마커(52a), 제2 중간 마커(52b), 제3 외측 마커(53a), 제3 중간 마커(53b)의 크기를 변경한다.In addition, the
보다 구체적으로는, 변경부(73)는, 콤바인(1)의 차속이 낮을수록, 제1 외측 마커(51a), 제1 중간 마커(51b), 제2 외측 마커(52a), 제2 중간 마커(52b), 제3 외측 마커(53a), 제3 중간 마커(53b)를 작게 한다.More specifically, as for the
즉, 작업 시스템(SY)은, 콤바인(1)의 차속에 따라서 제1 마커(51) 및 제2 마커(52)의 크기를 변경하는 변경부(73)를 구비하고 있다.That is, the work system SY is equipped with the
또한, 변경부(73)는, 제1 내측 마커(51c), 제2 내측 마커(52c), 제3 내측 마커(53c)의 크기를 변경하지 않도록 구성되어 있다. 즉, 본 실시 형태에 있어서, 제1 내측 마커(51c), 제2 내측 마커(52c), 제3 내측 마커(53c)의 크기는, 콤바인(1)의 차속에 관계없이 일정하다.In addition, the
단, 본 발명은 이것에 한정되지 않고, 변경부(73)는, 콤바인(1)의 차속에 따라서 제1 내측 마커(51c), 제2 내측 마커(52c), 제3 내측 마커(53c)의 크기를 변경하도록 구성되어 있어도 된다.However, this invention is not limited to this, The
여기서, 제2 외측 마커(52a) 및 제2 중간 마커(52b)의 크기가 변경될 경우에 대해서, 예를 들어 설명한다.Here, a case in which the sizes of the second
도 12에는, 포장(5)을 주행 중인 콤바인(1)이 포장 외연부(6)에 접근해 갈 경우의 예가, 평면도로 나타내져 있다. 또한, 이 예에서는, 설명을 이해하기 쉽게 하기 위해서, 제1 영역(41), 제3 영역(43), 각 제1 마커(51), 각 제3 마커(53)에 대해서는 생략하고 있다.In FIG. 12, the example in the case where the
도 12에 도시하는 예에서는, 콤바인(1)은, 먼저, 제4 위치(P4)에 위치하고 있다. 이때, 제2 외측 마커(52a)는 제2 영역(42)의 내측에 위치하고 있다. 그 때문에, 이때, 정지 제어, 방향 변경 제어, 감속 제어 모두 실행되지 않는다.In the example shown in FIG. 12, the
또한, 이때, 기체(10)의 전단부와 제2 외측 마커(52a)의 전단부 사이의 거리는, 제1 거리(D1)이다. 또한, 기체(10)의 전단부와 제2 중간 마커(52b)의 전단부 사이의 거리는, 제2 거리(D2)이다.In addition, at this time, the distance between the front end of the
이어서, 콤바인(1)은, 제5 위치(P5)에 도달한다. 이때, 제2 외측 마커(52a)가 제2 영역(42)의 외측으로 나와 있다. 또한, 이때, 제2 중간 마커(52b) 및 제2 내측 마커(52c)는, 모두 제2 영역(42)의 내측에 위치하고 있다. 그 때문에, 이때, 주행 제어부(29)에 의해 감속 제어가 실행된다.Next, the
이 감속 제어에 의해, 콤바인(1)의 차속은 감소하게 된다. 이에 따라, 변경부(73)는, 제2 외측 마커(52a) 및 제2 중간 마커(52b)의 크기를 작게 한다. 이에 의해, 기체(10)의 전단부와 제2 외측 마커(52a)의 전단부 사이의 거리는, 제3 거리(D3)로 된다. 또한, 기체(10)의 전단부와 제2 중간 마커(52b)의 전단부 사이의 거리는, 제4 거리(D4)로 된다.By this deceleration control, the vehicle speed of the
또한, 제3 거리(D3)는, 제1 거리(D1)보다도 짧다. 또한, 제4 거리(D4)는, 제2 거리(D2)보다도 짧다.In addition, the third distance D3 is shorter than the first distance D1. In addition, the fourth distance D4 is shorter than the second distance D2.
이어서, 콤바인(1)은, 제6 위치(P6)에 도달한다. 여기서, 콤바인(1)이 제5 위치(P5)로부터 제6 위치(P6)까지 이동하는 동안에, 주행 제어부(29)에 의한 감속 제어가 계속해서 실행된다. 그 때문에, 콤바인(1)이 제6 위치(P6)에 도달한 시점에서의 차속은, 콤바인(1)이 제5 위치(P5)에 위치하고 있었을 때의 차속에 비해서 낮다.Next, the
그 때문에, 이때, 제2 외측 마커(52a) 및 제2 중간 마커(52b)의 크기는, 더욱 작게 되어 있다. 구체적으로는, 기체(10)의 전단부와 제2 외측 마커(52a)의 전단부 사이의 거리는, 제5 거리(D5)로 되어 있다. 또한, 기체(10)의 전단부와 제2 중간 마커(52b)의 전단부 사이의 거리는, 제6 거리(D6)로 되어 있다.Therefore, at this time, the sizes of the second
또한, 제5 거리(D5)는, 제3 거리(D3)보다도 짧다. 또한, 제6 거리(D6)는, 제4 거리(D4)보다도 짧다.In addition, the fifth distance D5 is shorter than the third distance D3. In addition, the sixth distance D6 is shorter than the fourth distance D4.
또한, 이때, 제2 중간 마커(52b)가 제2 영역(42)의 외측으로 나와 있다. 또한, 이때, 제2 내측 마커(52c)는, 제2 영역(42)의 내측에 위치하고 있다. 그 때문에, 이때, 주행 제어부(29)에 의해 방향 변경 제어가 실행된다.Also, at this time, the second
단, 이 예에서는, 포장(5)의 경사 등의 영향에 의해, 콤바인(1)의 진행 방향은 실제로는 변화하지 않지만, 차속이 점차 저하되어 가는 것으로 한다. 따라서, 콤바인(1)은, 제6 위치(P6)를 통과하여, 그대로 직진을 계속하면서 감속되어 나간다.However, in this example, although the advancing direction of the
이어서, 콤바인(1)은, 제7 위치(P7)에 도달한다. 콤바인(1)이 제7 위치(P7)에 도달한 시점에서의 차속은, 콤바인(1)이 제6 위치(P6)에 위치하고 있었을 때의 차속에 비해서 낮다.Next, the
그 때문에, 이때, 제2 외측 마커(52a) 및 제2 중간 마커(52b)의 크기는, 더욱 작게 되어 있다. 구체적으로는, 기체(10)의 전단부와 제2 외측 마커(52a)의 전단부 사이의 거리는, 제7 거리(D7)로 되어 있다. 또한, 기체(10)의 전단부와 제2 중간 마커(52b)의 전단부 사이의 거리는, 제8 거리(D8)로 되어 있다.Therefore, at this time, the sizes of the second
또한, 제7 거리(D7)는, 제5 거리(D5)보다도 짧다. 또한, 제8 거리(D8)는, 제6 거리(D6)보다도 짧다.In addition, the seventh distance D7 is shorter than the fifth distance D5. In addition, the eighth distance D8 is shorter than the sixth distance D6.
또한, 이때, 제2 내측 마커(52c)가, 제2 영역(42)의 외형 선에 접촉하고 있다. 그 때문에, 주행 제어부(29)에 의해 정지 제어가 실행된다. 이에 의해, 콤바인(1)은 제7 위치(P7)에서 정지하게 된다.At this time, the second
〔경로 생성에 대해서〕[About route creation]
도 5에 도시한 바와 같이, 자동 주행 제어부(24)는, 제2 경로 생성부(28)(본 발명에 관한 「경로 생성부」에 상당)를 갖고 있다. 제2 경로 생성부(28)는, 제1 내측 마커(51c), 제2 내측 마커(52c), 제3 내측 마커(53c), 제1 영역(41), 제2 영역(42), 제3 영역(43)에 기초하여, 제2 작업 주행을 위한 목표 주행 경로(TL)(도 13 및 도 15 참조)를 생성하도록 구성되어 있다. 또한, 목표 주행 경로(TL)는, 상술한 예취 주행 경로(LI)와는 다른 경로이다.As shown in FIG. 5 , the automatic
상술한 바와 같이, 본 실시 형태에 있어서, 제2 작업 주행은 자동 주행에 의해 행하여진다. 즉, 제2 경로 생성부(28)는, 콤바인(1)의 자동 주행을 위한 목표 주행 경로(TL)를 생성한다.As described above, in the present embodiment, the second work travel is performed by automatic travel. That is, the second
이와 같이, 작업 시스템(SY)은, 콤바인(1)의 자동 주행을 위한 목표 주행 경로(TL)를 생성하는 제2 경로 생성부(28)를 구비하고 있다.In this way, the work system SY is provided with the 2nd path|
제2 경로 생성부(28)는, 콤바인(1)이 목표 주행 경로(TL)를 따라 자동 주행한 경우에, 제1 내측 마커(51c)가 제1 영역(41)의 외측으로 나오지 않고, 또한, 제2 내측 마커(52c)가 제2 영역(42)의 외측으로 나오지 않고, 또한, 제3 내측 마커(53c)가 제3 영역(43)의 외측으로 나오지 않도록, 목표 주행 경로(TL)를 생성한다.The second
즉, 제2 경로 생성부(28)는, 콤바인(1)이 목표 주행 경로(TL)를 따라 자동 주행한 경우에, 제1 내측 마커(51c)가 제1 영역(41)의 외측으로 나오지 않고, 또한, 제2 내측 마커(52c)가 제2 영역(42)의 외측으로 나오지 않도록, 목표 주행 경로(TL)를 생성한다.That is, when the
이하에서는, 제2 경로 생성부(28)에 의한 목표 주행 경로(TL)의 생성에 대해서 상세하게 설명한다.Hereinafter, generation of the target travel path TL by the second
본 실시 형태에 있어서, 제2 경로 생성부(28)는, 콤바인(1)이 예취 주행 중에 방향 전환할 경우, 및 콤바인(1)이 배출 작업을 행할 예정인 지점으로 이동할 경우에, 목표 주행 경로(TL)를 생성한다. 또한, 배출 작업이란, 곡립 탱크(14)에 저류된 곡립을 곡립 배출 장치(18)에 의해 배출하는 작업이다.In the present embodiment, when the
제2 경로 생성부(28)는, 먼저, 콤바인(1)이 최단 거리로 이동 가능한 목표 주행 경로(TL)를 생성한다. 그리고, 제2 경로 생성부(28)는, 콤바인(1)이 그 목표 주행 경로(TL)를 따라 실제로 주행하기 전에, 그 목표 주행 경로(TL)가 적절한지 여부를 판정한다.The second
이때, 제2 경로 생성부(28)는, 콤바인(1)이 그 목표 주행 경로(TL)를 따라 자동 주행한 경우에, 제1 내측 마커(51c)가 제1 영역(41)의 외측으로 나오지 않고, 또한, 제2 내측 마커(52c)가 제2 영역(42)의 외측으로 나오지 않고, 또한, 제3 내측 마커(53c)가 제3 영역(43)의 외측으로 나오지 않는지 여부를 판정한다.At this time, when the
콤바인(1)이 그 목표 주행 경로(TL)를 따라 자동 주행한 경우에, 제1 내측 마커(51c)가 제1 영역(41)의 외측으로 나오지 않고, 또한, 제2 내측 마커(52c)가 제2 영역(42)의 외측으로 나오지 않고, 또한, 제3 내측 마커(53c)가 제3 영역(43)의 외측으로 나오지 않는다고 판정된 경우, 제2 경로 생성부(28)는, 그 목표 주행 경로(TL)가 적절하다고 판정한다. 그리고, 그 목표 주행 경로(TL)를, 도 5에 도시한 바와 같이 주행 제어부(29)에 보낸다.When the
한편, 콤바인(1)이 그 목표 주행 경로(TL)를 따라 자동 주행한 경우에 제1 내측 마커(51c)가 제1 영역(41)의 외측으로 나온다고 판정된 경우, 제2 경로 생성부(28)는, 그 목표 주행 경로(TL)가 적절하지 않다고 판정한다. 또한, 콤바인(1)이 그 목표 주행 경로(TL)를 따라 자동 주행한 경우에 제2 내측 마커(52c)가 제2 영역(42)의 외측으로 나온다고 판정된 경우, 및 콤바인(1)이 그 목표 주행 경로(TL)를 따라 자동 주행한 경우에 제3 내측 마커(53c)가 제3 영역(43)의 외측으로 나온다고 판정된 경우에도, 제2 경로 생성부(28)는, 그 목표 주행 경로(TL)가 적절하지 않다고 판정한다.On the other hand, when it is determined that the first
생성된 목표 주행 경로(TL)가 적절하지 않다고 판정된 경우, 제2 경로 생성부(28)는, 새로운 목표 주행 경로(TL)를 생성한다. 그리고, 생성된 목표 주행 경로(TL)가 적절하다고 판정될 때까지, 새로운 목표 주행 경로(TL)의 생성과, 그 목표 주행 경로(TL)가 적절한지 여부의 판정을 반복한다. 그리고, 적절하다고 판정된 목표 주행 경로(TL)가, 주행 제어부(29)에 보내진다.When it is determined that the generated target travel path TL is not appropriate, the second
주행 제어부(29)는, 자차 위치 산출부(21)로부터 수취한 콤바인(1)의 위치 좌표와, 제2 경로 생성부(28)로부터 수취한 목표 주행 경로(TL)에 기초하여, 콤바인(1)의 자동 주행을 제어한다. 보다 구체적으로는, 주행 제어부(29)는, 목표 주행 경로(TL)를 따른 자동 주행이 행해지도록, 콤바인(1)의 주행을 제어한다.The
도 13 및 도 14에서는, 콤바인(1)이 예취 주행 중에 방향 전환할 때, 제2 경로 생성부(28)에 의해 목표 주행 경로(TL)가 생성되는 예가 도시되어 있다. 이 예에서는, 콤바인(1)은, 예취 주행 경로(LI)인 제1 예취 경로(LI1)를 따라 자동 주행을 행하고 있다. 그리고, 다음으로 주행하는 예취 주행 경로(LI)로서, 경로 선택부(27)에 의해 제2 예취 경로(LI2)가 선택되어 있다.In FIGS. 13 and 14, when the
제1 예취 경로(LI1)와 제2 예취 경로(LI2)는 직교하고 있다. 그 때문에, 콤바인(1)은, 90°의 방향 전환을 행할 필요가 있다.1st harvesting route LI1 and 2nd harvesting route LI2 are orthogonal to each other. Therefore, the
이 예에서, 제2 경로 생성부(28)는, 먼저, 목표 주행 경로(TL)인 제1 목표 경로(TL1)를 생성한다. 도 13에 도시하는 바와 같이, 제1 목표 경로(TL1)는, 제1 경로(t1), 제2 경로(t2), 제3 경로(t3)로 구성되어 있다.In this example, the second
제1 경로(t1)는, 기체 좌측으로 선회하면서 전진하기 위한 경로이다. 제2 경로(t2)는, 기체 우측으로 선회하면서 후진하기 위한 경로이다. 제3 경로(t3)는, 전진하기 위한 경로이다.The 1st path|route t1 is a path|route for advancing, turning to the left side of a body. The second path t2 is a path for moving backward while turning to the right side of the aircraft. The third path t3 is a path for moving forward.
콤바인(1)이 제1 목표 경로(TL1)를 따라 자동 주행할 경우, 콤바인(1)은, 제1 경로(t1), 제2 경로(t2), 제3 경로(t3)의 순으로 주행하게 된다.When the
여기서, 이 예에서는, 도 14에 도시하는 바와 같이, 콤바인(1)이 제1 경로(t1)를 따라 자동 주행한 경우, 제2 내측 마커(52c)가 제2 영역(42)의 외측으로 나오는 것으로 한다. 그 때문에, 제2 경로 생성부(28)는, 제1 목표 경로(TL1)가 적절하지 않다고 판정한다. 그리고, 제2 경로 생성부(28)는, 도 15에 도시하는 바와 같이, 새로운 목표 주행 경로(TL)인 제2 목표 경로(TL2)를 생성한다.Here, in this example, as shown in FIG. 14 , when the
그리고, 이 예에서는, 도 16에 도시하는 바와 같이, 콤바인(1)이 제2 목표 경로(TL2)를 따라 자동 주행한 경우, 제1 내측 마커(51c)가 제1 영역(41)의 외측으로 나오지 않고, 또한, 제2 내측 마커(52c)가 제2 영역(42)의 외측으로 나오지 않고, 또한, 제3 내측 마커(53c)가 제3 영역(43)의 외측으로 나오지 않는 것으로 한다. 그 때문에, 제2 경로 생성부(28)는, 제2 목표 경로(TL2)가 적절하다고 판정한다.And, in this example, as shown in FIG. 16 , when the
그리고, 제2 경로 생성부(28)는, 제2 목표 경로(TL2)를 주행 제어부(29)에 보낸다. 주행 제어부(29)는, 제2 목표 경로(TL2)를 따른 자동 주행이 행해지도록, 콤바인(1)의 주행을 제어한다.Then, the
또한, 도 13 및 도 15에 도시하는 바와 같이, 제2 목표 경로(TL2)를 따른 자동 주행에서의 전진 및 후진의 횟수는, 제1 목표 경로(TL1)를 따른 자동 주행에서의 전진 및 후진의 횟수보다도 많다. 또한, 제2 목표 경로(TL2)를 따른 자동 주행에서의 주행 거리는, 제1 목표 경로(TL1)를 따른 자동 주행에서의 주행 거리보다도 길다.Further, as shown in FIGS. 13 and 15 , the number of forwards and backwards in the automatic driving along the second target path TL2 is the number of forwards and backwards in the automatic driving along the first target path TL1 , as shown in FIGS. 13 and 15 . more than the number of times Further, the travel distance in the automatic travel along the second target path TL2 is longer than the travel distance in the automatic travel along the first target path TL1 .
또한, 도 15에 도시하는 바와 같이, 제2 목표 경로(TL2)에는, 콤바인(1)이 후진하기 위한 부분이 포함되어 있다. 이와 같이, 제2 경로 생성부(28)는, 콤바인(1)이 후진하기 위한 부분을 포함하는 목표 주행 경로(TL)를 생성 가능하다.Moreover, as shown in FIG. 15, the part for the
또한, 도 17 및 도 18에서는, 콤바인(1)이 배출 작업을 행할 예정인 지점인 배출 지점(DP)으로 이동할 경우에, 제2 경로 생성부(28)에 의해 목표 주행 경로(TL)가 생성되는 예가 도시되어 있다.In addition, in FIGS. 17 and 18 , when the
이 예에서는, 포장 외연부(6) 중, 배출 지점(DP)의 근방에, 운반차(CV)가 주차하고 있다. 운반차(CV)는, 콤바인(1)이 곡립 배출 장치(18)로부터 배출한 곡립을 수집하여, 운반할 수 있다.In this example, the transport vehicle CV is parked in the vicinity of the discharge point DP among the pavement
또한, 이 예에서는, 콤바인(1)은, 작업 대상 영역(CA)의 중앙 부분을 빠져 나가도록 예취 주행(중할 주행)을 행한 후, 미예취 영역을 통과하지 않고 배출 지점(DP)으로 이동하는 것으로 한다.In addition, in this example, the
이 예에서, 제2 경로 생성부(28)는, 먼저, 목표 주행 경로(TL)인 제3 목표 경로(TL3)를 생성한다. 도 17에 도시하는 바와 같이, 제3 목표 경로(TL3)에는, 90°의 좌측 선회가 행하여지는 선회 개소가 3개 포함되어 있다. 그리고, 콤바인(1)이 최초의 선회 개소를 통과할 때, 콤바인(1)은, 포장 외연부(6)에서의 측면부(61a) 근방을 통과하게 된다.In this example, the second
그리고, 이 예에서는, 도 18에 도시하는 바와 같이, 콤바인(1)이 제3 목표 경로(TL3)를 따라 자동 주행한 경우, 제1 내측 마커(51c)가 제1 영역(41)의 외측으로 나오지 않고, 또한, 제2 내측 마커(52c)가 제2 영역(42)의 외측으로 나오지 않고, 또한, 제3 내측 마커(53c)가 제3 영역(43)의 외측으로 나오지 않는 것으로 한다. 그 때문에, 제2 경로 생성부(28)는, 제3 목표 경로(TL3)가 적절하다고 판정한다.And, in this example, as shown in FIG. 18 , when the
그리고, 제2 경로 생성부(28)는, 제3 목표 경로(TL3)를 주행 제어부(29)에 보낸다. 주행 제어부(29)는, 제3 목표 경로(TL3)를 따른 자동 주행이 행해지도록, 콤바인(1)의 주행을 제어한다.Then, the
이상에서 설명한 구성이라면, 제1 내측 마커(51c) 및 제2 내측 마커(52c)의 2개의 가상적인 마커가 설정된다. 그리고, 제2 경로 생성부(28)는, 콤바인(1)이 목표 주행 경로(TL)를 따라 자동 주행한 경우에, 제1 내측 마커(51c)가 제1 영역(41)의 외측으로 나오지 않고, 또한, 제2 내측 마커(52c)가 제2 영역(42)의 외측으로 나오지 않도록, 목표 주행 경로(TL)를 생성한다.With the configuration described above, two virtual markers, the first
이에 의해, 목표 주행 경로(TL)의 생성 시, 제1 내측 마커(51c)가 제2 영역(42)의 외측으로 나오는 것은 허용됨과 함께, 제2 내측 마커(52c)가 제1 영역(41)의 외측으로 나오는 것은 허용되게 된다. 따라서, 제1 내측 마커(51c) 및 제2 내측 마커(52c)를, 콤바인(1)의 입체 형상에 맞춰서 적절히 설정함과 함께, 이들 마커에 대응시켜서 2개의 영역을 설정함으로써, 생성되는 목표 주행 경로(TL)가 효율적인 것으로 되기 쉬워진다.Accordingly, when the target travel path TL is generated, the first
예를 들어, 이상에서 설명한 구성이라면, 콤바인(1)의 기체(10) 중, 제2 내측 마커(52c)에 대응하는 부분이 제1 영역(41)의 외측으로 나오는 것은 허용된다. 따라서, 콤바인(1)의 기체(10) 중, 제2 내측 마커(52c)에 대응하는 부분이 제1 영역(41)의 외측으로 나오는 것이 회피되도록 목표 주행 경로(TL)가 생성되는 구성에 비하여, 목표 주행 경로(TL)가 충족해야 하는 조건이 완화된다. 그 때문에, 생성되는 목표 주행 경로(TL)가 효율적인 것으로 되기 쉬워진다.For example, if it is the structure demonstrated above, it is allowable for the part corresponding to the 2nd
이와 같이, 이상에서 설명한 구성이라면, 목표 주행 경로(TL)가 충족해야 하는 조건이 비교적 완화된다. 그 결과, 생성되는 목표 주행 경로(TL)가 효율적인 것으로 되기 쉬운 작업 시스템(SY)을 실현할 수 있다.In this way, with the configuration described above, the condition that the target travel path TL must satisfy is relatively relaxed. As a result, it is possible to realize the work system SY in which the generated target travel path TL is likely to be efficient.
〔그 밖의 실시 형태〕[Other embodiments]
(1) 주행 장치(11)는, 휠식이어도 되고, 세미크롤러식이어도 된다.(1) The traveling
(2) 상기 실시 형태에서는, 제1 경로 생성부(23)에 의해 생성되는 예취 주행 경로(LI)는, 종횡 방향으로 연장되는 복수의 메쉬 선이다. 그러나, 본 발명은 이것에 한정되지 않고, 제1 경로 생성부(23)에 의해 생성되는 예취 주행 경로(LI)는, 종횡 방향으로 연장되는 복수의 메쉬 선이 아니어도 된다. 예를 들어, 제1 경로 생성부(23)에 의해 생성되는 예취 주행 경로(LI)는, 와권상의 주행 경로이어도 된다. 또한, 예취 주행 경로(LI)는, 다른 예취 주행 경로(LI)와 직교하지 않아도 된다. 또한, 제1 경로 생성부(23)에 의해 생성되는 예취 주행 경로(LI)는, 서로 평행한 복수의 평행선이어도 된다.(2) In the said embodiment, the harvesting travel path|route LI produced|generated by the 1st path|
(3) 자차 위치 산출부(21), 작업 영역 산출부(22), 제1 경로 생성부(23), 자동 주행 제어부(24), 맵 생성부(25), 경로 선택부(27), 제2 경로 생성부(28), 주행 제어부(29), 기체 정보 기억부(33), 마커 위치 산출부(35), 마커 관리부(70), 마커 기억부(71), 마커 설정부(72), 변경부(73), 영역 관리부(75), 영역 기억부(76), 영역 설정부(77) 중, 일부 또는 모두가 콤바인(1)의 외부에 구비되어 있어도 되는 것이며, 예를 들어 콤바인(1)의 외부에 마련된 관리 시설이나 관리 서버에 구비되어 있어도 된다.(3) Own vehicle
(4) 콤바인(1)은, 자동 주행을 할 수 없도록 구성되어 있어도 된다.(4) The
(5) 상기 실시 형태에서는, 작업 영역 산출부(22)가, 콤바인(1)이 제1 작업 주행을 행한 영역을 외주 영역(SA)으로서 산출한다. 그러나, 본 발명은 이것에 한정되지 않는다. 외주 영역(SA)은, 콤바인(1)이 제1 작업 주행을 행하기 전에 결정되어 있어도 된다.(5) In the said embodiment, the work
(6) 각 제1 마커(51)는, 프레임상이 아니어도 된다. 예를 들어, 각 제1 마커(51)는, 1개 또는 복수의 점이어도 되고, 2점을 연결하는 직선이나 곡선이어도 되고, 복수의 직선이나 곡선이 조합된 것이어도 된다.(6) Each of the
(7) 각 제2 마커(52)는, 프레임상이 아니어도 된다. 예를 들어, 각 제2 마커(52)는, 1개 또는 복수의 점이어도 되고, 2점을 연결하는 직선이나 곡선이어도 되고, 복수의 직선이나 곡선이 조합된 것이어도 된다.(7) Each of the
(8) 각 제3 마커(53)는, 프레임상이 아니어도 된다. 예를 들어, 각 제3 마커(53)는, 1개 또는 복수의 점이어도 되고, 2점을 연결하는 직선이나 곡선이어도 되고, 복수의 직선이나 곡선이 조합된 것이어도 된다.(8) Each of the
(9) 상기 실시 형태에서는, 제1 마커(51), 제2 마커(52), 제3 마커(53)의 3종류의 마커가 존재한다. 그러나, 본 발명은 이것에 한정되지 않고, 마커는 2종류만이어도 되고, 4종류 이상이어도 된다.(9) In the above embodiment, there are three types of markers: the
(10) 제2 부분(10b)에 탈곡 장치(13)가 포함되어 있어도 되고, 곡립 탱크(14)가 포함되어 있어도 된다.(10) The threshing
(11) 제1 부분(10a)은, 기체(10) 중, 기체 프레임(9) 이외의 어떠한 부분이어도 된다.(11) The
(12) 제2 부분(10b)은, 기체(10) 중, 수확부(H) 이외의 어떠한 부분이어도 된다. 예를 들어, 제2 부분(10b)은 탈곡 장치(13)이어도 된다. 이 경우, 탈곡 장치(13)는, 본 발명에 관한 「작업 장치」에 상당한다. 또한, 제2 부분(10b)은 곡립 탱크(14)이어도 된다. 이 경우, 곡립 탱크(14)는, 본 발명에 관한 「작업 장치」에 상당한다.(12) The
(13) 상기 실시 형태에서는, 마커 설정부(72)는, 기체 정보 기억부(33)에 기억되어 있는 정보에 기초하여, 각 제1 마커(51), 각 제2 마커(52), 각 제3 마커(53)를 설정한다. 그러나, 본 발명은 이것에 한정되지 않고, 마커 설정부(72)는, 인위 조작에 의해 입력된 정보에 기초하여, 각 제1 마커(51), 각 제2 마커(52), 각 제3 마커(53)를 설정하도록 구성되어 있어도 된다.(13) In the above embodiment, the
(14) 상기 실시 형태에서는, 제3 영역(43)의 외형 선은, 포장 외연부(6)와 포장(5)의 경계에 일치하도록 설정된다. 그러나, 본 발명은 이것에 한정되지 않고, 제3 영역(43)의 외형 선은, 포장 외연부(6)와 포장(5)의 경계로부터, 포장(5)의 내측으로 소정 거리만큼 이격된 위치에 설정되어도 된다. 또한, 이 소정 거리를, 작업 시스템(SY)의 유저가 임의로 설정 가능해도 된다. 또한, 제3 영역(43)의 외형 선의 위치를, 포장 외연부(6)와 포장(5)의 경계에 일치하는 위치에 설정할지, 포장 외연부(6)와 포장(5)의 경계로부터 포장(5)의 내측으로 소정 거리만큼 이격된 위치에 설정할지를 유저가 선택 가능하여도 된다.(14) In the above embodiment, the outline of the
이것과 마찬가지로, 제1 영역(41)의 외형 선은, 상기 실시 형태에서의 위치로부터 포장(5)의 내측으로 소정 거리만큼 이격된 위치에 설정되어도 된다. 또한, 이 소정 거리를, 작업 시스템(SY)의 유저가 임의로 설정 가능해도 된다. 또한, 제1 영역(41)의 외형 선의 위치를, 상기 실시 형태에서의 위치에 설정할지, 상기 실시 형태에서의 위치로부터 포장(5)의 내측으로 소정 거리만큼 이격된 위치에 설정할지를 유저가 선택 가능하여도 된다.Similarly to this, the outline of the
이것과 마찬가지로, 제2 영역(42)의 외형 선은, 상기 실시 형태에서의 위치로부터 포장(5)의 내측으로 소정 거리만큼 이격된 위치에 설정되어도 된다. 또한, 이 소정 거리를, 작업 시스템(SY)의 유저가 임의로 설정 가능해도 된다. 또한, 제2 영역(42)의 외형 선의 위치를, 상기 실시 형태에서의 위치에 설정할지, 상기 실시 형태에서의 위치로부터 포장(5)의 내측으로 소정 거리만큼 이격된 위치에 설정할지를 유저가 선택 가능하여도 된다.Similarly, the outline of the
(15) 상기 실시 형태에서는, 제1 외측 마커(51a), 제1 중간 마커(51b), 제1 내측 마커(51c)의 3개의 제1 마커(51)가 존재한다. 그러나, 본 발명은 이것에 한정되지 않고, 제1 마커(51)의 개수는 1개 또는 2개이어도 되고, 4개 이상이어도 된다.(15) In the above embodiment, there are three first markers 51: the first
이것과 마찬가지로, 제2 마커(52)의 개수는 1개 또는 2개이어도 되고, 4개 이상이어도 된다. 또한, 제3 마커(53)의 개수는 1개 또는 2개이어도 되고, 4개 이상이어도 된다.Similarly to this, one or two may be sufficient as the number of the
(16) 상기 실시 형태에 있어서, 복수의 제1 마커(51), 복수의 제2 마커(52), 복수의 제3 마커(53)는 모두 마커 기억부(71)에 기억되어 있다. 그러나, 본 발명은 이것에 한정되지 않고, 복수의 제1 마커(51)를 기억하는 부재나 기능부와, 복수의 제2 마커(52)를 기억하는 부재나 기능부와, 복수의 제3 마커(53)를 기억하는 부재나 기능부가 서로 달라도 된다. 이 경우, 복수의 제1 마커(51)를 기억하는 부재나 기능부는, 본 발명에 관한 「제1 기억부」에 상당한다. 또한, 복수의 제2 마커(52)를 기억하는 부재나 기능부는, 본 발명에 관한 「제2 기억부」에 상당한다.(16) In the above embodiment, the plurality of
(17) 상기 실시 형태에 있어서, 제1 영역(41), 제2 영역(42), 제3 영역(43)은 모두 영역 기억부(76)에 기억되어 있다. 그러나, 본 발명은 이것에 한정되지 않고, 제1 영역(41)을 기억하는 부재나 기능부와, 제2 영역(42)을 기억하는 부재나 기능부와, 제3 영역(43)을 기억하는 부재나 기능부가 서로 달라도 된다. 이 경우, 제1 영역(41)을 기억하는 부재나 기능부는, 본 발명에 관한 「제3 기억부」에 상당한다. 또한, 제2 영역(42)을 기억하는 부재나 기능부는, 본 발명에 관한 「제4 기억부」에 상당한다.(17) In the above embodiment, the
(18) 맵 생성부(25) 대신에, 콤바인(1)의 외부에서 생성된 외연부 맵을 취득하는 맵 취득부가 구비되어 있어도 된다. 이 경우, 맵 취득부는, 본 발명에 관한 「취득부」에 상당한다.(18) Instead of the map production|
또한, 상술한 실시 형태(다른 실시 형태를 포함함, 이하 동일함)에서 개시되는 구성은, 모순이 생기지 않는 한, 다른 실시 형태에서 개시되는 구성과 조합해서 적용하는 것이 가능하다. 또한, 본 명세서에서 개시된 실시 형태는 예시이며, 본 발명의 실시 형태는 이것에 한정되지 않고, 본 발명의 목적을 일탈하지 않는 범위 내에서 적절히 개변하는 것이 가능하다.In addition, the structure disclosed by the above-mentioned embodiment (including another embodiment, it is the same hereinafter) can be applied in combination with the structure disclosed by another embodiment, unless a contradiction arises. In addition, embodiment disclosed in this specification is an illustration, Embodiment of this invention is not limited to this, It is possible to change suitably within the range which does not deviate from the objective of this invention.
본 발명은, 보통형 콤바인뿐만 아니라, 자탈형 콤바인, 트랙터, 이앙기, 옥수수 수확기, 감자 수확기, 인삼 수확기, 건설 작업기 등의 다양한 작업 차에 이용 가능하다.The present invention, as well as a normal combine, can be used in various types of work vehicles, such as a self-extracting combine, a tractor, a rice transplanter, a corn harvester, a potato harvester, a ginseng harvester, and a construction machine.
1: 콤바인(작업 차)
5: 포장
6: 포장 외연부
9: 기체 프레임
10: 기체
10a: 제1 부분
10b: 제2 부분
25: 맵 생성부(취득부)
28: 제2 경로 생성부(경로 생성부)
41: 제1 영역
42: 제2 영역
51c: 제1 내측 마커(제1 기준 마커)
52c: 제2 내측 마커(제2 기준 마커)
71: 마커 기억부(제1 기억부, 제2 기억부)
72: 마커 설정부
76: 영역 기억부(제3 기억부, 제4 기억부)
77: 영역 설정부
H: 수확부(작업 장치)
HA: 기준 높이(소정 높이)
SY: 작업 시스템(경로 생성 시스템)
TL: 목표 주행 경로1: Combine (work car)
5: Packaging
6: Packaging perimeter
9: Aircraft frame
10: gas
10a: first part
10b: second part
25: map generation unit (acquisition unit)
28: second path generating unit (path generating unit)
41: first area
42: second area
51c: first inner marker (first fiducial marker)
52c: second inner marker (second fiducial marker)
71: marker storage unit (first storage unit, second storage unit)
72: marker setting unit
76: area storage unit (third storage unit, fourth storage unit)
77: area setting unit
H: Harvesting unit (working device)
HA: reference height (predetermined height)
SY: working system (path generation system)
TL: target driving route
Claims (7)
상기 작업 차의 기체에 대한 상대 위치가 설정된 가상적인 제1 기준 마커를 기억하는 제1 기억부와,
상기 기체에 대한 상대 위치가 설정된 가상적인 제2 기준 마커를 기억하는 제2 기억부와,
포장을 둘러싸는 상태로 마련된 포장 외연부와 상기 포장의 경계의 주변에 설정된 제1 영역을 기억하는 제3 기억부와,
상기 경계의 주변에 설정된 제2 영역을 기억하는 제4 기억부를 구비하고,
상기 경로 생성부는, 상기 작업 차가 상기 목표 주행 경로를 따라 자동 주행한 경우에, 상기 제1 기준 마커가 상기 제1 영역의 외측으로 나오지 않고, 또한, 상기 제2 기준 마커가 상기 제2 영역의 외측으로 나오지 않도록, 상기 목표 주행 경로를 생성하는 경로 생성 시스템.It is a path generating system having a path generating unit for generating a target driving path for automatic driving of a work vehicle,
a first storage unit for storing a first virtual reference marker in which a relative position with respect to the aircraft of the working vehicle is set;
a second storage unit for storing a virtual second reference marker whose position relative to the aircraft is set;
a third storage unit for storing a first area set in the periphery of the outer edge of the package provided in a state of enclosing the package and the boundary of the package;
and a fourth storage unit for storing a second area set in the periphery of the boundary;
The path generating unit may include, when the work vehicle automatically travels along the target driving path, the first reference marker does not come out of the first area, and the second reference marker is located outside the second area. A path generating system for generating the target driving path so as not to come out as .
상기 제2 기준 마커는, 상기 기체 중 제2 부분의 평면으로 보았을 때의 외형에 대응하고 있고,
상기 제1 부분과 상기 제2 부분은 서로 다른 높이에 위치하고 있는, 경로 생성 시스템.The method according to claim 1, wherein the first reference marker corresponds to a planar appearance of a first portion of the airframe,
The second reference marker corresponds to a planar appearance of a second portion of the aircraft;
wherein the first portion and the second portion are located at different heights.
상기 제2 부분은, 상기 기체 프레임에 지지된 작업 장치인, 경로 생성 시스템.3. The method of claim 2, wherein the first part is a gas frame,
The second portion is a working device supported on the airframe frame.
상기 제2 기준 마커는, 상기 작업 장치가 소정 높이 이상까지 상승한 상태에서의, 상기 작업 장치의 평면으로 보았을 때의 외형에 대응하고 있는, 경로 생성 시스템.The method according to claim 3, wherein the working device is configured to be liftable with respect to the body frame,
The second reference marker corresponds to a planar appearance of the working device when the working device is raised to a predetermined height or more.
상기 제1 부분의 높이 위치와, 상기 제2 부분의 높이 위치와, 상기 외연부 정보에 기초하여, 상기 제1 영역 및 상기 제2 영역을 설정하는 영역 설정부를 구비하는, 경로 생성 시스템.The acquisition unit according to any one of claims 2 to 4, comprising: an acquisition unit for acquiring information on the outer edge indicating the position and height of the outer edge of the package;
and a region setting unit configured to set the first region and the second region based on a height position of the first part, a height position of the second part, and the outer edge information.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021068535A JP7515436B2 (en) | 2021-04-14 | 2021-04-14 | Route Generation System |
JPJP-P-2021-068535 | 2021-04-14 |
Publications (1)
Publication Number | Publication Date |
---|---|
KR20220142373A true KR20220142373A (en) | 2022-10-21 |
Family
ID=83575075
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020220045594A KR20220142373A (en) | 2021-04-14 | 2022-04-13 | Path generating system |
Country Status (3)
Country | Link |
---|---|
JP (1) | JP7515436B2 (en) |
KR (1) | KR20220142373A (en) |
CN (1) | CN115200599A (en) |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2021027834A (en) | 2020-11-16 | 2021-02-25 | ヤンマーパワーテクノロジー株式会社 | Autonomous-travel work vehicle |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006239844A (en) * | 2005-03-04 | 2006-09-14 | Sony Corp | Obstacle avoiding device, obstacle avoiding method, obstacle avoiding program and mobile robot device |
JP6701002B2 (en) * | 2016-06-23 | 2020-05-27 | 株式会社クボタ | Driving support system and work vehicle |
JP6919531B2 (en) * | 2017-11-30 | 2021-08-18 | 井関農機株式会社 | Work vehicle |
JP7036707B2 (en) * | 2018-12-14 | 2022-03-15 | ヤンマーパワーテクノロジー株式会社 | Travel route generator |
US11212954B2 (en) * | 2019-05-08 | 2022-01-04 | Deere & Company | Apparatus and methods for field operations based on historical field operation data |
JP7132191B2 (en) * | 2019-08-08 | 2022-09-06 | ヤンマーパワーテクノロジー株式会社 | Automated driving system for work vehicles |
-
2021
- 2021-04-14 JP JP2021068535A patent/JP7515436B2/en active Active
-
2022
- 2022-04-13 KR KR1020220045594A patent/KR20220142373A/en unknown
- 2022-04-14 CN CN202210392173.7A patent/CN115200599A/en active Pending
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2021027834A (en) | 2020-11-16 | 2021-02-25 | ヤンマーパワーテクノロジー株式会社 | Autonomous-travel work vehicle |
Also Published As
Publication number | Publication date |
---|---|
JP2022163534A (en) | 2022-10-26 |
JP7515436B2 (en) | 2024-07-12 |
CN115200599A (en) | 2022-10-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2020127405A (en) | Work vehicle automatic travel system | |
JP7353796B2 (en) | Automated driving system for work vehicles | |
KR20200096489A (en) | Work vehicle, travel path selection system for work vehicle, and travel path calculation system | |
JP6920958B2 (en) | Travel route generator | |
JP7174484B2 (en) | agricultural vehicle | |
JP6956620B2 (en) | Travel route generation system and field work vehicle | |
JP2019187352A (en) | Work vehicle | |
CN111343853B (en) | Agricultural operation vehicle, operation vehicle collision warning system and operation vehicle | |
KR20220142373A (en) | Path generating system | |
KR20230001514A (en) | Work support system | |
KR20220142374A (en) | Driving management system | |
KR102539520B1 (en) | Combines, Harvesters, and Autopilot Systems | |
JP7423443B2 (en) | harvester | |
KR20230001515A (en) | Work support system | |
KR20230107116A (en) | Driving control system | |
KR20230115975A (en) | Agricultural machine, agricultural machine control program, recording medium recording agricultural machine control program, agricultural machine control method | |
WO2024004782A1 (en) | Travel route management system | |
WO2024004785A1 (en) | Machine body control system | |
KR20230001512A (en) | Work support system | |
JP2023097980A (en) | Traveling management system | |
JP2023097981A (en) | system | |
JP2024085050A (en) | System and work machine | |
JP2024085614A (en) | system |