KR20200134971A - Speed sprayer of automatic driving - Google Patents

Speed sprayer of automatic driving Download PDF

Info

Publication number
KR20200134971A
KR20200134971A KR1020190061263A KR20190061263A KR20200134971A KR 20200134971 A KR20200134971 A KR 20200134971A KR 1020190061263 A KR1020190061263 A KR 1020190061263A KR 20190061263 A KR20190061263 A KR 20190061263A KR 20200134971 A KR20200134971 A KR 20200134971A
Authority
KR
South Korea
Prior art keywords
speed sprayer
speed
sprayer
processor
autonomous driving
Prior art date
Application number
KR1020190061263A
Other languages
Korean (ko)
Other versions
KR102259086B1 (en
Inventor
장진만
장영윤
장세윤
Original Assignee
장진만
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 장진만 filed Critical 장진만
Priority to KR1020190061263A priority Critical patent/KR102259086B1/en
Publication of KR20200134971A publication Critical patent/KR20200134971A/en
Application granted granted Critical
Publication of KR102259086B1 publication Critical patent/KR102259086B1/en

Links

Images

Classifications

    • AHUMAN NECESSITIES
    • A01AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01MCATCHING, TRAPPING OR SCARING OF ANIMALS; APPARATUS FOR THE DESTRUCTION OF NOXIOUS ANIMALS OR NOXIOUS PLANTS
    • A01M7/00Special adaptations or arrangements of liquid-spraying apparatus for purposes covered by this subclass
    • A01M7/0089Regulating or controlling systems
    • AHUMAN NECESSITIES
    • A01AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01MCATCHING, TRAPPING OR SCARING OF ANIMALS; APPARATUS FOR THE DESTRUCTION OF NOXIOUS ANIMALS OR NOXIOUS PLANTS
    • A01M9/00Special adaptations or arrangements of powder-spraying apparatus for purposes covered by this subclass
    • A01M9/0092Regulating or controlling systems
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D55/00Endless track vehicles
    • B62D55/06Endless track vehicles with tracks without ground wheels
    • B62D55/065Multi-track vehicles, i.e. more than two tracks
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0268Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/0274Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0278Control 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
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60YINDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
    • B60Y2200/00Type of vehicle
    • B60Y2200/20Off-Road Vehicles
    • B60Y2200/22Agricultural vehicles
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60YINDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
    • B60Y2200/00Type of vehicle
    • B60Y2200/20Off-Road Vehicles
    • B60Y2200/25Track 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

The present invention provides an autonomously drivable speed sprayer to generate an autonomous driving path in a short time. According to the present invention, the autonomously drivable speed sprayer comprises: at least two caterpillars mounted on both sides of the lower body of the speed sprayer to move the speed sprayer; a chemical liquid tank mounted on the central part of the main body and storing a chemical liquid; a spray unit disposed on the rear side of the main body to spray the chemical liquid; and a control panel installed on the front side of the main body. Each rotary shaft of the tracks is coupled to a driving motor for driving the tracks through a reducer operated as an actuator for changing the rotational speed of the driving motor. The control panel comprises: a global navigation satellite system (GNSS) sensor for detecting the position and movement of the speed sprayer; a memory storing an autonomous driving path; and a processor controlling an actuator based on the detected position and movement of the speed sprayer, such that the speed sprayer drives along the autonomous driving path. The processor of the control panel uses the GNSS sensor to detect the position and movement of the speed sprayer, determines the quality of the GNSS sensor, and performs control allowing the speed sprayer to drive along the autonomous driving path stored in the memory based on the detected position and movement of the speed sprayer.

Description

자율주행가능한 스피드 스프레이어{SPEED SPRAYER OF AUTOMATIC DRIVING}Autonomous speed sprayer {SPEED SPRAYER OF AUTOMATIC DRIVING}

본 발명은 스피드 스프레이어에 관한 것으로 보다 구체적으로는 자율주행가능한 스피드 스프레이어에 관한 것이다. The present invention relates to a speed sprayer, and more particularly to a speed sprayer capable of autonomous driving.

농기계 중 하나로 스피드 스프레이어가 알려져 있다. 스피드 스프레이어는 현재 과수원에서 많이 사용하고 있는 과수원용 전용방제기를 지칭한다. 스피드 스프레이어에 탑재되는 분무기는 엔진의 동력을 전달받아 실린더 내부의 플런저를 왕복 펌프 작동을 하게 하여 플런저가 위로 올라갈 때 약액은 여과기를 통과하여 흡입밸브를 위로 올려서 흡수관을 통해 실린더 내로 흡입되고, 플런저가 아래로 내려오면 이때의 압력으로 배출밸브를 밀어 올려 약액이 유치실로 이동되고 압축 된 약액은 유치실에 축적되면서 송출관으로 송출되어 약액의 분사가 이루어지게 되는데, 이때, 약액의 일부는 공기실로 들어가며 나머지는 압력조절장치의 흡수구를 통해 압력조절밸브를 위로 올리면서 여수구를 통하여 약액탱크로 되돌아오게 되며, 이와 같은 과정을 통하여 약액의 압력은 일정하게 유지되며 또한 약액탱크에 역류된 약액에 의해 탱크내의 약액이 서로 뒤섞이게 되며, 엔진의 동력을 이용하여 분무기를 통해 분무하도록 동작된다. One of the agricultural machinery is known as the speed sprayer. The speed sprayer refers to an orchard-only control device that is currently widely used in orchards. The nebulizer mounted on the speed sprayer receives the engine's power to reciprocate the plunger inside the cylinder, and when the plunger rises, the chemical liquid passes through the filter and lifts the suction valve upward, and is sucked into the cylinder through the absorption pipe. When the plunger comes down, the chemical liquid is pushed up at this pressure to push the discharge valve to move the chemical liquid to the indwelling chamber, and the compressed chemical liquid accumulates in the indwelling chamber and is sent to the delivery pipe to inject the chemical liquid. It enters the chamber, and the rest is returned to the chemical liquid tank through the drainage port while raising the pressure control valve through the absorption port of the pressure control device. Through this process, the pressure of the chemical liquid is kept constant, and also by the chemical liquid flowing back into the chemical liquid tank. The chemicals in the tank are mixed with each other, and they are operated to spray through a sprayer using the power of the engine.

한편 농업 분야는 농업 인구의 감소 및 고령화, 농업 경영비 상승 등으로 농업 여건 개선이 시급한 실정이다. 따라서, 농업 분야의 경쟁력을 갖추어야 하는데, 그 중 가장 중요한 요소가 IT 및 센서 기술과의 접목을 통한 고부가가치 산업으로의 변신이다.Meanwhile, in the agricultural sector, improvement of agricultural conditions is urgently due to the decline of the agricultural population, an aging population, and an increase in agricultural management costs. Therefore, it is necessary to have competitiveness in the agricultural field, of which the most important factor is the transformation into a high value-added industry through the grafting of IT and sensor technology.

최근 전자 기술의 발전으로, 스피드 스프레이어를 무인으로 운용하고 있다. 일반적으로 자율주행기술은 운전자의 조작없이 자동차 스스로 주행환경을 인식하여 목표 지점까지 운행할 수 있도록 하는 기술로서, 차선이탈 방지시스템과 차량 변경 제어기술, 장애물 회피 기술 등을 이용하여 출발지와 목적지를 입력하면 최적의 주행경로를 선택하여 스스로 주행할 수 있도록 하며, 자율주행기술이 적용된 자동차를 자율주행자동차 또는 무인자동차라 한다.With recent advances in electronic technology, speed sprayers are being operated unmanned. In general, autonomous driving technology is a technology that enables the vehicle to recognize the driving environment on its own without driver's manipulation and to drive to the target point. Using lane departure prevention system, vehicle change control technology, and obstacle avoidance technology, the starting point and destination are input. Then, it selects the optimal driving route and allows it to drive on its own, and a vehicle to which autonomous driving technology is applied is called an autonomous vehicle or an unmanned vehicle.

이러한 자율주행 트랙터에는 GPS를 이용한 위치인식 시스템과, 속도와 방향 및 가속도를 측정하는 IMU(Inertial Mwasurement Unit; 관성항법장치) 기술, 자율주행시 이동 방향을 모니터로 보여주는 하이브리드 EPS(Hybrid Electronic Power Steering) 시스템, 작업경로 생성 및 추종기술 등 4가지의 기술이 접목되어 있다. 자율주행 트랙터와 같은 농업기계는 국내의 열악한 농업환경과 인력난 등을 고려하면, 경쟁력 제고를 위한 필수 선택이라할 수 있지만, 경지면적이 좁고 비탈진 농지가 많은 농업환경으로 인해 국내에는 쉽게 적용되지 못하고 있는 실정이며, These self-driving tractors include a location recognition system using GPS, an Inertial Mwasurement Unit (IMU) technology that measures speed, direction, and acceleration, and a hybrid electronic power steering (EPS) system that monitors the direction of movement during autonomous driving. , Work path creation and follow-up technology, four technologies are grafted. Agricultural machinery such as self-driving tractors can be said to be an essential option for enhancing competitiveness in consideration of the poor agricultural environment and manpower shortages in Korea, but due to the agricultural environment with narrow arable land and many slopes, it is not easily applied in Korea. Actually,

따라서, 본 발명의 목적은 글로벌 항법 위성 시스템(GNSS) 센서를 이용함으로써 비교적 간단하고 저렴한 자율주행가능한 스피드 스프레이서를 제공하는 것을 목적으로 한다. Accordingly, an object of the present invention is to provide a relatively simple and inexpensive speed sprayer capable of autonomous driving by using a Global Navigation Satellite System (GNSS) sensor.

전술한 과제를 달성하기 위해 본 발명에 따르면, 스피드 스프레이어를 이동시키기 위해 스피드 스프레이어의 본체 하부의 양측에 장착되는 적어도 2개의 캐터필러, 본체의 중앙부에 장착되고 약액을 수용하는 약액탱크; 본체의 후방에서 약액을 분무하도록 배치된 분무부; 및 본체의 전방에 설치되는 제어반을 포함하는 자율주행 가능한 스피드 스프레이어가 제공되며, 여기서 캐터필러 각각의 회전축은 상기 구동모터로부터 회전 속도를 변속하기 위한 액추에이터로서 동작하는 감속기를 통해 캐터필러를 구동하기 위한 구동모터에 결합되고, 제어반에는,According to the present invention in order to achieve the above object, at least two caterpillars mounted on both sides of the lower body of the speed sprayer to move the speed sprayer, a chemical liquid tank mounted on the central portion of the body to accommodate a chemical solution; A spray unit disposed to spray a chemical solution from the rear of the body; And a control panel installed in front of the main body, wherein the rotation axis of each of the caterpillar is provided with a drive motor for driving the caterpillar through a reducer that operates as an actuator for shifting the rotational speed from the drive motor. Coupled to, and on the control panel,

상기 스피드 스프레이어의 위치 및 움직임을 감지하기 위한 GNSS(Global Navigation Satellite System) 센서; 자율 주행 경로가 저장된 메모리; 감지된 스피드 스프레이어의 위치 및 움직임에 기초하여 상기 스피드 스프레이어가 상기 자율 주행 경로를 따라 주행하도록 액추에이터를 제어하는 프로세서;를 포함하고, 상기 제어반의 프로세서는 GNSS 센서를 이용하여 스피드 스프레이어의 위치 및 움직임을 감지하고, GNSS 센서의 품질을 판단하고; 감지된 스피드 스프레이어의 위치 및 움직임에 기초하여 상기 스피드 스프레이어가 상기 스피드 스프레이어의 메모리에 저장된 자율 주행 경로를 따라 주행하도록 제어하도록 구성된다. A Global Navigation Satellite System (GNSS) sensor for detecting the position and movement of the speed sprayer; A memory in which autonomous driving routes are stored; And a processor for controlling the actuator so that the speed sprayer travels along the autonomous driving path based on the detected position and movement of the speed sprayer, and the processor of the control panel uses a GNSS sensor to determine the position and movement of the speed sprayer. Detect motion and determine the quality of the GNSS sensor; Based on the sensed position and movement of the speed sprayer, it is configured to control the speed sprayer to travel along an autonomous driving path stored in the memory of the speed sprayer.

전술한 양태에서 자율 주행 경로는, 기설정된 경로를 상기 스피드 스프레이어가 주행하는 동안에 상기 GNSS 센서에서 획득된 데이터에 기반하여 생성된다.In the above-described aspect, the autonomous driving route is generated based on data acquired by the GNSS sensor while the speed sprayer is driving a preset route.

또한 전술한 양태에서 프로세서는 GNSS 센서의 품질의 판단시, GNSS 센서의 품질을 판단하기 위한 인자와 기설정된 기준 값을 비교하고, 인자가 상기 기설정된 기준 값을 만족하는 경우, 현재 시간보다 특정한 시간 이전의 항법해를 통해 예측된 상기 스피드 스프레이어의 현재 위치와 상기 GNSS 센서를 통해 획득된 상기 스피드 스프레이어의 현재 위치를 비교하여 상기 GNSS 센서를 통해 획득되는 스피드 스프레이어의 위치가 양호한 상태인지를 판단하도록 구성된다. In addition, in the above-described aspect, when determining the quality of the GNSS sensor, the processor compares a factor for determining the quality of the GNSS sensor with a preset reference value, and when the factor satisfies the preset reference value, a specific time than the current time. It is determined whether the position of the speed sprayer obtained through the GNSS sensor is in good condition by comparing the current position of the speed sprayer predicted through the previous navigation solution with the current position of the speed sprayer obtained through the GNSS sensor. Is configured to judge.

또한 전술한 양태에서 프로세서는 GNSS 센서를 통해 획득된 스피드 스프레이어의 위치가 양호한 것으로 판단되면, 현재 시간의 시간 이전의 항법해를 획득하고, 상기 획득된 항법해에 기초하여 상기 자율 주행 경로 상에서 상기 현재 시간을 기준으로 특정 시간 이후의 제1 위치를 추정하고, 획득된 항법해에 기초하여 상기 현재 시간보다 특정 시간 이후의 제2 위치를 추정하고, 상기 스피드 스프레이어의 현재 위치를 기준으로 상기 제1 위치까지의 제1 벡터와 상기 스피드 스프레이어의 현재 위치를 기준으로 상기 제2 위치까지의 제2 벡터 사이의 방향각 차이를 산출하고, 상기 산출된 방향각 차이에 기초하여 이동 중인 스피드 스프레이어의 이동 방향을 제어하도록 구성된다. In addition, in the above-described aspect, when it is determined that the position of the speed sprayer obtained through the GNSS sensor is good, the processor obtains a navigation solution prior to the time of the current time, and based on the obtained navigation solution, the processor Based on the current time, a first position after a specific time is estimated, a second position after a specific time than the current time is estimated based on the obtained navigation solution, and the second position is estimated based on the current position of the speed sprayer. The speed sprayer in motion is calculated based on the first vector up to position 1 and the second vector up to the second position based on the current position of the speed sprayer. Is configured to control the direction of movement.

또한 전술한 양태에서 프로세서는 GNSS 센서를 통해 획득된 스피드 스프레이어의 위치가 양호하지 않은 것으로 판단되면, 이동 중인 스피드 스프레이어를 정지시키도록 구성된다.Further, in the above-described aspect, the processor is configured to stop the moving speed sprayer if it is determined that the position of the speed sprayer obtained through the GNSS sensor is not good.

또한 전술한 양태에서 프로세서는 GNSS 센서를 통해 획득된 스피드 스프레이어의 위치가 양호한 것으로 판단되면, 상기 GNSS 센서에 의해 감지된 상기 스피드 스프레이어의 속도를 기설정된 운용 속도와 비교하여 상기 스피드 스프레이어의 속도를 제어하도록 구성된다. In addition, in the above-described aspect, when it is determined that the position of the speed sprayer obtained through the GNSS sensor is good, the processor compares the speed of the speed sprayer detected by the GNSS sensor with a preset operating speed and It is configured to control the speed.

본 발명의 실시예에 따르면, 비교적 저렴한 GNSS 센서를 이용하여 자율주행가능한 스피드 스프레이서를 제공할 수 있으며, 가격 경쟁력을 대폭 확보할 수 있고, 또한 기존에 비해 빠른 시간에 자율 주행 경로를 생성할 수 있는 자율주행가능한 스피드 스프레이서를 제공할 수 있다.According to an embodiment of the present invention, it is possible to provide a speed sprayer capable of autonomous driving using a relatively inexpensive GNSS sensor, to secure a significant price competitiveness, and to create an autonomous driving route in a faster time than the conventional one. It can provide a speed sprayer capable of autonomous driving.

도 1은 본 발명의 실시예에 따른 자율주행가능한 스피드 스프레이어을 개략적으로 나타낸 사시도.
도 2은 본 발명의 실시예에 따른 자율주행가능한 스피드 스프레이어의 캐터필러 및 그 구동부를 개략적으로 나타낸 도면.
도 3은 본 발명의 실시예에 따른 자율주행가능한 스피드 스프레이어의 분무부 및 그 관련된 부품들을 개략적으로 나타낸 도면.
도 4는 본 발명의 실시예에 따른 자율스피드 스프레이어의 구성을 설명하기 위한 블록도,
도 5는 본 발명의 실시예에 따라 자율 주행 경로를 생성하는 방법을 설명하기 위한 도면,
도 6은 본 발명의 실시예에 따라 GNSS 센서의 이상 여부를 판단하기 위한 방법을 설명하기 위한 흐름도,
도 7 및 6는 본 발명의 실시예에 따라 자율 주행 경로를 갱신하는 방법을 설명하기 위한 도면들,
도 8은 본 발명의 실시예에 따라 스피드 스프레이어의 주행 속도를 제어하는 방법을 설명하기 위한 흐름도,
도 9은 본 발명의 실시예에 따라 스피드 스프레이어의 주행 방향을 제어하는 방법을 설명하기 위한 흐름도.
1 is a perspective view schematically showing a speed sprayer capable of autonomous driving according to an embodiment of the present invention.
2 is a schematic view showing a caterpillar of a speed sprayer capable of autonomous driving and a driving unit thereof according to an embodiment of the present invention.
3 is a view schematically showing a spray unit and related parts of an autonomous speed sprayer according to an embodiment of the present invention.
4 is a block diagram for explaining a configuration of an autonomous speed sprayer according to an embodiment of the present invention;
5 is a diagram for explaining a method of generating an autonomous driving route according to an embodiment of the present invention;
6 is a flowchart illustrating a method for determining whether a GNSS sensor is abnormal according to an embodiment of the present invention;
7 and 6 are diagrams for explaining a method of updating an autonomous driving route according to an embodiment of the present invention;
8 is a flow chart for explaining a method of controlling a traveling speed of a speed sprayer according to an embodiment of the present invention;
9 is a flowchart illustrating a method of controlling a driving direction of a speed sprayer according to an embodiment of the present invention.

본 발명의 이점 및 특징, 그리고 그것들을 달성하는 방법은 첨부되는 도면과 함께 상세하게 후술되는 실시예를 참조하면 명확해질 것이다. 그러나, 본 발명은 이하에서 개시되는 실시예에 한정되는 것이 아니라 서로 다른 다양한 형태로 구현될 것이다. Advantages and features of the present invention, and a method of achieving them will become apparent with reference to embodiments to be described later in detail together with the accompanying drawings. However, the present invention is not limited to the embodiments disclosed below, but will be implemented in various different forms.

본 명세서에서 본 실시예는 본 발명의 개시가 완전하도록 하며, 본 발명이 속하는 기술 분야에서 통상의 지식을 가진 자에게 발명의 범주를 완전하게 알려주기 위해 제공되는 것이다. 그리고 본 발명은 청구항의 범주에 의해 정의될 뿐이다. 따라서, 몇몇 실시예들에서, 잘 알려진 구성 요소, 잘 알려진 동작 및 잘 알려진 기술들은 본 발명이 모호하게 해석되는 것을 피하기 위하여 구체적으로 설명되지 않는다.In the present specification, the present embodiment is provided to complete the disclosure of the present invention, and to completely inform the scope of the invention to those of ordinary skill in the art to which the present invention belongs. And the invention is only defined by the scope of the claims. Accordingly, in some embodiments, well-known components, well-known operations, and well-known techniques have not been described in detail in order to avoid obscuring interpretation of the present invention.

명세서 전체에 걸쳐 동일 참조 부호는 동일 구성 요소를 지칭한다. 그리고, 본 명세서에서 사용된(언급된) 용어들은 실시예들을 설명하기 위한 것이며 본 발명을 제한하고자 하는 것은 아니다. 본 명세서에서, 단수형은 문구에서 특별히 언급하지 않는 한 복수형도 포함한다. 또한, '포함(또는, 구비)한다'로 언급된 구성 요소 및 동작은 하나 이상의 다른 구성요소 및 동작의 존재 또는 추가를 배제하지 않는다. The same reference numerals refer to the same components throughout the specification. In addition, the terms used in the present specification (referred to) are for describing exemplary embodiments and are not intended to limit the present invention. In this specification, the singular form also includes the plural form unless specifically stated in the phrase. In addition, elements and operations referred to as'comprising (or having)' do not exclude the presence or addition of one or more other elements and operations.

다른 정의가 없다면, 본 명세서에서 사용되는 모든 용어(기술 및 과학적 용어를 포함)는 본 발명이 속하는 기술분야에서 통상의 지식을 가진 자에게 공통적으로 이해될 수 있는 의미로 사용될 수 있을 것이다. 또 일반적으로 사용되는 사전에 정의되어 있는 용어들은 정의되어 있지 않은 한 이상적으로 또는 과도하게 해석되지 않는다.Unless otherwise defined, all terms (including technical and scientific terms) used in the present specification may be used as meanings that can be commonly understood by those of ordinary skill in the art to which the present invention belongs. In addition, terms defined in a commonly used dictionary are not interpreted ideally or excessively unless defined.

이하 첨부된 도면을 참조하여 본 발명의 다양한 실시예에 대해 설명하도록 한다.Hereinafter, various embodiments of the present invention will be described with reference to the accompanying drawings.

도 1은 본 발명에 따른 자율주행가능한 스피드 스프레이어(1)의 외관을 개략적으로 나타낸 사시도이다. 본 발명에 따른 스피드 스프레이어(1)는 스피드 스프레이어(1)를 이동시키기 위해 스피드 스프레이어(1)의 본체 하부에 장착되는 캐터필러(10), 본체의 중앙부에 장착되고 약액을 수용하는 약액탱크(20); 본체의 후방에서 약액을 분무하도록 배치된 분무부(30); 및 본체의 전방에 설치되는 제어반(100)을 포함한다.1 is a perspective view schematically showing the appearance of a speed sprayer 1 capable of autonomous driving according to the present invention. The speed sprayer 1 according to the present invention includes a caterpillar 10 mounted under the main body of the speed sprayer 1 to move the speed sprayer 1, a chemical liquid tank mounted in the center of the main body and accommodating a chemical solution. (20); A spray unit 30 disposed to spray a chemical solution from the rear of the body; And a control panel 100 installed in front of the main body.

도 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)를 구현하기 위한 배선이 단순화될 수 있다.FIG. 2 is a view showing a state in which the outer case of the speed sprayer 1 is removed in order to show the caterpillar 10 and its related configuration in more detail among the internal configurations of the self-driving speed sprayer 1. The caterpillar 10 is formed at the lower ends of both sides of the main body, and a reducer 10b is connected to each of the drive shafts 10a of the caterpillar 10 on both sides, and the driving force of the caterpillar 10 through the reducer 10b Each of the motors 10c for generating is connected. As one driving motor 10c is provided for each caterpillar 10, even if the same torque is generated from each driving motor 10c, the force transmitted to the caterpillar 10 through the control of the reducer 10b may be different. Through this, it is possible to rotate the speed sprayer 1 to the left or right. The battery 50 for operating the driving motor 10 is disposed on the upper side of the catafilter 10 through a frame, etc., as shown in FIGS. 1 and 2, and the battery 50 and the driving motor 10 As the distance decreases, wiring for implementing the driving motor 10 may be simplified.

도 3은 자율주행가능한 스피드 스프레이어(1)의 내부 구성 중 분무부(30) 및 그 관련 구성을 보다 상세하게 나타내기 위해 스피드 스프레이어(1)의 외부 케이스를 제거한 상태를 나타내는 도면이다. 3 is a view showing a state in which the outer case of the speed sprayer 1 is removed in order to more specifically show the spray unit 30 and its related configurations among the internal configurations of the self-driving speed sprayer 1.

도 3에 도시된 바와 같이, 분무부(30)는 송풍날개(34)를 회전시키기 위한 분무엔진(31), 분무 엔진(31)의 일측에 부착되어 엔진을 냉각하기 위한 라디에이터(31a), 약액을 압축하여 분무하는 스프레이어(32), 분무된 약액을 스피드 스프프레어(1)의 주행방향의 반대 방향으로 송풍하기 위한 송풍날개(34)를 포함한다.As shown in Figure 3, the spray unit 30 is a spray engine 31 for rotating the blowing blade 34, a radiator 31a for cooling the engine by being attached to one side of the spray engine 31, a chemical liquid It includes a sprayer 32 for compressing and spraying, and a blowing blade 34 for blowing the sprayed chemical in a direction opposite to the traveling direction of the speed sprayer 1.

분무 엔진(31)은 날개 회전축(35)을 통해 송풍 날개(34)의 중심에 연결되고, 분무 엔진(31)이 가동되면 날개 회전축(35)이 회전되어 소풍날개(34)가 회전된다. The spray engine 31 is connected to the center of the blowing blade 34 through the blade rotation shaft 35, and when the spray engine 31 is operated, the blade rotation shaft 35 is rotated so that the excursion blade 34 is rotated.

구체적으로 송풍날개(34)는 그 회전축에 회전풀리가 부착되어 엔진과 연결되는 동력전달장치에 접속되거나 분리되고, 또한 회전풀리 대신에 송풍날개(34)의 회전축에 베벨기어를 부착하고 엔진동력절달장치에 결합된 케이블에 베벨기어를 결합하여 동력전달이 전달가능하도록 구성될 수 있으며, 본 발명은 이에 한정되는 것은 아니고 다양한 방식으로 엔진으로부터의 구동력을 송풍날개(34)를 회전시키도록 변형 또는 수정될 수 있다는 것은 당업자에게 자명하다.Specifically, the blower blade 34 is connected to or separated from a power transmission device connected to the engine by attaching a rotary pulley to the rotating shaft, and attaching a bevel gear to the rotating shaft of the blower blade 34 instead of the rotary pulley to transmit engine power. It may be configured to transmit power by coupling a bevel gear to a cable coupled to the device, and the present invention is not limited thereto, and the present invention is modified or modified so that the driving force from the engine is rotated in various ways. It is obvious to those skilled in the art that it can be.

분무 엔진(31)의 측면에는 스프레이어(32)가 배치되는데 스프레이어(32)는 배관을 통해 약액탱크(20)에 연결되어, 약액 탱크(20)로부터 공급되는 약액을 압축하고 압축된 약액을 분사 노즐을 통해 송풍날개(34)를 향해 분사하도록 구성되어 있으며, 스프레이어(32)의 일부분에는 스프레이어(32) 내의 압력을 조절하기 위한 압력조절 핸들(32a)이 더 제공됨으로써 분사되는 약액의 압력을 조절할 수 있다.A sprayer 32 is disposed on the side of the spray engine 31, and the sprayer 32 is connected to the chemical liquid tank 20 through a pipe, compressing the chemical liquid supplied from the chemical liquid tank 20, and extracting the compressed chemical liquid. It is configured to spray toward the blowing blade 34 through the spray nozzle, and a pressure control handle 32a for controlling the pressure in the sprayer 32 is further provided at a part of the sprayer 32, You can adjust the pressure.

제어반(100)의 상부에는 스피드 스프레이어(1)의 위치 및 움직임을 감지하기 위해, GNSS(Global Navigation Satellite System) 센서(121) 및 주행 센서(122)를 포함하는데, GNSS 센서(121)는 우주의 위성에서 송신는 전파를 이용하여 특정 위치의 좌표를 산출하는 센서를 의미하고, 주행 센서(122)는 스피드 스프레이어(1)의 속도, 방향각 등을 측정하기 위한 센서를 통칭한다. 주행 센서(122)는 조향각 센서 및 속도 센서를 포함할 수 있다. 센서부(121,122)에 대해서는 이하의 해당하는 부분에서 보다 구체적으로 설명하도록 한다.The upper part of the control panel 100 includes a Global Navigation Satellite System (GNSS) sensor 121 and a travel sensor 122 to detect the position and movement of the speed sprayer 1, and the GNSS sensor 121 The transmission in the satellite of is meant a sensor that calculates the coordinates of a specific location using radio waves, and the travel sensor 122 collectively refers to a sensor for measuring the speed and direction angle of the speed sprayer 1. The travel sensor 122 may include a steering angle sensor and a speed sensor. The sensor units 121 and 122 will be described in more detail in the corresponding parts below.

또한 제어반(100)의 상부에는 스피드 스프레이어(1)의 주행 방향에 대해 장애물을 감지하기 위해 1쌍의 카메라(160)를 더 포함하여 스프드 스프레이어(1)가 자율중일 때 전방의 진행 경로에 장애물 등을 감지하고 이를 프로세서에 통보하도록 구성된다.In addition, at the top of the control panel 100, a pair of cameras 160 are further included to detect obstacles in the driving direction of the speed sprayer 1, and the forward path when the sprayer 1 is autonomous It is configured to detect obstacles, etc., and notify the processor.

다음으로 제어반(100)에 대해 이하에 설명한다. 도 4은 본 발명의 하나의 실시예에 따른 스피드 스프레이어(1)의 제어반(100)의 구성을 설명하기 위한 블록도이다.Next, the control panel 100 will be described below. 4 is a block diagram for explaining the configuration of the control panel 100 of the speed sprayer 1 according to an embodiment of the present invention.

제어반(100)는 사용자가 탑승하지 않더라도, 미리 설정된 경로를 따라 자율적으로 이동이 가능한 무인 자율주행 기계로 구현될 수 있도록 센서(120), 메모리(130) 및 프로세서(140), 카메라(160)를 포함할 수 있다.The control panel 100 includes a sensor 120, a memory 130, a processor 140, and a camera 160 so that it can be implemented as an unmanned autonomous vehicle that can autonomously move along a preset route even if the user is not on board. Can include.

액추에이터부(110)는 스피드 스프레이어(1)의 주행 관련 구성요소를 제어하기 위한 구성이다. 예를 들어, 액추에이터부(110)는 엑셀레이터 액추에이터, 브레이크 액추에이터, 조향각 제어 액추에이터를 포함하여 이루어지고, 엑셀레이터 액추에이터를 통해 스피드 스프레이어(1)에 마련된 캐터필러(10)의 회전 속도를 증가시키거나, 브레이크 액추에이터를 통해 스피드 스프레이어(1)에 마련된 바퀴의 회전 속도를 감소시키거나, 바퀴를 정지시키거나, 조향각 제어 액추에이터를 통해 스피드 스프레이어(1)의 양측의 캐터필러(10)의 회전 속도를 다르게 하여 스피드 스프레이어(1)를 좌측 또는 우측 방향으로 회전시키도록 이루어진다. The actuator unit 110 is a component for controlling the driving-related components of the speed sprayer 1. For example, the actuator unit 110 includes an accelerator actuator, a brake actuator, and a steering angle control actuator, and increases the rotation speed of the caterpillar 10 provided in the speed sprayer 1 through the accelerator actuator, or brake By reducing the rotation speed of the wheels provided in the speed sprayer (1) through an actuator, stopping the wheels, or by varying the rotation speed of the caterpillar 10 on both sides of the speed sprayer (1) through the steering angle control actuator. It is made to rotate the speed sprayer 1 to the left or right.

또한 액추에이터부(110)는 캐터필러(10)에 구동하기 위해 제공되는 모터(10c) 및 감속기(10a)를 포함하는 구성을 지칭할 수 있으며, 전술한 바와 같이 브레이크 또는 액셀레이터 등과 연관된 구성을 모두 포함하는 구성을 통칭하는 것으로 이해될 수도 있다.In addition, the actuator unit 110 may refer to a configuration including a motor 10c and a reducer 10a provided to drive the caterpillar 10, and includes all configurations related to a brake or an accelerator, as described above. It may be understood as collectively referring to configuration.

센서(120)는 스피드 스프레이어(1)의 위치 및 움직임을 감지한다. 이를 위해, 센서(120)는 도 4에 도시된 바와 같이 GNSS(Global Navigation Satellite System) 센서(121) 및 주행 센서(122)를 포함할 수 있다.The sensor 120 detects the position and movement of the speed sprayer 1. To this end, the sensor 120 may include a Global Navigation Satellite System (GNSS) sensor 121 and a travel sensor 122 as shown in FIG. 4.

GNSS 센서(121)는 위성을 이용하여 스피드 스프레이어(1)의 위치, 속도, 방향각 등을 측정할 수 있다. 여기에서, GNSS 센서(121)를 통해 획득되는 스피드 스프레이어(1)의 위치, 속도, 방향각 등을 GNSS 센서(121)의 측위해라 할 수 있다.The GNSS sensor 121 may measure the position, speed, and direction angle of the speed sprayer 1 using a satellite. Here, the position, speed, direction angle, etc. of the speed sprayer 1 acquired through the GNSS sensor 121 may be referred to as a side hazard of the GNSS sensor 121.

GNSS는 우주의 위성에서 송신는 전파를 이용하여 특정 위치의 좌표를 산출하는 시스템을 의미한다. 이와 같이, GNSS는 위성을 이용한다는 점에서, 시간 및 공간에 구애받지 않으며 다른 시스템에 비해 비교적 안정적으로 위치, 속도 및 시간 정보 등을 획득할 수 있다.GNSS refers to a system that calculates the coordinates of a specific location using radio waves transmitted from satellites in space. 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 sensor 121 determines its own location using a GNSS signal received from a satellite, receives positioning correction information from a Real Time Kinematic (RTK) reference station 300, and uses the positioning correction information to provide a GNSS signal. You can correct your position determined through.

한편, 본 발명의 실시예에 따르면, GNSS 센서(121)는 단일 주파수 기반의 저가형 GNSS 센서로 구현될 수 있다. 즉, 스피드 스프레이어(1)의 경우, 드론(drone), 비행체, 선박 등에 비해 상대적으로 저속으로 이동한다는 점에서, 단일 주파수만으로도 충분히 정확한 위치가 측정될 수 있다. Meanwhile, according to an embodiment of the present invention, the GNSS sensor 121 may be implemented as a low-cost GNSS sensor based on a single frequency. That is, in the case of the speed sprayer 1, 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.

이와 같이, 본 발명의 실시예에 따르면, 단일 주파수 기반의 GNSS 센서를 이용한다는 점에서, 2개 이상의 주파수를 이용하는 센서보다 저렴하게 스피드 스프레이어(1)의 위치를 측정할 수 있게 된다. 이 경우, RTK 기준국(300)은 cm급 정확도를 갖는 위치를 계산할 수 있도록 측위 보정 정보를 생성하여 저가형의 GNSS 센서(121)로 제공할 수 있다.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 speed sprayer 1 at a lower cost than a sensor using two or more frequencies. In this case, the RTK reference station 300 may generate positioning correction information so as to calculate a position with cm-class accuracy and provide it to the low-cost GNSS sensor 121.

주행 센서(122)는 스피드 스프레이어(1)의 속도, 방향각 등을 측정할 수 있다. 이를 위해, 주행 센서(122)는 스피드 스프레이어(1)의 방향각을 측정하기 위한 조향각 센서 및 스피드 스프레이어(1)의 속도를 측정하기 위한 속도 센서 등을 포함할 수 있다.The travel sensor 122 may measure the speed and direction angle of the speed sprayer 1. To this end, the travel sensor 122 may include a steering angle sensor for measuring the direction angle of the speed sprayer 1 and a speed sensor for measuring the speed of the speed sprayer 1.

메모리(130)는 자율 주행 경로가 저장된다. 이 경우, 스피드 스프레이어(1)는 사람에 의하지 않고, 무인으로 자율 주행 경로에 따라 자율적으로 주행할 수 있다. 한편 도 4에 도시한 바와 같이 스피드 스프레이어(1)에는 무인 주행으로 스피드 스프레이어(1)를 동작시킬 것인지 아니면 운전자가 직접 차량을 리모콘 등을 통해 주행할 것인지를 선택하기 위한 모드 선택부가 더 제공될 수도 있다.The memory 130 stores autonomous driving routes. In this case, the speed sprayer 1 can be autonomously driven according to an autonomous driving route unmanned, not by a person. Meanwhile, as shown in Fig. 4, the speed sprayer 1 further provides a mode selection unit for selecting whether to operate the speed sprayer 1 by unmanned driving or whether the driver will directly drive the vehicle through a remote control, etc. It could be.

사용자가 모드 선택부를 통해 수동 주행을 선택한 경우 프로세서는 사용자로부터의 리모콘 조작에 기반하여 차량을 동작시키는 반면 사용자가 모드 선택부를 통해 무인 주행을 선택한 경우 프로세서는 미리 정해진 자율주행모드로 차량을 동작시키게 된다.When the user selects manual driving through the mode selection unit, the processor operates the vehicle based on remote control operation from the user, whereas when the user selects unmanned driving through the mode selection unit, the processor operates the vehicle in a predetermined autonomous driving mode. .

자율 주행 경로는 기설정된 경로를 스피드 스프레이어(1)가 주행하는 동안에, GNSS 센서(120)에서 획득된 데이터에 기초하여 생성될 수 있다. 예를 들어, 자율 주행 경로는 스피드 스프레이어(1)가 앞으로 주행할 경로(가령, 경작지, 험로, 도로 등의 경로)를 미리 주행하고, 주행 중에 GNSS 센서(120)로부터 획득된 스피드 스프레이어(1)의 위치, 속도 및 방향각 등에 의해 생성될 수 있다. 이러한 자율 주행 경로를 생성하는 구체적인 방법에 대해서는 후술하도록 한다.The autonomous driving route may be generated based on data obtained by the GNSS sensor 120 while the speed sprayer 1 is driving a preset route. For example, as for the autonomous driving path, the speed sprayer 1 travels in advance on a path (for example, a path such as arable land, rough road, road, etc.), and the speed sprayer obtained from the GNSS sensor 120 ( 1) It can be created by its position, speed and direction angle. A specific method of generating such an autonomous driving route will be described later.

또한, 메모리(130)는 도 4에 도시된, 경로 생성 모듈(141) 및 움직임 제어 모듈(142) 등을 저장할 수 있다. 한편, 도 4에서는 모듈들을 개별적으로 도시하였으나, 적어도 2 개의 모듈들이 조합되어 하나의 유닛으로 구현될 수도 있다는 것은 자명하다. In addition, the memory 130 may store the path generation module 141 and the motion control module 142 shown in FIG. 4. Meanwhile, although modules are individually illustrated in FIG. 4, it is obvious that at least two modules may be combined and implemented as a single unit.

프로세서(140)는 스피드 스프레이어(1)의 전반적인 동작을 제어한다. 이를 위해, 프로세서(140)는 스피드 스프레이어(1)의 동작을 제어하기 위한 전용 프로세서(예: 임베디드 프로세서), 또는 메모리 장치에 저장된 하나 이상의 소프트웨어 프로그램들을 실행함으로써, 해당 동작들을 수행할 수 있는 범용 프로세서(generic-purpose processor)(예: CPU 또는 application processor) 등으로 구현될 수 있다.The processor 140 controls the overall operation of the speed sprayer 1. To this end, the processor 140 executes a dedicated processor (eg, an embedded processor) for controlling the operation of the speed sprayer 1, or one or more software programs stored in a memory device, thereby performing the corresponding operations. It may be implemented as a processor (generic-purpose processor) (eg, a CPU or an application processor).

먼저, 프로세서(140)는 스피드 스프레이어(1)의 동작모드를 판단하고 무인주행모드인 경우 먼저 자율 주행 경로를 생성할 수 있다. 이 경우, 프로세서(140)는 경로 생성 모듈(141)을 실행하고, GNSS 센서(121)에서 획득한 데이터를 경로 생성 모듈(141)의 입력으로 하여, 자율 주행 경로를 생성할 수 있다.First, the processor 140 may determine the operation mode of the speed sprayer 1 and, in the case of the unmanned driving mode, may first generate an autonomous driving route. In this case, the processor 140 may generate an autonomous driving route by executing the route generating module 141 and using data acquired from the GNSS sensor 121 as an input of the route generating module 141.

구체적으로, 프로세서(140)는 기설정된 경로를 스피드 스프레이어(1)가 주행하는 동안, GNSS 센서(121)를 통해 스피드 스프레이어(1)의 측지 좌표를 획득할 수 있다. 여기에서, 측지 좌표는 위도, 경도 및 타원체고에 대한 정보를 포함할 수 있다.Specifically, the processor 140 may acquire the geodetic coordinates of the speed sprayer 1 through the GNSS sensor 121 while the speed sprayer 1 travels on a preset path. Here, the geodetic coordinates may include information on latitude, longitude, and ellipsoid height.

그리고, 프로세서(140)는 획득된 측지 좌표를 지역 좌표로 변환할 수 있다. 즉, 측지 좌표는 지구 타원체 기반의 좌표라는 점에서, 프로세서(140)는 측지 좌표를 직각 좌표 형식의 지역 좌표로 변환할 수 있다. 여기에서, 지역 좌표는 특정한 기준점을 기준으로 한 x,y 좌표(가령, 특정한 기준점을 기준으로 동쪽, 북쪽 좌표) 및 높이에 대한 정보를 포함할 수 있다.In addition, the processor 140 may convert the obtained geodetic coordinates into local coordinates. That is, since the geodetic coordinates are coordinates based on the earth ellipsoid, the processor 140 may convert the geodetic coordinates into local coordinates in a rectangular coordinate format. Here, the local coordinates may include x,y coordinates (eg, east and north coordinates based on a specific reference point) and height information based on a specific reference point.

그리고, 프로세서(140)는 GNSS 센서(121)를 통해 스피드 스프레이어(1)의 방향각을 획득하고, 획득된 방향각에 기초하여 스피드 스프레이어(1)가 이동하는 경로의 형태를 판단할 수 있다. 여기에서, 경로의 형태는 회전 경로 및 직선 경로를 포함할 수 있다.In addition, the processor 140 may obtain the direction angle of the speed sprayer 1 through the GNSS sensor 121 and determine the shape of the path through which the speed sprayer 1 moves based on the obtained direction angle. have. Here, the shape of the path may include a rotation path and a straight path.

이 경우, 프로세서(140)는 GNSS 센서(121)를 통해 현재 스피드 스프레이어(1)의 방향각을 현재 시간보다 특정한 시간 이전에 획득한 스피드 스프레이어(1)의 방향각과 비교하여, 스피드 스프레이어(1)가 진행하는 경로가 회전 경로에 해당하는지 또는 직선 경로에 해당하는지를 판단할 수 있다.In this case, the processor 140 compares the direction angle of the current speed sprayer 1 through the GNSS sensor 121 with the direction angle of the speed sprayer 1 acquired before a specific time before the current time, It can be determined whether the path (1) is traveling corresponds to a rotation path or a straight path.

구체적으로, 프로세서(140)는 현재 스피드 스프레이어(1)의 방향각과 특정한 시간 이전에 획득한 스피드 스프레이어(1)의 방향각 사이의 차이가 기설정된 값 이상이면 스피드 스프레이어(1)가 진행하는 경로가 회전 경로에 해당하는 것으로 판단하고, 현재 스피드 스프레이어(1)의 방향각과 특정한 시간 이전에 획득한 스피드 스프레이어(1)의 방향각 사이의 차이가 기설정된 값 미만이면, 스피드 스프레이어(1)가 진행하는 경로가 직선 경로에 해당하는 것으로 판단할 수 있다.Specifically, if the difference between the current direction angle of the speed sprayer 1 and the direction angle of the speed sprayer 1 acquired before a specific time is greater than or equal to a preset value, the speed sprayer 1 proceeds. It is determined that the path to be rotated corresponds to the rotation path, and if the difference between the current direction angle of the speed sprayer 1 and the direction angle of the speed sprayer 1 acquired before a specific time is less than a preset value, the speed sprayer It can be determined that the path (1) proceeds corresponds to a straight path.

이후, 프로세서(140)는 판단된 경로 형태 및 지역 좌표에 기초하여 자율 주행 경로를 생성하고, 생성된 자율 주행 경로를 메모리(130)에 저장할 수 있다.Thereafter, the processor 140 may generate an autonomous driving route based on the determined route type and local coordinates, and store the generated autonomous driving route in the memory 130.

구체적으로, 프로세서(140)는 판단된 경로 형태에 따라 웨이포인트(웨이포인트s)를 설정하고, 웨이포인트 별로 지역 좌표 및 경로 벡터를 맵핑하여 자율 주행 경로를 생성할 수 있다.Specifically, the processor 140 may generate an autonomous driving route by setting waypoints (waypoints) according to the determined route type and mapping local coordinates and route vectors for each waypoint.

다시 도 4을 참조하면 스피드 스프레이어(1)는 차량의 전방에 배치되는 적어도 2개의 쌍안 카메라(160)를 더 포함하고 쌍안 카메라는 프로세서(140)에 연결되며, 프로세서는 전방 이동 경로상에 장애물이 있는지 여부를 판단하게 되고, 장애물이 존재하는 경우 프로세서(140)는 쌍안 카메라로부터의 위상차 정보를 이용하여 장애물까지의 거리 정보를 파악하고, 현재 스피드 스프레이어(1)의 속도, 조향각에 기반하여 장애물과의 충돌 여부를 판단하게 된다. Referring back to FIG. 4, the speed sprayer 1 further includes at least two binocular cameras 160 disposed in front of the vehicle, the binocular camera is connected to the processor 140, and the processor is an obstacle on the forward movement path. It is determined whether there is an obstacle, and if there is an obstacle, the processor 140 determines distance information to the obstacle using phase difference information from the binocular camera, and based on the current speed and steering angle of the speed sprayer 1 Whether it collides with an obstacle is determined.

장애물과의 출돌이 예상되는 경우 프로세서(140)는 비상 정지를 수행하거나, 다른 자율주행 경로를 탐색하도록 프로세서(140)의 경로 생성 모듈(141)에 명령할 수 있다. When it is expected that an obstacle is encountered, the processor 140 may perform an emergency stop or command the path generation module 141 of the processor 140 to search for another autonomous driving path.

다음으로 도 5를 참조하여 웨이포인트를 설정하는 방법에 대해 설명하도록 한다. 예를 들어, 도 5의 (a)와 같이, 스피드 스프레이어(1)가 지점 211 → 지점 212 → 지점 213 → 지점 214 → 지점 215 → 지점 216 → 지점 217 → 지점 218 → 지점 219를 따라 이동한 경우를 가정한다.Next, a method of setting a waypoint will be described with reference to FIG. 5. For example, as shown in (a) of FIG. 5, the speed sprayer 1 moves along point 211 → point 212 → point 213 → point 214 → point 215 → point 216 → point 217 → point 218 → point 219 Assume the case.

이 경우, 각 지점에 대한 지역 좌표는 특정한 기준점을 기준으로 한 x,y 좌표 및 높이 h로 구성되며, 도 5에서는 각 지점에 대해 (xn,yn,hn)(여기에서, n은 1~9)으로 표시하였다.In this case, the regional coordinates for each point are composed of x,y coordinates and height h based on a specific reference point, and in FIG. 5, (xn,yn,hn) for each point (where n is 1 to 9 ).

이 경우, 프로세서(140)는 지점 211 → 지점 212 → 지점 213을 따라 이동한 경로에 대해서는, 이들 지점 간의 방향각 사이의 차이가 기설정된 값 미만이라는 점에서, 해당 경로는 직선 경로에 해당하는 것으로 판단하고, 지점 213 → 지점 214 → 지점 215 → 지점 216을 따라 이동한 경로에 대해서는, 이들 지점 간의 방향각 사이의 차이가 기설정된 값 이상이라는 점에서, 해당 경로는 곡선 경로에 해당하는 것으로 판단하고, 지점 216 → 지점 217 → 지점 218 → 지점 219를 따라 이동한 경로에 대해서는, 이들 지점 간의 방향각 사이의 차이가 기설정된 값 미만이라는 점에서, 해당 경로는 직선 경로에 해당하는 것으로 판단할 수 있다.In this case, the processor 140 indicates that the path moved along the point 211 → the point 212 → the point 213 is that the difference between the direction angles between these points is less than a preset value, and the corresponding path corresponds to a straight path. For the path that traveled along point 213 → point 214 → point 215 → point 216, since the difference between the direction angles between these points is more than a preset value, it is determined that the corresponding path corresponds to a curved path. , Point 216 → point 217 → point 218 → point 219, the difference between the direction angles between these points is less than a preset value, and the corresponding path can be determined to correspond to a straight path. .

이 경우, 프로세서(140)는 직선 경로에 포함된 지점에 대해서는, 직선 경로의 시작점과 끝점을 웨이포인트로 설정할 수 있다. 그리고, 프로세서(140)는 웨이포인트에 지역 좌표를 맵핑하고, 시작점에서 끝점을 향하는 경로 벡터를 시작점의 웨이포인트에 맵핑하여, 직선 경로에 대한 자율 주행 경로를 생성할 수 있다.In this case, the processor 140 may set a starting point and an ending point of the linear path as waypoints for points included in the linear path. In addition, the processor 140 may map local coordinates to the waypoint and map a path vector from the start point to the end point to the waypoint of the start point, thereby generating an autonomous driving route for a straight line.

또한, 프로세서(140)는 곡선 경로에 포함된 지점에 대해서는, 곡선 경로에 포함된 지점들을 웨이포인트로 설정할 수 있다. 그리고, 프로세서(140)는 웨이포인트에 지역 좌표를 맵핑하고, 각 지점에서 다음 지점을 향하는 경로 벡터를 각 지점의 웨이포인트에 맵핑하여, 곡선 경로에 대한 자율 주행 경로를 생성할 수 있다.Also, for points included in the curved path, the processor 140 may set points included in the curved path as waypoints. Further, the processor 140 may generate an autonomous driving route for a curved path by mapping local coordinates to the waypoints and mapping a path vector from each point to the next point to the waypoints of each point.

예를 들어, 도 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을 따라 이동한 경로에 대한 자율 주행 경로를 생성할 수 있다.For example, in (a) of FIG. 5, the speed sprayer 1 moves along a point 211 → a point 212 → a point 213, in that the path corresponds to a straight path. As in b), point 211 and point 213 are set as waypoints for the corresponding route, local coordinates (x1,y1,h1) are mapped to waypoint 1 (ie, point 211), and local coordinates (x3,y3 ,h3) is mapped to waypoint 2 (i.e., point 213), and the vector 221 connecting waypoint 1 to waypoint 2 is mapped to waypoint 1 (i.e., point 211), and speed sprayer (1) It is possible to create an autonomous driving route for a route that traveled along point 211 → point 212 → point 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을 따라 이동한 경로에 대한 자율 주행 경로를 생성할 수 있다.In addition, in (a) of FIG. 5, the path that the speed sprayer 1 moves along the point 213 → the point 214 → the point 215 → the point 216 corresponds to a curved path, and the processor 140 is shown in FIG. As in (b), point 213, point 214, point 215, and point 216 are set as waypoints for the corresponding route, and local coordinates (x3,y3,h3) are mapped to waypoint 2 (i.e., point 213). , Local coordinates (x4,y4,h4) are mapped to waypoint 3 (i.e., point 214), local coordinates (x5,y5,h5) are mapped to waypoint 4 (i.e., point 215), and local coordinates ( x6,y6,h6) is mapped to waypoint 5 (i.e., point 216), and the vector 222 connecting waypoint 2 to waypoint 3 is mapped to waypoint 2 (i.e., point 213), and waypoint 3 Mapping the vector 223 connecting waypoint 4 in the waypoint 3 (i.e., point 214), and mapping the vector 224 connecting waypoint 4 to waypoint 5 to waypoint 4 (ie, point 215) , Point 213 → point 214 → point 215 → point 216, it is possible to create an autonomous driving route for a route that has moved along.

또한, 도 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를 따라 이동한 경로에 대한 자율 주행 경로를 생성할 수 있다.In addition, in (a) of FIG. 5, the path that the speed sprayer 1 moves along the point 216 → point 217 → point 218 → point 219 corresponds to a straight path, and the processor 140 is shown in FIG. As shown in (b), point 216 and point 219 are set as waypoints for the corresponding route, local coordinates (x6,y6,h6) are mapped to waypoint 5 (that is, point 216), and local coordinates (x9, y9,h9) is mapped to waypoint 6 (i.e., point 219), and the vector 225 connecting waypoint 5 to waypoint 6 is mapped to waypoint 5 (i.e., point 216), and the speed sprayer (1) ) Can create an autonomous driving route for a route that traveled along point 216 → point 217 → point 218 → point 219.

이와 같이, 본 발명의 실시예에 따르면, 자율 주행을 위해, 경로 및 해당 경로 주변을 포함하는 지도 전체를 저장하는 것이 아니라, 스피드 스프레이어(1)가 실제로 주행할 경로를 미리 주행하여 해당 경로에 대한 정보만을 저장할 수 있다. 또한, 해당 경로에서 획득한 모든 위치 관련 정보를 저장하는 것이 아니라, 경로의 형태에 따라 위치 관련 정보를 선별적으로 저장하여 자율 주행 경로를 생성할 수 있다.As described above, according to an embodiment of the present invention, for autonomous driving, instead of storing the entire map including the route and the periphery of the route, the speed sprayer 1 travels the route to be actually driven in advance and It can only store information about. In addition, it is possible to generate an autonomous driving route by selectively storing location-related information according to the shape of the route, rather than storing all location-related information acquired on a corresponding route.

또한 이와 같이, 본 발명의 실시예에 따르면 스피드 스프레이어(1)가 생성된 자율 주행 경로를 따라 이동하는 경우에 장애물을 만나게 되더라도 프로세서(140)는 카메라(160)로부터의 입력에 기반하여 충돌여부를 판단하고 다른 경로를 탐색하도록 함으로써 보다 안정적으로 스피드 스프레이어(1)를 자율주행시킬 수 있다.In addition, according to an embodiment of the present invention, even if an obstacle is encountered when the speed sprayer 1 moves along the generated autonomous driving path, the processor 140 determines whether or not there is a collision based on the input from the camera 160. It is possible to autonomously drive the speed sprayer 1 more stably by determining and searching for another route.

이에 따라, 본 발명의 실시예에 따르면, 고가의 센서가 부착된 드론 또는 MMS(Mobile Mapping System) 등을 이용하지 않아도, 최적의 자율 주행 경로를 생성할 수 있다는 점에서, 기존에 비해 시간 및 경제적인 측면에서 효율성이 극대화될 수 있다. Accordingly, according to an embodiment of the present invention, it is possible to generate an optimal autonomous driving route without using a drone with an expensive sensor or a Mobile Mapping System (MMS). Efficiency can be maximized in terms of phosphorus.

한편, 프로세서(140)는 자율 주행 경로를 따라 스피드 스프레이어(1)가 주행하도록 제어할 수 있다. 구체적으로, 프로세서(140)는 센서(120)를 통해 감지된 스피드 스프레이어(1)의 위치 및 움직임에 기초하여 스피드 스프레이어(1)가 자율 주행 경로를 따라 주행하도록 액추에이터부(110)를 제어할 수 있다. 이 경우, 프로세서(140)는 GNSS 센서(121)의 이상 여부에 대해 판단하고, 그에 따라, 스피드 스프레이어(1)의 주행을 제어할 수 있다.Meanwhile, the processor 140 may control the speed sprayer 1 to travel along the autonomous driving path. Specifically, the processor 140 controls the actuator unit 110 so that the speed sprayer 1 travels along the autonomous driving path based on the position and movement of the speed sprayer 1 sensed through the sensor 120. can do. In this case, the processor 140 may determine whether or not the GNSS sensor 121 is abnormal, and accordingly, control the running of the speed sprayer 1.

이하에서는 도 6를 참조하여 GNSS 센서(121)의 이상 여부에 대해 판단하는 방법에 대해 보다 구체적으로 설명하도록 한다.Hereinafter, a method of determining whether the GNSS sensor 121 is abnormal will be described in more detail with reference to FIG. 6.

먼저, 단계 S305에서 GNSS 센서(121)로부터 품질 판단 인자를 수신한다. 이어서 단계 S310에서, 프로세서(140)는 GNSS 센서(121)의 품질을 판단하기 위한 인자와 기설정된 기준값을 비교한다. 여기에서, 품질 판단 인자는 GNSS 센서(121)의 모호수 종류, 위치 정밀도, 위성의 개수, DOP(Dilution Of Precision) 중 적어도 하나를 포함할 수 있으며, 이러한 정보는 GNSS 센서(121)로부터 획득될 수 있다.First, in step S305, a quality determination factor is received from the GNSS sensor 121. Subsequently, in step S310, the processor 140 compares a factor for determining the quality of the GNSS sensor 121 with a preset reference value. 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 GNSS sensor 121, and such information may be obtained from the GNSS sensor 121. I can.

이 경우, 단계 S320에서 프로세서(140)는 품질 판단 인자가 기설정된 기준값을 만족하지 않는 경우, 단계는 S330으로 진행되고 현재 위치 상태가 불량한 것으로 판단할 수 있다. 이와 같이, 프로세서(140)는 품질 판단 인자가 기설정된 기준값을 만족하지 않으면 GNSS 센서(121)로부터 획득되는 데이터의 정확도가 떨어지는 것으로 볼 수 있다. 이에 따라, 프로세서(140)는 GNSS 센서(121)로부터 획득되는 위치 관련 정보를 스피드 스프레이어(1)의 주행의 제어에 이용하지 않으며, 스피드 스프레이어(1)가 주행 중인 경우에는 스피드 스프레이어(1)의 주행을 멈추도록 액추에이터부(110)를 제어할 수 있다.In this case, in step S320, when the quality determination factor does not satisfy the preset reference value, the step proceeds to S330 and may determine that the current location state is bad. In this way, if the quality determination factor does not satisfy a preset reference value, the processor 140 may see that the accuracy of the data acquired from the GNSS sensor 121 is poor. Accordingly, the processor 140 does not use the position-related information obtained from the GNSS sensor 121 to control the running of the speed sprayer 1, and when the speed sprayer 1 is running, the speed sprayer ( The actuator unit 110 can be controlled to stop the driving of 1).

예를 들어, 프로세서(140)는 케터필러의 구동을 중단시키기 위한 제어 신호를 생성하고, 생성된 제어 신호를 액추에이터부(110)로 제공할 수 있다. 이 경우, 액추에이터부(110)는 프로세서(140)로부터 제공받은 제어 신호에 따라 브레이크 액추에이터 또는 감속기를 구동하여, 케터필러의 구동을 중단시킬 수 있다.For example, the processor 140 may generate a control signal for stopping the driving of the caterpillar and provide the generated control signal to the actuator unit 110. In this case, the actuator unit 110 may stop driving the caterpillar by driving the brake actuator or the reducer according to the control signal provided from the processor 140.

한편, 프로세서(140)는 품질 판단 인자가 기설정된 기준값을 만족하는 경우(S320-Y), GNSS 센서(121)를 통해 획득된 데이터를 메모리(130)에 저장한다(S340). 여기에서, GNSS 센서(121)를 통해 획득된 데이터는 스피드 스프레이어(1)의 위치, 속도 및 방향각 등을 포함할 수 있다.Meanwhile, when the quality determination factor satisfies a preset reference value (S320-Y), the processor 140 stores data acquired through the GNSS sensor 121 in the memory 130 (S340). Here, the data acquired through the GNSS sensor 121 may include the position, speed, and direction angle of the speed sprayer 1.

이후, 프로세서(140)는 현재 시간보다 특정한 시간 이전의 항법해(navigation solution)를 통해 스피드 스프레이어(1)의 현재 위치를 예측한다(350).Then, the processor 140 predicts the current position of the speed sprayer 1 through a navigation solution before a specific time before the current time (350).

즉, 프로세서(140)는 현재 시간보다 특정한 시간 이전에 GNSS 센서(121)를 통해 획득된 데이터를 이용하여, 해당 시간으로부터 특정한 시간 이후에서의 스피드 스프레이어(1)의 위치 즉, 현재 시간에서의 스피드 스프레이어(1)의 위치를 예측할 수 있다.That is, the processor 140 uses the data acquired through the GNSS sensor 121 before a specific time than the current time, and the position of the speed sprayer 1 at a specific time after the corresponding time, that is, at the current time. The position of the speed sprayer 1 can be predicted.

구체적으로, 프로세서(140)는 이전 시간에서 GNSS 센서(121)를 통해 획득된 스피드 스프레이어(1)의 이전 시간에서의 위치, 이전 시간에서의 속도, 이전 시간에서의 방향각과, 이전 시간과 현재 시간 사이의 시간 차이를 이용하여, 현재 시간에서의 스피드 스프레이어(1)의 위치를 예측할 수 있다.Specifically, the processor 140 is the position at the previous time, the speed at the previous time, the direction angle at the previous time, and the previous time and the present time of the speed sprayer 1 acquired through the GNSS sensor 121 at the previous time. Using the time difference between times, it is possible to predict the position of the speed sprayer 1 at the current time.

즉, 프로세서(140)는 스피드 스프레이어(1)가 이전 시간에서의 위치부터 이전 시간에서의 방향을 따라 이전 시간에서의 속도로 시간 차이 동안 이동한 경우, 현재 시간에 스피드 스프레이어(1)가 도달할 위치를 현재 시간에서의 스피드 스프레이어(1)의 위치로 예측할 수 있다. That is, when the speed sprayer 1 moves from the position at the previous time to the direction at the previous time for a time difference at the speed at the previous time, the speed sprayer 1 is The position to be reached can be predicted by the position of the speed sprayer 1 at the current time.

그리고, 프로세서(140)는 GNSS 기반으로 현재 스피드 스프레이어(1)의 위치를 측정할 수 있다(S360). 즉, 프로세서(140)는 현재 시간에 GNSS 센서(121)를 통해 스피드 스프레이어(1)의 현재 위치를 획득할 수 있다.Then, the processor 140 may measure the current position of the speed sprayer 1 based on GNSS (S360). That is, the processor 140 may acquire the current position of the speed sprayer 1 through the GNSS sensor 121 at the current time.

이후, 프로세서(140)는 예측된 스피드 스프레이어(1)의 현재 위치와 GNSS 센서(121)를 통해 획득한 스피드 스프레이어(1)의 현재 위치를 비교하여, GNSS 센서(121)를 통해 획득되는 스피드 스프레이어(1)의 위치가 양호한 상태인지를 판단할 수 있다.Thereafter, the processor 140 compares the predicted current position of the speed sprayer 1 with the current position of the speed sprayer 1 acquired through the GNSS sensor 121, and is obtained through the GNSS sensor 121. It can be determined whether the position of the speed sprayer 1 is in a good state.

구체적으로, 프로세서(140)는 예측된 스피드 스프레이어(1)의 현재 위치와 GNSS 센서(121)를 통해 획득한 스피드 스프레이어(1)의 현재 위치 사이의 거리 차이를 산출할 수 있다(S370).Specifically, the processor 140 may calculate a distance difference between the predicted current position of the speed sprayer 1 and the current position of the speed sprayer 1 acquired through the GNSS sensor 121 (S370). .

그리고, 프로세서(140)는 거리 차이가 기준값을 만족하지 않는 경우(S380-N)(즉, 거리 차이가 기설정된 기준값을 초과하는 경우), 현재 위치 상태가 불량한 것으로 판단할 수 있다(S330). 즉, 프로세서(140)는 거리 차이가 기준값을 만족하지 않는 경우, GNSS 센서(121)에서 측정되는 스피드 스프레이어(1)의 위치가 불량한 것으로 판단할 수 있다.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 processor 140 may determine that the current location state is bad (S330). That is, when the distance difference does not satisfy the reference value, the processor 140 may determine that the position of the speed sprayer 1 measured by the GNSS sensor 121 is bad.

이와 같이, GNSS 센서(121)에서 측정되는 스피드 스프레이어(1)의 위치가 불량한 것으로 판단된 경우, 프로세서(140)는 GNSS 센서(121)로부터 획득되는 위치 관련 정보를 스피드 스프레이어(1)의 주행의 제어에 이용하지 않으며, 스피드 스프레이어(1)가 주행 중인 경우에는 스피드 스프레이어(1)의 주행을 멈추도록 액추에이터부(110)를 제어할 수 있다(S380).As described above, when it is determined that the position of the speed sprayer 1 measured by the GNSS sensor 121 is determined to be bad, the processor 140 transmits the position-related information obtained from the GNSS sensor 121 to the speed sprayer 1. When the speed sprayer 1 is not used to control the driving, and the speed sprayer 1 is running, the actuator unit 110 may be controlled to stop the driving of the speed sprayer 1 (S380).

한편, 프로세서(140)는 거리 차이가 기준값을 만족하는 경우(S380-Y)(즉, 거리 차이가 기설정된 기준값 이하인 경우), 현재 위치 상태가 양호한 것으로 판단할 수 있다(S290). 즉, 프로세서(140)는 거리 차이가 기준값을 만족하는 경우, GNSS 센서(121)에서 측정되는 스피드 스프레이어(1)의 위치가 양호한 것으로 판단할 수 있다.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 processor 140 may determine that the current location state is good (S290). That is, when the distance difference satisfies the reference value, the processor 140 may determine that the position of the speed sprayer 1 measured by the GNSS sensor 121 is good.

이 경우, GNSS 센서(121)에서 측정되는 스피드 스프레이어(1)의 위치가 양호한 것으로 판단된 경우, 프로세서(140)는 GNSS 센서(121)에서 측정되는 위치 관련 데이터를 이용하여 스피드 스프레이어(1)의 주행을 제어할 수 있다.In this case, when it is determined that the position of the speed sprayer 1 measured by the GNSS sensor 121 is good, the processor 140 uses the position-related data measured by the GNSS sensor 121 to use the speed sprayer 1 ) Can be controlled.

이와 같이, 본 발명의 실시예에 따르면, 주변 환경에 따라 GNSS 센서(121)에서 스피드 스프레이어(1)의 위치와 관련하여 부정확한 데이터가 측정될 수 있다는 점에서, 스피드 스프레이어(1)의 주행을 제어할 때, GNSS 센서(121)에서 획득되는 데이터의 이상 여부를 판단하고, 그 결과에 따라 스피드 스프레이어(1)의 주행을 제어할 수 있다는 점에서, 보다 정확히 자율 주행을 제어할 수 있게 된다.As such, according to an embodiment of the present invention, in that inaccurate data may be measured in relation to the position of the speed sprayer 1 in the GNSS sensor 121 according to the surrounding environment, the speed sprayer 1 When controlling the driving, it is possible to more accurately control autonomous driving in that it is possible to determine whether the data acquired by the GNSS sensor 121 is abnormal, and to control the driving of the speed sprayer 1 according to the result. There will be.

한편, 프로세서(140)는 자율 주행 경로를 갱신하고, 갱신된 자율 주행 경로를 따라 스피드 스프레이어(1)가 주행하도록 제어할 수 있다.Meanwhile, the processor 140 may update the autonomous driving route and control the speed sprayer 1 to travel along the updated autonomous driving route.

즉, 프로세서(140)는 스피드 스프레이어(1)가 자율 주행 경로에서 이탈한 경우, 주변에 존재하는 복수의 웨이포인트 중에서 어떠한 웨이포인트가 스피드 스프레이어(1)가 주행하여야 할 목표 지점에 해당하는지를 결정하고, 결정된 웨이포인트에 기초하여 자율 주행 경로를 갱신할 수 있다. 그리고, 프로세서(140)는 갱신된 자율 주행 경로를 따라 스피드 스프레이어(1)가 주행하도록 제어할 수 있다.That is, when the speed sprayer 1 deviates from the autonomous driving route, the processor 140 determines which waypoint among a plurality of waypoints existing around the speed sprayer 1 corresponds to a target point to which the speed sprayer 1 should travel. It may determine and update the autonomous driving route based on the determined waypoint. In addition, the processor 140 may control the speed sprayer 1 to travel along the updated autonomous driving path.

먼저, 프로세서(140)는 GNSS 센서(121)를 통해 획득되는 스피드 스프레이어(1)의 위치가 양호한 상태인지를 판단할 수 있다(S410). 이후, 프로세서(140)는 GNSS 센서(121)를 통해 획득되는 스피드 스프레이어(1)의 위치가 양호한 경우, GNSS 센서(121)를 통해 스피드 스프레이어(1)의 현재 위치를 획득할 수 있다(S420).First, the processor 140 may determine whether the position of the speed sprayer 1 acquired through the GNSS sensor 121 is in a good state (S410). Thereafter, when the position of the speed sprayer 1 acquired through the GNSS sensor 121 is good, the processor 140 may obtain the current position of the speed sprayer 1 through the GNSS sensor 121 ( S420).

그리고, 프로세서(140)는 스피드 스프레이어(1)의 현재 위치 및 자율 주행 경로에 기초하여, 스피드 스프레이어(1)가 자율 주행 경로를 이탈하였는지 여부를 판단할 수 있다(S430).Further, the processor 140 may determine whether the speed sprayer 1 deviates from the autonomous driving path based on the current position of the speed sprayer 1 and the autonomous driving path (S430).

구체적으로, 프로세서(140)는 GNSS 센서(121)를 통해 획득된 스피드 스프레이어(1)의 현재 위치를, 웨이포인트의 위치 및 경로 벡터에 따라 웨이포인트 사이에서 정의되는 위치와 비교하여, 스피드 스프레이어(1)의 현재 위치가 해당 위치들에 포함되지 않거나, 해당 위치들로부터 기설정된 거리 이상 떨어진 경우, 스피드 스프레이어(1)가 자율 주행 경로를 이탈한 것으로 판단할 수 있다.Specifically, the processor 140 compares the current position of the speed sprayer 1 acquired through the GNSS sensor 121 with a position defined between waypoints according to the position of the waypoint and the path vector, When the current position of the air 1 is not included in the corresponding positions or is more than a preset distance from the corresponding positions, it may be determined that the speed sprayer 1 has deviated from the autonomous driving route.

그리고, 프로세서(140)는 스피드 스프레이어(1)가 자율 주행 경로를 이탈한 것으로 판단된 경우(S430-Y), 스피드 스프레이어(1)의 현재 위치를 기준으로, 경로 벡터와 직교하는 수직선을 판단할 수 있다(S440).In addition, when it is determined that the speed sprayer 1 has deviated from the autonomous driving path (S430-Y), the processor 140 draws a vertical line perpendicular to the path vector based on the current position of the speed sprayer 1 It can be determined (S440).

이후, 프로세서(140)는 수직선에 기초하여 자율 주행 경로를 갱신할 수 있다(S450).Thereafter, the processor 140 may update the autonomous driving route based on the vertical line (S450).

구체적으로, 프로세서(140)는 경로 벡터와 직교하는 수직선들 중 가장 거리가 짧은 수직선을 판단하고, 판단된 수직선과 만나는 경로 벡터가 향하는 웨이포인트를 현재 경로를 이탈한 스피드 스프레이어(1)가 이동해야할 새로운 웨이포인트로 설정하여, 자율 주행 경로를 갱신할 수 있다.Specifically, the processor 140 determines a vertical line having the shortest distance among vertical lines orthogonal to the path vector, and the speed sprayer 1 deviating from the current path moves the waypoint to which the path vector meets the determined vertical line. By setting a new waypoint to be done, the autonomous driving route can be updated.

예를 들어, 도 8와 같이, 스피드 스프레이어(1)가 자율 주행 경로를 이탈하여, 지점 510에 현재 위치하고, 스피드 스프레이어(1)의 현재 위치(510) 주변에 3 개의 웨이포인트(520, 530, 540)이 존재하는 것으로 가정한다.For example, as shown in FIG. 8, the speed sprayer 1 deviates from the autonomous driving route and is currently located at a point 510, and three waypoints 520 around the current position 510 of the speed sprayer 1 530, 540) are assumed to exist.

이 경우, 프로세서(140)는 스피드 스프레이어(1)의 현재 위치(510)을 시작점으로 하여 웨이포인트 1(520)에서 웨이포인트 2(530)까지의 경로 벡터(550)에 수직한 수직선(570) 및 스피드 스프레이어(1)의 현재 위치(510)을 시작점으로 하여 웨이포인트 2(530)에서 웨이포인트 3(540)까지의 경로 벡터(560)에 수직한 수직선(580)을 판단할 수 있다.In this case, the processor 140 uses the current position 510 of the speed sprayer 1 as a starting point and a vertical line 570 perpendicular to the path vector 550 from the waypoint 1 520 to the waypoint 2 530. ) And the current position 510 of the speed sprayer 1 as a starting point, a vertical line 580 perpendicular to the path vector 560 from the waypoint 2 530 to the waypoint 3 540 may be determined. .

그리고, 프로세서(140)는 수직선(570)과 수직선(580) 사이의 거리를 비교하여, 이들 중 상대적으로 짧은 수직선(570)을 판단하고, 수직선(570)이 만나는 경로 벡터(550)가 향하는 웨이포인트 2(530)를 스피드 스프레이어(1)가 현재 위치(510)에서 이동해야할 웨이포인트로 설정하고, 현재 위치(510)에서 웨이포인트 2(530)을 향하는 경로 벡터(590)를 현재 위치(510)에 대한 위치에 맵핑하여, 자율 주행 경로를 현재 위치(510) → 웨이포인트 2(530) → 웨이포인트 3(540)으로 갱신할 수 있다.In addition, the processor 140 compares the distance between the vertical line 570 and the vertical line 580, determines a relatively short vertical line 570 among them, and determines the path vector 550 where the vertical line 570 meets. Point 2 (530) is set as the waypoint that the speed sprayer 1 should move from the current position 510, and the path vector 590 from the current position 510 to the waypoint 2 530 is set to the current position ( By mapping to the location of 510, the autonomous driving route may be updated to the current location 510 → waypoint 2 530 → waypoint 3 540.

한편, 프로세서(140)는 스피드 스프레이어(1)가 자율 주행 경로를 따라 주행하도록 액추에이터부(110)를 제어할 수 있다.Meanwhile, the processor 140 may control the actuator unit 110 so that the speed sprayer 1 travels along an autonomous driving path.

즉, 프로세서(140)는 스피드 스프레이어(1)가 자율 주행 경로를 따라 이동할 때, 스피드 스프레이어(1)가 자율 주행 경로에서 벗어나지 않고, 일정한 운용 속도로 자율 주행 경로를 따라 주행하도록 액추에이터부(110)를 제어할 수 있다.That is, when the speed sprayer 1 moves along the autonomous driving path, the processor 140 does not deviate from the autonomous driving path, and the actuator unit 140 drives the speed sprayer 1 along the autonomous driving path at a constant operating speed. 110) can be controlled.

이 경우, 프로세서(140)는 움직임 제어 모듈(142)을 실행하고, 센서(120)에서 획득한 데이터, 메모리(130)로부터 획득한 자율 주행 경로에 대한 데이터 등을 움직임 제어 모듈(142)의 입력으로 하여, 액추에이터부(110)를 제어하기 위한 제어 신호를 생성하고, 생성된 제어 신호를 액추에이터부(110)로 출력할 수 있다. 이에 따라, 액추에이터부(110)는 프로세서(140)로부터 제공받은 제어 신호에 따라 엑셀레이터 액추에이터, 브레이크 액추에이터 및 조향각 제어 액추에이터를 구동하여, 스피드 스프레이어(1)의 주행을 제어할 수 있다.In this case, the processor 140 executes the motion control module 142, and inputs the data acquired from the sensor 120 and the data on the autonomous driving route acquired from the memory 130 to the motion control module 142. As a result, a control signal for controlling the actuator unit 110 may be generated, and the generated control signal may be output to the actuator unit 110. Accordingly, the actuator unit 110 may control the traveling of the speed sprayer 1 by driving an accelerator actuator, a brake actuator, and a steering angle control actuator according to a control signal provided from the processor 140.

이하에서는 도 9을 참조하여, 스피드 스프레이어(1)의 주행 속도를 제어하는 방법에 대해 설명하도록 한다.Hereinafter, a method of controlling the traveling speed of the speed sprayer 1 will be described with reference to FIG. 9.

먼저, 프로세서(140)는 GNSS 센서(121)를 통해 획득되는 스피드 스프레이어(1)의 위치가 양호한지 여부를 판단할 수 있다. 이 경우, 프로세서(140)는 도 6에 도시된 방법에 따라 GNSS 센서(121)를 통해 획득되는 스피드 스프레이어(1)의 위치가 양호한지 여부를 판단할 수 있다(S610).First, the processor 140 may determine whether the position of the speed sprayer 1 obtained through the GNSS sensor 121 is good. In this case, the processor 140 may determine whether the position of the speed sprayer 1 obtained through the GNSS sensor 121 is good according to the method shown in FIG. 6 (S610).

그리고, 프로세서(140)는 GNSS 센서(121)를 통해 획득된 스피드 스프레이어(1)의 위치가 양호하지 않은 것으로 판단되면(S620-N), 이동 중인 스피드 스프레이어(1)를 정지시킬 수 있다.In addition, if it is determined that the position of the speed sprayer 1 acquired through the GNSS sensor 121 is not good (S620-N), the processor 140 may stop the moving speed sprayer 1 .

이 경우, 프로세서(140)는 브레이크 액추에이터를 구동시킬 수 있다(S630). 구체적으로, 프로세서(140)는 바퀴의 구동을 중단시키기 위한 제어 신호를 생성하고, 생성된 제어 신호를 액추에이터부(110)로 제공할 수 있다. 이 경우, 액추에이터부(110)는 프로세서(140)로부터 제공받은 제어 신호에 따라 브레이크 액추에이터(감속기)를 구동하여, 바퀴의 구동을 중단시킬 수 있다.In this case, the processor 140 may drive the brake actuator (S630). Specifically, the processor 140 may generate a control signal for stopping the driving of the wheel, and may provide the generated control signal to the actuator unit 110. In this case, the actuator unit 110 may stop driving the wheel by driving the brake actuator (reducer) according to the control signal provided from the processor 140.

한편, 프로세서(140)는 GNSS 센서(121)를 통해 획득된 스피드 스프레이어(1)의 위치가 양호한 것으로 판단되면(S620-Y), GNSS 센서(121)에 의해 감지된 스피드 스프레이어(1)의 속도를 기설정된 운용 속도와 비교하여 스피드 스프레이어(1)의 속도를 제어할 수 있다.On the other hand, if the processor 140 determines that the position of the speed sprayer 1 acquired through the GNSS sensor 121 is good (S620-Y), the speed sprayer 1 detected by the GNSS sensor 121 It is possible to control the speed of the speed sprayer 1 by comparing the speed of the speed with a preset operating speed.

이 경우, 프로세서(140)는 GNSS 센서(121)에 의해 감지된 속도가 기설정된 운용 속도를 초과하는 경우, 이동 중인 스피드 스프레이어(1)의 속도를 감소시키고, GNSS 센서(121)에 의해 감지된 속도가 기설정된 운용 속도 미만인 경우, 이동 중인 스피드 스프레이어(1)의 속도를 증가시킬 수 있다.In this case, when the speed sensed by the GNSS sensor 121 exceeds the preset operating speed, the processor 140 reduces the speed of the moving speed sprayer 1 and is detected by the GNSS sensor 121 When the set speed is less than the preset operating speed, the speed of the moving speed sprayer 1 can be increased.

구체적으로, 프로세서(140)는 GNSS 센서(121)에 의해 감지된 스피드 스프레이어(1)의 현재 속도와 기설정된 운용 속도 간의 차이를 산출할 수 있다(S640).Specifically, the processor 140 may calculate a difference between the current speed of the speed sprayer 1 detected by the GNSS sensor 121 and a preset operating speed (S640).

그리고, 프로세서(140)는 스피드 스프레이어(1)의 현재 속도와 기설정된 운용 속도 간의 차이에 기초하여 스피드 스프레이어(1)의 속도를 제어할 수 있다.Further, the processor 140 may control the speed of the speed sprayer 1 based on a difference between the current speed of the speed sprayer 1 and a preset operating speed.

구체적으로, 프로세서(140)는 스피드 스프레이어(1)의 현재 속도와 기설정된 운용 속도 간의 차이가 기설정된 기준값을 초과하는지 여부를 판단할 수 있다(S650).Specifically, the processor 140 may determine whether a difference between the current speed of the speed sprayer 1 and a preset operating speed exceeds a preset reference value (S650).

이때, 프로세서(140)는 스피드 스프레이어(1)의 현재 속도와 기설정된 운용 속도 간의 차이가 기설정된 기준값을 초과하는 경우(S650-Y), 브레이크 액추에이터를 구동할 수 있다(S630).In this case, when the difference between the current speed of the speed sprayer 1 and the preset operating speed exceeds a preset reference value (S650-Y), the processor 140 may drive the brake actuator (S630).

구체적으로, 프로세서(140)는 스피드 스프레이어(1)의 속도가 기설정된 운용 속도가 되기 위해, 현재 속도에서 감소되어야 하는 속도를 판단하고, 판단된 속도만큼 스피드 스프레이어(1)의 속도를 감소시키기 위한 제어 신호를 생성하여 액추에이터부(110)로 제공할 수 있다. 이 경우, 액추에이터부(110)는 프로세서(140)로부터 제공받은 제어 신호에 따라 브레이크 액추에이터를 구동하여 바퀴의 속도를 감소시킬 수 있다. 이에 따라, 스피드 스프레이어(1)는 기설정된 운용 속도로 주행할 수 있게 된다.Specifically, the processor 140 determines the speed to be reduced from the current speed in order for the speed of the speed sprayer 1 to become a preset operating speed, and reduces the speed of the speed sprayer 1 by the determined speed. It is possible to generate a control signal to be provided to the actuator unit 110. In this case, the actuator unit 110 may reduce the speed of the wheel by driving the brake actuator according to the control signal provided from the processor 140. Accordingly, the speed sprayer 1 can run at a preset operating speed.

한편, 프로세서(140)는 스피드 스프레이어(1)의 현재 속도와 기설정된 운용 속도 간의 차이가 기설정된 기준값을 초과하지 않은 경우(S650-N), 차이가 기설정된 기준값 미만인지를 판단할 수 있다.Meanwhile, when the difference between the current speed of the speed sprayer 1 and the preset operating speed does not exceed a preset reference value (S650-N), the processor 140 may determine whether the difference is less than a preset reference value. .

그리고, 프로세서(140)는 스피드 스프레이어(1)의 현재 속도와 기설정된 운용 속도 간의 차이가 기설정된 기준값 미만인 경우(S660-Y), 액추에이터를 구동할 수 있다(S670).In addition, when the difference between the current speed of the speed sprayer 1 and the preset operation speed is less than a preset reference value (S660-Y), the processor 140 may drive the actuator (S670).

구체적으로, 프로세서(140)는 스피드 스프레이어(1)의 속도가 기설정된 운용 속도가 되기 위해, 현재 속도에서 증가되어야 하는 속도를 판단하고, 판단된 속도만큼 스피드 스프레이어(1)의 속도를 증가시키기 위한 제어 신호를 생성하여 액추에이터부(110)로 제공할 수 있다. 이 경우, 액추에이터부(110)는 프로세서(140)로부터 제공받은 제어 신호에 따라 엑셀레이터 액추에이터를 구동하여, 바퀴의 속도를 증가시킬 수 있다. 이에 따라, 스피드 스프레이어(1)는 기설정된 운용 속도로 주행할 수 있게 된다.Specifically, the processor 140 determines the speed to be increased from the current speed in order for the speed of the speed sprayer 1 to become a preset operating speed, and increases the speed of the speed sprayer 1 by the determined speed. It is possible to generate a control signal to be provided to the actuator unit 110. In this case, the actuator unit 110 may increase the speed of the wheel by driving the accelerator actuator according to the control signal provided from the processor 140. Accordingly, the speed sprayer 1 can run at a preset operating speed.

한편, 프로세서(140)는 스피드 스프레이어(1)의 현재 속도와 기설정된 운용 속도 간의 차이가 기설정된 기준값 미만에 해당하지 않는 경우(S660-N), S610 단계로 돌아가 전술한 반복할 수 있다. 결국, 프로세서(140)는 전술한 방법을 통해, 스피드 스프레이어(1)가 기설정된 운용 속도로 자율 주행 경로를 따라 주행하도록 제어할 수 있다.Meanwhile, when the difference between the current speed of the speed sprayer 1 and the preset operating speed does not fall below a preset reference value (S660-N), the processor 140 may return to step S610 and repeat the above-described steps. As a result, the processor 140 may control the speed sprayer 1 to travel along the autonomous driving path at a preset operating speed through the above-described method.

이하에서는 도 10을 참조하여, 스피드 스프레이어(1)의 주행 방향을 제어하는 방법에 대해 설명하도록 한다.Hereinafter, a method of controlling the traveling direction of the speed sprayer 1 will be described with reference to FIG. 10.

먼저, 프로세서(140)는 GNSS 센서(121)를 통해 획득되는 스피드 스프레이어(1)의 위치가 양호한지 여부를 판단할 수 있다. 이 경우, 프로세서(140)는 도 6에 도시된 방법에 따라 GNSS 센서(121)를 통해 획득되는 스피드 스프레이어(1)의 위치가 양호한지 여부를 판단할 수 있다.First, the processor 140 may determine whether the position of the speed sprayer 1 obtained through the GNSS sensor 121 is good. In this case, the processor 140 may determine whether the position of the speed sprayer 1 acquired through the GNSS sensor 121 is good according to the method illustrated in FIG. 6.

그리고, 프로세서(140)는 GNSS 센서(121)를 통해 획득되는 스피드 스프레이어(1)의 위치가 양호한 것으로 판단되면, 항법해를 획득한다(S710). 구체적으로, 프로세서(140)는 현재 시간에 GNSS 센서(121)를 통해 스피드 스프레이어(1)의 위치, 속도 및 방향각 등을 획득할 수 있다.In addition, when it is determined that the position of the speed sprayer 1 acquired through the GNSS sensor 121 is good, the processor 140 obtains a navigation solution (S710). Specifically, the processor 140 may acquire the position, speed, and direction angle of the speed sprayer 1 through the GNSS sensor 121 at the current time.

그리고, 프로세서(140)는 획득된 항법해에 기초하여 자율 주행 경로 상에서 현재 시간을 기준으로 특정 시간 이후의 제1 위치를 추정할 수 있으며, 즉, 프로세서(140)는 현재 시간에 GNSS 센서(121)를 통해 획득된 데이터를 이용하여, 현재 시간으로부터 특정한 시간 이후에 스피드 스프레이어(1)가 자율 주행 경로 상에서 주행할 위치를 추정할 수 있다(S720).In addition, the processor 140 may estimate the first position after a specific time on the autonomous driving route based on the current time based on the obtained navigation solution. That is, the processor 140 may estimate the GNSS sensor 121 at the current time. ), it is possible to estimate a position at which the speed sprayer 1 will travel on the autonomous driving route after a specific time from the current time (S720).

구체적으로, 프로세서(140)는 스피드 스프레이어(1)가 현재 시간의 위치로부터 현재 시간의 속도로 특정한 시간 동안 자율 주행 경로를 따라 주행할 경우, 특정한 시간이 경과한 시점에 자율 주행 경로 상에서 도착하는 위치를 특정한 시간 이후에 스피드 스프레이어(1)가 자율 주행 경로 상에서 주행할 위치로 추정할 수 있다.Specifically, when the speed sprayer 1 travels along the autonomous driving route for a specific time from the position of the current time to the speed of the current time, the processor 140 is The position may be estimated as a position at which the speed sprayer 1 will travel on an autonomous driving route after a specific time.

또한, 프로세서(140)는 획득된 항법해에 기초하여 현재 시간을 기준으로 특정 시간 이후의 제2 위치를 추정할 수 있다.Also, the processor 140 may estimate the second position after a specific time based on the current time based on the obtained navigation solution.

구체적으로, 프로세서(140)는 스피드 스프레이어(1)가 현재 시간의 위치부터, 자율 주행 경로 상이 아닌, 현재 시간에서의 이동 방향을 따라 현재 시간의 속도로 특정한 시간 동안 주행할 경우, 특정한 시간이 경과한 시점에 도착하는 위치를 스피드 스프레이어(1)가 특정한 시간 이후에 주행할 위치로 추정할 수 있다.Specifically, when the speed sprayer 1 travels for a specific time at the speed of the current time along the moving direction at the current time, not on the autonomous driving route, from the position of the current time, the processor 140 The position arriving at the elapsed time can be estimated as a position at which the speed sprayer 1 will travel after a specific time.

그리고, 프로세서(140)는 스피드 스프레이어(1)의 현재 위치를 기준으로 제1 위치까지의 제1 벡터와 스피드 스프레이어(1)의 현재 위치를 기준으로 제2 위치까지의 제2 벡터 사이의 방향각 차이를 산출할 수 있다(S730).In addition, the processor 140 is the first vector to the first position based on the current position of the speed sprayer 1 and the second vector to the second position based on the current position of the speed sprayer (1). The direction angle difference may be calculated (S730).

즉, 프로세서(140)는 스피드 스프레이어(1)의 현재 위치부터 제1 위치를 연결하는 제1 벡터와 현재 위치부터 제2 위치를 연결하는 제2 벡터를 각각 생성하고, 제1 및 제2 벡터 사이의 방향각 차이를 산출할 수 있다.That is, the processor 140 generates a first vector connecting the first position from the current position of the speed sprayer 1 and a second vector connecting the second position from the current position, respectively, and the first and second vectors You can calculate the difference in the direction angle between

이후, 프로세서(140)는 산출된 방향각 차이에 기초하여 이동 중인 스피드 스프레이어(1)의 이동 방향을 제어할 수 있다.Thereafter, the processor 140 may control the moving direction of the moving speed sprayer 1 based on the calculated difference in direction angle.

구체적으로, 프로세서(140)는 Steering Dynamic Model을 이용하여, 산출된 방향각만큼 스피드 스프레이어(1)의 주행 방향이 변경되기 위하여, 양측의 케퍼필러에 전달되는 구동력을 상이하게 하여 회전하여야 하는 조향각을 산출할 수 있다(S740).Specifically, the processor 140 uses the Steering Dynamic Model to change the driving direction of the speed sprayer 1 by the calculated direction angle, and the steering angle to be rotated by making the driving force transmitted to the capper pillars on both sides different. Can be calculated (S740).

그리고, 프로세서(140)는 산출된 조향각에 기초하여 조향각 제어를 위한 액추에이터를 구동할 수 있다. 즉, 프로세서(140)는 바퀴의 회전축을 산출된 조향각만큼 회전시키기 위한 제어 신호를 생성하여 액추에이터부(110)로 제공할 수 있다. 이 경우, 액추에이터부(110)는 프로세서(140)로부터 제공받은 제어 신호에 따라 조향각 제어 액추에이터를 구동하여 산출된 조향각만큼 스피드 스프레이어(1)를 좌측 방향 또는 우측 방향으로 회전시킬 수 있다. 이에 따라, 스피드 스프레이어(1)는 자율 주행 경로를 벗어나지 않고, 자율 주행 경로를 따라 주행할 수 있게 된다.In addition, the processor 140 may drive an actuator for controlling the steering angle based on the calculated steering angle. That is, the processor 140 may generate a control signal for rotating the rotation axis of the wheel by the calculated steering angle and provide it to the actuator unit 110. In this case, the actuator unit 110 may drive the steering angle control actuator according to the control signal provided from the processor 140 to rotate the speed sprayer 1 in the left or right direction by the calculated steering angle. Accordingly, the speed sprayer 1 can travel along the autonomous driving path without leaving the autonomous driving path.

한편, 전술한 예에서, 스피드 스프레이어(1)의 주행을 제어하기 위해, 프로세서(140)는 주행 센서(122)에서 획득되는 데이터 가령, 스피드 스프레이어(1)의 속도 및 방향각 등을 이용할 수도 있다.Meanwhile, in the above-described example, in order to control the running of the speed sprayer 1, the processor 140 uses data acquired from the travel sensor 122, for example, the speed and direction angle of the speed sprayer 1 May be.

또한, 전술한 예에서, 프로세서(140)는 갱신된 자율 주행 경로를 이용하여, 특정한 시간 이후에 스피드 스프레이어(1)가 자율 주행 경로 상에서 주행할 위치를 추정할 수 있다.In addition, in the above-described example, the processor 140 may estimate a position at which the speed sprayer 1 will travel on the autonomous driving path after a specific time by using the updated autonomous driving path.

또한, 전술한 예에서는, 프로세서(140)가 GNSS 센서(121)를 통해 획득되는 스피드 스프레이어(1)의 위치가 양호한 경우를 판단하고, 그에 따라, 스피드 스프레이어(1)의 주행 속도 및 주행 방향을 제어하는 것으로 설명하였으나, 실시 예에 따라, GNSS 센서(121)를 통해 획득되는 스피드 스프레이어(1)의 위치가 양호한지에 대한 판단 없이 GNSS 센서(121)를 통해 획득되는 데이터를 이용하여 스피드 스프레이어(1)의 주행 속도 및 주행 방향을 제어할 수 있음은 물론이다.In addition, in the above-described example, the processor 140 determines the case where the position of the speed sprayer 1 obtained through the GNSS sensor 121 is good, and accordingly, the traveling speed and the traveling speed of the speed sprayer 1 Although it has been described as controlling the direction, according to the embodiment, the speed obtained through the GNSS sensor 121 is used without determining whether the position of the speed sprayer 1 is good. Of course, it is possible to control the running speed and the running direction of the sprayer 1.

한편, 도 4을 참조하면, 통신부(150)는 다양한 유형의 통신 방식에 기초하여 서버(200)와 통신을 수행할 수 있다. 예를 들어, 통신부(150)는 3G(3Generation), LTE(Long Term Evolution) 등의 이동 통신망을 통해, 서버(200)와 통신을 수행할 수 있다.Meanwhile, referring to FIG. 4, the communication unit 150 may perform communication with the server 200 based on various types of communication methods. For example, the communication unit 150 may perform communication with the server 200 through a mobile communication network such as 3G (3Generation) and LTE (Long Term Evolution).

이 경우, 프로세서(140)는 통신부(150)를 통해 서버(200)와 다양한 데이터를 송수신할 수 있다. 예를 들어, 프로세서(140)는 스피드 스프레이어(1)의 위치, 속도 및 방향각 등을 포함하는 측위해에 정보 및 스피드 스프레이어(1)의 주행/운용 상황에 대한 정보(가령, 스피드 스프레이어(1)의 주행 시작 시간 정보, 주행 시간 정보, 이상 상태에 대한 정보 등) 등을 통신부(150)를 통해 서버(200)로 전송할 수 있다. 또한, 프로세서(140)는 스피드 스프레이어(1)의 동작을 제어하기 위한 제어 정보 및 펌웨어 업데이트를 위한 정보 등을 통신부(150)를 통해 서버(200)로부터 수신할 수 있다.In this case, the processor 140 may transmit and receive various data to and from the server 200 through the communication unit 150. For example, the processor 140 includes information on the measurement including the position, speed, and direction angle of the speed sprayer 1 and information on the driving/operation status of the speed sprayer 1 (for example, speed sprayer 1). (1) driving start time information, driving time information, information on abnormal conditions, etc.) may be transmitted to the server 200 through the communication unit 150. In addition, the processor 140 may receive control information for controlling the operation of the speed sprayer 1 and information for updating firmware from the server 200 through the communication unit 150.

서버(200)(가령, 스피드 스프레이어 IoT(Internet of Things) 서버)는 사용자나 관리자가 스피드 스프레이어(1)의 운용과 관련된 정보를 확인할 수 있는 IoT 기반의 플랫폼으로, 스피드 스프레이어(1)로부터 제공받은 정보를 포함하는 스피드 스프레이어(1)의 운용과 관련된 각종 정보를 저장할 수 있다. 또한, 서버(200)는 스피드 스프레이어(1)의 운용과 관련된 각종 정보를 사용자나 관리자의 전자 장치(300)로 전송할 수 있다. 예를 들어, 서버(200)는 3G, LTE 등의 이동 통신망을 통해, 스피드 스프레이어(1)의 위치, 속도 및 방향각 등을 포함하는 측위해에 정보 및 스피드 스프레이어(1)의 주행/운용 상황에 대한 정보 등을 전자 장치(300)로 전송할 수 있다.Server 200 (e.g., Speed Sprayer Internet of Things (IoT) Server) is an IoT-based platform that allows users or administrators to check information related to the operation of the speed sprayer (1). Various information related to the operation of the speed sprayer 1 including the information provided from may be stored. In addition, the server 200 may transmit various types of information related to the operation of the speed sprayer 1 to the electronic device 300 of a user or an administrator. For example, the server 200 provides information on the measurement including the position, speed, and direction angle of the speed sprayer 1 through a mobile communication network such as 3G and LTE, and the running/ Information on the operation situation may be transmitted to the electronic device 300.

전자 장치(300)는 스피드 스프레이어(1)를 제어하기 위한 기능을 수행할 수 있다. 이 경우, 전자 장치(300)는 스피드 스프레이어(1)를 제어하기 위한 전용 컨트롤러로 구현되거나, 또는 해당 기능을 실행하기 위한 어플리케이션이 설치된 스마트폰(smartphone) 또는 태블릿 PC(tablet personal computer) 등으로 구현될 수 있다.The electronic device 300 may perform a function for controlling the speed sprayer 1. In this case, the electronic device 300 is implemented as a dedicated controller for controlling the speed sprayer 1, or a smartphone or a tablet PC (tablet personal computer) in which an application for executing the function is installed. Can be implemented.

이를 위해, 전자 장치(300)는 스피드 스프레이어(1)를 제어하기 위한 유저 인터페이스를 전자 장치에 제공할 수 있다. 유저 인터페이스에는 서버로부터 제공받은 스피드 스프레이어(1)의 현재 운용 상황을 나타내는 정보가 표시될 수 있고, 또한, 스피드 스프레이어(1)를 제어하기 위한 사용자 명령을 입력받는 GUI(Graphical User Interface)가 표시될 수 있다.To this end, the electronic device 300 may provide a user interface for controlling the speed sprayer 1 to the electronic device. In the user interface, information indicating the current operating status of the speed sprayer 1 provided from the server may be displayed, and a GUI (Graphical User Interface) for receiving a user command for controlling the speed sprayer 1 is provided. Can be displayed.

다음으로 본 발명의 실시예에 따른 스피드 스프레이어의 자율 주행 방법을 이하에 설명한다. Next, an autonomous driving method of a speed sprayer according to an embodiment of the present invention will be described below.

먼저 프로세서는 센서를 이용하여 스피드 스프레이어의 위치 및 움직임을 감지한다. 그리고, 감지된 스피드 스프레이어의 위치 및 움직임에 기초하여 스피드 스프레이어가 메모리에 저장된 자율 주행 경로를 따라 주행하도록 제어한다. 여기에서 센서는 GNSS(Global Navigation Satellite System) 센서를 포함할 수 있다. 자율 주행 경로는 기설정된 경로를 스피드 스프레이어가 주행하는 동안에 GNSS 센서에서 획득된 데이터에 기초하여 생성될 수 있다. 여기에서, GNSS 센서에서 획득된 데이터는 스피드 스프레이어의 위치, 속도 및 방향각을 포함할 수 있다.First, the processor uses sensors to detect the position and movement of the speed sprayer. And, based on the detected position and movement of the speed sprayer, the speed sprayer is controlled to travel along the autonomous driving path stored in the memory. Here, the sensor may include a Global Navigation Satellite System (GNSS) sensor. The autonomous driving route may be generated based on data acquired from the GNSS sensor while the speed sprayer is driving the preset route. Here, the data acquired from the GNSS sensor may include the position, speed, and direction angle of the speed sprayer.

한편, 기설정된 경로를 스피드 스프레이어가 주행하는 동안, GNSS 센서를 통해 스피드 스프레이어의 측지 좌표를 획득하고 획득된 측지 좌표를 지역 좌표로 변환하고, GNSS 센서를 통해 스피드 스프레이어의 방향각을 획득하고, 획득된 방향각에 기초하여 스피드 스프레이어가 이동하는 경로의 형태를 판단하고, 지역 좌표 및 판단된 경로 형태에 기초하여 자율 주행 경로를 생성하고, 생성된 자율 주행 경로를 스피드 스프레이어에 저장할 수 있다.Meanwhile, while the speed sprayer is traveling on a preset path, the speed sprayer's geodesic coordinates are acquired through the GNSS sensor, the acquired geodesic coordinates are converted into local coordinates, and the speed sprayer's direction angle is acquired through the GNSS sensor. , Based on the obtained direction angle, the shape of the route the speed sprayer moves is determined, an autonomous driving route is generated based on the local coordinates and the determined route shape, and the generated autonomous driving route may be stored in the speed sprayer. .

한편, 스피드 스프레이어에 저장된 자율 주행 경로를 따라 주행하도록 제어하는 단계는 GNSS 센서의 품질을 판단하기 위한 인자와 기설정된 기준 값을 비교하고, 인자가 기설정된 기준 값을 만족하는 경우, 현재 시간보다 특정한 시간 이전의 항법해를 통해 예측된 스피드 스프레이어의 현재 위치와 GNSS 센서를 통해 획득된 스피드 스프레이어의 현재 위치를 비교하여 GNSS 센서를 통해 획득되는 스피드 스프레이어의 위치가 양호한 상태인지를 판단하고, 판단된 상태에 따라 스피드 스프레이어의 주행을 제어할 수 있다. 이 경우, GNSS 센서를 통해 획득된 스피드 스프레이어의 위치가 양호하지 않은 것으로 판단되면, 이동 중인 스피드 스프레이어를 정지시킬 수 있다.On the other hand, the step of controlling to drive along the autonomous driving route stored in the speed sprayer is to compare a factor for determining the quality of the GNSS sensor with a preset reference value, and if the factor satisfies the preset reference value, it is less than the current time. By comparing the current position of the speed sprayer predicted through the navigation solution before a certain time and the current position of the speed sprayer obtained through the GNSS sensor, it is determined whether the position of the speed sprayer obtained through the GNSS sensor is in good condition. , It is possible to control the running of the speed sprayer according to the determined state. In this case, if it is determined that the position of the speed sprayer obtained through the GNSS sensor is not good, the speed sprayer in motion may be stopped.

또한, GNSS 센서를 통해 획득된 스피드 스프레이어의 위치가 양호한 것으로 판단되면, GNSS 센서에 의해 감지된 스피드 스프레이어의 속도를 기설정된 운용 속도와 비교하여 스피드 스프레이어의 속도를 제어할 수 있다. 구체적으로, 감지된 속도가 기설정된 운용 속도를 초과하는 경우, 이동 중인 스피드 스프레이어의 속도를 감소시키고, 감지된 속도가 기설정된 운용 속도 미만인 경우, 이동 중인 스피드 스프레이어의 속도를 증가시킬 수 있다.In addition, if it is determined that the position of the speed sprayer obtained through the GNSS sensor is good, the speed of the speed sprayer detected by the GNSS sensor is compared with a preset operating speed to control the speed of the speed sprayer. Specifically, if the detected speed exceeds a preset operating speed, the speed of the moving speed sprayer may be reduced, and if the detected speed is less than the preset operating speed, the speed of the moving speed sprayer may be increased. .

한편, 스피드 스프레이어에 저장된 자율 주행 경로를 따라 주행하도록 제어하는 단계는 GNSS 센서를 통해 획득된 스피드 스프레이어의 위치가 양호한 것으로 판단되면, 현재 시간의 시간 이전의 항법해를 획득하고, 획득된 항법해에 기초하여 자율 주행 경로 상에서 현재 시간을 기준으로 특정 시간 이후의 제1 위치를 추정하고, 획득된 항법해에 기초하여 현재 시간보다 특정 시간 이후의 제2 위치를 추정하고, 스피드 스프레이어의 현재 위치를 기준으로 제1 위치까지의 제1 벡터와 스피드 스프레이어의 현재 위치를 기준으로 제2 위치까지의 제2 벡터 사이의 방향각 차이를 산출하고, 산출된 방향각 차이에 기초하여 이동 중인 스피드 스프레이어의 이동 방향을 제어할 수 있다.On the other hand, the step of controlling to drive along the autonomous driving path stored in the speed sprayer is to obtain a navigation solution prior to the time of the current time when it is determined that the position of the speed sprayer obtained through the GNSS sensor is good, and the obtained navigation Based on the solution, the first position after a specific time is estimated based on the current time on the autonomous driving route, and the second position after a specific time is estimated based on the obtained navigation solution, and the current speed sprayer The direction angle difference between the first vector to the first position based on the position and the second vector to the second position based on the current position of the speed sprayer is calculated, and the moving speed based on the calculated direction angle difference The direction of movement of the sprayer can be controlled.

한편, 이와 관련하여 스피드 스프레이어의 자율 주행을 제어하는 구체적인 방법은 상술한 바 있다. 한편, 본 개시의 다양한 실시 예들은 기기(machine)(예: 컴퓨터)로 읽을 수 있는 저장 매체(machine-readable storage media에 저장된 명령어를 포함하는 소프트웨어로 구현될 수 있다. 기기는, 저장 매체로부터 저장된 명령어를 호출하고, 호출된 명령어에 따라 동작이 가능한 장치로서, 개시된 실시 예들에 따른 전자 장치(예: 전자 장치(A))를 포함할 수 있다. 상기 명령이 프로세서에 의해 실행될 경우, 프로세서가 직접, 또는 상기 프로세서의 제어하에 다른 구성요소들을 이용하여 상기 명령에 해당하는 기능을 수행할 수 있다.Meanwhile, a specific method of controlling the autonomous driving of the speed sprayer has been described above. 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 command may be performed using other components under the control of the processor.

명령은 컴파일러 또는 인터프리터에 의해 생성 또는 실행되는 코드를 포함할 수 있다. 기기로 읽을 수 있는 저장매체는, 비일시적(non-transitory) 저장매체의 형태로 제공될 수 있다. 여기서, '비일시적'은 저장매체가 신호(signal)를 포함하지 않으며 실재(tangible)한다는 것을 의미할 뿐 데이터가 저장매체에 반영구적 또는 임시적으로 저장됨을 구분하지 않는다.Instructions may include code generated or executed by a compiler or interpreter. A storage medium that can be read by a device may be provided in the form of a non-transitory storage medium. Here,'non-transient' means that the storage medium does not contain a signal and is tangible, but does not distinguish between semi-permanent or temporary storage of data in the storage medium.

일 시예에 따르면, 본 발명에 개시된 다양한 실시 예들에 따른 방법은 컴퓨터 프로그램 제품(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 a portion of the computer program product 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.

이상의 설명은 본 발명의 기술 사상을 예시적으로 설명한 것에 불과한 것으로, 본 발명이 속하는 기술분야에서 통상의 지식을 갖는 자라면 본 발명의 본질적인 특성에서 벗어나지 않는 범위에서 다양한 수정 및 변형이 가능할 것이다. 따라서, 본 발명에 게시된 실시예는 본 발명의 기술 사상을 한정하기 위한 것이 아닌 설명을 위한 것이고, 이런 실시예에 의하여 본 발명의 기술 사상의 범위가 한정되는 것은 아니다. The above description is merely illustrative of the technical idea of the present invention, and those of ordinary skill in the art to which the present invention pertains will be able to make various modifications and variations without departing from the essential characteristics of the present invention. Accordingly, the embodiments posted in the present invention are for explanation, not for limiting the technical idea of the present invention, and the scope of the technical idea of the present invention is not limited by these embodiments.

따라서 본 발명의 보호 범위는 전술한 실시예에 의해 제한되기 보다는 아래의 청구범위에 의하여 해석되어야하며, 그와 동등한 범위 내에 있는 모든 기술 사상은 본 발명의 권리범위에 포함되는 것으로 해석되어야 할 것이다. Therefore, the scope of protection of the present invention should be interpreted by the following claims rather than limited by the above-described embodiments, and all technical ideas within the scope equivalent thereto should be interpreted as being included in the scope of the present invention.

1 : 스피드 스프레이어 10: 캐터필러
20: 약제 탱크 30: 분무부
10a: 캐터필러 구동축 10b: 감속기(또는 액추에이터)
10c: 모터 50: 배터리
31: 송풍날개용 엔진 31a: 라디에이터
32: 스프레이어 32a: 압력조절핸들
35: 송풍날개 회전축 34: 송풍날개
33: 에어 벤트 110 : 액추에이터부
120 : 센서 130 : 메모리
140 : 프로세서
1: speed sprayer 10: caterpillar
20: medicine tank 30: spray unit
10a: Caterpillar drive shaft 10b: Reducer (or actuator)
10c: motor 50: battery
31: engine for blowing blades 31a: radiator
32: sprayer 32a: pressure control handle
35: blower blade rotation shaft 34: blower blade
33: air vent 110: actuator unit
120: sensor 130: memory
140: processor

Claims (6)

스피드 스프레이어를 이동시키기 위해 스피드 스프레이어의 본체 하부의 양측에 장착되는 적어도 2개의 캐터필러, 캐터필러에 동력을 전가하는 구동부, 본체에 장착되고 약액을 수용하는 약액탱크; 본체의 후방에서 약액을 분무하도록 배치된 분무부; 및 본체의 전방에 설치되는 제어반을 포함하는 자율주행 가능한 스피드 스프레이어에 있어서,
상기 제어반에는,
상기 스피드 스프레이어의 위치 및 움직임을 감지하기 위한 GNSS(Global Navigation Satellite System) 센서;
자율 주행 경로가 저장된 메모리;
감지된 스피드 스프레이어의 위치 및 움직임에 기초하여 상기 스피드 스프레이어가 상기 자율 주행 경로를 따라 주행하도록 액추에이터를 제어하는 프로세서;를 포함하고,
상기 제어반의 프로세서는
GNSS 센서를 이용하여 스피드 스프레이어의 위치 및 움직임을 감지하고,
GNSS 센서의 품질을 판단하고;
감지된 스피드 스프레이어의 위치 및 움직임에 기초하여 상기 스피드 스프레이어가 상기 스피드 스프레이어의 메모리에 저장된 자율 주행 경로를 따라 주행하도록 제어하도록 구성된 것을 특징으로 하는
자율주행 가능한 스피드 스프레이어.
At least two caterpillars mounted on both sides of a lower body of the speed sprayer to move the speed sprayer, a driving unit for transferring power to the caterpillar, a chemical liquid tank mounted on the body and accommodating a chemical solution; A spray unit disposed to spray a chemical solution from the rear of the body; And in the self-driving speed sprayer including a control panel installed in front of the body,
In the control panel,
A Global Navigation Satellite System (GNSS) sensor for detecting the position and movement of the speed sprayer;
A memory in which autonomous driving routes are stored;
Including; a processor for controlling an actuator such that the speed sprayer travels along the autonomous driving path based on the detected position and movement of the speed sprayer,
The processor of the control panel
Detects the position and movement of the speed sprayer using a GNSS sensor,
Judging the quality of the GNSS sensor;
Characterized in that configured to control the speed sprayer to travel along the autonomous driving path stored in the memory of the speed sprayer based on the sensed position and movement of the speed sprayer
Speed sprayer capable of autonomous driving.
제1항에 있어서,
자율 주행 경로는, 기설정된 경로를 상기 스피드 스프레이어가 주행하는 동안에 상기 GNSS 센서에서 획득된 데이터에 기반하여 생성되는
자율주행 가능한 스피드 스프레이어.
The method of claim 1,
The autonomous driving route is generated based on data acquired from the GNSS sensor while the speed sprayer is driving a preset route.
Speed sprayer capable of autonomous driving.
제2항에 있어서,
프로세서에서의 GNSS 센서의 품질의 판단은,
GNSS 센서의 품질을 판단하기 위한 인자와 기설정된 기준 값을 비교하고, 인자가 상기 기설정된 기준 값을 만족하는 경우, 현재 시간보다 특정한 시간 이전의 항법해를 통해 예측된 상기 스피드 스프레이어의 현재 위치와 상기 GNSS 센서를 통해 획득된 상기 스피드 스프레이어의 현재 위치를 비교하여 상기 GNSS 센서를 통해 획득되는 스피드 스프레이어의 위치가 양호한 상태인지를 판단하는
자율주행 가능한 스피드 스프레이어.
The method of claim 2,
The determination of the quality of the GNSS sensor in 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 speed sprayer predicted through a navigation solution before a specific time before the current time And comparing the current position of the speed sprayer obtained through the GNSS sensor to determine whether the position of the speed sprayer obtained through the GNSS sensor is in a good state.
Speed sprayer capable of autonomous driving.
제3항에 있어서,
프로세서는 GNSS 센서를 통해 획득된 스피드 스프레이어의 위치가 양호한 것으로 판단되면, 현재 시간의 시간 이전의 항법해를 획득하고, 상기 획득된 항법해에 기초하여 상기 자율 주행 경로 상에서 상기 현재 시간을 기준으로 특정 시간 이후의 제1 위치를 추정하고, 획득된 항법해에 기초하여 상기 현재 시간보다 특정 시간 이후의 제2 위치를 추정하고, 상기 스피드 스프레이어의 현재 위치를 기준으로 상기 제1 위치까지의 제1 벡터와 상기 스피드 스프레이어의 현재 위치를 기준으로 상기 제2 위치까지의 제2 벡터 사이의 방향각 차이를 산출하고, 상기 산출된 방향각 차이에 기초하여 이동 중인 스피드 스프레이어의 이동 방향을 제어하도록 구성된
자율주행 가능한 스피드 스프레이어.
The method of claim 3,
When it is determined that the position of the speed sprayer acquired through the GNSS sensor is good, the processor acquires a navigation solution prior to the time of the current time, and based on the current time on the autonomous driving route based on the obtained navigation solution. Estimates a first position after a specific time, estimates a second position after a specific time than the current time based on the obtained navigation solution, and determines the first position to the first position based on the current position of the speed sprayer. 1 Calculates the difference in direction angle between the vector and the second vector to the second position based on the current position of the speed sprayer, and controls the moving direction of the moving speed sprayer based on the calculated difference in direction angle Configured to
Speed sprayer capable of autonomous driving.
제2항에 있어서,
프로세서는 GNSS 센서를 통해 획득된 스피드 스프레이어의 위치가 양호하지 않은 것으로 판단되면, 이동 중인 스피드 스프레이어를 정지시키도록 구성된
자율주행 가능한 스피드 스프레이어.
The method of claim 2,
The processor is configured to stop the speed sprayer in motion if it determines that the speed sprayer's position acquired through the GNSS sensor is not good.
Speed sprayer capable of autonomous driving.
제2항에 있어서,
프로세서는 GNSS 센서를 통해 획득된 스피드 스프레이어의 위치가 양호한 것으로 판단되면, 상기 GNSS 센서에 의해 감지된 상기 스피드 스프레이어의 속도를 기설정된 운용 속도와 비교하여 상기 스피드 스프레이어의 속도를 제어하도록 구성된
자율주행 가능한 스피드 스프레이어.
The method of claim 2,
When it is determined that the position of the speed sprayer acquired through the GNSS sensor is good, the processor is configured to control the speed of the speed sprayer by comparing the speed of the speed sprayer detected by the GNSS sensor with a preset operating speed.
Speed sprayer capable of autonomous driving.
KR1020190061263A 2019-05-24 2019-05-24 Speed sprayer of automatic driving KR102259086B1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
KR1020190061263A KR102259086B1 (en) 2019-05-24 2019-05-24 Speed sprayer of automatic driving

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
KR1020190061263A KR102259086B1 (en) 2019-05-24 2019-05-24 Speed sprayer of automatic driving

Publications (2)

Publication Number Publication Date
KR20200134971A true KR20200134971A (en) 2020-12-02
KR102259086B1 KR102259086B1 (en) 2021-06-01

Family

ID=73791853

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020190061263A KR102259086B1 (en) 2019-05-24 2019-05-24 Speed sprayer of automatic driving

Country Status (1)

Country Link
KR (1) KR102259086B1 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20220120792A (en) * 2021-02-23 2022-08-31 주식회사 아세아텍 Semi autonomous driving orchard drug spray device
KR20220165999A (en) 2021-06-09 2022-12-16 한국전자통신연구원 Apparatus and method for guiding agricultural machine drive

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
IT202100023093A1 (en) * 2021-09-07 2023-03-07 Univ Bologna Alma Mater Studiorum AGRICULTURAL VEHICLE FOR PRECISION AGRICULTURE
KR102603095B1 (en) * 2023-02-06 2023-11-17 주식회사 준시스템 Remote controlable moving device for multipurpose farming

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000029521A (en) * 1998-07-08 2000-01-28 Fuji Heavy Ind Ltd Autonomous traveling method and autonomously traveling vehicle
KR20150113504A (en) * 2014-03-31 2015-10-08 권우혁 Walking Speed Sprayer shape
JP2016086727A (en) * 2014-11-04 2016-05-23 ヤンマー株式会社 Field management vehicle
KR20170008835A (en) * 2014-05-22 2017-01-24 얀마 가부시키가이샤 Running system of work vehicle
JP2017123829A (en) * 2016-01-15 2017-07-20 株式会社クボタ Field work vehicle
JP2019505423A (en) * 2016-11-24 2019-02-28 バイドゥドットコム タイムズ テクノロジー (ベイジン) カンパニー リミテッドBaidu.com Times Technology (Beijing) Co., Ltd. Steering control method and system for autonomous vehicle using proportional, integral and derivative (PID) controller

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000029521A (en) * 1998-07-08 2000-01-28 Fuji Heavy Ind Ltd Autonomous traveling method and autonomously traveling vehicle
KR20150113504A (en) * 2014-03-31 2015-10-08 권우혁 Walking Speed Sprayer shape
KR20170008835A (en) * 2014-05-22 2017-01-24 얀마 가부시키가이샤 Running system of work vehicle
JP2016086727A (en) * 2014-11-04 2016-05-23 ヤンマー株式会社 Field management vehicle
JP2017123829A (en) * 2016-01-15 2017-07-20 株式会社クボタ Field work vehicle
JP2019505423A (en) * 2016-11-24 2019-02-28 バイドゥドットコム タイムズ テクノロジー (ベイジン) カンパニー リミテッドBaidu.com Times Technology (Beijing) Co., Ltd. Steering control method and system for autonomous vehicle using proportional, integral and derivative (PID) controller

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20220120792A (en) * 2021-02-23 2022-08-31 주식회사 아세아텍 Semi autonomous driving orchard drug spray device
KR20220165999A (en) 2021-06-09 2022-12-16 한국전자통신연구원 Apparatus and method for guiding agricultural machine drive

Also Published As

Publication number Publication date
KR102259086B1 (en) 2021-06-01

Similar Documents

Publication Publication Date Title
KR102259086B1 (en) Speed sprayer of automatic driving
EP3832422B1 (en) Electronic device and vehicle control method of electronic device, server and method for providing precise map data of server
CN106909145B (en) Real-time obstacle sensing and avoiding system and method for unmanned channel survey vessel
KR101879247B1 (en) The Working Path Setting Method for Automatic Driving Agricultural Machine
JP5506423B2 (en) Semi-autonomous driving system for unmanned vehicles
KR102323394B1 (en) Apparatus and method for assisting driving of a vehicle
TWI716372B (en) Autonomously assisted and guided vehicle
US20180215393A1 (en) Autonomously traveling work vehicle
WO2019217186A1 (en) Coverage plan generation and implementation
KR20210037740A (en) Control device for work vehicle
US20180011495A1 (en) Route search method, route search system, non-transitory computer-readable storage medium, and work vehicle
EP2296071A1 (en) Modular and scalable positioning and navigation system
JP2018093799A (en) Travel route generating device
WO2019230098A1 (en) Information processing device
JP2016095660A (en) Unmanned operation system
EP3470947B1 (en) Method and system for guiding an autonomous vehicle
KR102168104B1 (en) Automatic driving method of agricultural vehicle
KR20140144921A (en) Simulation system for autonomous vehicle using virtual reality
JP5187757B2 (en) Unmanned mobile system
KR20200116437A (en) Agricultural machinery and automatic driving method thereof
US20220157179A1 (en) Action control device and action control method, and program
KR20190119213A (en) Agricultural machinery and automatic driving method thereof
KR101673749B1 (en) Positioning system using directive communication and method thereof
EP4098116A1 (en) Spraying work method, spraying work system, and spraying work program
CN114281109A (en) Multi-machine cooperation control system guided by unmanned aerial vehicle

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