KR20190143064A - System for calculating path following error of unmanned movable vehicle using total station and, method therefor - Google Patents
System for calculating path following error of unmanned movable vehicle using total station and, method therefor Download PDFInfo
- Publication number
- KR20190143064A KR20190143064A KR1020180070558A KR20180070558A KR20190143064A KR 20190143064 A KR20190143064 A KR 20190143064A KR 1020180070558 A KR1020180070558 A KR 1020180070558A KR 20180070558 A KR20180070558 A KR 20180070558A KR 20190143064 A KR20190143064 A KR 20190143064A
- Authority
- KR
- South Korea
- Prior art keywords
- moving object
- unmanned moving
- unmanned
- path
- gps module
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims abstract description 20
- 230000003287 optical effect Effects 0.000 claims description 34
- 230000005484 gravity Effects 0.000 claims description 6
- 238000013500 data storage Methods 0.000 claims description 3
- 239000010410 layer Substances 0.000 claims 4
- 239000002356 single layer Substances 0.000 claims 2
- 238000009313 farming Methods 0.000 abstract description 3
- 238000000691 measurement method Methods 0.000 abstract 1
- 238000004364 calculation method Methods 0.000 description 7
- 239000011159 matrix material Substances 0.000 description 5
- 238000005259 measurement Methods 0.000 description 3
- 238000011156 evaluation Methods 0.000 description 2
- 238000009434 installation Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000002452 interceptive effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/40—Correcting position, velocity or attitude
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/0278—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Aviation & Aerospace Engineering (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Optical Radar Systems And Details Thereof (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
본 발명은 무인 이동체의 경로추종 오차를 계산하기 위한 시스템에 대한 것으로서, 더욱 구체적으로는 GPS 시스템이 갖고 있던 오차를 고려하여 GPS 모듈 자체의 위치 오차를 측정함으로써 정밀도가 향상된, 경로추종 오차 계산 시스템에 대한 것이다. The present invention relates to a system for calculating a path following error of an unmanned moving object, and more particularly, by measuring a position error of the GPS module itself in consideration of the error of the GPS system, thereby improving the path tracking error calculation system. It is about.
아울러, 본 발명은 이러한 시스템을 이용하여 경로추종 오차를 계산하는 방법에 대한 것이기도 하다. In addition, the present invention also relates to a method for calculating a path tracking error using such a system.
일반적으로, 자율주행 트랙터, 자율주행 콤바인, 자율주행 밭농업 기계 등과 같은 자율주행 농기계, 자율 주행차, 무인 운송 수단, 드론 등과 같은 무인 이동체는 GPS 시스템과 연동하여 미리 입력된 기준 경로를 따라 주행(또는 비행)한다. Generally, autonomous farming machines such as autonomous tractors, autonomous driving combines, autonomous field farming machines, autonomous vehicles, unmanned vehicles, drones, and the like, drive along a pre-input reference path in conjunction with a GPS system. Or fly).
무인 이동체는, 안전하고 정확한 이동 또는 작업을 위하여, 기준 경로와 비교하여 허용 가능한 횡방향 경로 추종 오차 범위 내에서 이동해야 한다. 특히, 자율주행 트랙터 등은 비정형 환경에서 작업을 하므로, 경로 추종 오차 범위 내에서 주행하는 것은 작물 생산성 증대 및 작업 효율 측면에서 매우 중요하다. The unmanned vehicle must move within an acceptable lateral path following error range compared to the reference path for safe and accurate movement or operation. In particular, since self-driving tractors and the like work in an atypical environment, driving within the path following error range is very important in terms of crop productivity and work efficiency.
이러한 경로 추종 오차는 기준 경로의 위치 정보 데이터()에서 GPS 모듈이 측정한 실시간 위치 정보 데이터()를 감산하여 구하였다. 즉, 경로 추종 오차는 아래 식으로 계산하였다.This path tracking error is based on the location information data of the reference path ( ), The real-time location data measured by the GPS module ( ) Was subtracted. That is, the path following error was calculated by the following equation.
[식] [expression]
경로 추종 오차 = Path following error =
위 식에서, In the above formula,
: 기준 경로의 위치 정보 데이터로서, 3차원 좌표를 나타내는 벡터 행렬. : Vector matrix representing three-dimensional coordinates as positional information data of a reference path.
: GPS 모듈이 측정한 실시간 위치 정보 데이터로서, 3차원 좌표를 나타내는 벡터 행렬. : Vector matrix representing three-dimensional coordinates as real-time location information data measured by a GPS module.
그러나, 상기 식으로 구한 경로 추종 오차는 GPS로 얻은 데이터만을 이용하기 때문에 GPS 시스템이 갖고 있는 오차를 포함하고 있으므로 상당히 부정확하고, 이에 따라 자율 주행 트랙터 등에 대한 성능 평가가 제대로 이루어지지 못하고 있으며, 실제 현장에서 경로 추종 오차로 인해 작업 효율이 떨어지는 문제점이 있다. However, since the path tracking error obtained by the above equation uses only the data obtained by GPS, it includes the error of the GPS system, which is inaccurate. Therefore, the performance evaluation of the autonomous tractor is not performed properly. There is a problem that the work efficiency is lowered due to the path following error in the.
본 발명은 상술한 문제점을 해결하기 위해서 제안된 것으로서, GPS 시스템이 갖고 있던 오차를 고려하여 GPS 모듈 자체의 위치 오차를 측정함으로써 정밀도가 향상된, 무인 이동체의 경로추종 오차 계산 시스템 및 그 방법을 제공하고자 하는 목적을 갖고 있다.The present invention has been proposed to solve the above problems, and to provide a path tracking error calculation system and method of the unmanned moving object having improved accuracy by measuring the position error of the GPS module itself in consideration of the error of the GPS system. It has a purpose.
본 발명에 따른 무인 이동체의 경로추종 오차 계산 시스템은, 무인 이동체(100)에 설치된 GPS 모듈(30)과 반사용 프리즘(3); 주행 중인 무인 이동체(100)의 반사용 프리즘(3)에 광선을 조사하고, 반사용 프리즘(3)에 의해서 반사된 광선을 수광하여 무인 이동체(100)의 위치 정보 데이터()를 구하는 광파기(1); 제어 유닛; 및, 기준 경로(reference path)의 위치 정보 데이터()를 저장하는 데이터 저장부;를 구비한다. Path tracking error calculation system of the unmanned moving object according to the present invention,
기준 경로의 위치 정보 데이터()는 광파기(1)를 이용하여 경로를 계측하여 구하고, 무인 이동체(100)는 위치 정보 데이터()에 따라 주행한다. 그리고, GPS 모듈(30)은 주행 중인 무인 이동체(100)의 위치를 GPS로 실시간으로 파악하여 위치 정보 데이터()를 얻는다. Geolocation data for the reference route ( ) Is obtained by measuring the path using the
제어 유닛은 무인 이동체(100)의 횡방향 경로추종 오차값()을 아래 식으로 계산한다. The control unit is a transverse path following error value of the unmanned moving object 100 ( ) Is calculated by the following formula.
[식][expression]
위 식에서, In the above formula,
: 기준 경로의 위치 정보 데이터. : Position information data of the reference route.
: 광파기가 측정한 무인 이동체의 실시간 위치 정보 데이터. : Real-time location data of unmanned moving object measured by light wave.
: GPS 모듈을 이용하여 측정한, 무인 이동체의 실시간 위치 정보데이터. : Real time location data of unmanned moving object measured using GPS module.
GPS 모듈(10)과 반사용 프리즘(3)은 무인 이동체(100)의 동일한 위치에 설치되는 것이 바람직하다. The
구체적으로, 상기 무인 이동체(100)의 무게 중심점의 상측 방향 수직 연장선상에 2단 지그(30)가 설치되고, 2단 지그(30)는 1층 공간과 2층 공간을 각각 가지며, GPS 모듈(10)은 2층 공간에 설치되고 반사용 프리즘(3)은 1층 공간에 설치될 수 있다.Specifically, a two-
본 발명의 다른 측면인, 광파기를 이용하여 무인이동체의 경로추종 오차를 계산하는 방법은, (a) 기준 경로(reference path, )를 구하고, 상기 기준 경로의 위치 정보 데이터()를 무인 이동체(100)에 입력하는 단계; (b) 무인 이동체(100)에 GPS 모듈(30)과 반사용 프리즘(3)을 설치하는 단계; (c) GPS를 이용하여 무인 이동체(100)를 상기 기준 경로를 따라 주행시키는 단계; 및, (d) 무인 이동체(100)의 횡방향 경로추종 오차값()을 계산하는 단계;를 포함한다. In another aspect of the present invention, a method for calculating a path tracking error of an unmanned vehicle using an optical wave includes: (a) a reference path, ), And the position information data of the reference path ( ) Into the unmanned
상기 (c) 단계는, (c1) 무인 이동체(100)가 주행하는 동안에 GPS 모듈(30)에 표시되는 위치 정보 데이터()를 구하는 단계; 및. (c2) 광파기(1)를 이용하여 주행 중인 무인 이동체(100)의 위치 정보 데이터()를 구하는 단계;를 포함한다. In the step (c), (c1) the position information data displayed on the
상기 기준 경로의 위치 정보 데이터()는 광파기를 이용하여 경로를 계측하여 구할 수 있다. Location information data of the reference path ( ) Can be obtained by measuring the path using an optical wave.
본 발명은 GPS 시스템이 갖고 있던 오차를 고려하여 GPS 모듈 자체의 위치 오차를 측정함으로써 정밀도가 향상된, 무인 이동체의 경로추종 오차 계산 시스템 및 그 방법을 제공한다. The present invention provides a system and method for calculating a path tracking error of an unmanned moving object having improved accuracy by measuring the position error of the GPS module itself in consideration of the error of the GPS system.
도 1은 본 발명의 바람직한 실시예에 따른, 무인 이동체의 경로추종 오차 계산 방법을 보여주는 플로우 차트.
도 2는 본 발명에 따라 무인 이동체의 경로추종 오차를 계산하는 예를 보여주는 도면.
도 3은 본 발명에 따라 무인 이동체의 경로추종 오차를 계산하는 또 다른 예를 보여주는 도면.
도 4는 본 발명에 따른 경로추종 오차 계산 시스템을 구성하는 광파기와, GPS 모듈과, 반사용 프리즘 및 2단 지그를 보여주는 도면.
도 5a는 2단 지그의 변형예를 보여주는 정면도.
도 5b는 도 5a의 우측면도. 1 is a flow chart showing a path tracking error calculation method of an unmanned moving object according to a preferred embodiment of the present invention.
2 is a view showing an example of calculating a path following error of an unmanned moving object according to the present invention.
3 is a view showing another example of calculating a path following error of an unmanned moving object according to the present invention.
4 is a view showing an optical wave, a GPS module, a reflection prism, and a two-stage jig constituting the path tracking error calculating system according to the present invention;
5A is a front view showing a modification of the two-stage jig.
5B is a right side view of FIG. 5A.
이하, 첨부된 도면들을 참조로 본 발명에 대해서 상세히 설명하기로 한다. 이에 앞서, 본 명세서 및 청구범위에 사용된 용어나 단어는 통상적이거나 사전적인 의미로 한정해서 해석되어서는 아니되며, 발명자는 그 자신의 발명을 가장 최선의 방법으로 설명하기 위해 용어의 개념을 적절하게 정의할 수 있다는 원칙에 입각하여 본 발명의 기술적 사상에 부합하는 의미와 개념으로 해석되어야만 한다. 따라서, 본 명세서에 기재된 실시예와 도면에 도시된 구성은 본 발명의 실시예들에 불과할 뿐이고 본 발명의 기술적 사상을 모두 대변하는 것은 아니므로, 본 출원시점에 있어서 이들을 대체할 수 있는 다양한 균등물과 변형예들이 있을 수 있음을 이해하여야 한다. Hereinafter, the present invention will be described in detail with reference to the accompanying drawings. Prior to this, terms or words used in the present specification and claims should not be construed as being limited to the common or dictionary meanings, and the inventors should properly explain the concept of terms in order to best explain their own invention. Based on the principle that can be defined, it should be interpreted as meaning and concept corresponding to the technical idea of the present invention. Therefore, the embodiments described in the specification and the drawings shown in the drawings are only embodiments of the present invention and do not represent all of the technical idea of the present invention, various equivalents that may be substituted for them at the time of the present application It should be understood that there may be variations and variations.
아래에서는 무인 이동체의 경로추종 오차 계산 방법을 먼저 설명하고, 이어서 GPS 모듈과 반사용 프리즘을 설치하기 위한 2단 지그를 설명하기로 한다.In the following description, a path tracking error calculation method of an unmanned moving object will be described first, followed by a two-stage jig for installing a GPS module and a reflection prism.
도 1은 본 발명의 바람직한 실시예에 따른, 무인 이동체의 경로추종 오차 계산 방법을 보여주는 플로우 차트이고, 도 2는 무인 이동체의 경로추종 오차를 계산하는 예를 보여주는 도면이다.1 is a flowchart illustrating a method of calculating a path following error of an unmanned moving object according to a preferred embodiment of the present invention, and FIG. 2 is a view illustrating an example of calculating a path following error of an unmanned moving object.
상기 경로추종 오차 계산 방법은 기준 경로(reference path, )를 정밀 계측하고 그 경로 데이터()를 무인 이동체의 제어 유닛에 입력하는 단계(S10)와, 무인 이동체가 기준 경로()를 따라 주행하는 동안에 GPS 모듈에 표시되는 위치 정보 데이터()를 얻고 광파기(1)가 측정한 위치 정보 데이터()를 얻는 단계(S20)와, 제어 유닛이 무인 이동체의 경로 추종 오차를 계산하는 단계(S30)를 포함한다. The path tracking error calculation method includes a reference path, ) And precisely measure its path data ( ) Is input to the control unit of the unmanned moving object (S10), and the unmanned moving object is a reference path ( Location information data displayed on the GPS module while ) And the positional information data measured by the ), And the control unit calculates a path following error of the unmanned moving object (S30).
상기 S10 단계는 mm 단위의 오차 수준을 갖는 광파기(1)를 이용하여 기준 경로()를 정밀하게 계측하여 기준 경로()의 3축 위치 정보 데이터()를 얻고, 이와 같이 얻어진 위치 정보 데이터()를 무인 이동체의 제어 유닛에 입력한다. In the step S10, the reference path (using the
이어서, GPS 모듈과 반사용 프리즘을 무인 이동체에 설치한다. 한편, GPS 모듈과 반사용 프리즘의 설치는 S10 단계 이전이나 S10 단계와 함께 이루어질 수도 있다.Next, the GPS module and the reflecting prism are installed in the unmanned moving object. On the other hand, the installation of the GPS module and the reflection prism may be made before or in step S10.
GPS 모듈은 RTK-GPS(Real Time Kinematic-GPS)인 것이 바람직하다. RTK-GPS는 위치를 알고 있는 기준국과, 위치를 구하고자 하는 이동국(무인 이동체)에서 동시에 GPS 관측을 실시하고, 기준국에서 관측한 데이터를 무선 등의 방법으로 이동국(무인 이동체)에 실시간으로 송신하고, 기준국의 위치 성과에 기초해 이동국(무인 이동체)의 위치를 실시간으로 계산한다.The GPS module is preferably RTK-GPS (Real Time Kinematic-GPS). RTK-GPS simultaneously performs GPS observations from a reference station that knows its location and a mobile station (unmanned mobile) to obtain its location.The RTK-GPS provides real-time data to the mobile station (unmanned mobile). The position of the mobile station (unmanned moving object) is calculated in real time based on the position performance of the reference station.
광파기(1)는 토털 스테이션(total station)으로도 불리는 것으로서, 각도와 거리를 함께 측정할 수 있는 측량기이고, 전자식 세오돌라이트(electronic theodolite)와 광파측거기(EDM:electro-optical instruments)가 하나의 기기로 통합되어 있으므로 측정한 자료를 빠른 시간 안에 처리하고, 결과를 출력할 수 있는 전자식 측거ㆍ측각기이다. The
광파기(1)의 종류에는 광파 측거기에 측각 기능을 부가한 광파측거기 주체형과 광학식 세오돌라이트에 광파측거기를 부착한 광학식 세오돌라이트 주체형, 전자식 세오돌라이트에 광파측거기를 부착한 전자식 세오돌라이트 주체형이 있는데, 본 발명에는 이러한 광파기들이 모두 사용될 수 있다. The types of
전자식 세오돌라이트(electronic theodolite)와 광파측거기(EDM:electro-optical instruments)가 하나의 기기로 통합되어 있어 측정한 자료를 빠른 시간 안에 처리하고, 결과를 출력하는 전자식 측거ㆍ측각기이다. 정확하고 재빠른 측정이 가능하며, 작고 가벼워 사용이 간편한 것이 특징이다. Electronic theodolite and EDM (electro-optical instruments) are integrated into a single device, which is an electronic measuring and measuring device that processes the measured data quickly and outputs the result. Accurate and quick measurement is possible, and it is small and light and easy to use.
반사용 프리즘은 광파기(1)에서 나온 광파를 반사한다. 광파기(1)는 반사용 프리즘을 향하여 광파를 조사(전송)하고 반사용 프리즘은 이 광파를 반사하며, 광파기(1)는 반사된 광파를 이용하여 무인 이동체까지의 거리와 각도를 측정하며, 이 거리와 각도를 이용하여 무인 이동체의 위치를 실시간으로 계산한다. The reflecting prism reflects the light waves emitted from the
측정 오차를 줄이기 위해서, 반사용 프리즘은 GPS 모듈과 동일한 위치에 설치되는 것이 바람직하고, 더욱 바람직하게는 GPS 모듈과 반사용 프리즘이 무인 이동체의 무게 중심점의 상측 방향 수직 연장선상에 설치되며, 가장 바람직하게는 반사용 프리즘이 GPS 모듈의 아래에 설치된다. 이 점에 대해서는 아래에서 상세히 설명될 것이다. In order to reduce the measurement error, the reflecting prism is preferably installed at the same position as the GPS module, more preferably, the GPS module and the reflecting prism are installed on a vertical extension line in the upper direction of the center of gravity of the unmanned moving object. Preferably, a reflective prism is installed below the GPS module. This point will be described in detail below.
GPS 모듈과 광파기(1)의 설치가 완료되면, 무인 이동체를 주행시키면서 GPS 모듈에 표시되는 위치 정보 데이터()를 얻고 이와 동시에 광파기(1)가 측정한 위치 정보 데이터()를 얻는다(S20). When the installation of the GPS module and the
상기 위치 정보 데이터()()는 무인 이동체의 제어 유닛과 데이터 저장부로 전송된다. The location information data ( ) ( ) Is transmitted to the control unit and data storage of the unmanned vehicle.
이어서, 제어 유닛은 위치 정보 데이터()()()를 이용하여 무인 이동체의 횡방향 경로 추종 오차()를 계산한다(S30). 를 계산하기 위한 식은 아래와 같다. 한편, 본 명세서에서 횡방향은 수평 방향을 의미한다. Subsequently, the control unit stores the position information data ( ) ( ) ( Lateral path tracking error of unmanned vehicle using ) Is calculated (S30). The formula for calculating is In the present specification, the lateral direction means a horizontal direction.
[식][expression]
위 식에서, In the above formula,
: 기준 경로의 위치 정보 데이터로서, 3차원 좌표를 나타내는 벡터 행렬. : Vector matrix representing three-dimensional coordinates as positional information data of a reference path.
: 광파기가 측정한 무인 이동체의 실시간 위치 정보 데이터로서, 3차원 좌표를 나타내는 벡터 행렬. : A vector matrix representing three-dimensional coordinates as real-time positional information data of an unmanned moving object measured by an optical wave.
: GPS 모듈이 측정한 실시간 위치 정보 데이터로서, 3차원 좌표를 나타내는 벡터 행렬. : Vector matrix representing three-dimensional coordinates as real-time location information data measured by a GPS module.
도 2에 나타난 바와 같이, 는 실제로 무인 이동체가 주행할 때 발생하는 횡방향 경로 추종 오차이고, 는 기준 경로에 의한 위치 정보 데이터()와 GPS 모듈에 표시되는 위치 정보 데이터()의 차이로서 기존에 사용하던 경로 추종 오차 성능의 평가 기준으로 사용되던 값이다. As shown in Figure 2, Is actually the lateral path following error that occurs when the unmanned vehicle moves, Is the location information data by the reference path ( ) And the geolocation data displayed on the GPS module ( As a difference of), it is a value used as a criterion for evaluating path tracking error performance.
즉, 는 GPS 모듈 자체의 횡방향 위치 오차를 나타내는 것으로서, GPS 시스템의 오차를 고려한 무인 이동체의 실제 경로 추종 오차를 나타낸다. In other words, Represents the lateral position error of the GPS module itself, and represents the actual path tracking error of the unmanned moving object considering the error of the GPS system.
이에 비해, 기존의 평가 기준으로 사용되던 는 GPS 측정값만으로 평가하는 것이기 때문에 GPS 시스템의 오차를 포함하고 있고, 이에 따라 정확하지 못하다는 문제점이 있었다. In contrast, the existing evaluation criteria Since GPS is only evaluated by GPS measurement, it includes the error of GPS system, and accordingly, there is a problem that it is not accurate.
한편, 도 3은 본 발명에 따라 무인 이동체의 경로추종 오차를 계산하는 또 다른 예를 보여준다. 도 2는 무인 이동체가 직선으로 주행하는 것을 보여주고 있음에 비해, 도 3은 무인 이동체가 곡선 경로를 주행하는 것을 보여주고 있다. On the other hand, Figure 3 shows another example of calculating the path following error of the unmanned moving object according to the present invention. FIG. 2 shows that the unmanned vehicle travels in a straight line, whereas FIG. 3 shows that the unmanned vehicle travels in a curved path.
도 3은 무인 이동체가 기준 경로()를 따라 주행하고자 할 때, 기준 경로()의 위치 정보 데이터()에 대응하는 무인 이동체의 실제 위치(광파기로 측정한 위치 정보 데이터, )와, 이 때 GPS 모듈에 표시되는 위치 정보 데이터()의 관계를 보여준다. 3 is a reference path (unmanned moving object) ), If you want to drive along Geolocation data () Actual position of the unmanned moving object corresponding to) (position information data measured with an optical wave, ), And the location information data displayed on the GPS module ) Shows the relationship.
도면에서, In the drawing,
= 이다.= to be.
따라서, 는 GPS 시스템의 오차를 고려하여 GPS 모듈 자체의 위치 오차를 측정한 값으로서, 기존의 측정 기준() 보다 훨씬 정밀하게 횡방향 경로 추종 오차를 나타낸다. therefore, Is a measure of the position error of the GPS module itself in consideration of the error of the GPS system. The transverse path following error is more precise than.
도 4는 본 발명에 따른 경로추종 오차 계산 시스템을 구성하는 광파기(1)와, GPS 모듈(10)과, 반사용 프리즘(3) 및 2단 지그(30)를 보여준다. 4 shows an
도면에 나타난 바와 같이, GPS 모듈(10)과 반사용 프리즘(3)은 무인 이동체(100)의 무게 중심점의 상측 방향 수직 연장선상에 설치되는 것이 바람직한데, 이것은 무인 이동체(100)의 주행시에 GPS 모듈(10)과 반사용 프리즘(3)의 진동을 최소화하기 위한 것이다. As shown in the figure, the
GPS 모듈(10)과 반사용 프리즘(3)은 2단 지그(30)에 설치되는 것이 바람직하다. 구체적으로, 서포트 프레임(40)이 무인 이동체(100)에 수직으로 설치되고, 2단 지그(30)가 서포트 프레임(40)에 설치되되 무인 이동체(100)의 무게 중심점의 상측 방향 수직 연장선상에 설치된다. The
그리고, 2단 지그(30)는 반사용 프리즘(3)을 설치하기 위한 1층 공간과, GPS 모듈(10)을 설치하기 위한 2층 공간을 포함한다. The two-
한편, 도 5a는 2단 지그의 변형예를 보여주는 정면도이고, 도 5b는 도 5a의 우측면도이다. 5A is a front view illustrating a modification of the two-stage jig, and FIG. 5B is a right side view of FIG. 5A.
도면에 나타난 바와 같이, 2단 지그(30)는, 1층 평판(31)과, 1층 평판(31)에 수직으로 설치된 두 개의 제1 기둥(32)과, 1층 평판(31)에 수직으로 설치되되 제1 기둥(32)의 후방에 설치된 제2 기둥(34) 및, 제1,2 기둥(32)(34)의 상단에 설치된 2층 평판(33)을 포함한다. 제2 기둥(34)은 반사용 프리즘(3)의 후방에 위치한다. As shown in the figure, the two-
두 개의 제1 기둥(32)에는 반사용 프리즘(3)이 회동 가능하게 설치될 수 있다. The
그리고, 1,2층 평판(31)(33)의 선단은 반사용 프리즘(3)의 선단(4) 보다 후방에 위치하는 것이 바람직한데, 이것은 반사용 프리즘(3)으로 입사되는 입사광과 반사용 프리즘(3)에 의해 반사되는 반사광이 1,2층 평판(31)(33)과 간섭하지 않도록 하기 위함이다. And, the tip of the first and second layer
1 : 광파기 3 : 반사용 프리즘
4 : 반사용 프리즘의 선단 10 : GPS 모듈
30 : 2단 지그 31 : 1층 평판
32 : 제1 기둥 33 : 2층 평판
34 : 제2 기둥 40 : 서포트 프레임
100 : 무인 이동체
: 무인 이동체의 횡방향 경로 추종 오차
: 기준 경로
: 기준 경로의 위치 정보 데이터
: 광파기가 측정한 무인 이동체의 실시간 위치 정보 데이터
: GPS 모듈이 측정한 실시간 위치 정보 데이터1: light wave 3: reflection prism
4: tip of reflective prism 10: GPS module
30: 2-stage jig 31: 1st floor flatbed
32: first pillar 33: two-layer flat plate
34: second pillar 40: support frame
100: unmanned moving object
: Lateral Path Following Error of Unmanned Vehicles
Reference path
: Geolocation data of reference path
: Real-time location data of unmanned moving object measured by light wave
: Real-time location data measured by GPS module
Claims (9)
주행 중인 무인 이동체(100)의 반사용 프리즘(3)에 광선을 조사하고, 반사용 프리즘(3)에 의해서 반사된 광선을 수광하여 무인 이동체(100)의 위치 정보 데이터()를 구하는 광파기(1);
제어 유닛; 및,
기준 경로(reference path)의 위치 정보 데이터()를 저장하는 데이터 저장부;를 구비하고,
기준 경로의 위치 정보 데이터()는 광파기(1)를 이용하여 경로를 계측하여 구하고, 무인 이동체(100)는 위치 정보 데이터()에 따라 주행하며,
GPS 모듈(30)은 주행 중인 무인 이동체(100)의 위치를 GPS로 실시간으로 파악하여 위치 정보 데이터()를 얻으며,
제어 유닛은 무인 이동체(100)의 횡방향 경로추종 오차값()을 아래 식으로 계산하는 것을 특징으로 하는, 광파기를 이용하여 무인 이동체의 경로추종 오차를 계산하는 시스템.
[식]
위 식에서,
: 기준 경로의 위치 정보 데이터.
: 광파기가 측정한 무인 이동체의 실시간 위치 정보 데이터.
: GPS 모듈을 이용하여 측정한, 무인 이동체의 실시간 위치 정보데이터.A GPS module 30 and a reflection prism 3 installed in the unmanned moving object 100;
The light beam is irradiated to the reflecting prism 3 of the unmanned movable body 100 while traveling, and the light beam reflected by the reflecting prism 3 is received to receive the positional information data of the unmanned movable body 100 ( An optical wave receiver (1) for obtaining?
Control unit; And,
Geolocation data in a reference path ( Data storage unit for storing;
Geolocation data for the reference route ( ) Is obtained by measuring the path using the optical wave receiver 1, the unmanned moving object 100 is the position information data ( ),
The GPS module 30 grasps the position of the unmanned moving object 100 that is being driven in real time using GPS and provides location information data ( ),
The control unit is a transverse path following error value of the unmanned moving object 100 ( ) Is calculated by the following equation, the system for calculating the path tracking error of the unmanned moving object using an optical wave.
[expression]
In the above formula,
: Position information data of the reference route.
: Real-time location data of unmanned moving object measured by light wave.
: Real time location data of unmanned moving object measured using GPS module.
GPS 모듈(10)과 반사용 프리즘(3)은 무인 이동체(100)의 동일한 위치에 설치되는 것을 특징으로 하는, 광파기를 이용하여 무인 이동체의 경로추종 오차를 계산하는 시스템. The method of claim 1,
GPS module (10) and the reflecting prism (3) is installed in the same position of the unmanned moving object (100), a system for calculating the path tracking error of the unmanned moving object using an optical wave.
상기 무인 이동체(100)의 무게 중심점의 상측 방향 수직 연장선상에 2단 지그(30)가 설치되고,
2단 지그(30)는 1층 공간과 2층 공간을 각각 가지며, GPS 모듈(10)은 2층 공간에 설치되고 반사용 프리즘(3)은 1층 공간에 설치된 것을 특징으로 하는, 광파기를 이용하여 무인이동체의 경로추종 오차를 계산하는 시스템. The method according to claim 1 or 2,
A two-stage jig 30 is installed on an upward vertical extension line of the center of gravity of the unmanned moving object 100,
The two-stage jig 30 has a first floor space and a second floor space, respectively, the GPS module 10 is installed in the second floor space and the reflection prism 3 is installed in the first floor space, using a light wave System for calculating the path tracking error of an unmanned vehicle.
2단 지그(30)는,
1층 평판(31);
1층 평판(31)에 수직으로 설치된 두 개의 제1 기둥(32);
1층 평판(31)에 수직으로 설치되되, 제1 기둥(32)의 후방에 설치된 제2 기둥(34); 및,
제1,2 기둥(32)(34)의 상단에 설치된 2층 평판(33);을 포함하고,
두 개의 제1 기둥(32)에는 반사용 프리즘(3)이 회동 가능하게 설치되며,
제2 기둥(34)은 반사용 프리즘(3)의 후방에 위치하고,
1,2층 평판(31)(33)의 선단은 반사용 프리즘(3)의 선단(4) 보다 후방에 위치하는 것을 특징으로 하는, 광파기를 이용하여 무인이동체의 경로추종 오차를 계산하는 시스템. The method of claim 3,
The two-stage jig 30,
Single layer flat plate 31;
Two first pillars 32 installed perpendicular to the first floor flat plate 31;
A second pillar 34 installed perpendicular to the first floor flat plate 31 and installed at the rear of the first pillar 32; And,
Includes; two-layer flat plate 33 installed on the top of the first and second pillars (32, 34),
The reflective prisms 3 are rotatably installed on the two first pillars 32,
The second pillar 34 is located behind the reflecting prism 3,
A system for calculating a path tracking error of an unmanned vehicle using an optical wave, characterized in that the tip of the first and second layer flat plates (31, 33) is located behind the tip (4) of the reflecting prism (3).
(b) 무인 이동체(100)에 GPS 모듈(30)과 반사용 프리즘(3)을 설치하는 단계; 및,
(c) GPS를 이용하여 무인 이동체(100)를 상기 기준 경로를 따라 주행시키는 단계;를 포함하고,
상기 (c) 단계는,
(c1) 무인 이동체(100)가 주행하는 동안에 GPS 모듈(30)에 표시되는 위치 정보 데이터()를 구하는 단계; 및.
(c2) 광파기(1)를 이용하여 주행 중인 무인 이동체(100)의 위치 정보 데이터()를 구하는 단계;를 포함하고,
상기 무인 이동체(100)의 횡방향 경로추종 오차값()이 아래 식으로 계산되는 것을 특징으로 하는, 광파기를 이용하여 무인이동체의 경로추종 오차를 계산하는 방법.
[식]
위 식에서,
: 기준 경로의 위치 정보 데이터.
: 광파기가 측정한 무인 이동체의 위치 정보데이터.
: GPS 모듈을 이용하여 측정한, 무인이동체의 실시간 위치 정보데이터.(a) reference path, ), And the position information data of the reference path ( ) Into the unmanned moving object 100;
(b) installing the GPS module 30 and the reflecting prism 3 on the unmanned moving object 100; And,
(c) driving the unmanned moving object 100 along the reference path using GPS;
In step (c),
(c1) location information data displayed on the GPS module 30 while the unmanned moving object 100 is traveling ( Obtaining; And.
(c2) position information data of the unmanned moving object 100 that is traveling by using the optical wave receiver 1 Comprising ;;
Lateral path following error value of the unmanned moving object 100 ( ) Is calculated by the following equation, a method for calculating the path tracking error of the unmanned vehicle using an optical wave.
[expression]
In the above formula,
: Location information data of a reference path.
: Position information data of unmanned moving object measured by light wave.
: Real time location data of unmanned vehicle measured using GPS module.
상기 기준 경로의 위치 정보 데이터()는 광파기를 이용하여 경로를 계측하여 구하는 것을 특징으로 하는, 광파기를 이용하여 무인이동체의 경로추종 오차를 계산하는 방법. The method of claim 5,
Location information data of the reference path ( ) Is a method for calculating the path tracking error of the unmanned vehicle using the optical wave, characterized in that the optical path is measured and obtained.
상기 무인 이동체(100)에 설치된 2단 지그(30)를 포함하고,
2단 지그(30)는 1층 공간과 2층 공간을 각각 가지며, GPS 모듈(10)은 2층 공간에 설치되고 반사용 프리즘(3)은 1층 공간에 설치된 것을 특징으로 하는, 광파기를 이용하여 무인이동체의 경로추종 오차를 계산하는 방법. The method according to claim 5 or 6,
It includes a two-stage jig (30) installed on the unmanned moving object 100,
The two-stage jig 30 has a first floor space and a second floor space, respectively, the GPS module 10 is installed in the second floor space and the reflection prism 3 is installed in the first floor space, using a light wave To calculate the path tracking error of the unmanned vehicle.
상기 2단 지그(30)는 무인 이동체(100)의 무게 중심점의 상측 방향 수직 연장선상에 설치되는 것을 특징으로 하는, 광파기를 이용하여 무인이동체의 경로추종 오차를 계산하는 방법. The method of claim 7, wherein
The two-stage jig (30) is characterized in that installed on the vertical extension line in the upper direction of the center of gravity of the unmanned moving object (100), a method for calculating the path tracking error of the unmanned moving body using an optical wave.
2단 지그(30)는,
1층 평판(31);
1층 평판(31)에 수직으로 설치된 두 개의 제1 기둥(32);
1층 평판(31)에 수직으로 설치되되, 제1 기둥(32)의 후방에 설치된 제2 기둥(34); 및,
제1,2 기둥(32)(34)의 상단에 설치된 2층 평판(33);을 포함하고,
두 개의 제1 기둥(32)에는 반사용 프리즘(3)이 회동 가능하게 설치되며,
제2 기둥(34)은 반사용 프리즘(3)의 후방에 위치하고,
1,2층 평판(31)(33)의 선단은 반사용 프리즘(3)의 선단(4) 보다 후방에 위치하는 것을 특징으로 하는, 광파기를 이용하여 무인 이동체의 경로추종 오차를 계산하는 방법.
The method of claim 8,
The two-stage jig 30,
Single layer flat plate 31;
Two first pillars 32 installed perpendicular to the first floor flat plate 31;
A second pillar 34 installed perpendicular to the first floor flat plate 31 and installed at the rear of the first pillar 32; And,
Includes; two-layer flat plate 33 installed on the top of the first and second pillars (32, 34),
The reflective prisms 3 are rotatably installed on the two first pillars 32,
The second pillar 34 is located behind the reflecting prism 3,
A method for calculating a path tracking error of an unmanned moving object using an optical wave, characterized in that the tip of the first and second layer flat plates (31, 33) is located behind the tip (4) of the reflecting prism (3).
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020180070558A KR102129106B1 (en) | 2018-06-20 | 2018-06-20 | System for calculating path following error of unmanned movable vehicle using total station and, method therefor |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020180070558A KR102129106B1 (en) | 2018-06-20 | 2018-06-20 | System for calculating path following error of unmanned movable vehicle using total station and, method therefor |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20190143064A true KR20190143064A (en) | 2019-12-30 |
KR102129106B1 KR102129106B1 (en) | 2020-07-01 |
Family
ID=69103190
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020180070558A KR102129106B1 (en) | 2018-06-20 | 2018-06-20 | System for calculating path following error of unmanned movable vehicle using total station and, method therefor |
Country Status (1)
Country | Link |
---|---|
KR (1) | KR102129106B1 (en) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111487976A (en) * | 2020-05-03 | 2020-08-04 | 哈尔滨工程大学 | Backing track tracking method |
CN112924193A (en) * | 2021-03-22 | 2021-06-08 | 黑龙江惠达科技发展有限公司 | Method for testing an autopilot system and test system |
CN113271547A (en) * | 2021-05-24 | 2021-08-17 | 福建盛海智能科技有限公司 | Unmanned tracking driving method and terminal based on UWB array positioning navigation |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20120051981A (en) * | 2010-11-15 | 2012-05-23 | 현대건설주식회사 | Method for measuring verticality of structure using gnss and system thereof |
KR20150086065A (en) * | 2014-01-17 | 2015-07-27 | 전남대학교산학협력단 | System and method for path planning for autonomous navigation of driverless ground vehicle |
KR20180054321A (en) * | 2016-11-15 | 2018-05-24 | 한국국토정보공사 | Total measurement system operating with gnss measuremt module and method, and storage media storing the same |
-
2018
- 2018-06-20 KR KR1020180070558A patent/KR102129106B1/en active IP Right Grant
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20120051981A (en) * | 2010-11-15 | 2012-05-23 | 현대건설주식회사 | Method for measuring verticality of structure using gnss and system thereof |
KR20150086065A (en) * | 2014-01-17 | 2015-07-27 | 전남대학교산학협력단 | System and method for path planning for autonomous navigation of driverless ground vehicle |
KR20180054321A (en) * | 2016-11-15 | 2018-05-24 | 한국국토정보공사 | Total measurement system operating with gnss measuremt module and method, and storage media storing the same |
Non-Patent Citations (2)
Title |
---|
Biasion, A 외 2명. An integrated GPS and Total Station instrument for cultural heritage surveying: the LEICA SmartStation example. Proceeding Cipa XX international symposium. 2005.* * |
Chekole, Solomon Dargie. Surveying with GPS, total station and terresterial laser scaner: a comparative study. Royal Institute of Technology. 2014.* * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111487976A (en) * | 2020-05-03 | 2020-08-04 | 哈尔滨工程大学 | Backing track tracking method |
CN111487976B (en) * | 2020-05-03 | 2022-11-18 | 哈尔滨工程大学 | Backing track tracking method |
CN112924193A (en) * | 2021-03-22 | 2021-06-08 | 黑龙江惠达科技发展有限公司 | Method for testing an autopilot system and test system |
CN112924193B (en) * | 2021-03-22 | 2023-08-18 | 黑龙江惠达科技股份有限公司 | Method for testing an autopilot system and test system |
CN113271547A (en) * | 2021-05-24 | 2021-08-17 | 福建盛海智能科技有限公司 | Unmanned tracking driving method and terminal based on UWB array positioning navigation |
Also Published As
Publication number | Publication date |
---|---|
KR102129106B1 (en) | 2020-07-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11822351B2 (en) | Three-dimensional information processing unit, apparatus having three-dimensional information processing unit, unmanned aerial vehicle, informing device, method and program for controlling mobile body using three-dimensional information processing unit | |
EP3542182B1 (en) | Methods and systems for vehicle environment map generation and updating | |
US10801855B2 (en) | Method and system for creating map based on 3D laser | |
KR102129106B1 (en) | System for calculating path following error of unmanned movable vehicle using total station and, method therefor | |
EP2098821B1 (en) | Geographical data collecting device | |
US11307031B2 (en) | Surveying device, and calibration checking method and calibration checking program for surveying device | |
US9989632B2 (en) | Measuring system, and portable radio transceiver and measurement pole used in measuring system | |
JP5105596B2 (en) | Travel route determination map creation device and travel route determination map creation method for autonomous mobile body | |
CN101470204A (en) | Surveying system | |
JP2016505838A (en) | Method and apparatus for determining position coordinates of a target | |
JP7022601B2 (en) | Surveying equipment and surveying method | |
EP1130355A2 (en) | Target, surveying system and surveying method | |
KR102247523B1 (en) | Agricultural machinery and automatic driving method thereof | |
JP2019039868A (en) | Information processing device, information processing method and program for information processing | |
KR101217857B1 (en) | Integrated management system for gathering topographic data which can handle data measured by total station | |
JP6968877B2 (en) | Self-position estimator, control method, program and storage medium | |
JP2005062034A (en) | Railroad track measuring gauge, railroad track measuring system, and railroad track measuring method | |
CN107102315A (en) | A kind of laser range finder calibration method | |
JP5105595B2 (en) | Travel route determination map creation device and travel route determination map creation method for autonomous mobile body | |
US20130003037A1 (en) | Distance based position sensing | |
JP2012173013A (en) | Estimated position evaluation system and program | |
CN112334790A (en) | Positioning system and positioning method for movable object, and storage medium | |
KR20200080598A (en) | Method for evaluating mobile robot movement | |
JP2005127992A (en) | Instrument and method for measuring position of moving object by laser range finder | |
WO2022256976A1 (en) | Method and system for constructing dense point cloud truth value data and electronic device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A201 | Request for examination | ||
E902 | Notification of reason for refusal | ||
E902 | Notification of reason for refusal | ||
E701 | Decision to grant or registration of patent right | ||
GRNT | Written decision to grant |