KR101879247B1

KR101879247B1 - 자율주행 농업기계의 작업경로 설정방법

Info

Publication number: KR101879247B1
Application number: KR1020170144187A
Authority: KR
Inventors: 정선옥; 김용주; 이민찬
Original assignee: 충남대학교산학협력단
Priority date: 2017-10-31
Filing date: 2017-10-31
Publication date: 2018-08-17
Anticipated expiration: 2037-10-31

Abstract

본 발명은 자율주행 농업기계의 작업경로 표시장치 및 작업경로 설정방법에 관한 것으로서, 더욱 상세하게는 사용자가 농업기계의 폭을 입력하고, 농경지 외곽을 시험 주행한 뒤, 최적의 선회 구간, 최단 선회 구간을 계산하여 경로를 설정하도록 함과 아울러 작업을 진행할 때 디스플레이에 최적 방향을 제시하도록 한, 자율주행 농업기계의 작업경로 표시장치와 작업경로 설정방법에 관한 것이다.

Description

자율주행 농업기계의 작업경로 설정방법{The Working Path Setting Method for Automatic Driving Agricultural Machine}

본 발명은 자율주행 농업기계의 작업경로 설정방법에 관한 것으로서, 더욱 상세하게는 사용자가 농업기계의 폭을 입력하고, 농경지 외곽을 시험 주행한 뒤, 최적의 선회 구간, 최단 선회 구간을 계산하여 경로를 설정하도록 함과 아울러 작업을 진행할 때 디스플레이에 최적 방향을 제시하도록 한, 자율주행 농업기계의 작업경로 설정방법에 관한 것이다.

최근 국내 산업은 4차 산업혁명이란 슬로건을 통해 인공지능과 ICT 기술을 융합하여 미국, 독일, 일본과 같은 기술 선진국들의 수준에 견줄 산업시스템을 구축하고 있다. 이러한 산업 구조의 변화는 농업분야에도 영향을 미치게 되는데, 농업분야의 새로운 산업시스템의 대표적인 예로 스마트 팜이 손꼽히고 있다. 스마트 팜은 온실 내 설치된 센서들의 데이터를 모듈에서 수집하고, 무선 통신을 통해 사용자에게 PC 혹은 스마트폰으로 실시간 모니터링할 수 있도록 정보를 전송하거나 사용자가 설정해둔 값에 따라 온실 내 환경 등을 조절하고 있다. 따라서, 스마트 팜 시스템을 적용하면, 데이터가 실시간으로 확인되고, 실시간 환경 조절이 가능하기 때문에 사용자는 증가한 수확량으로 고소득을 취할 수 있게 된다.

이와 관련하여, 농업분야에서 가장 핵심적인 작업 기계 중 하나인 트랙터에도 변화의 바람이 불고 있는데, 기술 선진국에서는 무인트랙터의 연구가 상당히 진행되어 이미 상용화된 상황이고, 작업 상황을 확인할 수 있는 모니터링 기술도 도입되었다. 무인트랙터에서 사용되는 자율주행기술은 운전자의 조작없이 자동차 스스로 주행환경을 인식하여 목표 지점까지 운행할 수 있도록 하는 기술로서, 차선이탈 방지시스템과 차량 변경 제어기술, 장애물 회피 기술 등을 이용하여 출발지와 목적지를 입력하면 최적의 주행경로를 선택하여 스스로 주행할 수 있도록 하며, 자율주행기술이 적용된 자동차를 자율주행자동차 또는 무인자동차라 한다.

이러한 자율주행기술은 기본적으로 도로를 주행하는 자동차에 적용되고 있지만, 군사적인 목적이나 농업기술에도 많이 이용되고 있다. 구체적으로 자율주행기술을 적용된 농기계로서 자율주행 트랙터가 있다. 자율주행트랙터는 스스로 알아서 움직이는 트랙터로서, 경작지의 위치와 크기를 측정하여 경작지에 맞는 작업경로를 설정하면, 작업경로를 따라 이동하면서 작업을 수행하도록 구성된다.

이러한 자율주행 트랙터에는 GPS(Global Positioning System)를 이용한 위치인식 시스템과, 속도와 방향 및 가속도를 측정하는 IMU(Inertial Mwasurement Unit; 관성항법장치) 기술, 자율주행시 이동 방향을 모니터로 보여주는 하이브리드 EPS(Hybrid Electronic Power Steering) 시스템, 작업경로 생성 및 추종기술 등 4가지의 기술이 접목되어 있다. 자율주행트랙터와 같은 농업기계는 국내의 열악한 농업환경과 인력난 등을 고려하면, 경쟁력 제고를 위한 필수 선택이라 할 수 있지만, 경지면적이 좁고 비탈진 농지가 많은 농업환경으로 인해 국내에는 쉽게 적용되지 못하고 있다.

한편, 무인트랙터와 관련한 연구는 국내에서도 활발히 진행되어, 자동 경로 생성 등의 기술을 개발하였지만, 기술 선진국에 비해 측정 위치의 정확도, 노지 상태, 트랙터 주요 요소에 대한 모니터링을 크게 고려하지 않아 작업 안정성을 확보하는데 어려움이 있다, 또한, 트랙터 주행 시 조향과 속도로 인한 안정성 확보에 집중하여 작업자가 현 트랙터 위치별 작동 상황을 파악하기 어렵다.

다시 말해서, 대부분의 무인트랙터는 사람이 직접 운전하지 않기에 작업환경에 따른 변수가 발생하고 있으며, 변수들에 따라 주행 속도, 조향각이 변할 수 있고, 트랙터 부위별 장치들의 상태가 변할 수 있기 때문에 이로 인해 경로 이탈 혹은 트랙터 안정성에 문제가 생길 수 있다.

하지만, 기존의 국내 무인트랙터 기술은 작업기의 자동 경로 생성 후, 무인으로 주행할 수 있도록 하는데 초점이 맞춰져 있으므로, 변수들에 의해 발생할 사고에 대해 대처하기 어려운 문제점이 있다.

참고로, 특허문헌 1은 자율주행 트랙터의 위치계산시, RTK와 DGPS를 사용하여 정교한 위치를 계산하고, GPS 오류 발생 시, 속도를 사용하여 위치를 계산하도록 한, 자율주행 트랙터를 개시하고 있으며, 특허문헌 2는 하이브리드 트랙터에 가해지는 작업부하량 정도와 3점히치장치의 링크상태를 디스플레이에 표시하도록 한, 하이브리드 트랙터용 디스플레이 장치와 이를 포함하는 하이브리드 트랙터용 인터페이스 시스템을 개시하고 있다.

그리고, 비특허문헌 1은, 농업용 차량의 선회 구간에서의 최적 경로 계획과 관련하여, 최적 선회 방법과 거리를 조건별로 계산하도록 한, 농업용 차량의 최적 작업 경로에 대한 내용을 개시하고 있다.

대한민국 등록특허공보 제10-1339750호 대한민국 등록특허공보 제10-1536412호

Chung SO, Chang YC, Kim SC. 1999. An optimal operation path of agricultural field machines. ASAE/CSAE-SCGR Annual International Meeting. Paper NO. 991105. Toronto, Ontario Canada.

본 발명은 상기와 같은 문제점을 해결하기 위하여 안출된 것으로, 본 발명의 자율주행 농업기계의 작업경로 표시장치와 작업경로 설정방법은, GPS의 위치 데이터와 속도를 활용하는 기존의 자동 경로 생성방법과는 달리, 사용자가 농업기계의 폭을 입력하고, 농경지 외곽을 시험 주행한 뒤, 최적의 선회 구간, 최단 선회 구간을 계산하여 경로를 설정하도록 함과 아울러 작업을 진행할 때 디스플레이에 최적 방향을 제시하도록 하는 것을 과제로 한다.

또한, 추가적으로 타이어 슬립율, 작업 종료 예상 시간, 트랙터의 위치, PTO 단수 및 rpm, 조향각, 트랙터의 기울어짐, 3점 히치 높이 및 정상 결합 여부 등과 같은 트랙터 정보를 디스플레이를 통해 제공하는 것을 과제로 한다.

상기 목적을 달성하기 위한 본 발명의 자율주행 농업기계의 작업경로 표시장치는, 농작업차량의 캐빈 상부에 설치되어 농작업차량의 실제 차속과 절대 위치를 측정하는 GPS 센서와; 농작업차량의 캐빈 안쪽에 부착되며 작업경로를 생성하고 GPS 센서의 신호를 기반으로 작업경로를 따라 이동하는 농작업차량의 위치를 표시하는 네비게이션 디스플레이와, 농작업차량의 캐빈에 설치되며 PC 또는 스마트폰과의 통신을 통해 네비게이션 디스플레이를 제어하고 정보를 전송하는 무선통신모듈;을 포함하는 것을 특징으로 한다.

또한, 농작업차량의 선단에 설치되어 조향각을 측정함과 아울러 농작업차량의 롤 데이터와, 피치 데이터 및 요 데이터를 측정하여 농작업차량의 기울어짐을 판단하여 무선통신모듈로 전송하는 AHRS 모듈과; 농작업차량의 후륜축에 설치되어 바퀴의 회전수를 통해 차속을 측정하고 농작업차량의 슬립을 확인하여 무선통신모듈로 전송하는 마그네틱 센서;를 더 포함하는 것을 특징으로 한다.

또한, 작업기로 동력을 전달하는 농작업차량의 PTO부에 설치되어 PTO 단수와 회전속도를 측정하여 무선통신모듈로 전송하는 PTO 센서와; 작업기가 연결되는 농작업차량의 히치축에 구비되어 3점 히치 높이를 측정하고 작업기와의 정상 결합 여부를 확인하여 무선통신모듈로 전송하는 3점 히치축 센서;를 더 포함하는 것을 특징으로 한다.

또한, 네비게이션 디스플레이는 농작업차량의 주행경로가 표시되고 주행경로 상의 농작업차량의 위치가 표시되는 주행상황 표시부와, 농작업차량의 예정경로를 안내하는 경로안내부와, GPS와의 연결 여부를 표시하는 GPS 표시부 및 작업자가 작업기에 대한 정보나 주행속도를 입력하는 사용자 입력부를 포함하는 것을 특징으로 한다.

또한, 네비게이션 디스플레이는 PTO 센서로부터 전달된 PTO 단수가 표시되는 PTO 표시부와, 농작업차량의 작업과 관련한 여러 정보를 표시하는 작업정보 표시부를 더 포함하는 것을 특징으로 한다.

또, 본 발명의 자율주행 농업기계의 작업경로 설정방법은, 농작업차량의 최대 허용속도와 작업폭이 설정된 후 필드 주행을 시작하는 단계와; 농경지의 경계를 탐색하고 위치 데이터를 저장하는 단계와; 농경지에 대한 탐색이 완료되면 최소 탐색 경로 Min(L)와 최소 회행 거리 수(Nro)를 계산하는 단계와; 농작업차량의 작업폭을 고려한 최적 경로 NL(k), RL(k) 계획을 생성하는 단계와; 최적 경로 계획상의 구간별 최단시간 선회거리 Lt를 계산하는 단계와; 최적 탐색 경로와 최적 경로 계획 및 구간별 최단시간 선회거리를 종합하는 단계와; 종합된 경로를 경위도 좌표로 전환하여 작업경로를 결정하는 단계;를 포함하는 것을 특징으로 한다.

또한, 결정된 작업경로에 따라 농작업차량이 주행하면서 작업을 수행하고, 농작업차량의 각 부분에 대한 정보를 측정하여 캐빈 내의 무선통신모듈로 전송함과 아울러 무선통신모듈이 수신된 데이터를 네비게이션 디스플레이로 보내 네비게이션 디스플레이에 작업 경로와 농작업차량의 정보가 표시되도록 단계;를 더 포함하는 것을 특징으로 한다.

또한, 농경지의 경계를 탐색하고 위치 데이터를 저장하는 단계는, 농작업차량에 탑승하여 작업을 진행할 필드의 경계를 주행하며, GPS에서 필드 경계 그리고 작업 시작점과 종료점에 대한 위치 데이터를 저장하는 것을 특징으로 한다.

또한, 최소 탐색 경로 Min(L)을 계산하는 단계는, GPS에서 네비게이션 디스플레이로 필드 경계 정보를 무선으로 송신한 뒤, 네비게이션 디스플레이에서 해당 정보를 수신하여 저장 및 최적 작업 경로 생성하되, 네비게이션 디스플레이 내의 계산부에서 작업 시작점, 작업 종료점을 고려하여, 회행 작업 구간(L_ro), 왕복 작업 구간(L_re), 출입 구간에서 작업 시작점까지 이동 경로(L₁), 왕복 작업에서 회행 작업 전환 경로(L₂), 모서리 회전 경로(L₃) 및 작업 후 출입 구간까지 이동경로(L₄)로 이루어진 최소 탐색 경로 Min(L)를 계산하는 것을 특징으로 한다.

또한, 최소 회행 거리 수(Nro)는 다음의 수학식에 따라 계산되는 것을 특징으로 한다;

여기서, R은 최소 선회반경, We는 유효 작업 구간 사이의 간격이고, a는 조향각을 의미한다.

또한, 최적 경로 NL(k), RL(k) 계획을 생성하는 단계는 작업 열의 좌우 정점을 NL(k), NR(k)로 나누고, 선회 구간에서 선회 후 위치와 각 정점의 위치 중 거리가 가장 짧은 정점으로 이동하고, 지난 정점은 삭제하는 과정을 반복하여 정점 하나가 남을 때까지 경로를 생성하는 것을 특징으로 한다.

또한, 구간별 최단시간 선회거리 Lt를 계산하는 단계는 사용자가 지정한 작업폭과, 필드 내에서 유효 작업 구간 사이의 간격(We), 및 최소 선회 반경(R)를 고려하여 계산하며, 구간별 최단시간 선회거리 Lt는 유효 작업 구간 사이의 간격과 최소 선회반경 사이의 관계에 따라 달리지는 것을 특징으로 한다.

본 발명에 따른 자율주행 농업기계의 작업경로 표시장치는, 작업 중인 농작업차량의 경로 현황과 필드 변수에 따른 농작업차량의 각 부위별 현황을 확인할 수 있고, 농작업차량에 설치된 센서와 무선통신모듈을 통해 무선 통신으로 데이터가 송수신되어 사용자가 원하는 농작업차량의 정보를 네비게이션 디스플레이에서 확인할 수 있음은 물론 간단한 모듈의 기지국 설치로 모바일과 PC에서도 실시간으로 확인이 가능한 효과가 있다.

그리고 본 발명에 따른 자율주행 농업기계의 작업경로 설정방법은, 주행 경로를 GPS에 의존하여 작성하는 기존 방법과 다르게 작업폭 설정과 시험 경계주행을 통해 GPS 오차(작업기 폭, 거리 오차)로 발생하는 최적 경로 생성의 정확도를 높여 작업 경로를 최소화하므로, 안내되는 경로로 주행시 작업 시간을 줄일 수 있게 되는 효과가 있다.

또한, 무인트랙터 뿐만이 아니라 농작업차량에 연결되는 모든 작업기에도 적용가능하며, 이를 통해 작업기의 속도, 조향각 조절을 통해 작업 안정성을 향상 시킬 수 있게 된다.

도 1은 본 발명에 따른 자율주행 농업기계의 작업경로 표시장치를 개략적으로 표시한 구성도이다.
도 2는 본 발명에 따른 자율주행 농업기계의 작업경로 표시장치의 네비게이션 디스플레이가 도시된 도면이다.
도 3은 본 발명에 따른 자율주행 농업기계의 작업경로 설정방법이 도시된 순서도이다.
도 4는 본 발명에 따른 트랙터의 최적 경로 생성 모습을 나타낸 참고도이다.
도 5는 본 발명에 따른 구간별 최단시간 선회거리 Lt를 계산하는 방법을 나타낸 참고도이다.

본 발명에서 사용되는 용어는 가능한 현재 널리 사용되는 일반적인 용어를 선택하였으나, 특정한 경우는 출원인이 임의로 선정한 용어도 있는데 이 경우에는 단순한 용어의 명칭이 아닌 발명을 실시하기 위한 구체적인 내용에 기재되거나 사용된 의미를 고려하여 그 의미가 파악되어야 할 것이다.

이하, 첨부한 도면에 도시된 바람직한 실시 예들을 참조하여 본 발명의 기술적 구성을 상세하게 설명한다.

여기서, 상하좌우, 우측, 좌측, 저면 등 방향과 관련된 표현은 모두 제시한 도면을 기준으로 기재하고 있음을 밝혀둔다.

본 발명에 따른 자율주행 농업기계의 작업경로 표시장치는 도 1에 도시된 바와 같이, 농작업차량의 캐빈 상부에 설치되어 농작업차량의 실제 차속과 절대 위치를 측정하는 GPS 센서(40)와; 농작업차량의 캐빈 안쪽에 부착되며 작업경로를 생성하고 GPS 센서(40)의 신호를 기반으로 작업경로를 따라 이동하는 농작업차량의 위치를 표시하는 네비게이션 디스플레이(10)와, 농작업차량의 캐빈에 설치되며 PC 또는 스마트폰과의 통신을 통해 네비게이션 디스플레이를 제어하고 정보를 전송하는 무선통신모듈(20)과; 농작업차량의 선단에 설치되어 조향각을 측정함과 아울러 농작업차량의 롤 데이터와, 피치 데이터 및 요 데이터를 측정하여 농작업차량의 기울어짐을 판단하여 무선통신모듈(20)로 전송하는 AHRS 모듈(30)과; 농작업차량의 후륜축에 설치되어 바퀴의 회전수를 통해 차속을 측정하고 농작업차량의 슬립을 확인하여 무선통신모듈(20)로 전송하는 마그네틱 센서(50)와; 작업기로 동력을 전달하는 농작업차량의 PTO부에 설치되어 PTO 단수와 회전속도를 측정하여 무선통신모듈로 전송하는 PTO 센서(60)와; 작업기가 연결되는 농작업차량의 히치축에 구비되어 3점 히치 높이를 측정하고 작업기와의 정상 결합 여부를 확인하여 무선통신모듈(20)로 전송하는 3점 히치축 센서(70);를 포함하여 이루어진다.

상기 GPS 센서(40)는 농작업차량의 절대위치와 실제 농작업차량의 속도를 측정하며, 위치와 속도를 이용하여 작업 종료 예상시간을 계산하고, 마그네틱 센(50)에서 감지된 타이어의 회전속도를 통해 필드에서 차량이 얼마나 미끄러지는지의 지표인 슬립율을 계산하여 후 네비게이션 디스플레이(10)에 표시되도록 한다.

이와 같이, 농작업차량에 다수의 센서가 설치되고 무선통신모듈이 설치됨에 따라 각각의 센서와 무선통신모듈(20) 간의 무선통신을 통해 작업 중인 농작업차량의 경로 현황과 필드 변수에 따른 농작업차량의 각 부위별 현황을 확인할 수 있게 된다.

그리고, 네비게이션 디스플레이(10)는 농작업차량의 주행경로가 표시되고 주행경로 상의 농작업차량의 위치가 표시되는 주행상황 표시부(11)와, 농작업차량의 예정경로를 안내하는 경로안내부(12)와, GPS와의 연결 여부를 표시하는 GPS 표시부(13) 및 작업자가 작업기에 대한 정보나 주행속도를 입력하는 사용자 입력부(14)와, PTO 센서(60)로부터 전달된 PTO 단수가 표시되는 PTO 표시부(15)와, 농작업차량의 작업과 관련한 여러 정보를 표시하는 작업정보 표시부(16)를 포함하여 이루어진다.

따라서, 사용자가 원하는 농작업차량의 정보를 네비게이션 디스플레이(10)에서 확인할 수 있게 된다. 그리고 간단한 모듈의 기지국을 설치하게 되면 모바일과 PC에서도 실시간으로 확인할 수 있게 된다.

한편, 본 발명에 따른 자율주행 농업기계의 작업경로 설정방법은 도 3에 도시된 바와 같이, 농작업차량의 최대 허용속도와 작업폭이 설정된 후 필드 주행을 시작하는 단계와; 농경지의 경계를 탐색하고 위치 데이터를 저장하는 단계와; 농경지에 대한 탐색이 완료되면 최소 탐색 경로 Min(L)와 최소 회행 거리 수(Nro)를 계산하는 단계와; 농작업차량의 작업폭을 고려한 최적 경로 NL(k), RL(k) 계획을 생성하는 단계와; 최적 경로 계획상의 구간별 최단시간 선회거리 Lt를 계산하는 단계와; 최적 탐색 경로와 최적 경로 계획 및 구간별 최단시간 선회거리를 종합하는 단계와; 종합된 경로를 경위도 좌표로 전환하여 작업경로를 결정하는 단계;를 포함하하여 이루어진다.

그리고, 농작업차량이 결정된 작업경로를 따라 이동하는 것을 확인할 수 있도록, 결정된 작업경로에 따라 농작업차량이 주행하면서 작업을 수행하고, 농작업차량의 각 부분에 대한 정보를 측정하여 캐빈 내의 무선통신모듈로 전송함과 아울러 무선통신모듈이 수신된 데이터를 네비게이션 디스플레이로 보내 네비게이션 디스플레이에 작업 경로와 농작업차량의 정보가 표시되도록 단계;를 더 포함할 수 있다.

농작업차량의 작업경로를 생성할 때 가장 중요하게 고려해야 할 사항으로는, 작업 구간 사이의 거리, 선회 방법과 선회 거리, 회행 작업 수 그리고 주행 경로와 순서이다. 작업 구간 사이의 거리는 트랙터와 작업기의 고유 작업 폭을 고려해야 하기 때문이며, 이를 고려하지 않으면 작업이 중첩되는 현상이 발생한다. 그리고 농작업차량의 구조상 작업 폭과 길이가 일반 차량보다 클 뿐만 아니라, 중량도 크고, 쉽게 후진, 회전을 할 수 없기 때문에, 최적의 선회 경로와 최적의 회행 작업 수를 고려해야 한다. 그리고 주행 경로와 순서가 계산이 부실할 경우에는, 작업이 겹치는 구간 혹은 작업을 못한 공간이 생기게 된다. 따라서, 이들 요인을 모두 고려하여 작업경로를 생성해야 한다.

농경지의 경계를 탐색하고 위치 데이터를 저장하는 단계에서는, 작업자가 농작업차량에 탑승하여 작업을 진행할 필드의 경계를 주행하면서, GPS에서 필드 경계 그리고 작업 시작점과 종료점에 대한 위치 데이터를 저장하게 된다. 이에 따라 필드 경계(필드 엣지)를 고려한 작업경로를 설정할 수 있게 되며, 작업이 종료되는 시간을 예측할 수 있게 된다.

그리고, 최소 탐색 경로 Min(L)을 계산하는 단계는, GPS에서 네비게이션 디스플레이(10)로 필드 경계 정보를 무선으로 송신한 뒤, 네비게이션 디스플레이(10)에서 해당 정보를 수신하여 저장 및 최적 작업 경로 생성하게 된다. 즉, 네비게이션 디스플레이(10) 내의 계산부에서 작업 시작점, 작업 종료점을 고려하여, 회행 작업 구간(L_ro), 왕복 작업 구간(L_re), 출입 구간에서 작업 시작점까지 이동 경로(L₁), 왕복 작업에서 회행 작업 전환 경로(L₂), 모서리 회전 경로(L₃) 및 작업 후 출입 구간까지 이동경로(L₄)로 이루어진 최소 탐색 경로 Min(L)를 계산하도록 구성된다.

한편, 상기한 최소 회행 거리 수(Nro)는 다음의 수학식 1에 따라 계산된다.

여기서, G는 가우스 함수, R은 최소 선회반경, We는 유효 작업 구간 사이의 간격이고, a는 조향각을 의미한다.

그리고, 상기 수학식 1을 이용하게 되면 조향각을 구할 수도 있으며, 이 경우 조향각은 다음의 수학식 2와 같이 계산된다.

또한, 최적 경로 NL(k), RL(k) 계획을 생성하는 단계는 도 4와 같이, 작업 열의 좌우 정점을 NL(k), NR(k)로 나누고, 선회 구간에서 선회 후 위치와 각 정점의 위치 중 거리가 자장 짧을 정점으로 이동하고, 지난 정점은 삭제하는 과정을 반복하여 정점 하나가 남을 때까지 경로를 생성하게 된다. 그리고, 이를 수식으로 나타내면 다음의 수학식 3과 같다.

여기서, k는 1~n까지의 변수이고, NL(k): k번째 왼쪽 노드이며, RL(k): k번째 오른쪽 노드이고, LW_ki 및 RW_ki는 k노드에서 I노드로 이동하는 경로가중치를 의미한다.

또, 또한, 구간별 최단시간 선회거리 Lt를 계산하는 단계는 사용자가 지정한 작업폭과, 필드 내에서 유효 작업 구간 사이의 간격(We), 및 최소 선회 반경(R)를 고려하여 계산하는 것으로, 구간별 최단시간 선회거리 Lt는 도 5에 도시된 바와 같이, 유효 작업 구간 사이의 간격과 최소 선회반경 사이의 관계에 따라 달리진다.

즉, 유효 작업 구간 사이의 간격(We)이 최소 선회 반경(R)의 2배 미만(We<2R)인 경우의 최단시간 선회거리 Lt는, πR+4Rβ(β는 선회 시작구간에 인접한 비유효 선회구간의 중심점과 유효 선회구간의 중심점 사이의 각도)로 결정되고, 유효 작업 구간 사이의 간격(We)이 최소 선회 반경(R)의 2배(We=2R)인 경우에는 πR로 결정되며, 유효 작업 구간 사이의 간격(We)이 최소 선회 반경(R)의 2배를 초과(We>2R)하는 경우에는 πR+d(d는 인접 비유효 선회구간의 중심점 사이의 거리)로 결정된다.

이상의 설명은 본 발명을 예시적으로 설명한 것이고, 명세서에 게시된 실시예는 본 발명의 기술사상을 한정하기 위한 것이 아니라 설명하기 위한 것이므로 본 발명이 속하는 기술분야에서 통상의 지식을 가진 자라면 본 발명의 기술사상을 벗어나지 않는 범위에서 다양한 수정 및 변형이 가능할 것이다. 그러므로 본 발명의 보호범위는 청구범위에 기재된 사항에 의해 해석되고, 그와 균등한 범위 내에 있는 기술적 사항도 본 발명의 권리범위에 포함되는 것으로 해석되어야 할 것이다.

10 : 네비게이션 디스플레이 11 : 주행상황 표시부
12 : 경로안내부 13 : GPS 표시부
14 : 사용자 입력부 15 : PTO 표시부
16 : 작업정보 표시부 20 : 무선통신모듈
30 : AHRS 센서 40 : GPS 센서
50 : 마그네틱 센서 60 : PTO 센서
70 : 3점 히치축 센서

Claims

삭제
삭제
삭제
삭제
삭제
농작업차량의 최대 허용속도와 작업폭이 설정된 후 필드 주행을 시작하는 단계와;
농경지의 경계를 탐색하고 위치 데이터를 저장하는 단계와;
농경지에 대한 탐색이 완료되면 최소 탐색 경로 Min(L)와 최소 회행 거리 수(Nro)를 계산하는 단계와;
농작업차량의 작업폭을 고려한 최적 경로 NL(k), RL(k) 계획을 생성하는 단계와;
최적 경로 계획상의 구간별 최단시간 선회거리 Lt를 계산하는 단계와;
최적 탐색 경로와 최적 경로 계획 및 구간별 최단시간 선회거리를 종합하는 단계와; 종합된 경로를 경위도 좌표로 전환하여 작업경로를 결정하는 단계;를 포함하고,
최적 경로 NL(k), RL(k) 계획을 생성하는 단계는,
작업 열의 좌우 정점을 NL(k), NR(k)로 나누고, 선회 구간에서 선회 후 위치와 각 정점의 위치 중 거리가 가장 짧은 정점으로 이동하고, 지난 정점은 삭제하는 과정을 반복하여 정점 하나가 남을 때까지 경로를 생성하는 한편,
최소 회행 거리 수(Nro)는,
다음의 수학식에 따라 계산되는 것을 특징으로 하는 자율주행 농업기계의 작업경로 설정방법;

여기서, R은 최소 선회반경, We는 유효 작업 구간 사이의 간격이고, a는 조향각을 의미한다.
청구항 6에 있어서,
결정된 작업경로에 따라 농작업차량이 주행하면서 작업을 수행하고, 농작업차량의 각 부분에 대한 정보를 측정하여 캐빈 내의 무선통신모듈로 전송함과 아울러 무선통신모듈이 수신된 데이터를 네비게이션 디스플레이로 보내 네비게이션 디스플레이에 작업 경로와 농작업차량의 정보가 표시되도록 단계;를 더 포함하는 것을 특징으로 하는 자율주행 농업기계의 작업경로 설정방법.
청구항 6 또는 7에 있어서,
농경지의 경계를 탐색하고 위치 데이터를 저장하는 단계는,
농작업차량에 탑승하여 작업을 진행할 필드의 경계를 주행하며, GPS에서 필드 경계 그리고 작업 시작점과 종료점에 대한 위치 데이터를 저장하는 것을 특징으로 하는 자율주행 농업기계의 작업경로 설정방법.
청구항 6 또는 7에 있어서,
최소 탐색 경로 Min(L)을 계산하는 단계는,
GPS에서 네비게이션 디스플레이로 필드 경계 정보를 무선으로 송신한 뒤, 네비게이션 디스플레이에서 해당 정보를 수신하여 저장 및 최적 작업 경로 생성하되,
네비게이션 디스플레이 내의 계산부에서 작업 시작점, 작업 종료점을 고려하여, 회행 작업 구간(L_ro), 왕복 작업 구간(L_re), 출입 구간에서 작업 시작점까지 이동 경로(L₁), 왕복 작업에서 회행 작업 전환 경로(L₂), 모서리 회전 경로(L₃) 및 작업 후 출입 구간까지 이동경로(L₄)로 이루어진 최소 탐색 경로 Min(L)를 계산하는 것을 특징으로 하는 자율주행 농업기계의 작업경로 설정방법.
삭제
삭제
청구항 6 또는 7에 있어서,
구간별 최단시간 선회거리 Lt를 계산하는 단계는,
사용자가 지정한 작업폭과, 필드 내에서 유효 작업 구간 사이의 간격(W_e), 및 최소 선회 반경(R)를 고려하여 계산하며, 구간별 최단시간 선회거리 Lt는 유효 작업 구간 사이의 간격과 최소 선회반경 사이의 관계에 따라 달리지는 것을 특징으로 하는 자율주행 농업기계의 작업경로 설정방법.