KR20200116437A - Agricultural machinery and automatic driving method thereof - Google Patents
Agricultural machinery and automatic driving method thereof Download PDFInfo
- Publication number
- KR20200116437A KR20200116437A KR1020200124969A KR20200124969A KR20200116437A KR 20200116437 A KR20200116437 A KR 20200116437A KR 1020200124969 A KR1020200124969 A KR 1020200124969A KR 20200124969 A KR20200124969 A KR 20200124969A KR 20200116437 A KR20200116437 A KR 20200116437A
- Authority
- KR
- South Korea
- Prior art keywords
- agricultural machine
- path
- processor
- autonomous driving
- determined
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims description 33
- 230000033001 locomotion Effects 0.000 claims abstract description 23
- 239000013598 vector Substances 0.000 claims description 30
- 230000007423 decrease Effects 0.000 claims description 4
- 238000013507 mapping Methods 0.000 claims description 4
- 239000000243 solution Substances 0.000 description 12
- 238000004891 communication Methods 0.000 description 8
- 238000003860 storage Methods 0.000 description 7
- 230000002159 abnormal effect Effects 0.000 description 5
- 238000004590 computer program Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 230000006870 function Effects 0.000 description 4
- 239000000470 constituent Substances 0.000 description 3
- 238000012937 correction Methods 0.000 description 3
- 230000005856 abnormality Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000009313 farming Methods 0.000 description 2
- 239000003337 fertilizer Substances 0.000 description 2
- 238000010295 mobile communication Methods 0.000 description 2
- 230000032683 aging Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000007596 consolidation process Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 239000012895 dilution Substances 0.000 description 1
- 238000010790 dilution Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000007480 spreading Effects 0.000 description 1
- 230000009466 transformation 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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/0278—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
-
- 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
-
- 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/14—Adaptive cruise control
-
- 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
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/10—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
-
- 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
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- 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
- B60W2300/00—Indexing codes relating to the type of vehicle
- B60W2300/15—Agricultural vehicles
-
- 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/10—Longitudinal 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/20—Off-Road Vehicles
- B60Y2200/22—Agricultural vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Mechanical Engineering (AREA)
- Life Sciences & Earth Sciences (AREA)
- Transportation (AREA)
- Physics & Mathematics (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Soil Sciences (AREA)
- Environmental Sciences (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Guiding Agricultural Machines (AREA)
Abstract
Description
본 발명은 농기계 및 그의 자율 주행 방법에 관한 것으로, 무인으로 이동 가능한 농기계 및 그의 자율 주행 방법에 관한 것이다.The present invention relates to an agricultural machine and an autonomous driving method thereof, and to an agricultural machine capable of unmanned movement and an autonomous driving method thereof.
농업 분야는 농업 인구의 감소 및 고령화, 농업 경영비 상승 등으로 농업 여건 개선이 시급한 실정이다. 따라서, 농업 분야의 경쟁력을 갖추어야 하는데, 그 중 가장 중요한 요소가 IT 및 센서 기술과의 접목을 통한 고부가가치 산업으로의 변신이다.In the agricultural sector, improvement of agricultural conditions is urgent due to the decline and aging of the agricultural population and the increase in agricultural management costs. Therefore, it is necessary to have competitiveness in the agricultural field, among which the most important factor is the transformation into a high value-added industry through the grafting of IT and sensor technology.
한편, 최근 전자 기술의 발전으로, 농기계를 무인으로 운용하고 있다. 농기계를 무인으로 운용하기 위해서는, 자율 주행 경로가 필요한데, 자율 주행 경로를 구축하기 위해서는 많은 비용이 요구된다는 문제가 존재하였다.On the other hand, with the recent development of electronic technology, agricultural machinery is being operated unmanned. In order to operate agricultural machinery unmanned, there is a problem that an autonomous driving route is required, but a large cost is required to establish an autonomous driving route.
따라서, 본 발명의 목적은 GNSS(Global Navigation Satellite System) 센서를 이용하여 생성된 자율 주행 경로를 이용하여 자율 주행을 수행할 수 있는 농기게 및 그의 자율 주행 방법을 제공함에 있다.Accordingly, an object of the present invention is to provide a farming machine capable of performing autonomous driving using an autonomous driving route generated using a Global Navigation Satellite System (GNSS) sensor and a method for autonomous driving thereof.
상술한 목적을 달성하기 위한 본 발명의 일 실시 예에 따른 농기계는 구동부, 상기 농기계의 위치 및 움직임을 감지하기 위한 센서, 자율 주행 경로가 저장된 메모리 및 상기 감지된 농기계의 위치 및 움직임에 기초하여 상기 농기계가 상기 자율 주행 경로를 따라 주행하도록 상기 구동부를 제어하는 프로세서를 포함하며, 상기 센서는 GNSS(Global Navigation Satellite System) 센서를 포함하고, 상기 자율 주행 경로는 기설정된 경로를 농기계가 주행하는 동안에 상기 GNSS 센서에서 획득된 데이터에 기초하여 생성된 것일 수 있다.The agricultural machine according to an embodiment of the present invention for achieving the above object includes a driving unit, a sensor for detecting the location and movement of the agricultural machine, a memory storing an autonomous driving path, and the detected location and movement of the agricultural machine. And a processor for controlling the driving unit so that the agricultural machine travels along the autonomous driving path, and the sensor includes a Global Navigation Satellite System (GNSS) sensor, and the autonomous driving path is a preset route while the agricultural machine travels. It may be generated based on data obtained from the GNSS sensor.
이 경우, 상기 GNSS 센서에서 획득된 데이터는 상기 농기계의 위치, 속도 및 방향각을 포함할 수 있다.In this case, the data obtained from the GNSS sensor may include the position, speed, and direction angle of the agricultural machine.
한편, 상기 프로세서는 상기 기설정된 경로를 농기계가 주행하는 동안, 상기 GNSS 센서를 통해 상기 농기계의 측지 좌표를 획득하고 상기 획득된 측지 좌표를 지역 좌표로 변환하고, 상기 GNSS 센서를 통해 상기 농기계의 방향각을 획득하고, 상기 획득된 방향각에 기초하여 상기 농기계가 이동하는 경로의 형태를 판단하고, 상기 지역 좌표 및 상기 판단된 경로 형태에 기초하여 상기 자율 주행 경로를 생성하고, 상기 생성된 자율 주행 경로를 상기 메모리에 저장할 수 있다.On the other hand, the processor acquires the geodetic coordinates of the agricultural machine through the GNSS sensor while the agricultural machine travels the preset path, converts the obtained geodetic coordinates into local coordinates, and the direction of the agricultural machine through the GNSS sensor. Obtain an angle, determine the shape of the path the agricultural machine moves based on the obtained direction angle, generate the autonomous driving path based on the local coordinates and the determined path shape, and generate the autonomous driving The path can be stored in the memory.
또한, 상기 프로세서는 상기 GNSS 센서의 품질을 판단하기 위한 인자와 기설정된 기준 값을 비교하고, 상기 인자가 상기 기설정된 기준 값을 만족하는 경우, 현재 시간보다 특정한 시간 이전의 항법해를 통해 예측된 상기 농기계의 현재 위치와 상기 GNSS 센서를 통해 획득된 상기 농기계의 현재 위치를 비교하여 상기 GNSS 센서를 통해 획득되는 농기계의 위치가 양호한 상태인지를 판단하고, 상기 판단된 상태에 따라 농기계의 주행을 제어할 수 있다.In addition, the processor compares the factor for determining the quality of the GNSS sensor with a preset reference value, and when the factor satisfies the preset reference value, the predicted through a navigation solution before a specific time prior to the current time. By comparing the current location of the agricultural machine with the current location of the agricultural machine acquired through the GNSS sensor, it is determined whether the location of the agricultural machine obtained through the GNSS sensor is in a good state, and the driving of the agricultural machine is controlled according to the determined state. can do.
여기에서, 상기 프로세서는 상기 GNSS 센서를 통해 획득된 농기계의 위치가 양호하지 않은 것으로 판단되면, 이동 중인 농기계를 정지시킬 수 있다.Here, if it is determined that the position of the agricultural machine acquired through the GNSS sensor is not good, the processor may stop the moving agricultural machine.
또한, 상기 프로세서는 상기 GNSS 센서를 통해 획득된 농기계의 위치가 양호한 것으로 판단되면, 상기 GNSS 센서에 의해 감지된 상기 농기계의 속도를 기설정된 운용 속도와 비교하여 상기 농기계의 속도를 제어할 수 있다.In addition, when it is determined that the position of the agricultural machine acquired through the GNSS sensor is good, the processor may control the speed of the agricultural machine by comparing the speed of the agricultural machine detected by the GNSS sensor with a preset operating speed.
여기에서, 상기 프로세서는 상기 감지된 속도가 기설정된 운용 속도를 초과하는 경우, 상기 이동 중인 농기계의 속도를 감소시키고, 상기 감지된 속도가 기설정된 운용 속도 미만인 경우, 상기 이동 중인 농기계의 속도를 증가시킬 수 있다.Here, when the detected speed exceeds a preset operating speed, the processor decreases the speed of the moving agricultural machine, and when the detected speed is less than a preset operating speed, the processor increases the speed of the moving agricultural machine. I can make it.
한편, 상기 프로세서는 상기 GNSS 센서를 통해 획득된 농기계의 위치가 양호한 것으로 판단되면, 현재 시간의 시간 이전의 항법해를 획득하고, 상기 획득된 항법해에 기초하여 상기 자율 주행 경로 상에서 상기 현재 시간을 기준으로 특정 시간 이후의 제1 위치를 추정하고, 상기 획득된 항법해에 기초하여 상기 현재 시간보다 특정 시간 이후의 제2 위치를 추정하고, 상기 농기계의 현재 위치를 기준으로 상기 제1 위치까지의 제1 벡터와 상기 농기계의 현재 위치를 기준으로 상기 제2 위치까지의 제2 벡터 사이의 방향각 차이를 산출하고, 상기 산출된 방향각 차이에 기초하여 이동 중인 농기계의 이동 방향을 제어할 수 있다.On the other hand, if it is determined that the location of the agricultural machine acquired through the GNSS sensor is good, the processor acquires a navigation solution prior to the time of the current time, and calculates the current time on the autonomous driving route based on the obtained navigation solution. Estimates a first position after a specific time as a reference, estimates a second position after a specific time from the current time based on the obtained navigation solution, and up to the first position based on the current position of the agricultural machine The direction angle difference between the first vector and the second vector to the second position based on the current position of the farm machine may be calculated, and the moving direction of the farm machine in motion may be controlled based on the calculated direction angle difference. .
한편, 본 발명의 일 실시 예에 따른 농기계의 자율 주행 방법은 센서를 이용하여, 상기 농기계의 위치 및 움직임을 감지하는 단계 및 상기 감지된 농기계의 위치 및 움직임에 기초하여 상기 농기계가 상기 농기계에 저장된 자율 주행 경로를 따라 주행하도록 제어하는 단계를 포함하며, 상기 센서는 GNSS(Global Navigation Satellite System) 센서를 포함하고, 상기 자율 주행 경로는 기설정된 경로를 상기 농기계가 주행하는 동안에 상기 GNSS 센서에서 획득된 데이터에 기초하여 생성된 것일 수 있다.On the other hand, the autonomous driving method of an agricultural machine according to an embodiment of the present invention uses a sensor to detect the location and movement of the agricultural machine, and the agricultural machine is stored in the agricultural machine based on the detected location and movement of the agricultural machine. Including the step of controlling to travel along an autonomous driving path, wherein the sensor includes a Global Navigation Satellite System (GNSS) sensor, and the autonomous driving path is obtained from the GNSS sensor while the agricultural machine travels on a preset path. It may be generated based on data.
이상과 같은 본 발명의 다양한 실시 예에 따르면, 무인 농기계의 자율 주행을 위한 자율 주행 경로를 저렴한 GNSS 센서를 이용하여 생성할 수 있어, 가격 경쟁력을 대폭 확보할 수 있고, 기존에 비해 빠른 시간에 자율 주행 경로를 생성할 수 있다.According to various embodiments of the present invention as described above, an autonomous driving route for autonomous driving of an unmanned agricultural machine can be generated using an inexpensive GNSS sensor, so that price competitiveness can be significantly secured. You can create a driving route.
그리고, 농기계를 자율 주행으로 기동함으로써, 사람이 농기계을 직접 운전하여 농업 관련 작업을 수행하는데 발생할 수 있는 안전 사고를 방지할 수 있다.In addition, by starting the agricultural machine by autonomous driving, it is possible to prevent a safety accident that may occur when a person directly drives the agricultural machine to perform agricultural-related work.
도 1은 본 발명의 일 실시 예에 따른 농기계의 구성을 설명하기 위한 블록도,
도 2는 본 발명의 일 실시 예에 따라 자율 주행 경로를 생성하는 방법을 설명하기 위한 도면,
도 3은 본 발명의 일 실시 예에 따라 GNSS 센서의 이상 여부를 판단하기 위한 방법을 설명하기 위한 흐름도,
도 4 및 5는 본 발명의 일 실시 예에 따라 자율 주행 경로를 갱신하는 방법을 설명하기 위한 도면들,
도 6은 본 발명의 일 실시 예에 따라 농기계의 주행 속도를 제어하는 방법을 설명하기 위한 흐름도,
도 7은 본 발명의 일 실시 예에 따라 농기계의 주행 방향을 제어하는 방법을 설명하기 위한 흐름도,
도 8은 본 발명의 일 실시 예에 따라 전자 장치에서 제공되는 유저 인터페이스를 설명하기 위한 도면, 그리고
도 9는 본 발명의 일 실시 예에 따른 자율 주행 방법을 설명하기 위한 흐름도이다.1 is a block diagram for explaining the configuration of an agricultural machine according to an embodiment of the present invention,
2 is a view for explaining a method of generating an autonomous driving route according to an embodiment of the present invention;
3 is a flow chart illustrating a method for determining whether a GNSS sensor is abnormal according to an embodiment of the present invention;
4 and 5 are diagrams for explaining a method of updating an autonomous driving route according to an embodiment of the present invention;
6 is a flowchart illustrating a method of controlling a driving speed of an agricultural machine according to an embodiment of the present invention.
7 is a flowchart illustrating a method of controlling a driving direction of an agricultural machine according to an embodiment of the present invention;
8 is a diagram for explaining a user interface provided by an electronic device according to an embodiment of the present invention, and
9 is a flowchart illustrating an autonomous driving method according to an embodiment of the present invention.
이하에서는 첨부된 도면을 참조하여 본 발명의 다양한 실시 예에 대해 설명하도록 한다.Hereinafter, various embodiments of the present invention will be described with reference to the accompanying drawings.
도 1은 본 발명의 일 실시 예에 따른 농기계의 구성을 설명하기 위한 블록도이다.1 is a block diagram illustrating the configuration of an agricultural machine according to an embodiment of the present invention.
먼저, 본 발명이 일 실시 예에 따른 농기계(100)는 트랙터, 콤바인, 경운기 등과 같이 경작지의 밭갈이, 비료살포, 비료운반, 각종 농작물 운반 등의 작업에 이용되는 다양한 운행 수단을 의미할 수 있다. 이를 위해, 농기계(100)는 본체와 본체의 전방 및 후방 각각의 하부에 구비된 바퀴를 포함할 수 있다.First, the
한편, 농기계(100)는 인간이 탑승하지 않더라도, 미리 설정된 경로를 따라 자율적으로 이동이 가능한 무인 농기계로 구현될 수 있으며, 이를 위해, 농기계(100)는 도 1a와 같이 구동부(110), 센서(120), 메모리(130) 및 프로세서(140)를 포함할 수 있다.On the other hand, the
구동부(110)는 농기계(100)의 주행을 제어하기 위한 구성이다. 예를 들어, 구동부(110)는 엑셀레이터 액추에이터를 통해 농기계(100)에 마련된 바퀴의 회전 속도를 증가시키고, 브레이크 액추에이터를 통해 농기계(100)에 마련된 바퀴의 회전 속도를 감소시키거나 바퀴를 정지시키고, 조향각 제어 액추에이터를 통해 농기계(100)에 마련된 바퀴의 회전축을 회전시켜, 농기계(100)를 좌측 또는 우측 방향으로 회전시킬 수 있다.The
센서(120)는 농기계(100)의 위치 및 움직임을 감지한다.The
이를 위해, 센서(120)는 도 1b에 도시된 바와 같이 GNSS(Global Navigation Satellite System) 센서(121) 및 구동체 센서(122)를 포함할 수 있다.To this end, the
GNSS 센서(121)(또는, GNSS 수신기)는 위성을 이용하여 농기계(100)의 위치, 속도, 방향각 등을 측정할 수 있다. 여기에서, GNSS 센서(121)를 통해 획득되는 농기계(100)의 위치, 속도, 방향각 등을 GNSS 센서(121)의 측위해라 할 수 있다.The GNSS sensor 121 (or GNSS receiver) may measure the position, speed, and direction angle of the
GNSS는 우주의 위성에서 송신는 전파를 이용하여 특정 위치의 좌표를 산출하는 시스템을 의미하며, 미국의 위성위치 측정시스템(GPS : Global Positioning System), 러시아의 GLONASS(Global Navigation Satellite System), 유럽의 GALILEO(Europian Satellite Navigation System) 및 중국의 Beidou(北斗, Compass) 등의 위성을 이용하는 다양한 위치 측정 시스템을 통합한 명칭이다. GNSS refers to a system that calculates coordinates of a specific location by using radio waves for transmission from satellites in space, the US's Global Positioning System (GPS), Russia's GLONASS (Global Navigation Satellite System), and Europe's GALILEO. (Europian Satellite Navigation System) and China's Beidou (北斗, Compass) is a name that combines various positioning systems using satellites.
이와 같이, GNSS는 위성을 이용한다는 점에서, 시간 및 공간에 구애받지 않으며 다른 시스템에 비해 비교적 안정적으로 위치, 속도 및 시간 정보 등을 획득할 수 있다.In this way, since the GNSS uses a satellite, it is not restricted to time and space, and can obtain position, speed, and time information relatively stably compared to other systems.
GNSS 센서(121)는 위성으로부터 수신된 GNSS 신호를 이용하여 자신의 위치를 결정하고, RTK(Real Time Kinematic) 기준국(300)으로부터 측위 보정 정보를 전달받고, 측위 보정 정보를 이용하여, GNSS 신호를 통해 결정된 자신의 위치를 보정할 수 있다. The GNSS
한편, 본 발명의 일 실시 예에 따르면, GNSS 센서(121)는 단일 주파수 기반의 저가형 GNSS 센서로 구현될 수 있다.Meanwhile, according to an embodiment of the present invention, the GNSS
즉, 농기계의 경우, 드론(drone), 비행체, 선박 등에 비해 상대적으로 저속으로 이동한다는 점에서, 단일 주파수만으로도 충분히 정확한 위치가 측정될 수 있다. 이와 같이, 본 발명의 일 실시 예에 따르면, 단일 주파수 기반의 GNSS 센서를 이용한다는 점에서, 2개 이상의 주파수를 이용하는 센서보다 저렴하게 농기계(100)의 위치를 측정할 수 있게 된다. 이 경우, RTK 기준국(300)은 cm급 정확도를 갖는 위치를 계산할 수 있도록 측위 보정 정보를 생성하여 저가형의 GNSS 센서(121)로 제공할 수 있다.That is, in the case of agricultural machinery, since it moves at a relatively low speed compared to a drone, a vehicle, a ship, etc., a sufficiently accurate position can be measured with only a single frequency. As described above, according to an embodiment of the present invention, since a single frequency-based GNSS sensor is used, it is possible to measure the position of the
구동체 센서(122)는 농기계(100)의 속도, 방향각 등을 측정할 수 있다. 이를 위해, 구동체 센서(122)는 농기계(100)의 방향각을 측정하기 위한 조향각 센서 및 농기계(100)의 속도를 측정하기 위한 속도 센서 등을 포함할 수 있다.The
메모리(130)는 자율 주행 경로가 저장된다. 이 경우, 농기계(100)는 사람에 의하지 않고, 무인으로 자율 주행 경로에 따라 자율적으로 주행할 수 있다.The
여기에서, 자율 주행 경로는 기설정된 경로를 농기계(100)가 주행하는 동안에, GNSS 센서(120)에서 획득된 데이터에 기초하여 생성될 수 있다.Here, the autonomous driving route may be generated based on data obtained by the GNSS
예를 들어, 자율 주행 경로는 농기계(100)가 앞으로 주행할 경로(가령, 경작지, 험로, 도로 등의 경로)를 미리 주행하고, 주행 중에 GNSS 센서(120)로부터 획득된 농기계(100)의 위치, 속도 및 방향각 등에 의해 생성될 수 있다.For example, the autonomous driving route is the location of the
이러한 자율 주행 경로를 생성하는 구체적인 방법에 대해서는 후술하도록 한다.A specific method of generating such an autonomous driving route will be described later.
또한, 메모리(130)는 도 1b에 도시된, 경로 생성 모듈(141) 및 움직임 제어 모듈(142) 등을 저장할 수 있다. 한편, 도 1b에서는 모듈들을 개별적으로 도시하였으나, 적어도 2 개의 모듈들이 조합되어 구현될 수도 있음은 물론이다.In addition, the
프로세서(140)는 농기계(100)의 전반적인 동작을 제어한다. 이를 위해, 프로세서(140)는 농기계(100)의 동작을 제어하기 위한 전용 프로세서(예: 임베디드 프로세서), 또는 메모리 장치에 저장된 하나 이상의 소프트웨어 프로그램들을 실행함으로써, 해당 동작들을 수행할 수 있는 범용 프로세서(generic-purpose processor)(예: CPU 또는 application processor) 등으로 구현될 수 있다.The
먼저, 프로세서(140)는 자율 주행 경로를 생성할 수 있다. 이 경우, 프로세서(140)는 경로 생성 모듈(141)을 실행하고, GNSS 센서(121)에서 획득한 데이터를 경로 생성 모듈(141)의 입력으로 하여, 자율 주행 경로를 생성할 수 있다.First, the
구체적으로, 프로세서(140)는 기설정된 경로를 농기계(100)가 주행하는 동안, GNSS 센서(121)를 통해 농기계(100)의 측지 좌표를 획득할 수 있다. 여기에서, 측지 좌표는 위도, 경도 및 타원체고에 대한 정보를 포함할 수 있다.Specifically, the
그리고, 프로세서(140)는 획득된 측지 좌표를 지역 좌표로 변환할 수 있다. 즉, 측지 좌표는 지구 타원체 기반의 좌표라는 점에서, 프로세서(140)는 측지 좌표를 직각 좌표 형식의 지역 좌표로 변환할 수 있다. 여기에서, 지역 좌표는 특정한 기준점을 기준으로 한 x,y 좌표(가령, 특정한 기준점을 기준으로 동쪽, 북쪽 좌표) 및 높이에 대한 정보를 포함할 수 있다.In addition, the
그리고, 프로세서(140)는 GNSS 센서(121)를 통해 농기계(100)의 방향각을 획득하고, 획득된 방향각에 기초하여 농기계(100)가 이동하는 경로의 형태를 판단할 수 있다.In addition, the
여기에서, 경로의 형태는 회전 경로 및 직선 경로를 포함할 수 있다.Here, the shape of the path may include a rotation path and a straight path.
이 경우, 프로세서(140)는 GNSS 센서(121)를 통해 현재 농기계(100)의 방향각을 현재 시간보다 특정한 시간 이전에 획득한 농기계(100)의 방향각과 비교하여, 농기계(100)가 진행하는 경로가 회전 경로에 해당하는지 또는 직선 경로에 해당하는지를 판단할 수 있다.In this case, the
구체적으로, 프로세서(140)는 현재 농기계(100)의 방향각과 특정한 시간 이전에 획득한 농기계(100)의 방향각 사이의 차이가 기설정된 값 이상이면 농기계(100)가 진행하는 경로가 회전 경로에 해당하는 것으로 판단하고, 현재 농기계(100)의 방향각과 특정한 시간 이전에 획득한 농기계(100)의 방향각 사이의 차이가 기설정된 값 미만이면, 농기계(100)가 진행하는 경로가 직선 경로에 해당하는 것으로 판단할 수 있다.Specifically, if the difference between the direction angle of the current
이후, 프로세서(140)는 판단된 경로 형태 및 지역 좌표에 기초하여 자율 주행 경로를 생성하고, 생성된 자율 주행 경로를 메모리(130)에 저장할 수 있다.Thereafter, the
구체적으로, 프로세서(140)는 판단된 경로 형태에 따라 waypoints를 설정하고, waypoints 별로 지역 좌표 및 경로 벡터를 맵핑하여 자율 주행 경로를 생성할 수 있다.Specifically, the
먼저, 도 2를 참조하여 waypoints를 설정하는 방법에 대해 설명하도록 한다.First, a method of setting waypoints will be described with reference to FIG. 2.
예를 들어, 도 2의 (a)와 같이, 농기계(100)가 지점 211 → 지점 212 → 지점 213 → 지점 214 → 지점 215 → 지점 216 → 지점 217 → 지점 218 → 지점 219를 따라 이동한 경우를 가정한다. For example, as shown in (a) of FIG. 2, when the
이 경우, 각 지점에 대한 지역 좌표는 특정한 기준점을 기준으로 한 x,y 좌표 및 높이 h로 구성되며, 도 2에서는 각 지점에 대해 (xn,yn,hn)(여기에서, n은 1~9)으로 표시하였다.In this case, the local coordinates for each point are composed of x,y coordinates and height h based on a specific reference point, and in FIG. 2 for each point (x n ,y n ,h n ) (where n is 1 to 9).
이 경우, 프로세서(140)는 지점 211 → 지점 212 → 지점 213을 따라 이동한 경로에 대해서는, 이들 지점 간의 방향각 사이의 차이가 기설정된 값 미만이라는 점에서, 해당 경로는 직선 경로에 해당하는 것으로 판단하고, 지점 213 → 지점 214 → 지점 215 → 지점 216을 따라 이동한 경로에 대해서는, 이들 지점 간의 방향각 사이의 차이가 기설정된 값 이상이라는 점에서, 해당 경로는 곡선 경로에 해당하는 것으로 판단하고, 지점 216 → 지점 217 → 지점 218 → 지점 219를 따라 이동한 경로에 대해서는, 이들 지점 간의 방향각 사이의 차이가 기설정된 값 미만이라는 점에서, 해당 경로는 직선 경로에 해당하는 것으로 판단할 수 있다.In this case, the
이 경우, 프로세서(140)는 직선 경로에 포함된 지점에 대해서는, 직선 경로의 시작점과 끝점을 waypoints로 설정할 수 있다. 그리고, 프로세서(140)는 waypoints에 지역 좌표를 맵핑하고, 시작점에서 끝점을 향하는 경로 벡터를 시작점의 waypoint에 맵핑하여, 직선 경로에 대한 자율 주행 경로를 생성할 수 있다.In this case, the
또한, 프로세서(140)는 곡선 경로에 포함된 지점에 대해서는, 곡선 경로에 포함된 지점들을 waypoints로 설정할 수 있다. 그리고, 프로세서(140)는 waypoints에 지역 좌표를 맵핑하고, 각 지점에서 다음 지점을 향하는 경로 벡터를 각 지점의 waypoint에 맵핑하여, 곡선 경로에 대한 자율 주행 경로를 생성할 수 있다.Also, for points included in the curved path, the
예를 들어, 도 2의 (a)에서, 농기계(100)가 지점 211 → 지점 212 → 지점 213을 따라 이동한 경로는 직선 경로에 해당한다는 점에서, 프로세서(140)는 도 2의 (b)와 같이, 지점 211 및 지점 213을 해당 경로에 대한 waypoints로 설정하고, 지역 좌표 (x1,y1,h1)를 waypoint 1(즉, 지점 211)에 맵핑하고, 지역 좌표 (x3,y3,h3)를 waypoint 2(즉, 지점 213)에 맵핑하고, waypoint 1에서 waypoint 2를 잇는 벡터(221)를 waypoint 1(즉, 지점 211)에 맵핑하여, 농기계(100)가 지점 211 → 지점 212 → 지점 213을 따라 이동한 경로에 대한 자율 주행 경로를 생성할 수 있다.For example, in (a) of FIG. 2, the path that the
또한, 도 2의 (a)에서, 농기계(100)가 지점 213 → 지점 214 → 지점 215 → 지점 216을 따라 이동한 경로는 곡선 경로에 해당한다는 점에서, 프로세서(140)는 도 2의 (b)와 같이, 지점 213, 지점 214, 지점 215 및 지점 216을 해당 경로에 대한 waypoints로 설정하고, 지역 좌표 (x3,y3,h3)를 waypoint 2(즉, 지점 213)에 맵핑하고, 지역 좌표 (x4,y4,h4)를 waypoint 3(즉, 지점 214)에 맵핑하고, 지역 좌표 (x5,y5,h5)를 waypoint 4(즉, 지점 215)에 맵핑하고, 지역 좌표 (x6,y6,h6)를 waypoint 5(즉, 지점 216)에 맵핑하고, waypoint 2에서 waypoint 3을 잇는 벡터(222)를 waypoint 2(즉, 지점 213)에 맵핑하고, waypoint 3에서 waypoint 4를 잇는 벡터(223)를 waypoint 3(즉, 지점 214)에 맵핑하고, waypoint 4에서 waypoint 5를 잇는 벡터(224)를 waypoint 4(즉, 지점 215)에 맵핑하여, 지점 213 → 지점 214 → 지점 215 → 지점 216을 따라 이동한 경로에 대한 자율 주행 경로를 생성할 수 있다.In addition, in Figure 2 (a), in that the path along which the
또한, 도 2의 (a)에서, 농기계(100)가 지점 216 → 지점 217 → 지점 218 → 지점 219를 따라 이동한 경로는 직선 경로에 해당한다는 점에서, 프로세서(140)는 도 2의 (b)와 같이, 지점 216 및 지점 219를 해당 경로에 대한 waypoints로 설정하고, 지역 좌표 (x6,y6,h6)를 waypoint 5(즉, 지점 216)에 맵핑하고, 지역 좌표 (x9,y9,h9)를 waypoint 6(즉, 지점 219)에 맵핑하고, waypoint 5에서 waypoint 6을 잇는 벡터(225)를 waypoint 5(즉, 지점 216)에 맵핑하여, 농기계(100)가 지점 216 → 지점 217 → 지점 218 → 지점 219를 따라 이동한 경로에 대한 자율 주행 경로를 생성할 수 있다.In addition, in (a) of FIG. 2, the path of the
이와 같이, 본 발명의 일 실시 예에 따르면, 자율 주행을 위해, 경로 및 해당 경로 주변을 포함하는 지도 전체를 저장하는 것이 아니라, 농기계(100)가 실제로 주행할 경로를 미리 주행하여 해당 경로에 대한 정보만을 저장할 수 있다. 또한, 해당 경로에서 획득한 모든 위치 관련 정보를 저장하는 것이 아니라, 경로의 형태에 따라 위치 관련 정보를 선별적으로 저장하여 자율 주행 경로를 생성할 수 있다.As described above, according to an embodiment of the present invention, for autonomous driving, the entire map including the route and the periphery of the route is not stored, but the
이에 따라, 본 발명의 일 실시 예에 따르면, 고가의 센서가 부착된 드론 또는 MMS(Mobile Mapping System) 등을 이용하지 않아도, 최적의 자율 주행 경로를 생성할 수 있다는 점에서, 기존에 비해 시간 및 경제적인 측면에서 효율성이 극대화될 수 있다.Accordingly, according to an embodiment of the present invention, in that an optimal autonomous driving route can be generated without using a drone with an expensive sensor or a Mobile Mapping System (MMS), compared to the existing time and time Efficiency can be maximized in terms of economy.
한편, 프로세서(140)는 자율 주행 경로를 따라 농기계(100)가 주행하도록 제어할 수 있다.Meanwhile, the
구체적으로, 프로세서(140)는 센서(120)를 통해 감지된 농기계(100)의 위치 및 움직임에 기초하여 농기계(100)가 자율 주행 경로를 따라 주행하도록 구동부(110)를 제어할 수 있다.Specifically, the
이 경우, 프로세서(140)는 GNSS 센서(121)의 이상 여부에 대해 판단하고, 그에 따라, 농기계(100)의 주행을 제어할 수 있다.In this case, the
이하에서는 도 2를 참조하여 GNSS 센서(121)의 이상 여부에 대해 판단하는 방법에 대해 보다 구체적으로 설명하도록 한다.Hereinafter, a method of determining whether the
먼저, 프로세서(140)는 GNSS 센서(121)의 품질을 판단하기 위한 인자와 기설정된 기준값을 비교한다(S310).First, the
여기에서, 품질 판단 인자는 GNSS 센서(121)의 모호수 종류, 위치 정밀도, 위성의 개수, DOP(Dilution Of Precision) 중 적어도 하나를 포함할 수 있으며, 이러한 정보는 GNSS 센서(121)로부터 획득될 수 있다.Here, the quality determination factor may include at least one of the type of ambiguity, the location precision, the number of satellites, and DOP (Dilution Of Precision) of the
이 경우, 프로세서(140)는 품질 판단 인자가 기설정된 기준값을 만족하지 않는 경우(S320-N), 현재 위치 상태가 불량한 것으로 판단할 수 있다(S330). 이와 같이, 프로세서(140)는 품질 판단 인자가 기설정된 기준값을 만족하지 않으면 GNSS 센서(121)로부터 획득되는 데이터의 정확도가 떨어지는 것으로 볼 수 있다. 이에 따라, 프로세서(140)는 GNSS 센서(121)로부터 획득되는 위치 관련 정보를 농기계(100)의 주행의 제어에 이용하지 않으며, 농기계(100)가 주행 중인 경우에는 농기계(100)의 주행을 멈추도록 구동부(110)를 제어할 수 있다. In this case, when the quality determination factor does not satisfy a preset reference value (S320-N), the
예를 들어, 프로세서(140)는 바퀴의 구동을 중단시키기 위한 제어 신호를 생성하고, 생성된 제어 신호를 구동부(110)로 제공할 수 있다. 이 경우, 구동부(110)는 프로세서(140)로부터 제공받은 제어 신호에 따라 브레이크 액추에이터를 구동하여, 바퀴의 구동을 중단시킬 수 있다.For example, the
한편, 프로세서(140)는 품질 판단 인자가 기설정된 기준값을 만족하는 경우(S320-Y), GNSS 센서(121)를 통해 획득된 데이터를 메모리(130)에 저장한다(S340). 여기에서, GNSS 센서(121)를 통해 획득된 데이터는 농기계(100)의 위치, 속도 및 방향각 등을 포함할 수 있다.Meanwhile, when the quality determination factor satisfies a preset reference value (S320-Y), the
이후, 프로세서(140)는 현재 시간보다 특정한 시간 이전의 항법해(navigation solution)를 통해 농기계(100)의 현재 위치를 예측한다(S250).Thereafter, the
즉, 프로세서(140)는 현재 시간보다 특정한 시간 이전에 GNSS 센서(121)를 통해 획득된 데이터를 이용하여, 해당 시간으로부터 특정한 시간 이후에서의 농기계(100)의 위치 즉, 현재 시간에서의 농기계(100)의 위치를 예측할 수 있다.That is, the
구체적으로, 프로세서(140)는 이전 시간에서 GNSS 센서(121)를 통해 획득된 농기계(100)의 이전 시간에서의 위치, 이전 시간에서의 속도, 이전 시간에서의 방향각과, 이전 시간과 현재 시간 사이의 시간 차이를 이용하여, 현재 시간에서의 농기계(100)의 위치를 예측할 수 있다. Specifically, the
즉, 프로세서(140)는 농기계(100)가 이전 시간에서의 위치부터 이전 시간에서의 방향을 따라 이전 시간에서의 속도로 시간 차이 동안 이동한 경우, 현재 시간에 농기계(100)가 도달할 위치를 현재 시간에서의 농기계(100)의 위치로 예측할 수 있다. That is, when the
그리고, 프로세서(140)는 GNSS 기반으로 현재 농기계(100)의 위치를 측정할 수 있다(S360). 즉, 프로세서(140)는 현재 시간에 GNSS 센서(121)를 통해 농기계(100)의 현재 위치를 획득할 수 있다.In addition, the
이후, 프로세서(140)는 예측된 농기계(100)의 현재 위치와 GNSS 센서(121)를 통해 획득한 농기계(100)의 현재 위치를 비교하여, GNSS 센서(121)를 통해 획득되는 농기계(100)의 위치가 양호한 상태인지를 판단할 수 있다.Thereafter, the
구체적으로, 프로세서(140)는 예측된 농기계(100)의 현재 위치와 GNSS 센서(121)를 통해 획득한 농기계(100)의 현재 위치 사이의 거리 차이를 산출할 수 있다(S370).Specifically, the
그리고, 프로세서(140)는 거리 차이가 기준값을 만족하지 않는 경우(S380-N)(즉, 거리 차이가 기설정된 기준값을 초과하는 경우), 현재 위치 상태가 불량한 것으로 판단할 수 있다(S330). 즉, 프로세서(140)는 거리 차이가 기준값을 만족하지 않는 경우, GNSS 센서(121)에서 측정되는 농기계(100)의 위치가 불량한 것으로 판단할 수 있다.In addition, when the distance difference does not satisfy the reference value (S380-N) (ie, when the distance difference exceeds a preset reference value), the
이와 같이, GNSS 센서(121)에서 측정되는 농기계(100)의 위치가 불량한 것으로 판단된 경우, 프로세서(140)는 GNSS 센서(121)로부터 획득되는 위치 관련 정보를 농기계(100)의 주행의 제어에 이용하지 않으며, 농기계(100)가 주행 중인 경우에는 농기계(100)의 주행을 멈추도록 구동부(110)를 제어할 수 있다(S380). As described above, when it is determined that the location of the
한편, 프로세서(140)는 거리 차이가 기준값을 만족하는 경우(S380-Y)(즉, 거리 차이가 기설정된 기준값 이하인 경우), 현재 위치 상태가 양호한 것으로 판단할 수 있다(S290). 즉, 프로세서(140)는 거리 차이가 기준값을 만족하는 경우, GNSS 센서(121)에서 측정되는 농기계(100)의 위치가 양호한 것으로 판단할 수 있다.Meanwhile, when the distance difference satisfies the reference value (S380-Y) (that is, when the distance difference is less than a preset reference value), the
이 경우, GNSS 센서(121)에서 측정되는 농기계(100)의 위치가 양호한 것으로 판단된 경우, 프로세서(140)는 GNSS 센서(121)에서 측정되는 위치 관련 데이터를 이용하여 농기계(100)의 주행을 제어할 수 있다.In this case, when it is determined that the location of the
이와 같이, 본 발명의 일 실시 예에 따르면, 주변 환경에 따라 GNSS 센서(121)에서 농기계(100)의 위치와 관련하여 부정확한 데이터가 측정될 수 있다는 점에서, 농기계(100)의 주행을 제어할 때, GNSS 센서(121)에서 획득되는 데이터의 이상 여부를 판단하고, 그 결과에 따라 농기계(100)의 주행을 제어할 수 있다는 점에서, 보다 정확히 자율 주행을 제어할 수 있게 된다. As described above, according to an embodiment of the present invention, the
한편, 프로세서(140)는 자율 주행 경로를 갱신하고, 갱신된 자율 주행 경로를 따라 농기계(100)가 주행하도록 제어할 수 있다.Meanwhile, the
즉, 프로세서(140)는 농기계(100)가 자율 주행 경로에서 이탈한 경우, 주변에 존재하는 복수의 waypoints 중에서 어떠한 waypoint가 농기계(100)가 주행하여야 할 목표 지점에 해당하는지를 결정하고, 결정된 waypoint에 기초하여 자율 주행 경로를 갱신할 수 있다. 그리고, 프로세서(140)는 갱신된 자율 주행 경로를 따라 농기계(100)가 주행하도록 제어할 수 있다.That is, when the
먼저, 프로세서(140)는 GNSS 센서(121)를 통해 획득되는 농기계(100)의 위치가 양호한 상태인지를 판단할 수 있다(S410). 이에 대해서는, 도 3과 함께 구체적으로 설명한 바 있다.First, the
이후, 프로세서(140)는 GNSS 센서(121)를 통해 획득되는 농기계(100)의 위치가 양호한 경우, GNSS 센서(121)를 통해 농기계(100)의 현재 위치를 획득할 수 있다(S420).Thereafter, when the location of the
그리고, 프로세서(140)는 농기계(100)의 현재 위치 및 자율 주행 경로에 기초하여, 농기계(100)가 자율 주행 경로를 이탈하였는지 여부를 판단할 수 있다(S430).Further, the
구체적으로, 프로세서(140)는 GNSS 센서(121)를 통해 획득된 농기계(100)의 현재 위치를, waypoints의 위치 및 경로 벡터에 따라 waypoints 사이에서 정의되는 위치와 비교하여, 농기계(100)의 현재 위치가 해당 위치들에 포함되지 않거나, 해당 위치들로부터 기설정된 거리 이상 떨어진 경우, 농기계(100)가 자율 주행 경로를 이탈한 것으로 판단할 수 있다.Specifically, the
그리고, 프로세서(140)는 농기계(100)가 자율 주행 경로를 이탈한 것으로 판단된 경우(S430-Y), 농기계(100)의 현재 위치를 기준으로, 경로 벡터와 직교하는 수직선을 판단할 수 있다(S440).In addition, when it is determined that the
이후, 프로세서(140)는 수직선에 기초하여 자율 주행 경로를 갱신할 수 있다(S450).Thereafter, the
구체적으로, 프로세서(140)는 경로 벡터와 직교하는 수직선들 중 가장 거리가 짧은 수직선을 판단하고, 판단된 수직선과 만나는 경로 벡터가 향하는 waypoint를 현재 경로를 이탈한 농기계(100)가 이동해야할 새로운 waypoint로 설정하여, 자율 주행 경로를 갱신할 수 있다.Specifically, the
예를 들어, 도 5와 같이, 농기계(100)가 자율 주행 경로를 이탈하여, 지점 510에 현재 위치하고, 농기계(100)의 현재 위치(510) 주변에 3 개의 waypoints(520, 530, 540)이 존재하는 것으로 가정한다.For example, as shown in FIG. 5, the
이 경우, 프로세서(140)는 농기계(100)의 현재 위치(510)을 시작점으로 하여 waypoint 1(520)에서 waypoint 2(530)까지의 경로 벡터(550)에 수직한 수직선(570) 및 농기계(100)의 현재 위치(510)을 시작점으로 하여 waypoint 2(530)에서 waypoint 3(540)까지의 경로 벡터(560)에 수직한 수직선(580)을 판단할 수 있다.In this case, the
그리고, 프로세서(140)는 수직선(570)과 수직선(580) 사이의 거리를 비교하여, 이들 중 상대적으로 짧은 수직선(570)을 판단하고, 수직선(570)이 만나는 경로 벡터(550)가 향하는 waypoint 2(530)를 농기계(100)가 현재 위치(510)에서 이동해야할 waypoint로 설정하고, 현재 위치(510)에서 waypoint 2(530)을 향하는 경로 벡터(590)를 현재 위치(510)에 대한 위치에 맵핑하여, 자율 주행 경로를 현재 위치(510) → waypoint 2(530) → waypoint 3(540)으로 갱신할 수 있다.Further, the
한편, 프로세서(140)는 농기계(100)가 자율 주행 경로를 따라 주행하도록 구동부(110)를 제어할 수 있다.Meanwhile, the
즉, 프로세서(140)는 농기계(100)가 자율 주행 경로를 따라 이동할 때, 농기계(100)가 자율 주행 경로에서 벗어나지 않고, 일정한 운용 속도로 자율 주행 경로를 따라 주행하도록 구동부(110)를 제어할 수 있다.That is, when the
이 경우, 프로세서(140)는 움직임 제어 모듈(142)을 실행하고, 센서(120)에서 획득한 데이터, 메모리(130)로부터 획득한 자율 주행 경로에 대한 데이터 등을 움직임 제어 모듈(142)의 입력으로 하여, 구동부(110)를 제어하기 위한 제어 신호를 생성하고, 생성된 제어 신호를 구동부(110)로 출력할 수 있다. 이에 따라, 구동부(110)는 프로세서(140)로부터 제공받은 제어 신호에 따라 엑셀레이터 액추에이터, 브레이크 액추에이터 및 조향각 제어 액추에이터를 구동하여, 농기계(100)의 주행을 제어할 수 있다.In this case, the
이하에서는 도 6을 참조하여, 농기계(100)의 주행 속도를 제어하는 방법에 대해 설명하도록 한다.Hereinafter, a method of controlling the traveling speed of the
먼저, 프로세서(140)는 GNSS 센서(121)를 통해 획득되는 농기계(100)의 위치가 양호한지 여부를 판단할 수 있다. 이 경우, 프로세서(140)는 도 3에 도시된 방법에 따라 GNSS 센서(121)를 통해 획득되는 농기계(100)의 위치가 양호한지 여부를 판단할 수 있다(S610). First, the
그리고, 프로세서(140)는 GNSS 센서(121)를 통해 획득된 농기계(100)의 위치가 양호하지 않은 것으로 판단되면(S620-N), 이동 중인 농기계(100)를 정지시킬 수 있다.In addition, when it is determined that the position of the
이 경우, 프로세서(140)는 브레이크 액추에이터를 구동시킬 수 있다(S630).In this case, the
구체적으로, 프로세서(140)는 바퀴의 구동을 중단시키기 위한 제어 신호를 생성하고, 생성된 제어 신호를 구동부(110)로 제공할 수 있다. 이 경우, 구동부(110)는 프로세서(140)로부터 제공받은 제어 신호에 따라 브레이크 액추에이터를 구동하여, 바퀴의 구동을 중단시킬 수 있다.Specifically, the
한편, 프로세서(140)는 GNSS 센서(121)를 통해 획득된 농기계(100)의 위치가 양호한 것으로 판단되면(S620-Y), GNSS 센서(121)에 의해 감지된 농기계(100)의 속도를 기설정된 운용 속도와 비교하여 농기계(100)의 속도를 제어할 수 있다.On the other hand, if the
이 경우,프로세서(140)는 GNSS 센서(121)에 의해 감지된 속도가 기설정된 운용 속도를 초과하는 경우, 이동 중인 농기계(100)의 속도를 감소시키고, GNSS 센서(121)에 의해 감지된 속도가 기설정된 운용 속도 미만인 경우, 이동 중인 농기계(100)의 속도를 증가시킬 수 있다.In this case, when the speed sensed by the
구체적으로, 프로세서(140)는 GNSS 센서(121)에 의해 감지된 농기계(100)의 현재 속도와 기설정된 운용 속도 간의 차이를 산출할 수 있다(S640).Specifically, the
그리고, 프로세서(140)는 농기계(100)의 현재 속도와 기설정된 운용 속도 간의 차이에 기초하여 농기계(100)의 속도를 제어할 수 있다.Further, the
구체적으로, 프로세서(140)는 농기계(100)의 현재 속도와 기설정된 운용 속도 간의 차이가 기설정된 기준값을 초과하는지 여부를 판단할 수 있다(S650).Specifically, the
이때, 프로세서(140)는 농기계(100)의 현재 속도와 기설정된 운용 속도 간의 차이가 기설정된 기준값을 초과하는 경우(S650-Y), 브레이크 액추에이터를 구동할 수 있다(S630).At this time, the
구체적으로, 프로세서(140)는 농기계(100)의 속도가 기설정된 운용 속도가 되기 위해, 현재 속도에서 감소되어야 하는 속도를 판단하고, 판단된 속도만큼 농기계(100)의 속도를 감소시키기 위한 제어 신호를 생성하여 구동부(110)로 제공할 수 있다. 이 경우, 구동부(110)는 프로세서(140)로부터 제공받은 제어 신호에 따라 브레이크 액추에이터를 구동하여 바퀴의 속도를 감소시킬 수 있다. 이에 따라, 농기계(100)는 기설정된 운용 속도로 주행할 수 있게 된다.Specifically, the
한편, 프로세서(140)는 농기계(100)의 현재 속도와 기설정된 운용 속도 간의 차이가 기설정된 기준값을 초과하지 않은 경우(S650-N), 차이가 기설정된 기준값 미만인지를 판단할 수 있다.Meanwhile, when the difference between the current speed of the
그리고, 프로세서(140)는 농기계(100)의 현재 속도와 기설정된 운용 속도 간의 차이가 기설정된 기준값 미만인 경우(S660-Y), 엑셀레이터 액추에이터를 구동할 수 있다(S670).In addition, when the difference between the current speed of the
구체적으로, 프로세서(140)는 농기계(100)의 속도가 기설정된 운용 속도가 되기 위해, 현재 속도에서 증가되어야 하는 속도를 판단하고, 판단된 속도만큼 농기계(100)의 속도를 증가시키기 위한 제어 신호를 생성하여 구동부(110)로 제공할 수 있다. 이 경우, 구동부(110)는 프로세서(140)로부터 제공받은 제어 신호에 따라 엑셀레이터 액추에이터를 구동하여, 바퀴의 속도를 증가시킬 수 있다. 이에 따라, 농기계(100)는 기설정된 운용 속도로 주행할 수 있게 된다.Specifically, the
한편, 프로세서(140)는 농기계(100)의 현재 속도와 기설정된 운용 속도 간의 차이가 기설정된 기준값 미만에 해당하지 않는 경우(S660-N), S610 단계로 돌아가 전술한 반복할 수 있다.Meanwhile, when the difference between the current speed of the
결국, 프로세서(140)는 전술한 방법을 통해, 농기계(100)가 기설정된 운용 속도로 자율 주행 경로를 따라 주행하도록 제어할 수 있다. Consequently, the
이하에서는 도 7을 참조하여, 농기계(100)의 주행 방향을 제어하는 방법에 대해 설명하도록 한다.Hereinafter, a method of controlling the driving direction of the
먼저, 프로세서(140)는 GNSS 센서(121)를 통해 획득되는 농기계(100)의 위치가 양호한지 여부를 판단할 수 있다. 이 경우, 프로세서(140)는 도 3에 도시된 방법에 따라 GNSS 센서(121)를 통해 획득되는 농기계(100)의 위치가 양호한지 여부를 판단할 수 있다.First, the
*그리고, 프로세서(140)는 GNSS 센서(121)를 통해 획득되는 농기계(100)의 위치가 양호한 것으로 판단되면, 항법해를 획득한다(S710). 구체적으로, 프로세서(140)는 현재 시간에 GNSS 센서(121)를 통해 농기계(100)의 위치, 속도 및 방향각 등을 획득할 수 있다.* And, when it is determined that the location of the
그리고, 프로세서(140)는 획득된 항법해에 기초하여 자율 주행 경로 상에서 현재 시간을 기준으로 특정 시간 이후의 제1 위치를 추정할 수 있다(S720).Further, the
즉, 프로세서(140)는 현재 시간에 GNSS 센서(121)를 통해 획득된 데이터를 이용하여, 현재 시간으로부터 특정한 시간 이후에 농기계(100)가 자율 주행 경로 상에서 주행할 위치를 추정할 수 있다.That is, the
구체적으로, 프로세서(140)는 농기계(100)가 현재 시간의 위치로부터 현재 시간의 속도로 특정한 시간 동안 자율 주행 경로를 따라 주행할 경우, 특정한 시간이 경과한 시점에 자율 주행 경로 상에서 도착하는 위치를 특정한 시간 이후에 농기계(100)가 자율 주행 경로 상에서 주행할 위치로 추정할 수 있다.Specifically, when the
또한, 프로세서(140)는 획득된 항법해에 기초하여 현재 시간을 기준으로 특정 시간 이후의 제2 위치를 추정할 수 있다(S730).Also, the
구체적으로, 프로세서(140)는 농기계(100)가 현재 시간의 위치부터, 자율 주행 경로 상이 아닌, 현재 시간에서의 이동 방향을 따라 현재 시간의 속도로 특정한 시간 동안 주행할 경우, 특정한 시간이 경과한 시점에 도착하는 위치를 농기계(100)가 특정한 시간 이후에 주행할 위치로 추정할 수 있다.Specifically, when the
그리고, 프로세서(140)는 농기계(100)의 현재 위치를 기준으로 제1 위치까지의 제1 벡터와 농기계(100)의 현재 위치를 기준으로 제2 위치까지의 제2 벡터 사이의 방향각 차이를 산출할 수 있다(S740).Further, the
즉, 프로세서(140)는 농기계(100)의 현재 위치부터 제1 위치를 연결하는 제1 벡터와 현재 위치부터 제2 위치를 연결하는 제2 벡터를 각각 생성하고, 제1 및 제2 벡터 사이의 방향각 차이를 산출할 수 있다.That is, the
이후, 프로세서(140)는 산출된 방향각 차이에 기초하여 이동 중인 농기계(100)의 이동 방향을 제어할 수 있다.Thereafter, the
구체적으로, 프로세서(140)는 Steering Dynamic Model을 이용하여, 산출된 방향각만큼 농기계(100)의 주행 방향이 변경되기 위하여, 바퀴의 회전축이 회전하여야 하는 조향각을 산출할 수 있다(S450). Specifically, the
그리고, 프로세서(140)는 산출된 조향각에 기초하여 조향각 제어 액추에이터를 구동할 수 있다.In addition, the
즉, 프로세서(140)는 바퀴의 회전축을 산출된 조향각만큼 회전시키기 위한 제어 신호를 생성하여 구동부(110)로 제공할 수 있다. 이 경우, 구동부(110)는 프로세서(140)로부터 제공받은 제어 신호에 따라 조향각 제어 액추에이터를 구동하여 바퀴의 회전축을 산출된 조향각만큼 좌측 방향 또는 우측 방향으로 회전시킬 수 있다. 이에 따라, 농기계(100)는 자율 주행 경로를 벗어나지 않고, 자율 주행 경로를 따라 주행할 수 있게 된다.That is, the
한편, 전술한 예에서, 농기계(100)의 주행을 제어하기 위해, 프로세서(140)는 구동체 센서(122)에서 획득되는 데이터 가령, 농기계(100)의 속도 및 방향각 등을 이용할 수도 있다.Meanwhile, in the above-described example, in order to control the running of the
또한, 전술한 예에서, 프로세서(140)는 갱신된 자율 주행 경로를 이용하여, 특정한 시간 이후에 농기계(100)가 자율 주행 경로 상에서 주행할 위치를 추정할 수 있다.In addition, in the above-described example, the
또한, 전술한 예에서는, 프로세서(140)가 GNSS 센서(121)를 통해 획득되는 농기계(100)의 위치가 양호한 경우를 판단하고, 그에 따라, 농기계(100)의 주행 속도 및 주행 방향을 제어하는 것으로 설명하였으나, 실시 예에 따라, GNSS 센서(121)를 통해 획득되는 농기계(100)의 위치가 양호한지에 대한 판단 없이 GNSS 센서(121)를 통해 획득되는 데이터를 이용하여 농기계(100)의 주행 속도 및 주행 방향을 제어할 수 있음은 물론이다.In addition, in the above-described example, the
한편, 도 1b을 참조하면, 통신부(150)는 다양한 유형의 통신 방식에 기초하여 서버(200)와 통신을 수행할 수 있다. 예를 들어, 통신부(150)는 3G(3Generation), LTE(Long Term Evolution) 등의 이동 통신망을 통해, 서버(200)와 통신을 수행할 수 있다. Meanwhile, referring to FIG. 1B, the
이 경우, 프로세서(140)는 통신부(150)를 통해 서버(200)와 다양한 데이터를 송수신할 수 있다.In this case, the
예를 들어, 프로세서(140)는 농기계(100)의 위치, 속도 및 방향각 등을 포함하는 측위해에 정보 및 농기계(100)의 주행/운용 상황에 대한 정보(가령, 농기계(100)의 주행 시작 시간 정보, 주행 시간 정보, 이상 상태에 대한 정보 등) 등을 통신부(150)를 통해 서버(200)로 전송할 수 있다. 또한, 프로세서(140)는 농기계(100)의 동작을 제어하기 위한 제어 정보 및 펌웨어 업데이트를 위한 정보 등을 통신부(150)를 통해 서버(200)로부터 수신할 수 있다.For example, the
서버(200)(가령, 농기계 IoT(Internet of Things) 서버)는 사용자나 관리자가 농기계(100)의 운용과 관련된 정보를 확인할 수 있는 IoT 기반의 플랫폼으로, 농기계(100)로부터 제공받은 정보를 포함하는 농기계(100)의 운용과 관련된 각종 정보를 저장할 수 있다.The server 200 (for example, the agricultural machinery Internet of Things (IoT) server) is an IoT-based platform through which a user or administrator can check information related to the operation of the
그리고, 서버(200)는 농기계(100)의 운용과 관련된 각종 정보를 사용자나 관리자의 전자 장치(300)로 전송할 수 있다.In addition, the
예를 들어, 서버(200)는 3G, LTE 등의 이동 통신망을 통해, 농기계(100)의 위치, 속도 및 방향각 등을 포함하는 측위해에 정보 및 농기계(100)의 주행/운용 상황에 대한 정보 등을 전자 장치(300)로 전송할 수 있다.For example, the
전자 장치(300)는 농기계(100)를 제어하기 위한 기능을 수행할 수 있다. 이 경우, 전자 장치(300)는 농기계(100)를 제어하기 위한 전용 컨트롤러로 구현되거나, 또는 해당 기능을 실행하기 위한 어플리케이션이 설치된 스마트폰(smartphone) 또는 태블릿 PC(tablet personal computer) 등으로 구현될 수 있다.The
이를 위해, 도 8과 같이, 전자 장치(300)는 농기계(100)를 제어하기 위한 유저 인터페이스(800)를 전자 장치(300)에 마련된 디스플레이에 표시할 수 있다.To this end, as shown in FIG. 8, the
이 경우, 유저 인터페이스(800)에는 서버(200)로부터 제공받은 농기계(100)의 현재 운용 상황을 나타내는 정보(가령, 도 8의 810, 820, 830, 840)가 표시될 수 있고, 또한, 농기계(100)를 제어하기 위한 사용자 명령을 입력받는 GUI(Graphical User Interface)(가령, 도 8의 850)가 표시될 수 있다.In this case, the user interface 800 may display information (eg, 810, 820, 830, 840 in FIG. 8) indicating the current operation status of the
이에 따라, 전자 장치(300)는 GUI(850)가 선택되면, 선택된 GUI에 따라 농기계(100)의 동작을 제어하기 위한 제어 정보를 서버(200)를 통해 농기계(100)로 전송할 수 있다.Accordingly, when the
이 경우, 프로세서(140)는 서버(200)로부터 수신된 제어 정보에 따라 농기계(100)의 동작을 제어할 수 있다. In this case, the
예를 들어, 프로세서(140)는 농기계(100)의 주행 시작을 위한 제어 정보가 수신되면, 농기계(100)가 주행을 시작하도록 하는 제어 명령을 구동부(110)로 제공할 수 있고, 구동부(110)는 제어 명령에 따라 엑셀레이터 액추에이터를 제어하여 바퀴를 구동시킬 수 있다.For example, when control information for starting the driving of the
이와 같이, 사용자는 전자 장치(300)를 통해, 농기계(100)의 각종 운용 상황을 모니터링하고, 농기계(100)의 각종 동작을 제어할 수 있다. In this way, the user can monitor various operating conditions of the
한편, 전자 장치(300)는 사용자 명령에 따라 펌웨어 업데이트에 대한 정보를 서버(200)를 통해 농기계(100)로 전송할 수 있다.Meanwhile, the
이 경우, 프로세서(140)는 서버(200)로부터 수신된 펌웨어 업데이트에 대한 정보에 따라 농기계(100)의 펌웨어에 대한 업데이트를 진행할 수 있다.In this case, the
이와 같이, 관리자는 전자 장치(300)를 통해 농기계(100)의 각종 운용 상황을 모니터링하여 농기계(100)에 기술 이상 여부를 확인하고, 이상이 있는 경우 전자 장치(300)를 통해 농기계(100)의 펌웨어에 대한 업데이트를 진행할 수 있게 된다.In this way, the manager monitors various operating conditions of the
도 9는 본 발명의 일 실시 예에 따른 농기계의 자율 주행 방법을 설명하기 위한 흐름도이다.9 is a flowchart illustrating an autonomous driving method of an agricultural machine according to an embodiment of the present invention.
먼저, 센서를 이용하여, 농기계의 위치 및 움직임을 감지한다(S910).First, using a sensor, the position and movement of the agricultural machine is sensed (S910).
그리고, 감지된 농기계의 위치 및 움직임에 기초하여 농기계가 농기계에 저장된 자율 주행 경로를 따라 주행하도록 제어한다(S920).Then, based on the sensed position and movement of the agricultural machine, the agricultural machine is controlled to travel along the autonomous driving path stored in the agricultural machine (S920).
여기에서 센서는 GNSS(Global Navigation Satellite System) 센서를 포함할 수 있다.Here, the sensor may include a Global Navigation Satellite System (GNSS) sensor.
그리고, 자율 주행 경로는 기설정된 경로를 농기계가 주행하는 동안에 GNSS 센서에서 획득된 데이터에 기초하여 생성될 수 있다.In addition, the autonomous driving route may be generated based on data obtained from the GNSS sensor while the agricultural machine is driving a preset route.
여기에서, GNSS 센서에서 획득된 데이터는 농기계의 위치, 속도 및 방향각을 포함할 수 있다.Here, the data obtained from the GNSS sensor may include the position, speed, and direction angle of the agricultural machine.
한편, 기설정된 경로를 농기계가 주행하는 동안, GNSS 센서를 통해 농기계의 측지 좌표를 획득하고 획득된 측지 좌표를 지역 좌표로 변환하고, GNSS 센서를 통해 농기계의 방향각을 획득하고, 획득된 방향각에 기초하여 농기계가 이동하는 경로의 형태를 판단하고, 지역 좌표 및 판단된 경로 형태에 기초하여 자율 주행 경로를 생성하고, 생성된 자율 주행 경로를 농기계에 저장할 수 있다.On the other hand, while the agricultural machine is running on a preset route, the geodetic coordinates of the agricultural machine are acquired through the GNSS sensor, the acquired geodetic coordinates are converted into local coordinates, the direction angle of the agricultural machine is acquired through the GNSS sensor, and the obtained direction angle Based on the determination of the shape of the path on which the farm machine moves, the autonomous driving path may be generated based on the local coordinates and the determined path type, and the generated autonomous driving path may be stored in the farm machine.
한편, S920 단계는 GNSS 센서의 품질을 판단하기 위한 인자와 기설정된 기준 값을 비교하고, 인자가 기설정된 기준 값을 만족하는 경우, 현재 시간보다 특정한 시간 이전의 항법해를 통해 예측된 농기계의 현재 위치와 GNSS 센서를 통해 획득된 농기계의 현재 위치를 비교하여 GNSS 센서를 통해 획득되는 농기계의 위치가 양호한 상태인지를 판단하고, 판단된 상태에 따라 농기계의 주행을 제어할 수 있다.On the other hand, step S920 compares the factor for determining the quality of the GNSS sensor with a preset reference value, and if the factor satisfies the preset reference value, the current of the agricultural machine predicted through a navigation solution before a specific time before the current time. By comparing the location and the current location of the agricultural machine acquired through the GNSS sensor, it is possible to determine whether the location of the agricultural machine acquired through the GNSS sensor is in a good state, and control the driving of the agricultural machine according to the determined status.
이 경우, GNSS 센서를 통해 획득된 농기계의 위치가 양호하지 않은 것으로 판단되면, 이동 중인 농기계를 정지시킬 수 있다.In this case, if it is determined that the location of the agricultural machine acquired through the GNSS sensor is not good, the moving agricultural machine can be stopped.
또한, GNSS 센서를 통해 획득된 농기계의 위치가 양호한 것으로 판단되면, GNSS 센서에 의해 감지된 농기계의 속도를 기설정된 운용 속도와 비교하여 농기계의 속도를 제어할 수 있다.In addition, if it is determined that the position of the agricultural machine acquired through the GNSS sensor is good, the speed of the agricultural machine detected by the GNSS sensor is compared with a preset operating speed to control the speed of the agricultural machine.
구체적으로, 감지된 속도가 기설정된 운용 속도를 초과하는 경우, 이동 중인 농기계의 속도를 감소시키고, 감지된 속도가 기설정된 운용 속도 미만인 경우, 이동 중인 농기계의 속도를 증가시킬 수 있다.Specifically, when the sensed speed exceeds a preset operating speed, the speed of the moving agricultural machine may be reduced, and if the detected speed is less than the preset operating speed, the speed of the moving agricultural machine may be increased.
*한편, S920 단계는 GNSS 센서를 통해 획득된 농기계의 위치가 양호한 것으로 판단되면, 현재 시간의 시간 이전의 항법해를 획득하고, 획득된 항법해에 기초하여 자율 주행 경로 상에서 현재 시간을 기준으로 특정 시간 이후의 제1 위치를 추정하고, 획득된 항법해에 기초하여 현재 시간보다 특정 시간 이후의 제2 위치를 추정하고, 농기계의 현재 위치를 기준으로 제1 위치까지의 제1 벡터와 농기계의 현재 위치를 기준으로 제2 위치까지의 제2 벡터 사이의 방향각 차이를 산출하고, 산출된 방향각 차이에 기초하여 이동 중인 농기계의 이동 방향을 제어할 수 있다.* On the other hand, in step S920, if it is determined that the location of the agricultural machine acquired through the GNSS sensor is good, a navigation solution prior to the time of the current time is obtained, and based on the current time on the autonomous driving route based on the obtained navigation solution. Estimates the first position after time, estimates the second position after a specific time from the current time based on the obtained navigation solution, and the first vector to the first position based on the current position of the agricultural machine and the current of the agricultural machine A direction angle difference between the second vectors up to the second position based on the position may be calculated, and a moving direction of a moving agricultural machine may be controlled based on the calculated direction angle difference.
한편, 이와 관련하여 농기계의 자율 주행을 제어하는 구체적인 방법은 상술한 바 있다.Meanwhile, a specific method of controlling autonomous driving of agricultural machinery has been described above.
한편, 본 개시의 다양한 실시 예들은 기기(machine)(예: 컴퓨터)로 읽을 수 있는 저장 매체(machine-readable storage media에 저장된 명령어를 포함하는 소프트웨어로 구현될 수 있다. 기기는, 저장 매체로부터 저장된 명령어를 호출하고, 호출된 명령어에 따라 동작이 가능한 장치로서, 개시된 실시 예들에 따른 전자 장치(예: 전자 장치(A))를 포함할 수 있다. 상기 명령이 프로세서에 의해 실행될 경우, 프로세서가 직접, 또는 상기 프로세서의 제어하에 다른 구성요소들을 이용하여 상기 명령에 해당하는 기능을 수행할 수 있다. 명령은 컴파일러 또는 인터프리터에 의해 생성 또는 실행되는 코드를 포함할 수 있다. 기기로 읽을 수 있는 저장매체는, 비일시적(non-transitory) 저장매체의 형태로 제공될 수 있다. 여기서, '비일시적'은 저장매체가 신호(signal)를 포함하지 않으며 실재(tangible)한다는 것을 의미할 뿐 데이터가 저장매체에 반영구적 또는 임시적으로 저장됨을 구분하지 않는다.Meanwhile, various embodiments of the present disclosure may be implemented as software including instructions stored in a machine-readable storage media (eg, a computer). The device is stored from a storage medium. As a device capable of calling a command and operating according to the called command, it may include an electronic device (eg, electronic device A) according to the disclosed embodiments. When the command is executed by a processor, the processor is directly executed by the processor. Alternatively, a function corresponding to the instruction may be performed using other components under the control of the processor, and the instruction may include a code generated or executed by a compiler or an interpreter. May be provided in the form of a non-transitory storage medium, where'non-transitory' means that the storage medium does not contain a signal and is tangible, but the data is a storage medium. It does not distinguish between being stored semi-permanently or temporarily.
일 시예에 따르면, 본 발명에 개시된 다양한 실시 예들에 따른 방법은 컴퓨터 프로그램 제품(computer program product)에 포함되어 제공될 수 있다. 컴퓨터 프로그램 제품은 상품으로서 판매자 및 구매자 간에 거래될 수 있다. 컴퓨터 프로그램 제품은 기기로 읽을 수 있는 저장 매체(예: compact disc read only memory (CD-ROM))의 형태로, 또는 어플리케이션 스토어(예: 플레이 스토어TM)를 통해 온라인으로 배포될 수 있다. 온라인 배포의 경우에, 컴퓨터 프로그램 제품의 적어도 일부는 제조사의 서버, 어플리케이션 스토어의 서버, 또는 중계 서버의 메모리와 같은 저장 매체에 적어도 일시 저장되거나, 임시적으로 생성될 수 있다.According to one embodiment, the method according to various embodiments disclosed in the present invention may be provided by being included in a computer program product. Computer program products can be traded between sellers and buyers as commodities. The computer program product may be distributed online in the form of a device-readable storage medium (eg, compact disc read only memory (CD-ROM)) or through an application store (eg, Play StoreTM). In the case of online distribution, at least some of the computer program products may be temporarily stored or temporarily generated in a storage medium such as a server of a manufacturer, a server of an application store, or a memory of a relay server.
다양한 실시 예들에 따른 구성 요소(예: 모듈 또는 프로그램) 각각은 단수 또는 복수의 개체로 구성될 수 있으며, 전술한 해당 서브 구성 요소들 중 일부 서브 구성 요소가 생략되거나, 또는 다른 서브 구성 요소가 다양한 실시예에 더 포함될 수 있다. 대체적으로 또는 추가적으로, 일부 구성 요소들(예: 모듈 또는 프로그램)은 하나의 개체로 통합되어, 통합되기 이전의 각각의 해당 구성 요소에 의해 수행되는 기능을 동일 또는 유사하게 수행할 수 있다. 다양한 실시예들에 따른, 모듈, 프로그램 또는 다른 구성 요소에 의해 수행되는 동작들은 순차적, 병렬적, 반복적 또는 휴리스틱하게 실행되거나, 적어도 일부 동작이 다른 순서로 실행되거나, 생략되거나, 또는 다른 동작이 추가될 수 있다.Each of the constituent elements (eg, modules or programs) according to various embodiments may be composed of a singular or a plurality of entities, and some sub-elements of the aforementioned sub-elements are omitted, or other sub-elements are various. It may be further included in the embodiment. Alternatively or additionally, some constituent elements (eg, a module or a program) may be integrated into one entity, and functions performed by each corresponding constituent element prior to the consolidation may be performed identically or similarly. Operations performed by modules, programs, or other components according to various embodiments are sequentially, parallel, repetitively or heuristically executed, or at least some operations are executed in a different order, omitted, or other operations are added. Can be.
100 : 농기계
110 : 구동부
120 : 센서
130 : 메모리
140 : 프로세서100: agricultural machinery 110: drive
120: sensor 130: memory
140: processor
Claims (10)
상기 농기계의 주행을 제어하는 구동부;
GNSS(Global Navigation Satellite System) 센서를 포함하고, 상기 농기계의 위치 및 움직임을 감지하기 위한 센서;
메모리; 및
상기 농기계가 주행하는 동안, 상기 GNSS 센서를 통해 상기 농기계의 좌표를 획득하고, 상기 GNSS 센서를 통해 상기 농기계의 방향각을 획득하고, 상기 획득된 방향각에 기초하여 상기 농기계가 이동하는 경로의 형태를 판단하고, 상기 좌표 및 상기 판단된 경로 형태에 기초하여 자율 주행 경로를 생성하고, 상기 생성된 자율 주행 경로를 상기 메모리에 저장하는 프로세서;를 포함하고,
상기 프로세서는,
현재 시간 이전의 방향각 및 현재 시간의 방향각을 획득하고, 상기 현재 시간 이전의 방향각 및 상기 현재 시간의 방향각 사이의 차이가 기 설정된 값 이상이면 상기 자율 주행 경로의 두 지점 사이의 현재 경로가 회전 경로인 것으로 판단하고, 기 설정된 값 미만이면 상기 자율 주행 경로의 상기 두 지점 사이의 현재 경로가 직선 경로인 것으로 판단하고, 상기 판단된 직선 경로 또는 상기 판단된 회전 경로에 기초하여 웨이포인트를 설정하고, 웨이포인트 별로 좌표 및 경로 백터를 맵핑하여 상기 자율 주행 경로를 생성하는 농기계.In agricultural machinery,
A driving unit for controlling the driving of the agricultural machinery;
A sensor including a Global Navigation Satellite System (GNSS) sensor and detecting a position and movement of the agricultural machine;
Memory; And
While the agricultural machine is running, the coordinates of the agricultural machine are obtained through the GNSS sensor, the direction angle of the agricultural machine is obtained through the GNSS sensor, and the shape of the path on which the agricultural machine moves based on the obtained direction angle And a processor that determines and generates an autonomous driving path based on the coordinates and the determined path type, and stores the generated autonomous driving path in the memory,
The processor,
A direction angle before the current time and a direction angle of the current time are acquired, and if the difference between the direction angle before the current time and the direction angle of the current time is more than a preset value, the current route between two points of the autonomous driving route Is determined to be a rotational path, and if it is less than a preset value, it is determined that the current path between the two points of the autonomous driving path is a linear path, and a waypoint is determined based on the determined linear path or the determined rotational path. Agricultural machinery that creates the autonomous driving route by setting and mapping coordinates and route vectors for each waypoint.
상기 프로세서는,
직선 경로로 판단된 경로에 대해서는 직선 경로의 시작 지점과 끝 지점을 웨이포인트로 설정하고, 상기 시작 지점에서 상기 끝 지점을 향하는 경로 벡터를 상기 시작 지점에 대응하는 웨이포인트에 매핑하며, 곡선 경로로 판단된 경로에 대해서는 곡선 경로 내의 포함된 모든 지점을 웨이포인트로 설정하고, 각 지점에서 다음 지점으로 향하는 경로 벡터를 각 지점의 웨이포인트에 매핑하여 상기 자율 주행 경로를 생성하는 농기계. The method of claim 1,
The processor,
For a route determined as a straight path, the start point and the end point of the straight path are set as waypoints, and a path vector from the start point to the end point is mapped to a waypoint corresponding to the start point, and For the determined route, all points included in the curved route are set as waypoints, and the path vector from each point to the next point is mapped to the waypoints of each point to generate the autonomous driving route.
상기 프로세서는,
상기 GNSS 센서를 통해 상기 농기계의 측지 좌표를 획득하고 상기 획득된 측지 좌표를 지역 좌표로 변환하고, 상기 지역 좌표 및 상기 판단된 경로 형태에 기초하여 자율 주행 경로를 생성하는 농기계. The method of claim 1,
The processor,
An agricultural machine that acquires the geodetic coordinates of the agricultural machine through the GNSS sensor, converts the obtained geodetic coordinates into local coordinates, and generates an autonomous driving route based on the local coordinates and the determined path shape.
상기 프로세서는,
상기 감지된 농기계의 위치 및 움직임에 기초하여 상기 농기계가 상기 자율 주행 경로를 따라 주행하도록 상기 구동부를 제어하는 농기계. The method of claim 1,
The processor,
An agricultural machine that controls the driving unit so that the agricultural machine travels along the autonomous driving path based on the sensed position and movement of the agricultural machine.
상기 프로세서는,
상기 GNSS 센서의 품질을 판단하기 위한 인자와 기설정된 기준 값을 비교하고, 상기 인자가 상기 기설정된 기준 값을 만족하는 경우, 현재 시간보다 특정한 시간 이전의 항법해를 통해 예측된 상기 농기계의 현재 위치와 상기 GNSS 센서를 통해 획득된 상기 농기계의 현재 위치를 비교하여 상기 GNSS 센서를 통해 획득되는 농기계의 위치가 양호한 상태인지를 판단하고, 상기 판단된 상태에 따라 농기계의 주행을 제어하는, 농기계.The method of claim 4,
The processor,
When the factor for determining the quality of the GNSS sensor is compared with a preset reference value, and the factor satisfies the preset reference value, the current position of the agricultural machine predicted through a navigation solution before a specific time than the current time Comparing the current position of the agricultural machine acquired through the GNSS sensor and determining whether the location of the agricultural machine obtained through the GNSS sensor is in a good state, and controlling the driving of the agricultural machine according to the determined state.
상기 프로세서는,
상기 GNSS 센서를 통해 획득된 농기계의 위치가 양호하지 않은 것으로 판단되면, 이동 중인 농기계를 정지시키는, 농기계.The method of claim 5,
The processor,
When it is determined that the location of the agricultural machine acquired through the GNSS sensor is not good, the agricultural machine in motion is stopped.
상기 프로세서는,
상기 GNSS 센서를 통해 획득된 농기계의 위치가 양호한 것으로 판단되면, 상기 GNSS 센서에 의해 감지된 상기 농기계의 속도를 기설정된 운용 속도와 비교하여 상기 농기계의 속도를 제어하는, 농기계.The method of claim 5,
The processor,
When it is determined that the location of the agricultural machine acquired through the GNSS sensor is good, comparing the speed of the agricultural machine detected by the GNSS sensor with a preset operating speed to control the speed of the agricultural machine.
상기 프로세서는,
상기 감지된 속도가 기설정된 운용 속도를 초과하는 경우, 상기 이동 중인 농기계의 속도를 감소시키고, 상기 감지된 속도가 기설정된 운용 속도 미만인 경우, 상기 이동 중인 농기계의 속도를 증가시키는, 농기계.The method of claim 7,
The processor,
When the sensed speed exceeds a preset operating speed, decreases the speed of the moving agricultural machine, and when the sensed speed is less than a preset operating speed, increases the speed of the moving agricultural machine.
상기 프로세서는,
상기 GNSS 센서를 통해 획득된 농기계의 위치가 양호한 것으로 판단되면, 현재 시간의 시간 이전의 항법해를 획득하고, 상기 획득된 항법해에 기초하여 상기 자율 주행 경로 상에서 상기 현재 시간을 기준으로 특정 시간 이후의 제1 위치를 추정하고, 상기 획득된 항법해에 기초하여 상기 현재 시간보다 특정 시간 이후의 제2 위치를 추정하고, 상기 농기계의 현재 위치를 기준으로 상기 제1 위치까지의 제1 벡터와 상기 농기계의 현재 위치를 기준으로 상기 제2 위치까지의 제2 벡터 사이의 각도 차이를 산출하고, 상기 산출된 각도 차이에 기초하여 이동 중인 농기계의 이동 방향을 제어하는, 농기계.The method of claim 5,
The processor,
If it is determined that the location of the agricultural machine acquired through the GNSS sensor is good, a navigation solution prior to the time of the current time is obtained, and after a specific time based on the current time on the autonomous driving route based on the obtained navigation solution. Estimating the first position of, and estimating a second position after a specific time from the current time based on the obtained navigation solution, and a first vector to the first position based on the current position of the agricultural machine and the Calculating an angle difference between the second vector to the second position based on the current position of the agricultural machine, and controlling the moving direction of the agricultural machine in motion based on the calculated angle difference.
상기 농기계가 주행하는 동안, GNSS 센서(Global Navigation Satellite System)를 이용하여 상기 농기계의 위치 및 움직임을 감지하는 단계;
상기 GNSS 센서를 통해 상기 농기계의 방향각을 획득하고, 상기 획득된 방향각에 기초하여 상기 농기계가 이동하는 경로의 형태를 판단하고, 상기 좌표 및 상기 판단된 경로 형태에 기초하여 자율 주행 경로를 생성하는 단계; 및
상기 생성된 자율 주행 경로를 메모리에 저장하는 단계;를 포함하고,
상기 자율 주행 경로를 생성하는 단계는,
현재 시간 이전의 방향각 및 현재 시간의 방향각을 획득하고, 상기 현재 시간 이전의 방향각 및 상기 현재 시간의 방향각 사이의 차이가 기 설정된 값 이상이면 상기 자율 주행 경로의 두 지점 사이의 현재 경로가 회전 경로인 것으로 판단하고, 기 설정된 값 미만이면 상기 자율 주행 경로의 상기 두 지점 사이의 현재 경로가 직선 경로인 것으로 판단하고, 상기 판단된 직선 경로 또는 상기 판단된 회전 경로에 기초하여 웨이포인트를 설정하여 상기 자율 주행 경로를 생성하는 자율 주행 방법.
In the autonomous driving method of agricultural machinery,
Sensing the position and movement of the agricultural machine while the agricultural machine is running, using a Global Navigation Satellite System (GNSS);
Acquires the direction angle of the agricultural machine through the GNSS sensor, determines the shape of the path the agricultural machine moves based on the obtained direction angle, and creates an autonomous driving route based on the coordinates and the determined path shape Step to do; And
Storing the generated autonomous driving route in a memory; Including,
The step of generating the autonomous driving route,
A direction angle before the current time and a direction angle of the current time are acquired, and if the difference between the direction angle before the current time and the direction angle of the current time is more than a preset value, the current route between two points of the autonomous driving route Is determined to be a rotation path, and if it is less than a preset value, it is determined that the current path between the two points of the autonomous driving path is a straight path, and a waypoint is determined based on the determined linear path or the determined rotation path. An autonomous driving method for generating the autonomous driving route by setting.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020200124969A KR102247523B1 (en) | 2020-09-25 | 2020-09-25 | Agricultural machinery and automatic driving method thereof |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020200124969A KR102247523B1 (en) | 2020-09-25 | 2020-09-25 | Agricultural machinery and automatic driving method thereof |
Related Parent Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020180037633A Division KR20190119213A (en) | 2018-03-30 | 2018-03-30 | Agricultural machinery and automatic driving method thereof |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20200116437A true KR20200116437A (en) | 2020-10-12 |
KR102247523B1 KR102247523B1 (en) | 2021-05-03 |
Family
ID=72886435
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020200124969A KR102247523B1 (en) | 2020-09-25 | 2020-09-25 | Agricultural machinery and automatic driving method thereof |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR102247523B1 (en) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20220070683A (en) * | 2020-11-23 | 2022-05-31 | 주식회사 성부 | Method for creating autonomous driving paths in agricultural machinery |
CN117848349A (en) * | 2024-01-11 | 2024-04-09 | 海南大学 | Crawler-type agricultural machinery navigation method and system when navigation RTK signal is lost |
WO2024122967A1 (en) * | 2022-12-06 | 2024-06-13 | 전찬우 | Location information-based digital agricultural machine operation system |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102613401B1 (en) * | 2021-06-29 | 2023-12-12 | 재단법인대구경북과학기술원 | Method and apparatus for generating autonomous driving path |
KR20230049792A (en) | 2021-10-06 | 2023-04-14 | 대한민국(농촌진흥청장) | Autunomous driving device, agriculturl machinery including the same and method therefor for controlling the autonomous agriculturl machinery control |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015527572A (en) * | 2012-06-28 | 2015-09-17 | コーニンクレッカ フィリップス エヌ ヴェ | Method and apparatus for positioning |
KR101577752B1 (en) * | 2014-04-03 | 2015-12-15 | 주식회사 에스원 | Method and apparatus for calculating vehicle speed, and method and apparatus for recording vehicle driving status |
JP2018013833A (en) * | 2016-07-19 | 2018-01-25 | 株式会社クボタ | Service car and inclination travel management system for service car |
-
2020
- 2020-09-25 KR KR1020200124969A patent/KR102247523B1/en active IP Right Grant
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015527572A (en) * | 2012-06-28 | 2015-09-17 | コーニンクレッカ フィリップス エヌ ヴェ | Method and apparatus for positioning |
KR101577752B1 (en) * | 2014-04-03 | 2015-12-15 | 주식회사 에스원 | Method and apparatus for calculating vehicle speed, and method and apparatus for recording vehicle driving status |
JP2018013833A (en) * | 2016-07-19 | 2018-01-25 | 株式会社クボタ | Service car and inclination travel management system for service car |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20220070683A (en) * | 2020-11-23 | 2022-05-31 | 주식회사 성부 | Method for creating autonomous driving paths in agricultural machinery |
WO2024122967A1 (en) * | 2022-12-06 | 2024-06-13 | 전찬우 | Location information-based digital agricultural machine operation system |
CN117848349A (en) * | 2024-01-11 | 2024-04-09 | 海南大学 | Crawler-type agricultural machinery navigation method and system when navigation RTK signal is lost |
Also Published As
Publication number | Publication date |
---|---|
KR102247523B1 (en) | 2021-05-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR102247523B1 (en) | Agricultural machinery and automatic driving method thereof | |
US10197400B2 (en) | Calibration methods and systems for an autonomous navigation vehicle | |
CN101382431B (en) | Positioning system and method thereof | |
KR102168104B1 (en) | Automatic driving method of agricultural vehicle | |
US11428822B2 (en) | Methods and systems for location determination | |
KR20130050112A (en) | A method and system to control relative position among vehicles using dgps mobile reference station | |
KR20150051747A (en) | Method for determining location of vehicle | |
KR102322538B1 (en) | Navigation device for self-driving vehicle | |
KR20210143696A (en) | Method and apparatus for displaying location of vehicle | |
JP2007333636A (en) | Roadside device, terminal device, and dgps (differential gps) positioning system | |
KR102259086B1 (en) | Speed sprayer of automatic driving | |
CN103946722A (en) | Navigation system and method with location-aware accuracy and/or power adjustments | |
EP4071739A1 (en) | Information processing device, control method, program, and storage medium | |
KR20190119213A (en) | Agricultural machinery and automatic driving method thereof | |
CN107085232B (en) | GPS navigation system and positioning precision testing method thereof | |
CN111295567A (en) | Course determining method, device, storage medium and movable platform | |
KR102209422B1 (en) | Rtk gnss based driving license test vehicle position determination device | |
KR101673749B1 (en) | Positioning system using directive communication and method thereof | |
CN107291073A (en) | A kind of agricultural robot system, method and its device based on AUTONOMOUS TASK | |
JP2019045456A (en) | Positioning system | |
CN116609798A (en) | Navigation system with position correction mechanism and method of operation thereof | |
US8874362B2 (en) | Method and device for determining the location of a vehicle | |
KR20200119092A (en) | Vehicle and localization method thereof | |
JP2013108961A (en) | Positioning device and program | |
KR102036080B1 (en) | Portable positioning device and method for operating portable positioning device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A107 | Divisional application of patent | ||
E902 | Notification of reason for refusal | ||
E701 | Decision to grant or registration of patent right | ||
GRNT | Written decision to grant |