KR102259086B1 - 자율주행가능한 스피드 스프레이어 - Google Patents
자율주행가능한 스피드 스프레이어 Download PDFInfo
- Publication number
- KR102259086B1 KR102259086B1 KR1020190061263A KR20190061263A KR102259086B1 KR 102259086 B1 KR102259086 B1 KR 102259086B1 KR 1020190061263 A KR1020190061263 A KR 1020190061263A KR 20190061263 A KR20190061263 A KR 20190061263A KR 102259086 B1 KR102259086 B1 KR 102259086B1
- Authority
- KR
- South Korea
- Prior art keywords
- speed sprayer
- speed
- sprayer
- processor
- autonomous driving
- Prior art date
Links
- 230000033001 locomotion Effects 0.000 claims abstract description 29
- 239000000126 substance Substances 0.000 claims abstract description 28
- 239000007921 spray Substances 0.000 claims abstract description 17
- 239000007788 liquid Substances 0.000 claims abstract description 9
- 238000005507 spraying Methods 0.000 claims abstract description 6
- 239000013598 vector Substances 0.000 claims description 30
- 239000003638 chemical reducing agent Substances 0.000 abstract description 9
- 239000000243 solution Substances 0.000 description 21
- 238000000034 method Methods 0.000 description 20
- 230000001276 controlling effect Effects 0.000 description 19
- 238000005516 engineering process Methods 0.000 description 9
- 238000013507 mapping Methods 0.000 description 9
- 238000004891 communication Methods 0.000 description 6
- 230000002159 abnormal effect Effects 0.000 description 5
- 238000004590 computer program Methods 0.000 description 4
- 230000006870 function Effects 0.000 description 4
- 230000008859 change Effects 0.000 description 3
- 238000012937 correction Methods 0.000 description 3
- 230000007423 decrease Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 241000251468 Actinopterygii Species 0.000 description 2
- 238000010521 absorption reaction Methods 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 2
- 238000007664 blowing Methods 0.000 description 2
- 239000000470 constituent Substances 0.000 description 2
- 238000011534 incubation Methods 0.000 description 2
- 238000010295 mobile communication Methods 0.000 description 2
- 239000002420 orchard Substances 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 230000032683 aging Effects 0.000 description 1
- 238000007596 consolidation process Methods 0.000 description 1
- 238000001816 cooling Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 238000010790 dilution Methods 0.000 description 1
- 239000012895 dilution Substances 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000002708 enhancing effect Effects 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000000575 pesticide Substances 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 230000001052 transient effect Effects 0.000 description 1
Images
Classifications
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01M—CATCHING, TRAPPING OR SCARING OF ANIMALS; APPARATUS FOR THE DESTRUCTION OF NOXIOUS ANIMALS OR NOXIOUS PLANTS
- A01M7/00—Special adaptations or arrangements of liquid-spraying apparatus for purposes covered by this subclass
- A01M7/0089—Regulating or controlling systems
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01M—CATCHING, TRAPPING OR SCARING OF ANIMALS; APPARATUS FOR THE DESTRUCTION OF NOXIOUS ANIMALS OR NOXIOUS PLANTS
- A01M9/00—Special adaptations or arrangements of powder-spraying apparatus for purposes covered by this subclass
- A01M9/0092—Regulating or controlling systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D55/00—Endless track vehicles
- B62D55/06—Endless track vehicles with tracks without ground wheels
- B62D55/065—Multi-track vehicles, i.e. more than two tracks
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
-
- 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/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
-
- 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
-
- 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
-
- 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/25—Track vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Life Sciences & Earth Sciences (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Pest Control & Pesticides (AREA)
- Environmental Sciences (AREA)
- Physics & Mathematics (AREA)
- Insects & Arthropods (AREA)
- General Physics & Mathematics (AREA)
- Wood Science & Technology (AREA)
- Zoology (AREA)
- Computer Networks & Wireless Communication (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Catching Or Destruction (AREA)
Abstract
본 발명에 따르면 스피드 스프레이어를 이동시키기 위해 스피드 스프레이어의 본체 하부의 양측에 장착되는 적어도 2개의 캐터필러, 본체의 중앙부에 장착되고 약액을 수용하는 약액탱크; 본체의 후방에서 약액을 분무하도록 배치된 분무부; 및 본체의 전방에 설치되는 제어반을 포함하는 자율주행 가능한 스피드 스프레이어가 제공되며, 여기서 캐터필러 각각의 회전축은 상기 구동모터로부터 회전 속도를 변속하기 위한 액추에이터로서 동작하는 감속기를 통해 캐터필러를 구동하기 위한 구동모터에 결합되고, 제어반에는, 상기 스피드 스프레이어의 위치 및 움직임을 감지하기 위한 GNSS(Global Navigation Satellite System) 센서; 자율 주행 경로가 저장된 메모리; 감지된 스피드 스프레이어의 위치 및 움직임에 기초하여 상기 스피드 스프레이어가 상기 자율 주행 경로를 따라 주행하도록 액추에이터를 제어하는 프로세서;를 포함하고, 상기 제어반의 프로세서는 GNSS 센서를 이용하여 스피드 스프레이어의 위치 및 움직임을 감지하고, GNSS 센서의 품질을 판단하고; 감지된 스피드 스프레이어의 위치 및 움직임에 기초하여 상기 스피드 스프레이어가 상기 스피드 스프레이어의 메모리에 저장된 자율 주행 경로를 따라 주행하도록 제어하도록 구성된다.
Description
본 발명은 스피드 스프레이어에 관한 것으로 보다 구체적으로는 자율주행가능한 스피드 스프레이어에 관한 것이다.
농기계 중 하나로 스피드 스프레이어가 알려져 있다. 스피드 스프레이어는 현재 과수원에서 많이 사용하고 있는 과수원용 전용방제기를 지칭한다. 스피드 스프레이어에 탑재되는 분무기는 엔진의 동력을 전달받아 실린더 내부의 플런저를 왕복 펌프 작동을 하게 하여 플런저가 위로 올라갈 때 약액은 여과기를 통과하여 흡입밸브를 위로 올려서 흡수관을 통해 실린더 내로 흡입되고, 플런저가 아래로 내려오면 이때의 압력으로 배출밸브를 밀어 올려 약액이 유치실로 이동되고 압축 된 약액은 유치실에 축적되면서 송출관으로 송출되어 약액의 분사가 이루어지게 되는데, 이때, 약액의 일부는 공기실로 들어가며 나머지는 압력조절장치의 흡수구를 통해 압력조절밸브를 위로 올리면서 여수구를 통하여 약액탱크로 되돌아오게 되며, 이와 같은 과정을 통하여 약액의 압력은 일정하게 유지되며 또한 약액탱크에 역류된 약액에 의해 탱크내의 약액이 서로 뒤섞이게 되며, 엔진의 동력을 이용하여 분무기를 통해 분무하도록 동작된다.
한편 농업 분야는 농업 인구의 감소 및 고령화, 농업 경영비 상승 등으로 농업 여건 개선이 시급한 실정이다. 따라서, 농업 분야의 경쟁력을 갖추어야 하는데, 그 중 가장 중요한 요소가 IT 및 센서 기술과의 접목을 통한 고부가가치 산업으로의 변신이다.
최근 전자 기술의 발전으로, 스피드 스프레이어를 무인으로 운용하고 있다. 일반적으로 자율주행기술은 운전자의 조작없이 자동차 스스로 주행환경을 인식하여 목표 지점까지 운행할 수 있도록 하는 기술로서, 차선이탈 방지시스템과 차량 변경 제어기술, 장애물 회피 기술 등을 이용하여 출발지와 목적지를 입력하면 최적의 주행경로를 선택하여 스스로 주행할 수 있도록 하며, 자율주행기술이 적용된 자동차를 자율주행자동차 또는 무인자동차라 한다.
이러한 자율주행 트랙터에는 GPS를 이용한 위치인식 시스템과, 속도와 방향 및 가속도를 측정하는 IMU(Inertial Mwasurement Unit; 관성항법장치) 기술, 자율주행시 이동 방향을 모니터로 보여주는 하이브리드 EPS(Hybrid Electronic Power Steering) 시스템, 작업경로 생성 및 추종기술 등 4가지의 기술이 접목되어 있다. 자율주행 트랙터와 같은 농업기계는 국내의 열악한 농업환경과 인력난 등을 고려하면, 경쟁력 제고를 위한 필수 선택이라할 수 있지만, 경지면적이 좁고 비탈진 농지가 많은 농업환경으로 인해 국내에는 쉽게 적용되지 못하고 있는 실정이며,
따라서, 본 발명의 목적은 글로벌 항법 위성 시스템(GNSS) 센서를 이용함으로써 비교적 간단하고 저렴한 자율주행가능한 스피드 스프레이서를 제공하는 것을 목적으로 한다.
전술한 과제를 달성하기 위해 본 발명에 따르면, 스피드 스프레이어를 이동시키기 위해 스피드 스프레이어의 본체 하부의 양측에 장착되는 적어도 2개의 캐터필러, 본체의 중앙부에 장착되고 약액을 수용하는 약액탱크; 본체의 후방에서 약액을 분무하도록 배치된 분무부; 및 본체의 전방에 설치되는 제어반을 포함하는 자율주행 가능한 스피드 스프레이어가 제공되며, 여기서 캐터필러 각각의 회전축은 상기 구동모터로부터 회전 속도를 변속하기 위한 액추에이터로서 동작하는 감속기를 통해 캐터필러를 구동하기 위한 구동모터에 결합되고, 제어반에는,
상기 스피드 스프레이어의 위치 및 움직임을 감지하기 위한 GNSS(Global Navigation Satellite System) 센서; 자율 주행 경로가 저장된 메모리; 감지된 스피드 스프레이어의 위치 및 움직임에 기초하여 상기 스피드 스프레이어가 상기 자율 주행 경로를 따라 주행하도록 액추에이터를 제어하는 프로세서;를 포함하고, 상기 제어반의 프로세서는 GNSS 센서를 이용하여 스피드 스프레이어의 위치 및 움직임을 감지하고, GNSS 센서의 품질을 판단하고; 감지된 스피드 스프레이어의 위치 및 움직임에 기초하여 상기 스피드 스프레이어가 상기 스피드 스프레이어의 메모리에 저장된 자율 주행 경로를 따라 주행하도록 제어하도록 구성된다.
전술한 양태에서 자율 주행 경로는, 기설정된 경로를 상기 스피드 스프레이어가 주행하는 동안에 상기 GNSS 센서에서 획득된 데이터에 기반하여 생성된다.
또한 전술한 양태에서 프로세서는 GNSS 센서의 품질의 판단시, GNSS 센서의 품질을 판단하기 위한 인자와 기설정된 기준 값을 비교하고, 인자가 상기 기설정된 기준 값을 만족하는 경우, 현재 시간보다 특정한 시간 이전의 항법해를 통해 예측된 상기 스피드 스프레이어의 현재 위치와 상기 GNSS 센서를 통해 획득된 상기 스피드 스프레이어의 현재 위치를 비교하여 상기 GNSS 센서를 통해 획득되는 스피드 스프레이어의 위치가 양호한 상태인지를 판단하도록 구성된다.
또한 전술한 양태에서 프로세서는 GNSS 센서를 통해 획득된 스피드 스프레이어의 위치가 양호한 것으로 판단되면, 현재 시간의 시간 이전의 항법해를 획득하고, 상기 획득된 항법해에 기초하여 상기 자율 주행 경로 상에서 상기 현재 시간을 기준으로 특정 시간 이후의 제1 위치를 추정하고, 획득된 항법해에 기초하여 상기 현재 시간보다 특정 시간 이후의 제2 위치를 추정하고, 상기 스피드 스프레이어의 현재 위치를 기준으로 상기 제1 위치까지의 제1 벡터와 상기 스피드 스프레이어의 현재 위치를 기준으로 상기 제2 위치까지의 제2 벡터 사이의 방향각 차이를 산출하고, 상기 산출된 방향각 차이에 기초하여 이동 중인 스피드 스프레이어의 이동 방향을 제어하도록 구성된다.
또한 전술한 양태에서 프로세서는 GNSS 센서를 통해 획득된 스피드 스프레이어의 위치가 양호하지 않은 것으로 판단되면, 이동 중인 스피드 스프레이어를 정지시키도록 구성된다.
또한 전술한 양태에서 프로세서는 GNSS 센서를 통해 획득된 스피드 스프레이어의 위치가 양호한 것으로 판단되면, 상기 GNSS 센서에 의해 감지된 상기 스피드 스프레이어의 속도를 기설정된 운용 속도와 비교하여 상기 스피드 스프레이어의 속도를 제어하도록 구성된다.
본 발명의 실시예에 따르면, 비교적 저렴한 GNSS 센서를 이용하여 자율주행가능한 스피드 스프레이서를 제공할 수 있으며, 가격 경쟁력을 대폭 확보할 수 있고, 또한 기존에 비해 빠른 시간에 자율 주행 경로를 생성할 수 있는 자율주행가능한 스피드 스프레이서를 제공할 수 있다.
도 1은 본 발명의 실시예에 따른 자율주행가능한 스피드 스프레이어을 개략적으로 나타낸 사시도.
도 2은 본 발명의 실시예에 따른 자율주행가능한 스피드 스프레이어의 캐터필러 및 그 구동부를 개략적으로 나타낸 도면.
도 3은 본 발명의 실시예에 따른 자율주행가능한 스피드 스프레이어의 분무부 및 그 관련된 부품들을 개략적으로 나타낸 도면.
도 4는 본 발명의 실시예에 따른 자율스피드 스프레이어의 구성을 설명하기 위한 블록도,
도 5는 본 발명의 실시예에 따라 자율 주행 경로를 생성하는 방법을 설명하기 위한 도면,
도 6은 본 발명의 실시예에 따라 GNSS 센서의 이상 여부를 판단하기 위한 방법을 설명하기 위한 흐름도,
도 7 및 6는 본 발명의 실시예에 따라 자율 주행 경로를 갱신하는 방법을 설명하기 위한 도면들,
도 8은 본 발명의 실시예에 따라 스피드 스프레이어의 주행 속도를 제어하는 방법을 설명하기 위한 흐름도,
도 9은 본 발명의 실시예에 따라 스피드 스프레이어의 주행 방향을 제어하는 방법을 설명하기 위한 흐름도.
도 2은 본 발명의 실시예에 따른 자율주행가능한 스피드 스프레이어의 캐터필러 및 그 구동부를 개략적으로 나타낸 도면.
도 3은 본 발명의 실시예에 따른 자율주행가능한 스피드 스프레이어의 분무부 및 그 관련된 부품들을 개략적으로 나타낸 도면.
도 4는 본 발명의 실시예에 따른 자율스피드 스프레이어의 구성을 설명하기 위한 블록도,
도 5는 본 발명의 실시예에 따라 자율 주행 경로를 생성하는 방법을 설명하기 위한 도면,
도 6은 본 발명의 실시예에 따라 GNSS 센서의 이상 여부를 판단하기 위한 방법을 설명하기 위한 흐름도,
도 7 및 6는 본 발명의 실시예에 따라 자율 주행 경로를 갱신하는 방법을 설명하기 위한 도면들,
도 8은 본 발명의 실시예에 따라 스피드 스프레이어의 주행 속도를 제어하는 방법을 설명하기 위한 흐름도,
도 9은 본 발명의 실시예에 따라 스피드 스프레이어의 주행 방향을 제어하는 방법을 설명하기 위한 흐름도.
본 발명의 이점 및 특징, 그리고 그것들을 달성하는 방법은 첨부되는 도면과 함께 상세하게 후술되는 실시예를 참조하면 명확해질 것이다. 그러나, 본 발명은 이하에서 개시되는 실시예에 한정되는 것이 아니라 서로 다른 다양한 형태로 구현될 것이다.
본 명세서에서 본 실시예는 본 발명의 개시가 완전하도록 하며, 본 발명이 속하는 기술 분야에서 통상의 지식을 가진 자에게 발명의 범주를 완전하게 알려주기 위해 제공되는 것이다. 그리고 본 발명은 청구항의 범주에 의해 정의될 뿐이다. 따라서, 몇몇 실시예들에서, 잘 알려진 구성 요소, 잘 알려진 동작 및 잘 알려진 기술들은 본 발명이 모호하게 해석되는 것을 피하기 위하여 구체적으로 설명되지 않는다.
명세서 전체에 걸쳐 동일 참조 부호는 동일 구성 요소를 지칭한다. 그리고, 본 명세서에서 사용된(언급된) 용어들은 실시예들을 설명하기 위한 것이며 본 발명을 제한하고자 하는 것은 아니다. 본 명세서에서, 단수형은 문구에서 특별히 언급하지 않는 한 복수형도 포함한다. 또한, '포함(또는, 구비)한다'로 언급된 구성 요소 및 동작은 하나 이상의 다른 구성요소 및 동작의 존재 또는 추가를 배제하지 않는다.
다른 정의가 없다면, 본 명세서에서 사용되는 모든 용어(기술 및 과학적 용어를 포함)는 본 발명이 속하는 기술분야에서 통상의 지식을 가진 자에게 공통적으로 이해될 수 있는 의미로 사용될 수 있을 것이다. 또 일반적으로 사용되는 사전에 정의되어 있는 용어들은 정의되어 있지 않은 한 이상적으로 또는 과도하게 해석되지 않는다.
이하 첨부된 도면을 참조하여 본 발명의 다양한 실시예에 대해 설명하도록 한다.
도 1은 본 발명에 따른 자율주행가능한 스피드 스프레이어(1)의 외관을 개략적으로 나타낸 사시도이다. 본 발명에 따른 스피드 스프레이어(1)는 스피드 스프레이어(1)를 이동시키기 위해 스피드 스프레이어(1)의 본체 하부에 장착되는 캐터필러(10), 본체의 중앙부에 장착되고 약액을 수용하는 약액탱크(20); 본체의 후방에서 약액을 분무하도록 배치된 분무부(30); 및 본체의 전방에 설치되는 제어반(100)을 포함한다.
도 2는 자율주행가능한 스피드 스프레이어(1)의 내부 구성 중 캐터필러(10) 및 그 관련 구성을 보다 상세하게 나타내기 위해 스피드 스프레이어(1)의 외부 케이스를 제거한 상태를 나타내는 도면이다. 캐터필러(10)는 본체의 양측의 하단에 각각 형성되며 양측의 캐터필러(10)의 구동축(10a)의 각각에는 감속기(reducer)(10b)가 연결되고 감속기(10b)를 통해 캐터필러(10)의 구동력을 생성하기 위한 모터(10c)가 각각 연결된다. 각각의 캐터필러(10) 마다 하나의 구동모터(10c)가 제공됨에 따라 각각의 구동모터(10c)로부터 동일한 토크가 발생되더라도 감속기(10b)의 제어를 통해 캐터필러(10)에 전달되는 힘이 상이할 수 있으며 이를 통해 스피드 스프레이어(1)의 좌측 또는 우측으로의 회전이 가능하게 된다. 구동모터(10)를 동작시키기 위한 배터리(50)는 도 1 및 도 2에 도시된 바와 같이 캐터필터(10)의 상부측에 프레임 등을 통해 배치되고 배터리(50)와 구동모터(10)의 거리가 짧아짐에 따라 구동모터(10)를 구현하기 위한 배선이 단순화될 수 있다.
도 3은 자율주행가능한 스피드 스프레이어(1)의 내부 구성 중 분무부(30) 및 그 관련 구성을 보다 상세하게 나타내기 위해 스피드 스프레이어(1)의 외부 케이스를 제거한 상태를 나타내는 도면이다.
도 3에 도시된 바와 같이, 분무부(30)는 송풍날개(34)를 회전시키기 위한 분무엔진(31), 분무 엔진(31)의 일측에 부착되어 엔진을 냉각하기 위한 라디에이터(31a), 약액을 압축하여 분무하는 스프레이어(32), 분무된 약액을 스피드 스프프레어(1)의 주행방향의 반대 방향으로 송풍하기 위한 송풍날개(34)를 포함한다.
분무 엔진(31)은 날개 회전축(35)을 통해 송풍 날개(34)의 중심에 연결되고, 분무 엔진(31)이 가동되면 날개 회전축(35)이 회전되어 소풍날개(34)가 회전된다.
구체적으로 송풍날개(34)는 그 회전축에 회전풀리가 부착되어 엔진과 연결되는 동력전달장치에 접속되거나 분리되고, 또한 회전풀리 대신에 송풍날개(34)의 회전축에 베벨기어를 부착하고 엔진동력절달장치에 결합된 케이블에 베벨기어를 결합하여 동력전달이 전달가능하도록 구성될 수 있으며, 본 발명은 이에 한정되는 것은 아니고 다양한 방식으로 엔진으로부터의 구동력을 송풍날개(34)를 회전시키도록 변형 또는 수정될 수 있다는 것은 당업자에게 자명하다.
분무 엔진(31)의 측면에는 스프레이어(32)가 배치되는데 스프레이어(32)는 배관을 통해 약액탱크(20)에 연결되어, 약액 탱크(20)로부터 공급되는 약액을 압축하고 압축된 약액을 분사 노즐을 통해 송풍날개(34)를 향해 분사하도록 구성되어 있으며, 스프레이어(32)의 일부분에는 스프레이어(32) 내의 압력을 조절하기 위한 압력조절 핸들(32a)이 더 제공됨으로써 분사되는 약액의 압력을 조절할 수 있다.
제어반(100)의 상부에는 스피드 스프레이어(1)의 위치 및 움직임을 감지하기 위해, GNSS(Global Navigation Satellite System) 센서(121) 및 주행 센서(122)를 포함하는데, GNSS 센서(121)는 우주의 위성에서 송신는 전파를 이용하여 특정 위치의 좌표를 산출하는 센서를 의미하고, 주행 센서(122)는 스피드 스프레이어(1)의 속도, 방향각 등을 측정하기 위한 센서를 통칭한다. 주행 센서(122)는 조향각 센서 및 속도 센서를 포함할 수 있다. 센서부(121,122)에 대해서는 이하의 해당하는 부분에서 보다 구체적으로 설명하도록 한다.
또한 제어반(100)의 상부에는 스피드 스프레이어(1)의 주행 방향에 대해 장애물을 감지하기 위해 1쌍의 카메라(160)를 더 포함하여 스프드 스프레이어(1)가 자율중일 때 전방의 진행 경로에 장애물 등을 감지하고 이를 프로세서에 통보하도록 구성된다.
다음으로 제어반(100)에 대해 이하에 설명한다. 도 4은 본 발명의 하나의 실시예에 따른 스피드 스프레이어(1)의 제어반(100)의 구성을 설명하기 위한 블록도이다.
제어반(100)는 사용자가 탑승하지 않더라도, 미리 설정된 경로를 따라 자율적으로 이동이 가능한 무인 자율주행 기계로 구현될 수 있도록 센서(120), 메모리(130) 및 프로세서(140), 카메라(160)를 포함할 수 있다.
액추에이터부(110)는 스피드 스프레이어(1)의 주행 관련 구성요소를 제어하기 위한 구성이다. 예를 들어, 액추에이터부(110)는 엑셀레이터 액추에이터, 브레이크 액추에이터, 조향각 제어 액추에이터를 포함하여 이루어지고, 엑셀레이터 액추에이터를 통해 스피드 스프레이어(1)에 마련된 캐터필러(10)의 회전 속도를 증가시키거나, 브레이크 액추에이터를 통해 스피드 스프레이어(1)에 마련된 바퀴의 회전 속도를 감소시키거나, 바퀴를 정지시키거나, 조향각 제어 액추에이터를 통해 스피드 스프레이어(1)의 양측의 캐터필러(10)의 회전 속도를 다르게 하여 스피드 스프레이어(1)를 좌측 또는 우측 방향으로 회전시키도록 이루어진다.
또한 액추에이터부(110)는 캐터필러(10)에 구동하기 위해 제공되는 모터(10c) 및 감속기(10a)를 포함하는 구성을 지칭할 수 있으며, 전술한 바와 같이 브레이크 또는 액셀레이터 등과 연관된 구성을 모두 포함하는 구성을 통칭하는 것으로 이해될 수도 있다.
센서(120)는 스피드 스프레이어(1)의 위치 및 움직임을 감지한다. 이를 위해, 센서(120)는 도 4에 도시된 바와 같이 GNSS(Global Navigation Satellite System) 센서(121) 및 주행 센서(122)를 포함할 수 있다.
GNSS 센서(121)는 위성을 이용하여 스피드 스프레이어(1)의 위치, 속도, 방향각 등을 측정할 수 있다. 여기에서, GNSS 센서(121)를 통해 획득되는 스피드 스프레이어(1)의 위치, 속도, 방향각 등을 GNSS 센서(121)의 측위해라 할 수 있다.
GNSS는 우주의 위성에서 송신는 전파를 이용하여 특정 위치의 좌표를 산출하는 시스템을 의미한다. 이와 같이, GNSS는 위성을 이용한다는 점에서, 시간 및 공간에 구애받지 않으며 다른 시스템에 비해 비교적 안정적으로 위치, 속도 및 시간 정보 등을 획득할 수 있다.
GNSS 센서(121)는 위성으로부터 수신된 GNSS 신호를 이용하여 자신의 위치를 결정하고, RTK(Real Time Kinematic) 기준국(300)으로부터 측위 보정 정보를 전달받고, 측위 보정 정보를 이용하여, GNSS 신호를 통해 결정된 자신의 위치를 보정할 수 있다.
한편, 본 발명의 실시예에 따르면, GNSS 센서(121)는 단일 주파수 기반의 저가형 GNSS 센서로 구현될 수 있다. 즉, 스피드 스프레이어(1)의 경우, 드론(drone), 비행체, 선박 등에 비해 상대적으로 저속으로 이동한다는 점에서, 단일 주파수만으로도 충분히 정확한 위치가 측정될 수 있다.
이와 같이, 본 발명의 실시예에 따르면, 단일 주파수 기반의 GNSS 센서를 이용한다는 점에서, 2개 이상의 주파수를 이용하는 센서보다 저렴하게 스피드 스프레이어(1)의 위치를 측정할 수 있게 된다. 이 경우, RTK 기준국(300)은 cm급 정확도를 갖는 위치를 계산할 수 있도록 측위 보정 정보를 생성하여 저가형의 GNSS 센서(121)로 제공할 수 있다.
주행 센서(122)는 스피드 스프레이어(1)의 속도, 방향각 등을 측정할 수 있다. 이를 위해, 주행 센서(122)는 스피드 스프레이어(1)의 방향각을 측정하기 위한 조향각 센서 및 스피드 스프레이어(1)의 속도를 측정하기 위한 속도 센서 등을 포함할 수 있다.
메모리(130)는 자율 주행 경로가 저장된다. 이 경우, 스피드 스프레이어(1)는 사람에 의하지 않고, 무인으로 자율 주행 경로에 따라 자율적으로 주행할 수 있다. 한편 도 4에 도시한 바와 같이 스피드 스프레이어(1)에는 무인 주행으로 스피드 스프레이어(1)를 동작시킬 것인지 아니면 운전자가 직접 차량을 리모콘 등을 통해 주행할 것인지를 선택하기 위한 모드 선택부가 더 제공될 수도 있다.
사용자가 모드 선택부를 통해 수동 주행을 선택한 경우 프로세서는 사용자로부터의 리모콘 조작에 기반하여 차량을 동작시키는 반면 사용자가 모드 선택부를 통해 무인 주행을 선택한 경우 프로세서는 미리 정해진 자율주행모드로 차량을 동작시키게 된다.
자율 주행 경로는 기설정된 경로를 스피드 스프레이어(1)가 주행하는 동안에, GNSS 센서(120)에서 획득된 데이터에 기초하여 생성될 수 있다. 예를 들어, 자율 주행 경로는 스피드 스프레이어(1)가 앞으로 주행할 경로(가령, 경작지, 험로, 도로 등의 경로)를 미리 주행하고, 주행 중에 GNSS 센서(120)로부터 획득된 스피드 스프레이어(1)의 위치, 속도 및 방향각 등에 의해 생성될 수 있다. 이러한 자율 주행 경로를 생성하는 구체적인 방법에 대해서는 후술하도록 한다.
또한, 메모리(130)는 도 4에 도시된, 경로 생성 모듈(141) 및 움직임 제어 모듈(142) 등을 저장할 수 있다. 한편, 도 4에서는 모듈들을 개별적으로 도시하였으나, 적어도 2 개의 모듈들이 조합되어 하나의 유닛으로 구현될 수도 있다는 것은 자명하다.
프로세서(140)는 스피드 스프레이어(1)의 전반적인 동작을 제어한다. 이를 위해, 프로세서(140)는 스피드 스프레이어(1)의 동작을 제어하기 위한 전용 프로세서(예: 임베디드 프로세서), 또는 메모리 장치에 저장된 하나 이상의 소프트웨어 프로그램들을 실행함으로써, 해당 동작들을 수행할 수 있는 범용 프로세서(generic-purpose processor)(예: CPU 또는 application processor) 등으로 구현될 수 있다.
먼저, 프로세서(140)는 스피드 스프레이어(1)의 동작모드를 판단하고 무인주행모드인 경우 먼저 자율 주행 경로를 생성할 수 있다. 이 경우, 프로세서(140)는 경로 생성 모듈(141)을 실행하고, GNSS 센서(121)에서 획득한 데이터를 경로 생성 모듈(141)의 입력으로 하여, 자율 주행 경로를 생성할 수 있다.
구체적으로, 프로세서(140)는 기설정된 경로를 스피드 스프레이어(1)가 주행하는 동안, GNSS 센서(121)를 통해 스피드 스프레이어(1)의 측지 좌표를 획득할 수 있다. 여기에서, 측지 좌표는 위도, 경도 및 타원체고에 대한 정보를 포함할 수 있다.
그리고, 프로세서(140)는 획득된 측지 좌표를 지역 좌표로 변환할 수 있다. 즉, 측지 좌표는 지구 타원체 기반의 좌표라는 점에서, 프로세서(140)는 측지 좌표를 직각 좌표 형식의 지역 좌표로 변환할 수 있다. 여기에서, 지역 좌표는 특정한 기준점을 기준으로 한 x,y 좌표(가령, 특정한 기준점을 기준으로 동쪽, 북쪽 좌표) 및 높이에 대한 정보를 포함할 수 있다.
그리고, 프로세서(140)는 GNSS 센서(121)를 통해 스피드 스프레이어(1)의 방향각을 획득하고, 획득된 방향각에 기초하여 스피드 스프레이어(1)가 이동하는 경로의 형태를 판단할 수 있다. 여기에서, 경로의 형태는 회전 경로 및 직선 경로를 포함할 수 있다.
이 경우, 프로세서(140)는 GNSS 센서(121)를 통해 현재 스피드 스프레이어(1)의 방향각을 현재 시간보다 특정한 시간 이전에 획득한 스피드 스프레이어(1)의 방향각과 비교하여, 스피드 스프레이어(1)가 진행하는 경로가 회전 경로에 해당하는지 또는 직선 경로에 해당하는지를 판단할 수 있다.
구체적으로, 프로세서(140)는 현재 스피드 스프레이어(1)의 방향각과 특정한 시간 이전에 획득한 스피드 스프레이어(1)의 방향각 사이의 차이가 기설정된 값 이상이면 스피드 스프레이어(1)가 진행하는 경로가 회전 경로에 해당하는 것으로 판단하고, 현재 스피드 스프레이어(1)의 방향각과 특정한 시간 이전에 획득한 스피드 스프레이어(1)의 방향각 사이의 차이가 기설정된 값 미만이면, 스피드 스프레이어(1)가 진행하는 경로가 직선 경로에 해당하는 것으로 판단할 수 있다.
이후, 프로세서(140)는 판단된 경로 형태 및 지역 좌표에 기초하여 자율 주행 경로를 생성하고, 생성된 자율 주행 경로를 메모리(130)에 저장할 수 있다.
구체적으로, 프로세서(140)는 판단된 경로 형태에 따라 웨이포인트(웨이포인트s)를 설정하고, 웨이포인트 별로 지역 좌표 및 경로 벡터를 맵핑하여 자율 주행 경로를 생성할 수 있다.
다시 도 4을 참조하면 스피드 스프레이어(1)는 차량의 전방에 배치되는 적어도 2개의 쌍안 카메라(160)를 더 포함하고 쌍안 카메라는 프로세서(140)에 연결되며, 프로세서는 전방 이동 경로상에 장애물이 있는지 여부를 판단하게 되고, 장애물이 존재하는 경우 프로세서(140)는 쌍안 카메라로부터의 위상차 정보를 이용하여 장애물까지의 거리 정보를 파악하고, 현재 스피드 스프레이어(1)의 속도, 조향각에 기반하여 장애물과의 충돌 여부를 판단하게 된다.
장애물과의 출돌이 예상되는 경우 프로세서(140)는 비상 정지를 수행하거나, 다른 자율주행 경로를 탐색하도록 프로세서(140)의 경로 생성 모듈(141)에 명령할 수 있다.
다음으로 도 5를 참조하여 웨이포인트를 설정하는 방법에 대해 설명하도록 한다. 예를 들어, 도 5의 (a)와 같이, 스피드 스프레이어(1)가 지점 211 → 지점 212 → 지점 213 → 지점 214 → 지점 215 → 지점 216 → 지점 217 → 지점 218 → 지점 219를 따라 이동한 경우를 가정한다.
이 경우, 각 지점에 대한 지역 좌표는 특정한 기준점을 기준으로 한 x,y 좌표 및 높이 h로 구성되며, 도 5에서는 각 지점에 대해 (xn,yn,hn)(여기에서, n은 1~9)으로 표시하였다.
이 경우, 프로세서(140)는 지점 211 → 지점 212 → 지점 213을 따라 이동한 경로에 대해서는, 이들 지점 간의 방향각 사이의 차이가 기설정된 값 미만이라는 점에서, 해당 경로는 직선 경로에 해당하는 것으로 판단하고, 지점 213 → 지점 214 → 지점 215 → 지점 216을 따라 이동한 경로에 대해서는, 이들 지점 간의 방향각 사이의 차이가 기설정된 값 이상이라는 점에서, 해당 경로는 곡선 경로에 해당하는 것으로 판단하고, 지점 216 → 지점 217 → 지점 218 → 지점 219를 따라 이동한 경로에 대해서는, 이들 지점 간의 방향각 사이의 차이가 기설정된 값 미만이라는 점에서, 해당 경로는 직선 경로에 해당하는 것으로 판단할 수 있다.
이 경우, 프로세서(140)는 직선 경로에 포함된 지점에 대해서는, 직선 경로의 시작점과 끝점을 웨이포인트로 설정할 수 있다. 그리고, 프로세서(140)는 웨이포인트에 지역 좌표를 맵핑하고, 시작점에서 끝점을 향하는 경로 벡터를 시작점의 웨이포인트에 맵핑하여, 직선 경로에 대한 자율 주행 경로를 생성할 수 있다.
또한, 프로세서(140)는 곡선 경로에 포함된 지점에 대해서는, 곡선 경로에 포함된 지점들을 웨이포인트로 설정할 수 있다. 그리고, 프로세서(140)는 웨이포인트에 지역 좌표를 맵핑하고, 각 지점에서 다음 지점을 향하는 경로 벡터를 각 지점의 웨이포인트에 맵핑하여, 곡선 경로에 대한 자율 주행 경로를 생성할 수 있다.
예를 들어, 도 5의 (a)에서, 스피드 스프레이어(1)가 지점 211 → 지점 212 → 지점 213을 따라 이동한 경로는 직선 경로에 해당한다는 점에서, 프로세서(140)는 도 5의 (b)와 같이, 지점 211 및 지점 213을 해당 경로에 대한 웨이포인트로 설정하고, 지역 좌표 (x1,y1,h1)를 웨이포인트 1(즉, 지점 211)에 맵핑하고, 지역 좌표 (x3,y3,h3)를 웨이포인트 2(즉, 지점 213)에 맵핑하고, 웨이포인트 1에서 웨이포인트 2를 잇는 벡터(221)를 웨이포인트 1(즉, 지점 211)에 맵핑하여, 스피드 스프레이어(1)가 지점 211 → 지점 212 → 지점 213을 따라 이동한 경로에 대한 자율 주행 경로를 생성할 수 있다.
또한, 도 5의 (a)에서, 스피드 스프레이어(1)가 지점 213 → 지점 214 → 지점 215 → 지점 216을 따라 이동한 경로는 곡선 경로에 해당한다는 점에서, 프로세서(140)는 도 5의 (b)와 같이, 지점 213, 지점 214, 지점 215 및 지점 216을 해당 경로에 대한 웨이포인트로 설정하고, 지역 좌표 (x3,y3,h3)를 웨이포인트 2(즉, 지점 213)에 맵핑하고, 지역 좌표 (x4,y4,h4)를 웨이포인트 3(즉,지점 214)에 맵핑하고, 지역 좌표 (x5,y5,h5)를 웨이포인트 4(즉, 지점 215)에 맵핑하고, 지역 좌표 (x6,y6,h6)를 웨이포인트 5(즉, 지점 216)에 맵핑하고, 웨이포인트 2에서 웨이포인트 3을 잇는 벡터(222)를 웨이포인트 2(즉, 지점 213)에 맵핑하고, 웨이포인트 3에서 웨이포인트 4를 잇는 벡터(223)를 웨이포인트 3(즉, 지점 214)에 맵핑하고, 웨이포인트 4에서 웨이포인트 5를 잇는 벡터(224)를 웨이포인트 4(즉, 지점 215)에 맵핑하여, 지점 213 → 지점 214 → 지점 215 → 지점 216을 따라 이동한 경로에 대한 자율 주행 경로를 생성할 수 있다.
또한, 도 5의 (a)에서, 스피드 스프레이어(1)가 지점 216 → 지점 217 → 지점 218 → 지점 219를 따라 이동한 경로는 직선 경로에 해당한다는 점에서, 프로세서(140)는 도 5의 (b)와 같이, 지점 216 및 지점 219를 해당 경로에 대한 웨이포인트로 설정하고, 지역 좌표 (x6,y6,h6)를 웨이포인트 5(즉, 지점 216)에 맵핑하고, 지역 좌표 (x9,y9,h9)를 웨이포인트 6(즉, 지점 219)에 맵핑하고, 웨이포인트 5에서 웨이포인트 6을 잇는 벡터(225)를 웨이포인트 5(즉, 지점 216)에 맵핑하여, 스피드 스프레이어(1)가 지점 216 → 지점 217 → 지점 218 → 지점 219를 따라 이동한 경로에 대한 자율 주행 경로를 생성할 수 있다.
이와 같이, 본 발명의 실시예에 따르면, 자율 주행을 위해, 경로 및 해당 경로 주변을 포함하는 지도 전체를 저장하는 것이 아니라, 스피드 스프레이어(1)가 실제로 주행할 경로를 미리 주행하여 해당 경로에 대한 정보만을 저장할 수 있다. 또한, 해당 경로에서 획득한 모든 위치 관련 정보를 저장하는 것이 아니라, 경로의 형태에 따라 위치 관련 정보를 선별적으로 저장하여 자율 주행 경로를 생성할 수 있다.
또한 이와 같이, 본 발명의 실시예에 따르면 스피드 스프레이어(1)가 생성된 자율 주행 경로를 따라 이동하는 경우에 장애물을 만나게 되더라도 프로세서(140)는 카메라(160)로부터의 입력에 기반하여 충돌여부를 판단하고 다른 경로를 탐색하도록 함으로써 보다 안정적으로 스피드 스프레이어(1)를 자율주행시킬 수 있다.
이에 따라, 본 발명의 실시예에 따르면, 고가의 센서가 부착된 드론 또는 MMS(Mobile Mapping System) 등을 이용하지 않아도, 최적의 자율 주행 경로를 생성할 수 있다는 점에서, 기존에 비해 시간 및 경제적인 측면에서 효율성이 극대화될 수 있다.
한편, 프로세서(140)는 자율 주행 경로를 따라 스피드 스프레이어(1)가 주행하도록 제어할 수 있다. 구체적으로, 프로세서(140)는 센서(120)를 통해 감지된 스피드 스프레이어(1)의 위치 및 움직임에 기초하여 스피드 스프레이어(1)가 자율 주행 경로를 따라 주행하도록 액추에이터부(110)를 제어할 수 있다. 이 경우, 프로세서(140)는 GNSS 센서(121)의 이상 여부에 대해 판단하고, 그에 따라, 스피드 스프레이어(1)의 주행을 제어할 수 있다.
이하에서는 도 6를 참조하여 GNSS 센서(121)의 이상 여부에 대해 판단하는 방법에 대해 보다 구체적으로 설명하도록 한다.
먼저, 단계 S305에서 GNSS 센서(121)로부터 품질 판단 인자를 수신한다. 이어서 단계 S310에서, 프로세서(140)는 GNSS 센서(121)의 품질을 판단하기 위한 인자와 기설정된 기준값을 비교한다. 여기에서, 품질 판단 인자는 GNSS 센서(121)의 모호수 종류, 위치 정밀도, 위성의 개수, DOP(Dilution Of Precision) 중 적어도 하나를 포함할 수 있으며, 이러한 정보는 GNSS 센서(121)로부터 획득될 수 있다.
이 경우, 단계 S320에서 프로세서(140)는 품질 판단 인자가 기설정된 기준값을 만족하지 않는 경우, 단계는 S330으로 진행되고 현재 위치 상태가 불량한 것으로 판단할 수 있다. 이와 같이, 프로세서(140)는 품질 판단 인자가 기설정된 기준값을 만족하지 않으면 GNSS 센서(121)로부터 획득되는 데이터의 정확도가 떨어지는 것으로 볼 수 있다. 이에 따라, 프로세서(140)는 GNSS 센서(121)로부터 획득되는 위치 관련 정보를 스피드 스프레이어(1)의 주행의 제어에 이용하지 않으며, 스피드 스프레이어(1)가 주행 중인 경우에는 스피드 스프레이어(1)의 주행을 멈추도록 액추에이터부(110)를 제어할 수 있다.
예를 들어, 프로세서(140)는 케터필러의 구동을 중단시키기 위한 제어 신호를 생성하고, 생성된 제어 신호를 액추에이터부(110)로 제공할 수 있다. 이 경우, 액추에이터부(110)는 프로세서(140)로부터 제공받은 제어 신호에 따라 브레이크 액추에이터 또는 감속기를 구동하여, 케터필러의 구동을 중단시킬 수 있다.
한편, 프로세서(140)는 품질 판단 인자가 기설정된 기준값을 만족하는 경우(S320-Y), GNSS 센서(121)를 통해 획득된 데이터를 메모리(130)에 저장한다(S340). 여기에서, GNSS 센서(121)를 통해 획득된 데이터는 스피드 스프레이어(1)의 위치, 속도 및 방향각 등을 포함할 수 있다.
이후, 프로세서(140)는 현재 시간보다 특정한 시간 이전의 항법해(navigation solution)를 통해 스피드 스프레이어(1)의 현재 위치를 예측한다(350).
즉, 프로세서(140)는 현재 시간보다 특정한 시간 이전에 GNSS 센서(121)를 통해 획득된 데이터를 이용하여, 해당 시간으로부터 특정한 시간 이후에서의 스피드 스프레이어(1)의 위치 즉, 현재 시간에서의 스피드 스프레이어(1)의 위치를 예측할 수 있다.
구체적으로, 프로세서(140)는 이전 시간에서 GNSS 센서(121)를 통해 획득된 스피드 스프레이어(1)의 이전 시간에서의 위치, 이전 시간에서의 속도, 이전 시간에서의 방향각과, 이전 시간과 현재 시간 사이의 시간 차이를 이용하여, 현재 시간에서의 스피드 스프레이어(1)의 위치를 예측할 수 있다.
즉, 프로세서(140)는 스피드 스프레이어(1)가 이전 시간에서의 위치부터 이전 시간에서의 방향을 따라 이전 시간에서의 속도로 시간 차이 동안 이동한 경우, 현재 시간에 스피드 스프레이어(1)가 도달할 위치를 현재 시간에서의 스피드 스프레이어(1)의 위치로 예측할 수 있다.
그리고, 프로세서(140)는 GNSS 기반으로 현재 스피드 스프레이어(1)의 위치를 측정할 수 있다(S360). 즉, 프로세서(140)는 현재 시간에 GNSS 센서(121)를 통해 스피드 스프레이어(1)의 현재 위치를 획득할 수 있다.
이후, 프로세서(140)는 예측된 스피드 스프레이어(1)의 현재 위치와 GNSS 센서(121)를 통해 획득한 스피드 스프레이어(1)의 현재 위치를 비교하여, GNSS 센서(121)를 통해 획득되는 스피드 스프레이어(1)의 위치가 양호한 상태인지를 판단할 수 있다.
구체적으로, 프로세서(140)는 예측된 스피드 스프레이어(1)의 현재 위치와 GNSS 센서(121)를 통해 획득한 스피드 스프레이어(1)의 현재 위치 사이의 거리 차이를 산출할 수 있다(S370).
그리고, 프로세서(140)는 거리 차이가 기준값을 만족하지 않는 경우(S380-N)(즉, 거리 차이가 기설정된 기준값을 초과하는 경우), 현재 위치 상태가 불량한 것으로 판단할 수 있다(S330). 즉, 프로세서(140)는 거리 차이가 기준값을 만족하지 않는 경우, GNSS 센서(121)에서 측정되는 스피드 스프레이어(1)의 위치가 불량한 것으로 판단할 수 있다.
이와 같이, GNSS 센서(121)에서 측정되는 스피드 스프레이어(1)의 위치가 불량한 것으로 판단된 경우, 프로세서(140)는 GNSS 센서(121)로부터 획득되는 위치 관련 정보를 스피드 스프레이어(1)의 주행의 제어에 이용하지 않으며, 스피드 스프레이어(1)가 주행 중인 경우에는 스피드 스프레이어(1)의 주행을 멈추도록 액추에이터부(110)를 제어할 수 있다(S380).
한편, 프로세서(140)는 거리 차이가 기준값을 만족하는 경우(S380-Y)(즉, 거리 차이가 기설정된 기준값 이하인 경우), 현재 위치 상태가 양호한 것으로 판단할 수 있다(S290). 즉, 프로세서(140)는 거리 차이가 기준값을 만족하는 경우, GNSS 센서(121)에서 측정되는 스피드 스프레이어(1)의 위치가 양호한 것으로 판단할 수 있다.
이 경우, GNSS 센서(121)에서 측정되는 스피드 스프레이어(1)의 위치가 양호한 것으로 판단된 경우, 프로세서(140)는 GNSS 센서(121)에서 측정되는 위치 관련 데이터를 이용하여 스피드 스프레이어(1)의 주행을 제어할 수 있다.
이와 같이, 본 발명의 실시예에 따르면, 주변 환경에 따라 GNSS 센서(121)에서 스피드 스프레이어(1)의 위치와 관련하여 부정확한 데이터가 측정될 수 있다는 점에서, 스피드 스프레이어(1)의 주행을 제어할 때, GNSS 센서(121)에서 획득되는 데이터의 이상 여부를 판단하고, 그 결과에 따라 스피드 스프레이어(1)의 주행을 제어할 수 있다는 점에서, 보다 정확히 자율 주행을 제어할 수 있게 된다.
한편, 프로세서(140)는 자율 주행 경로를 갱신하고, 갱신된 자율 주행 경로를 따라 스피드 스프레이어(1)가 주행하도록 제어할 수 있다.
즉, 프로세서(140)는 스피드 스프레이어(1)가 자율 주행 경로에서 이탈한 경우, 주변에 존재하는 복수의 웨이포인트 중에서 어떠한 웨이포인트가 스피드 스프레이어(1)가 주행하여야 할 목표 지점에 해당하는지를 결정하고, 결정된 웨이포인트에 기초하여 자율 주행 경로를 갱신할 수 있다. 그리고, 프로세서(140)는 갱신된 자율 주행 경로를 따라 스피드 스프레이어(1)가 주행하도록 제어할 수 있다.
먼저, 프로세서(140)는 GNSS 센서(121)를 통해 획득되는 스피드 스프레이어(1)의 위치가 양호한 상태인지를 판단할 수 있다(S410). 이후, 프로세서(140)는 GNSS 센서(121)를 통해 획득되는 스피드 스프레이어(1)의 위치가 양호한 경우, GNSS 센서(121)를 통해 스피드 스프레이어(1)의 현재 위치를 획득할 수 있다(S420).
그리고, 프로세서(140)는 스피드 스프레이어(1)의 현재 위치 및 자율 주행 경로에 기초하여, 스피드 스프레이어(1)가 자율 주행 경로를 이탈하였는지 여부를 판단할 수 있다(S430).
구체적으로, 프로세서(140)는 GNSS 센서(121)를 통해 획득된 스피드 스프레이어(1)의 현재 위치를, 웨이포인트의 위치 및 경로 벡터에 따라 웨이포인트 사이에서 정의되는 위치와 비교하여, 스피드 스프레이어(1)의 현재 위치가 해당 위치들에 포함되지 않거나, 해당 위치들로부터 기설정된 거리 이상 떨어진 경우, 스피드 스프레이어(1)가 자율 주행 경로를 이탈한 것으로 판단할 수 있다.
그리고, 프로세서(140)는 스피드 스프레이어(1)가 자율 주행 경로를 이탈한 것으로 판단된 경우(S430-Y), 스피드 스프레이어(1)의 현재 위치를 기준으로, 경로 벡터와 직교하는 수직선을 판단할 수 있다(S440).
이후, 프로세서(140)는 수직선에 기초하여 자율 주행 경로를 갱신할 수 있다(S450).
구체적으로, 프로세서(140)는 경로 벡터와 직교하는 수직선들 중 가장 거리가 짧은 수직선을 판단하고, 판단된 수직선과 만나는 경로 벡터가 향하는 웨이포인트를 현재 경로를 이탈한 스피드 스프레이어(1)가 이동해야할 새로운 웨이포인트로 설정하여, 자율 주행 경로를 갱신할 수 있다.
예를 들어, 도 8와 같이, 스피드 스프레이어(1)가 자율 주행 경로를 이탈하여, 지점 510에 현재 위치하고, 스피드 스프레이어(1)의 현재 위치(510) 주변에 3 개의 웨이포인트(520, 530, 540)이 존재하는 것으로 가정한다.
이 경우, 프로세서(140)는 스피드 스프레이어(1)의 현재 위치(510)을 시작점으로 하여 웨이포인트 1(520)에서 웨이포인트 2(530)까지의 경로 벡터(550)에 수직한 수직선(570) 및 스피드 스프레이어(1)의 현재 위치(510)을 시작점으로 하여 웨이포인트 2(530)에서 웨이포인트 3(540)까지의 경로 벡터(560)에 수직한 수직선(580)을 판단할 수 있다.
그리고, 프로세서(140)는 수직선(570)과 수직선(580) 사이의 거리를 비교하여, 이들 중 상대적으로 짧은 수직선(570)을 판단하고, 수직선(570)이 만나는 경로 벡터(550)가 향하는 웨이포인트 2(530)를 스피드 스프레이어(1)가 현재 위치(510)에서 이동해야할 웨이포인트로 설정하고, 현재 위치(510)에서 웨이포인트 2(530)을 향하는 경로 벡터(590)를 현재 위치(510)에 대한 위치에 맵핑하여, 자율 주행 경로를 현재 위치(510) → 웨이포인트 2(530) → 웨이포인트 3(540)으로 갱신할 수 있다.
한편, 프로세서(140)는 스피드 스프레이어(1)가 자율 주행 경로를 따라 주행하도록 액추에이터부(110)를 제어할 수 있다.
즉, 프로세서(140)는 스피드 스프레이어(1)가 자율 주행 경로를 따라 이동할 때, 스피드 스프레이어(1)가 자율 주행 경로에서 벗어나지 않고, 일정한 운용 속도로 자율 주행 경로를 따라 주행하도록 액추에이터부(110)를 제어할 수 있다.
이 경우, 프로세서(140)는 움직임 제어 모듈(142)을 실행하고, 센서(120)에서 획득한 데이터, 메모리(130)로부터 획득한 자율 주행 경로에 대한 데이터 등을 움직임 제어 모듈(142)의 입력으로 하여, 액추에이터부(110)를 제어하기 위한 제어 신호를 생성하고, 생성된 제어 신호를 액추에이터부(110)로 출력할 수 있다. 이에 따라, 액추에이터부(110)는 프로세서(140)로부터 제공받은 제어 신호에 따라 엑셀레이터 액추에이터, 브레이크 액추에이터 및 조향각 제어 액추에이터를 구동하여, 스피드 스프레이어(1)의 주행을 제어할 수 있다.
이하에서는 도 9을 참조하여, 스피드 스프레이어(1)의 주행 속도를 제어하는 방법에 대해 설명하도록 한다.
먼저, 프로세서(140)는 GNSS 센서(121)를 통해 획득되는 스피드 스프레이어(1)의 위치가 양호한지 여부를 판단할 수 있다. 이 경우, 프로세서(140)는 도 6에 도시된 방법에 따라 GNSS 센서(121)를 통해 획득되는 스피드 스프레이어(1)의 위치가 양호한지 여부를 판단할 수 있다(S610).
그리고, 프로세서(140)는 GNSS 센서(121)를 통해 획득된 스피드 스프레이어(1)의 위치가 양호하지 않은 것으로 판단되면(S620-N), 이동 중인 스피드 스프레이어(1)를 정지시킬 수 있다.
이 경우, 프로세서(140)는 브레이크 액추에이터를 구동시킬 수 있다(S630). 구체적으로, 프로세서(140)는 바퀴의 구동을 중단시키기 위한 제어 신호를 생성하고, 생성된 제어 신호를 액추에이터부(110)로 제공할 수 있다. 이 경우, 액추에이터부(110)는 프로세서(140)로부터 제공받은 제어 신호에 따라 브레이크 액추에이터(감속기)를 구동하여, 바퀴의 구동을 중단시킬 수 있다.
한편, 프로세서(140)는 GNSS 센서(121)를 통해 획득된 스피드 스프레이어(1)의 위치가 양호한 것으로 판단되면(S620-Y), GNSS 센서(121)에 의해 감지된 스피드 스프레이어(1)의 속도를 기설정된 운용 속도와 비교하여 스피드 스프레이어(1)의 속도를 제어할 수 있다.
이 경우, 프로세서(140)는 GNSS 센서(121)에 의해 감지된 속도가 기설정된 운용 속도를 초과하는 경우, 이동 중인 스피드 스프레이어(1)의 속도를 감소시키고, GNSS 센서(121)에 의해 감지된 속도가 기설정된 운용 속도 미만인 경우, 이동 중인 스피드 스프레이어(1)의 속도를 증가시킬 수 있다.
구체적으로, 프로세서(140)는 GNSS 센서(121)에 의해 감지된 스피드 스프레이어(1)의 현재 속도와 기설정된 운용 속도 간의 차이를 산출할 수 있다(S640).
그리고, 프로세서(140)는 스피드 스프레이어(1)의 현재 속도와 기설정된 운용 속도 간의 차이에 기초하여 스피드 스프레이어(1)의 속도를 제어할 수 있다.
구체적으로, 프로세서(140)는 스피드 스프레이어(1)의 현재 속도와 기설정된 운용 속도 간의 차이가 기설정된 기준값을 초과하는지 여부를 판단할 수 있다(S650).
이때, 프로세서(140)는 스피드 스프레이어(1)의 현재 속도와 기설정된 운용 속도 간의 차이가 기설정된 기준값을 초과하는 경우(S650-Y), 브레이크 액추에이터를 구동할 수 있다(S630).
구체적으로, 프로세서(140)는 스피드 스프레이어(1)의 속도가 기설정된 운용 속도가 되기 위해, 현재 속도에서 감소되어야 하는 속도를 판단하고, 판단된 속도만큼 스피드 스프레이어(1)의 속도를 감소시키기 위한 제어 신호를 생성하여 액추에이터부(110)로 제공할 수 있다. 이 경우, 액추에이터부(110)는 프로세서(140)로부터 제공받은 제어 신호에 따라 브레이크 액추에이터를 구동하여 바퀴의 속도를 감소시킬 수 있다. 이에 따라, 스피드 스프레이어(1)는 기설정된 운용 속도로 주행할 수 있게 된다.
한편, 프로세서(140)는 스피드 스프레이어(1)의 현재 속도와 기설정된 운용 속도 간의 차이가 기설정된 기준값을 초과하지 않은 경우(S650-N), 차이가 기설정된 기준값 미만인지를 판단할 수 있다.
그리고, 프로세서(140)는 스피드 스프레이어(1)의 현재 속도와 기설정된 운용 속도 간의 차이가 기설정된 기준값 미만인 경우(S660-Y), 액추에이터를 구동할 수 있다(S670).
구체적으로, 프로세서(140)는 스피드 스프레이어(1)의 속도가 기설정된 운용 속도가 되기 위해, 현재 속도에서 증가되어야 하는 속도를 판단하고, 판단된 속도만큼 스피드 스프레이어(1)의 속도를 증가시키기 위한 제어 신호를 생성하여 액추에이터부(110)로 제공할 수 있다. 이 경우, 액추에이터부(110)는 프로세서(140)로부터 제공받은 제어 신호에 따라 엑셀레이터 액추에이터를 구동하여, 바퀴의 속도를 증가시킬 수 있다. 이에 따라, 스피드 스프레이어(1)는 기설정된 운용 속도로 주행할 수 있게 된다.
한편, 프로세서(140)는 스피드 스프레이어(1)의 현재 속도와 기설정된 운용 속도 간의 차이가 기설정된 기준값 미만에 해당하지 않는 경우(S660-N), S610 단계로 돌아가 전술한 반복할 수 있다. 결국, 프로세서(140)는 전술한 방법을 통해, 스피드 스프레이어(1)가 기설정된 운용 속도로 자율 주행 경로를 따라 주행하도록 제어할 수 있다.
이하에서는 도 10을 참조하여, 스피드 스프레이어(1)의 주행 방향을 제어하는 방법에 대해 설명하도록 한다.
먼저, 프로세서(140)는 GNSS 센서(121)를 통해 획득되는 스피드 스프레이어(1)의 위치가 양호한지 여부를 판단할 수 있다. 이 경우, 프로세서(140)는 도 6에 도시된 방법에 따라 GNSS 센서(121)를 통해 획득되는 스피드 스프레이어(1)의 위치가 양호한지 여부를 판단할 수 있다.
그리고, 프로세서(140)는 GNSS 센서(121)를 통해 획득되는 스피드 스프레이어(1)의 위치가 양호한 것으로 판단되면, 항법해를 획득한다(S710). 구체적으로, 프로세서(140)는 현재 시간에 GNSS 센서(121)를 통해 스피드 스프레이어(1)의 위치, 속도 및 방향각 등을 획득할 수 있다.
그리고, 프로세서(140)는 획득된 항법해에 기초하여 자율 주행 경로 상에서 현재 시간을 기준으로 특정 시간 이후의 제1 위치를 추정할 수 있으며, 즉, 프로세서(140)는 현재 시간에 GNSS 센서(121)를 통해 획득된 데이터를 이용하여, 현재 시간으로부터 특정한 시간 이후에 스피드 스프레이어(1)가 자율 주행 경로 상에서 주행할 위치를 추정할 수 있다(S720).
구체적으로, 프로세서(140)는 스피드 스프레이어(1)가 현재 시간의 위치로부터 현재 시간의 속도로 특정한 시간 동안 자율 주행 경로를 따라 주행할 경우, 특정한 시간이 경과한 시점에 자율 주행 경로 상에서 도착하는 위치를 특정한 시간 이후에 스피드 스프레이어(1)가 자율 주행 경로 상에서 주행할 위치로 추정할 수 있다.
또한, 프로세서(140)는 획득된 항법해에 기초하여 현재 시간을 기준으로 특정 시간 이후의 제2 위치를 추정할 수 있다.
구체적으로, 프로세서(140)는 스피드 스프레이어(1)가 현재 시간의 위치부터, 자율 주행 경로 상이 아닌, 현재 시간에서의 이동 방향을 따라 현재 시간의 속도로 특정한 시간 동안 주행할 경우, 특정한 시간이 경과한 시점에 도착하는 위치를 스피드 스프레이어(1)가 특정한 시간 이후에 주행할 위치로 추정할 수 있다.
그리고, 프로세서(140)는 스피드 스프레이어(1)의 현재 위치를 기준으로 제1 위치까지의 제1 벡터와 스피드 스프레이어(1)의 현재 위치를 기준으로 제2 위치까지의 제2 벡터 사이의 방향각 차이를 산출할 수 있다(S730).
즉, 프로세서(140)는 스피드 스프레이어(1)의 현재 위치부터 제1 위치를 연결하는 제1 벡터와 현재 위치부터 제2 위치를 연결하는 제2 벡터를 각각 생성하고, 제1 및 제2 벡터 사이의 방향각 차이를 산출할 수 있다.
이후, 프로세서(140)는 산출된 방향각 차이에 기초하여 이동 중인 스피드 스프레이어(1)의 이동 방향을 제어할 수 있다.
구체적으로, 프로세서(140)는 Steering Dynamic Model을 이용하여, 산출된 방향각만큼 스피드 스프레이어(1)의 주행 방향이 변경되기 위하여, 양측의 케퍼필러에 전달되는 구동력을 상이하게 하여 회전하여야 하는 조향각을 산출할 수 있다(S740).
그리고, 프로세서(140)는 산출된 조향각에 기초하여 조향각 제어를 위한 액추에이터를 구동할 수 있다. 즉, 프로세서(140)는 바퀴의 회전축을 산출된 조향각만큼 회전시키기 위한 제어 신호를 생성하여 액추에이터부(110)로 제공할 수 있다. 이 경우, 액추에이터부(110)는 프로세서(140)로부터 제공받은 제어 신호에 따라 조향각 제어 액추에이터를 구동하여 산출된 조향각만큼 스피드 스프레이어(1)를 좌측 방향 또는 우측 방향으로 회전시킬 수 있다. 이에 따라, 스피드 스프레이어(1)는 자율 주행 경로를 벗어나지 않고, 자율 주행 경로를 따라 주행할 수 있게 된다.
한편, 전술한 예에서, 스피드 스프레이어(1)의 주행을 제어하기 위해, 프로세서(140)는 주행 센서(122)에서 획득되는 데이터 가령, 스피드 스프레이어(1)의 속도 및 방향각 등을 이용할 수도 있다.
또한, 전술한 예에서, 프로세서(140)는 갱신된 자율 주행 경로를 이용하여, 특정한 시간 이후에 스피드 스프레이어(1)가 자율 주행 경로 상에서 주행할 위치를 추정할 수 있다.
또한, 전술한 예에서는, 프로세서(140)가 GNSS 센서(121)를 통해 획득되는 스피드 스프레이어(1)의 위치가 양호한 경우를 판단하고, 그에 따라, 스피드 스프레이어(1)의 주행 속도 및 주행 방향을 제어하는 것으로 설명하였으나, 실시 예에 따라, GNSS 센서(121)를 통해 획득되는 스피드 스프레이어(1)의 위치가 양호한지에 대한 판단 없이 GNSS 센서(121)를 통해 획득되는 데이터를 이용하여 스피드 스프레이어(1)의 주행 속도 및 주행 방향을 제어할 수 있음은 물론이다.
한편, 도 4을 참조하면, 통신부(150)는 다양한 유형의 통신 방식에 기초하여 서버(200)와 통신을 수행할 수 있다. 예를 들어, 통신부(150)는 3G(3Generation), LTE(Long Term Evolution) 등의 이동 통신망을 통해, 서버(200)와 통신을 수행할 수 있다.
이 경우, 프로세서(140)는 통신부(150)를 통해 서버(200)와 다양한 데이터를 송수신할 수 있다. 예를 들어, 프로세서(140)는 스피드 스프레이어(1)의 위치, 속도 및 방향각 등을 포함하는 측위해에 정보 및 스피드 스프레이어(1)의 주행/운용 상황에 대한 정보(가령, 스피드 스프레이어(1)의 주행 시작 시간 정보, 주행 시간 정보, 이상 상태에 대한 정보 등) 등을 통신부(150)를 통해 서버(200)로 전송할 수 있다. 또한, 프로세서(140)는 스피드 스프레이어(1)의 동작을 제어하기 위한 제어 정보 및 펌웨어 업데이트를 위한 정보 등을 통신부(150)를 통해 서버(200)로부터 수신할 수 있다.
서버(200)(가령, 스피드 스프레이어 IoT(Internet of Things) 서버)는 사용자나 관리자가 스피드 스프레이어(1)의 운용과 관련된 정보를 확인할 수 있는 IoT 기반의 플랫폼으로, 스피드 스프레이어(1)로부터 제공받은 정보를 포함하는 스피드 스프레이어(1)의 운용과 관련된 각종 정보를 저장할 수 있다. 또한, 서버(200)는 스피드 스프레이어(1)의 운용과 관련된 각종 정보를 사용자나 관리자의 전자 장치(300)로 전송할 수 있다. 예를 들어, 서버(200)는 3G, LTE 등의 이동 통신망을 통해, 스피드 스프레이어(1)의 위치, 속도 및 방향각 등을 포함하는 측위해에 정보 및 스피드 스프레이어(1)의 주행/운용 상황에 대한 정보 등을 전자 장치(300)로 전송할 수 있다.
전자 장치(300)는 스피드 스프레이어(1)를 제어하기 위한 기능을 수행할 수 있다. 이 경우, 전자 장치(300)는 스피드 스프레이어(1)를 제어하기 위한 전용 컨트롤러로 구현되거나, 또는 해당 기능을 실행하기 위한 어플리케이션이 설치된 스마트폰(smartphone) 또는 태블릿 PC(tablet personal computer) 등으로 구현될 수 있다.
이를 위해, 전자 장치(300)는 스피드 스프레이어(1)를 제어하기 위한 유저 인터페이스를 전자 장치에 제공할 수 있다. 유저 인터페이스에는 서버로부터 제공받은 스피드 스프레이어(1)의 현재 운용 상황을 나타내는 정보가 표시될 수 있고, 또한, 스피드 스프레이어(1)를 제어하기 위한 사용자 명령을 입력받는 GUI(Graphical User Interface)가 표시될 수 있다.
다음으로 본 발명의 실시예에 따른 스피드 스프레이어의 자율 주행 방법을 이하에 설명한다.
먼저 프로세서는 센서를 이용하여 스피드 스프레이어의 위치 및 움직임을 감지한다. 그리고, 감지된 스피드 스프레이어의 위치 및 움직임에 기초하여 스피드 스프레이어가 메모리에 저장된 자율 주행 경로를 따라 주행하도록 제어한다. 여기에서 센서는 GNSS(Global Navigation Satellite System) 센서를 포함할 수 있다. 자율 주행 경로는 기설정된 경로를 스피드 스프레이어가 주행하는 동안에 GNSS 센서에서 획득된 데이터에 기초하여 생성될 수 있다. 여기에서, GNSS 센서에서 획득된 데이터는 스피드 스프레이어의 위치, 속도 및 방향각을 포함할 수 있다.
한편, 기설정된 경로를 스피드 스프레이어가 주행하는 동안, GNSS 센서를 통해 스피드 스프레이어의 측지 좌표를 획득하고 획득된 측지 좌표를 지역 좌표로 변환하고, GNSS 센서를 통해 스피드 스프레이어의 방향각을 획득하고, 획득된 방향각에 기초하여 스피드 스프레이어가 이동하는 경로의 형태를 판단하고, 지역 좌표 및 판단된 경로 형태에 기초하여 자율 주행 경로를 생성하고, 생성된 자율 주행 경로를 스피드 스프레이어에 저장할 수 있다.
한편, 스피드 스프레이어에 저장된 자율 주행 경로를 따라 주행하도록 제어하는 단계는 GNSS 센서의 품질을 판단하기 위한 인자와 기설정된 기준 값을 비교하고, 인자가 기설정된 기준 값을 만족하는 경우, 현재 시간보다 특정한 시간 이전의 항법해를 통해 예측된 스피드 스프레이어의 현재 위치와 GNSS 센서를 통해 획득된 스피드 스프레이어의 현재 위치를 비교하여 GNSS 센서를 통해 획득되는 스피드 스프레이어의 위치가 양호한 상태인지를 판단하고, 판단된 상태에 따라 스피드 스프레이어의 주행을 제어할 수 있다. 이 경우, GNSS 센서를 통해 획득된 스피드 스프레이어의 위치가 양호하지 않은 것으로 판단되면, 이동 중인 스피드 스프레이어를 정지시킬 수 있다.
또한, GNSS 센서를 통해 획득된 스피드 스프레이어의 위치가 양호한 것으로 판단되면, GNSS 센서에 의해 감지된 스피드 스프레이어의 속도를 기설정된 운용 속도와 비교하여 스피드 스프레이어의 속도를 제어할 수 있다. 구체적으로, 감지된 속도가 기설정된 운용 속도를 초과하는 경우, 이동 중인 스피드 스프레이어의 속도를 감소시키고, 감지된 속도가 기설정된 운용 속도 미만인 경우, 이동 중인 스피드 스프레이어의 속도를 증가시킬 수 있다.
한편, 스피드 스프레이어에 저장된 자율 주행 경로를 따라 주행하도록 제어하는 단계는 GNSS 센서를 통해 획득된 스피드 스프레이어의 위치가 양호한 것으로 판단되면, 현재 시간의 시간 이전의 항법해를 획득하고, 획득된 항법해에 기초하여 자율 주행 경로 상에서 현재 시간을 기준으로 특정 시간 이후의 제1 위치를 추정하고, 획득된 항법해에 기초하여 현재 시간보다 특정 시간 이후의 제2 위치를 추정하고, 스피드 스프레이어의 현재 위치를 기준으로 제1 위치까지의 제1 벡터와 스피드 스프레이어의 현재 위치를 기준으로 제2 위치까지의 제2 벡터 사이의 방향각 차이를 산출하고, 산출된 방향각 차이에 기초하여 이동 중인 스피드 스프레이어의 이동 방향을 제어할 수 있다.
한편, 이와 관련하여 스피드 스프레이어의 자율 주행을 제어하는 구체적인 방법은 상술한 바 있다. 한편, 본 개시의 다양한 실시 예들은 기기(machine)(예: 컴퓨터)로 읽을 수 있는 저장 매체(machine-readable storage media에 저장된 명령어를 포함하는 소프트웨어로 구현될 수 있다. 기기는, 저장 매체로부터 저장된 명령어를 호출하고, 호출된 명령어에 따라 동작이 가능한 장치로서, 개시된 실시 예들에 따른 전자 장치(예: 전자 장치(A))를 포함할 수 있다. 상기 명령이 프로세서에 의해 실행될 경우, 프로세서가 직접, 또는 상기 프로세서의 제어하에 다른 구성요소들을 이용하여 상기 명령에 해당하는 기능을 수행할 수 있다.
명령은 컴파일러 또는 인터프리터에 의해 생성 또는 실행되는 코드를 포함할 수 있다. 기기로 읽을 수 있는 저장매체는, 비일시적(non-transitory) 저장매체의 형태로 제공될 수 있다. 여기서, '비일시적'은 저장매체가 신호(signal)를 포함하지 않으며 실재(tangible)한다는 것을 의미할 뿐 데이터가 저장매체에 반영구적 또는 임시적으로 저장됨을 구분하지 않는다.
일 시예에 따르면, 본 발명에 개시된 다양한 실시 예들에 따른 방법은 컴퓨터 프로그램 제품(computer program product)에 포함되어 제공될 수 있다. 컴퓨터 프로그램 제품은 상품으로서 판매자 및 구매자 간에 거래될 수 있다. 컴퓨터 프로그램 제품은 기기로 읽을 수 있는 저장 매체(예: compact disc read only memory (CD-ROM))의 형태로, 또는 어플리케이션 스토어(예: 플레이 스토어TM)를 통해 온라인으로 배포될 수 있다. 온라인 배포의 경우에, 컴퓨터 프로그램 제품의 적어도 일부는 제조사의 서버, 어플리케이션 스토어의 서버, 또는 중계 서버의 메모리와 같은 저장 매체에 적어도 일시 저장되거나, 임시적으로 생성될 수 있다.
다양한 실시 예들에 따른 구성 요소(예: 모듈 또는 프로그램) 각각은 단수 또는 복수의 개체로 구성될 수 있으며, 전술한 해당 서브 구성 요소들 중 일부 서브 구성 요소가 생략되거나, 또는 다른 서브 구성 요소가 다양한 실시예에 더 포함될 수 있다. 대체적으로 또는 추가적으로, 일부 구성 요소들(예: 모듈 또는 프로그램)은 하나의 개체로 통합되어, 통합되기 이전의 각각의 해당 구성 요소에 의해 수행되는 기능을 동일 또는 유사하게 수행할 수 있다. 다양한 실시예들에 따른, 모듈, 프로그램 또는 다른 구성 요소에 의해 수행되는 동작들은 순차적, 병렬적, 반복적 또는 휴리스틱하게 실행되거나, 적어도 일부 동작이 다른 순서로 실행되거나, 생략되거나, 또는 다른 동작이 추가될 수 있다.
이상의 설명은 본 발명의 기술 사상을 예시적으로 설명한 것에 불과한 것으로, 본 발명이 속하는 기술분야에서 통상의 지식을 갖는 자라면 본 발명의 본질적인 특성에서 벗어나지 않는 범위에서 다양한 수정 및 변형이 가능할 것이다. 따라서, 본 발명에 게시된 실시예는 본 발명의 기술 사상을 한정하기 위한 것이 아닌 설명을 위한 것이고, 이런 실시예에 의하여 본 발명의 기술 사상의 범위가 한정되는 것은 아니다.
따라서 본 발명의 보호 범위는 전술한 실시예에 의해 제한되기 보다는 아래의 청구범위에 의하여 해석되어야하며, 그와 동등한 범위 내에 있는 모든 기술 사상은 본 발명의 권리범위에 포함되는 것으로 해석되어야 할 것이다.
1 : 스피드 스프레이어 10: 캐터필러
20: 약제 탱크 30: 분무부
10a: 캐터필러 구동축 10b: 감속기(또는 액추에이터)
10c: 모터 50: 배터리
31: 송풍날개용 엔진 31a: 라디에이터
32: 스프레이어 32a: 압력조절핸들
35: 송풍날개 회전축 34: 송풍날개
33: 에어 벤트 110 : 액추에이터부
120 : 센서 130 : 메모리
140 : 프로세서
20: 약제 탱크 30: 분무부
10a: 캐터필러 구동축 10b: 감속기(또는 액추에이터)
10c: 모터 50: 배터리
31: 송풍날개용 엔진 31a: 라디에이터
32: 스프레이어 32a: 압력조절핸들
35: 송풍날개 회전축 34: 송풍날개
33: 에어 벤트 110 : 액추에이터부
120 : 센서 130 : 메모리
140 : 프로세서
Claims (6)
- 스피드 스프레이어를 이동시키기 위해 스피드 스프레이어의 본체 하부의 양측에 장착되는 적어도 2개의 캐터필러, 캐터필러에 동력을 전가하는 구동부, 본체에 장착되고 약액을 수용하는 약액탱크; 본체의 후방에서 약액을 분무하도록 배치된 분무부; 및 본체의 전방에 설치되는 제어반을 포함하는 자율주행 가능한 스피드 스프레이어에 있어서,
상기 제어반에는, 상기 스피드 스프레이어의 위치 및 움직임을 감지하기 위한 GNSS(Global Navigation Satellite System) 센서; 자율 주행 경로가 저장된 메모리; 및 감지된 스피드 스프레이어의 위치 및 움직임에 기초하여 상기 스피드 스프레이어가 상기 자율 주행 경로를 따라 주행하도록 액추에이터를 제어하는 프로세서;를 포함하고,
상기 제어반의 프로세서는, GNSS 센서를 이용하여 스피드 스프레이어의 위치 및 움직임을 감지하고; GNSS 센서의 품질을 판단하고; 감지된 스피드 스프레이어의 위치 및 움직임에 기초하여 상기 스피드 스프레이어가 상기 스피드 스프레이어의 메모리에 저장된 자율 주행 경로를 따라 주행하도록 제어하도록 구성되고,
상기 자율 주행 경로는, 기설정된 경로를 상기 스피드 스프레이어가 주행하는 동안에 상기 GNSS 센서에서 획득된 데이터에 기반하여 생성되며,
프로세서에서의 GNSS 센서의 품질의 판단은, GNSS 센서의 품질을 판단하기 위한 인자와 기설정된 기준 값을 비교하고, 인자가 상기 기설정된 기준 값을 만족하는 경우, 현재 시간보다 특정한 시간 이전의 항법해를 통해 예측된 상기 스피드 스프레이어의 현재 위치와 상기 GNSS 센서를 통해 획득된 상기 스피드 스프레이어의 현재 위치를 비교하여 상기 GNSS 센서를 통해 획득되는 스피드 스프레이어의 위치가 양호한 상태인지를 판단하고
프로세서는 GNSS 센서를 통해 획득된 스피드 스프레이어의 위치가 양호한 것으로 판단되면, 현재 시간의 시간 이전의 항법해를 획득하고, 상기 획득된 항법해에 기초하여 상기 자율 주행 경로 상에서 상기 현재 시간을 기준으로 특정 시간 이후의 제1 위치를 추정하고, 획득된 항법해에 기초하여 상기 현재 시간보다 특정 시간 이후의 제2 위치를 추정하고, 상기 스피드 스프레이어의 현재 위치를 기준으로 상기 제1 위치까지의 제1 벡터와 상기 스피드 스프레이어의 현재 위치를 기준으로 상기 제2 위치까지의 제2 벡터 사이의 방향각 차이를 산출하고, 상기 산출된 방향각 차이에 기초하여 이동 중인 스피드 스프레이어의 이동 방향을 제어하도록 구성되고,
프로세서는 GNSS 센서를 통해 획득된 스피드 스프레이어의 위치가 양호하지 않은 것으로 판단되면, 이동 중인 스피드 스프레이어를 정지시키도록 구성되고,
프로세서는 GNSS 센서를 통해 획득된 스피드 스프레이어의 위치가 양호한 것으로 판단되면, 상기 GNSS 센서에 의해 감지된 상기 스피드 스프레이어의 속도를 기설정된 운용 속도와 비교하여 상기 스피드 스프레이어의 속도를 제어하도록 구성되며,
프로세서는 스피드 스프레이어가 자율 주행 경로에서 이탈한 경우, 주변에 존재하는 복수의 웨이포인트 중에서 어떤 웨이포인트가 스피드 스프레이어가 주행하여야 할 목표 지점에 해당하는지를 결정하고, 결정된 웨이포인트에 기초하여 자율 주행 경로를 갱신하도록 구성되며,
자율 주행 경로를 갱신하기 위해 프로세서는 GNSS 센서를 통해 스피드 스프레이어의 현재 위치를 획득하고, 프로세서는 GNSS 센서를 통해 획득된 스피드 스프레이어의 현재 위치를, 웨이포인트의 위치 및 경로 벡터에 따라 웨이포인트 사이에서 정의되는 위치와 비교하여, 스피드 스프레이어의 현재 위치가 해당 위치들에 포함되지 않거나, 해당 위치들로부터 미리설정된 거리 이상 떨어진 경우, 스피드 스프레이어가 자율 주행 경로를 이탈한 것으로 판단하고, 스피드 스프레이어가 자율 주행 경로를 이탈한 것으로 판단된 경우, 프로세서는 현재 스피드 스페레이어의 위치로부터 경로 벡터와 직교하는 수직선들 중 최단거리의 수직선을 판단하고, 판단된 수직선과 만나는 경로 벡터가 향하는 웨이포인트를 현재 경로를 이탈 중인 스피드 스프레이어가 이동해야할 새로운 웨이포인트로 설정하여, 자율 주행 경로를 갱신하도록 구성된 것을 특징으로하는
자율주행 가능한 스피드 스프레이어. - 삭제
- 삭제
- 삭제
- 삭제
- 삭제
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020190061263A KR102259086B1 (ko) | 2019-05-24 | 2019-05-24 | 자율주행가능한 스피드 스프레이어 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020190061263A KR102259086B1 (ko) | 2019-05-24 | 2019-05-24 | 자율주행가능한 스피드 스프레이어 |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20200134971A KR20200134971A (ko) | 2020-12-02 |
KR102259086B1 true KR102259086B1 (ko) | 2021-06-01 |
Family
ID=73791853
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020190061263A KR102259086B1 (ko) | 2019-05-24 | 2019-05-24 | 자율주행가능한 스피드 스프레이어 |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR102259086B1 (ko) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
IT202100023093A1 (it) * | 2021-09-07 | 2023-03-07 | Univ Bologna Alma Mater Studiorum | Veicolo agricolo per agricoltura di precisione |
KR102603095B1 (ko) * | 2023-02-06 | 2023-11-17 | 주식회사 준시스템 | 원격조정이 가능한 다목적 농업용 이동장치 |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102562083B1 (ko) * | 2021-02-23 | 2023-08-02 | 주식회사 아세아텍 | 반 자율주행 과수방제장치 |
KR20220165999A (ko) | 2021-06-09 | 2022-12-16 | 한국전자통신연구원 | 농기계 주행 가이드 방법 및 장치 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000029521A (ja) | 1998-07-08 | 2000-01-28 | Fuji Heavy Ind Ltd | 自律走行方法及び自律走行車 |
JP2016086727A (ja) * | 2014-11-04 | 2016-05-23 | ヤンマー株式会社 | 圃場管理車両 |
JP2017123829A (ja) | 2016-01-15 | 2017-07-20 | 株式会社クボタ | 圃場作業車両 |
JP2019505423A (ja) | 2016-11-24 | 2019-02-28 | バイドゥドットコム タイムズ テクノロジー (ベイジン) カンパニー リミテッドBaidu.com Times Technology (Beijing) Co., Ltd. | 比例、積分及び微分(pid)コントローラを用いた自律走行車のステアリング制御方法及びシステム |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20150113504A (ko) * | 2014-03-31 | 2015-10-08 | 권우혁 | 보행형 스피드 스프레이어 |
KR102125112B1 (ko) * | 2014-05-22 | 2020-06-22 | 얀마 파워 테크놀로지 가부시키가이샤 | 작업 차량의 주행 시스템 |
-
2019
- 2019-05-24 KR KR1020190061263A patent/KR102259086B1/ko active IP Right Grant
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000029521A (ja) | 1998-07-08 | 2000-01-28 | Fuji Heavy Ind Ltd | 自律走行方法及び自律走行車 |
JP2016086727A (ja) * | 2014-11-04 | 2016-05-23 | ヤンマー株式会社 | 圃場管理車両 |
JP2017123829A (ja) | 2016-01-15 | 2017-07-20 | 株式会社クボタ | 圃場作業車両 |
JP2019505423A (ja) | 2016-11-24 | 2019-02-28 | バイドゥドットコム タイムズ テクノロジー (ベイジン) カンパニー リミテッドBaidu.com Times Technology (Beijing) Co., Ltd. | 比例、積分及び微分(pid)コントローラを用いた自律走行車のステアリング制御方法及びシステム |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
IT202100023093A1 (it) * | 2021-09-07 | 2023-03-07 | Univ Bologna Alma Mater Studiorum | Veicolo agricolo per agricoltura di precisione |
KR102603095B1 (ko) * | 2023-02-06 | 2023-11-17 | 주식회사 준시스템 | 원격조정이 가능한 다목적 농업용 이동장치 |
Also Published As
Publication number | Publication date |
---|---|
KR20200134971A (ko) | 2020-12-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR102259086B1 (ko) | 자율주행가능한 스피드 스프레이어 | |
EP3832422B1 (en) | Electronic device and vehicle control method of electronic device, server and method for providing precise map data of server | |
CN108475059B (zh) | 自主视觉导航 | |
JP5506423B2 (ja) | 無人車両の半自律走行システム | |
CN108873902A (zh) | 一种无人驾驶矿用车辆的远程控制方法及装置 | |
KR102168104B1 (ko) | 농업용기계의 자율 주행 방법 | |
TWI716372B (zh) | 自主輔助及導向車輛 | |
KR101879247B1 (ko) | 자율주행 농업기계의 작업경로 설정방법 | |
US20180215393A1 (en) | Autonomously traveling work vehicle | |
US11661084B2 (en) | Information processing apparatus, information processing method, and mobile object | |
US20180373269A1 (en) | Systems and methods using a backup navigational tool for unmanned aerial vehicles delivering merchandise | |
KR20170082165A (ko) | 차량 자율주행 서비스 시스템 및 이를 위한 클라우드 서버 및 그 동작 방법 | |
KR20210037740A (ko) | 작업 차량 제어 장치 | |
KR20190095579A (ko) | 차량의 주행을 보조하는 장치 및 방법 | |
EP2296071A1 (en) | Modular and scalable positioning and navigation system | |
WO2019230098A1 (ja) | 情報処理装置 | |
EP3470947B1 (en) | Method and system for guiding an autonomous vehicle | |
KR20140144921A (ko) | 가상현실을 이용한 무인 자동차의 자율 주행 시뮬레이션 시스템 | |
US20190163201A1 (en) | Autonomous Vehicle Sensor Compensation Using Displacement Sensor | |
US20200056895A1 (en) | Autonomous vehicle waypoint routing | |
JP5187757B2 (ja) | 無人移動体システム | |
US20220157179A1 (en) | Action control device and action control method, and program | |
KR20190119213A (ko) | 농기계 및 그의 자율 주행 방법 | |
KR101673749B1 (ko) | 지향성 통신을 이용한 측위 시스템 및 그 방법 | |
CN114521248A (zh) | 信息处理设备、信息处理方法和程序 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
E902 | Notification of reason for refusal | ||
E701 | Decision to grant or registration of patent right | ||
GRNT | Written decision to grant |