KR102079524B1 - Automatic driving vehicle and automatic driving system with the same - Google Patents

Automatic driving vehicle and automatic driving system with the same Download PDF

Info

Publication number
KR102079524B1
KR102079524B1 KR1020160040998A KR20160040998A KR102079524B1 KR 102079524 B1 KR102079524 B1 KR 102079524B1 KR 1020160040998 A KR1020160040998 A KR 1020160040998A KR 20160040998 A KR20160040998 A KR 20160040998A KR 102079524 B1 KR102079524 B1 KR 102079524B1
Authority
KR
South Korea
Prior art keywords
vertex
unit
information
vehicle
identification information
Prior art date
Application number
KR1020160040998A
Other languages
Korean (ko)
Other versions
KR20170015107A (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
Priority claimed from JP2015157183A external-priority patent/JP6690904B2/en
Priority claimed from JP2015175792A external-priority patent/JP6651313B2/en
Application filed by 야마하하쓰도키 가부시키가이샤 filed Critical 야마하하쓰도키 가부시키가이샤
Publication of KR20170015107A publication Critical patent/KR20170015107A/en
Application granted granted Critical
Publication of KR102079524B1 publication Critical patent/KR102079524B1/en

Links

Images

Classifications

    • 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
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • 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
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/10Path keeping
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/14Adaptive cruise control
    • B60W30/143Speed control
    • 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
    • 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/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • 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/0259Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
    • 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/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Electromagnetism (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Theoretical Computer Science (AREA)
  • Quality & Reliability (AREA)
  • Measurement Of Optical Distance (AREA)
  • Image Processing (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Abstract

(과제) 고정밀도로 현재위치를 인식할 수 있는 자주식의 자동 주행 차량을 제공한다.
(해결 수단) 이 자동 주행 차량은 기정 주로 상을, 그 기정 주로 상에 설치된 정점에 의거하여 속도가 제어된 상태에서 자동 주행 가능하게 구성되어 있다. 자동 주행 차량은 정점을 통과한 것을 검지하는 정점 검지부와, 각 정점이 배치되어 있는 위치에 관한 정점 위치정보와 각 정점을 식별하기 위한 정점 식별정보가 대응되어서 기억된 기억부와, 정점 검지부에서 통과한 것이 검지된 정점을 정점 식별정보에 의거해서 특정하는 정점 특정부와, 정점 특정부에 의해 특정된 정점으로부터 현재지점까지의 주행거리를 계측하는 주행거리 계측부와, 정점 위치정보에 의거하여 검출된 정점의 위치와 주행거리 계측부에 의해 계측된 정점으로부터 현재지점까지의 주행거리에 의거하여 현재지점을 특정하는 현재지점 특정부를 구비한다.
(Problem) Provide a self-propelled self-driving vehicle that can recognize the current position with high precision.
(Solution means) The autonomous vehicle is configured to be capable of autonomous driving in a state in which a speed is controlled based on a vertex provided on a predetermined main road. The autonomous vehicle passes through a vertex detector that detects that the vertex has passed, vertex position information on the position where each vertex is located, vertex identification information for identifying each vertex, and a memory stored therein, and the vertex detector. A vertex specifying unit which identifies a vertex detected by the vertex identification information, a mileage measuring unit which measures the travel distance from the vertex specified by the vertex specifying unit to the current point, and detected based on the vertex position information. And a current point specifying section that specifies the current point based on the position of the peak and the distance traveled from the vertex measured by the travel distance measuring section to the present point.

Description

자동 주행 차량 및 이것을 포함하는 자동 주행 시스템{AUTOMATIC DRIVING VEHICLE AND AUTOMATIC DRIVING SYSTEM WITH THE SAME}AUTOMATIC DRIVING VEHICLE AND AUTOMATIC DRIVING SYSTEM WITH THE SAME}

본 발명은 자동 주행 차량에 관한 것으로서, 특히 미리 정해진 주로를 자동 주행 가능한 자동 주행 차량에 관한 것이다. 또한, 본 발명은 이러한 자동 주행 차량을 포함하는 자동 주행 시스템에 관한 것이다.The present invention relates to an autonomous vehicle, and more particularly, to an autonomous vehicle capable of automatically traveling a predetermined main road. The present invention also relates to an autonomous driving system including such an autonomous vehicle.

종래, 주로(走路)에 매설된 전자 유도선을 센서에 의해 검출하고, 이 유도선을 따라서 기정의 주로를 자동 주행하는 자동 주행 차량이 개발되어 있다. 이러한 자동 주행 차량은, 예를 들면 골프장에 있어서 캐디백 등의 화물이나 플레이어를 태워서 주행하는 골프카에 이용되고 있다(예를 들면, 하기 특허문헌 1 참조). 또한, 골프카는 「골프카트」라고도 불린다.Background Art Conventionally, an automatic traveling vehicle has been developed that detects an electromagnetic guide line embedded in a main road by a sensor and automatically runs a predetermined main road along the guide line. Such an autonomous vehicle is used, for example, in a golf car that carries cargo such as a caddy bag or a player at a golf course (see, for example, Patent Document 1 below). In addition, a golf car is also called a "golf cart."

일본 특허공개 2000-181540호 공보Japanese Patent Publication No. 2000-181540

특허문헌 1에 기재된 골프카는 기정의 주로를 자동 주행하는 기능은 갖고 있지만, 현재의 주행위치를 인식하는 기능은 갖고 있지 않다. 최근 시장으로부터는, 골프카의 운행관리를 위해서 골프카의 현재위치를 인식하는 것이 요구되고 있다. 또한, 장해물을 검지해서 차량의 주행을 제어할 때에도 골프카의 현재위치를 인식하는 것이 요구되고 있다. 또한, 차량의 속도제어 등 차량의 주행제어를 향상시키기 위해서도 골프카의 현재위치를 인식하는 것이 요구되고 있다.The golf car described in Patent Literature 1 has a function of automatically driving a predetermined main road, but does not have a function of recognizing the current running position. Recently, from the market, it is required to recognize the current position of the golf car for the operation management of the golf car. In addition, when detecting obstacles and controlling the running of the vehicle, it is required to recognize the current position of the golf car. In addition, in order to improve the running control of the vehicle such as the speed control of the vehicle, it is required to recognize the current position of the golf car.

본 발명은 보다 고정밀도로 현재위치를 인식할 수 있는, 기정 주로를 자동 주행 가능한 자동 주행 차량을 제공하는 것을 목적으로 한다. 또한, 본 발명은 이러한 자동 주행 차량을 포함하는 자동 주행 시스템을 제공하는 것을 목적으로 한다.An object of the present invention is to provide an autonomous vehicle capable of automatically driving a predetermined main road, which can recognize a current position with higher accuracy. In addition, an object of the present invention is to provide an automatic traveling system including such an automatic traveling vehicle.

본원 발명자는 자동 주행 차량의 현재위치를 인식하기 위해서 수단을 검토하는 것에 앞서서, 자동 주행 차량의 하나인 골프카를 예의 연구했다. 골프카는 골프장의 지형에 맞춰서 설정된 주로를 자동 주행한다. 그 때문에, 골프카는 수목이 무성한 환경 하에서 주행할 경우가 있다. 또한 골프카는 고저차가 큰 주로를 주행할 경우가 있다. 시험을 반복한 결과, GPS로 현재지점을 특정하기 위해서는 충분한 정밀도가 얻어지지 않을 경우가 있는 것을 알 수 있었다.The present inventors earnestly studied the golf car which is one of the autonomous vehicles before examining a means for recognizing the present position of the autonomous vehicle. The golf car automatically runs the road set according to the terrain of the golf course. For this reason, the golf car may run in a lush environment. In addition, a golf car may drive a large road with a high elevation. As a result of repeating the test, it was found that sufficient precision could not be obtained to specify the current point by GPS.

그래서, 본원 발명자는 자동 주행 차량이 기정 주로를 자동 주행하는 것, 및 자동 주행 차량의 속도가 기정 주로 내에 매설된 정점에 의거하여 제어되는 것에 주목했다. 그리고, 정점을 활용하여 정점의 위치 및 정점으로부터 현재지점까지의 주행거리에 의거하여 현재지점을 특정하는 것을 생각해냈다. 이와 같이, 정점 및 주행거리를 활용함으로써 자동 주행 차량이 수목이 무성한 환경 하에서 주행해도, 또한 고저차가 큰 주로를 주행해도 자동 주행 차량의 현재위치를 인식할 수 있다.Therefore, the inventor of the present application has noted that the autonomous vehicle automatically travels the predetermined main road, and that the speed of the automatic traveling vehicle is controlled based on the vertex embedded in the predetermined main road. Then, using the vertices, it was conceived to specify the current position based on the position of the vertex and the mileage from the vertex to the current position. Thus, by utilizing the vertex and the mileage, the current position of the autonomous vehicle can be recognized even if the autonomous vehicle travels in an environment in which the trees are dense, or if the high-rise vehicle is driven on a large main road.

본 발명은 기정 주로 상을 자동 주행 가능하게 구성되고, 또한 그 기정 주로의 아래에 매설된 정점에 의거하여 차량의 주행상태를 제어하는 자동 주행 차량으로서,The present invention is directed to an autonomous vehicle configured to be capable of automatically traveling on a predetermined main road, and to control a driving state of the vehicle based on a vertex embedded below the predetermined main road.

상기 정점을 통과한 것을 검지하는 정점 검지부와,A vertex detection unit for detecting that the vertex has passed;

복수의 상기 정점의 각각에 관해서, 각 정점이 배치되어 있는 위치에 관한 정점 위치정보와 각 정점을 식별하기 위한 정점 식별정보를 대응시켜서 기억하는 기억부와,A storage unit that associates and stores vertex position information about a position where each vertex is disposed and vertex identification information for identifying each vertex with respect to each of the plurality of vertices;

상기 정점 검지부에서 통과한 것이 검지된 상기 정점을, 상기 정점 식별정보에 의거해서 특정하는 정점 특정부와,A vertex specifying unit specifying the vertex detected by the vertex detecting unit based on the vertex identification information;

상기 정점 특정부에 의해 특정된 상기 정점으로부터 현재지점까지의 주행거리를 계측하는 주행거리 계측부와,A mileage measurement unit for measuring a mileage from the vertex specified by the vertex specifying unit to the current point;

각 정점이 배치되어 있는 위치에 관한 상기 정점 위치정보에 의거하여 상기 정점 특정부에 의해 특정된 상기 정점의 위치를 검출함과 아울러, 그 검출된 상기 정점의 위치와 상기 주행거리 계측부에 의해 계측된 상기 정점으로부터 현재지점까지의 주행거리에 의거하여 현재지점을 특정하는 현재지점 특정부를 구비한 것을 특징으로 한다.The position of the vertex specified by the vertex specifying unit is detected based on the vertex position information on the position where each vertex is disposed, and the position of the detected vertex and the traveling distance measuring unit are measured. And a current point specifying unit which specifies the current point based on the mileage from the vertex to the current point.

상기 구성에 의하면, 자동 주행 차량이 직전에 통과한 정점이 정점 특정부에 의해 특정되고, 정점 위치정보에 의거해서 그 특정된 정점의 위치가 검출된다. 또한, 특정된 정점으로부터 현재지점까지의 주행거리가 주행거리 계측부에 의해 계측된다. 자동 주행 차량은 기정의 주로 상을 주행하고 있기 때문에, 정점의 위치와 그 정점의 위치로부터의 주행거리의 2개의 정보에 의거하여 고정밀도로 자동 주행 차량의 현재지점을 특정하는 것이 가능하다.According to the above structure, the vertex that the vehicle has just passed through is identified by the vertex specifying unit, and the position of the specified vertex is detected based on the vertex position information. In addition, the traveling distance from the specified vertex to the present point is measured by the traveling distance measuring unit. Since the autonomous vehicle travels mainly on a predetermined phase, it is possible to specify the current point of the autonomous vehicle with high accuracy based on two pieces of information: the position of the vertex and the travel distance from the position of the vertex.

자동 주행 차량이 정점을 통과했을 때, 정점 특정부가 그 통과한 정점을 특정하기 위해서는 여러 가지의 구성을 채용할 수 있다. 예를 들면,When the autonomous vehicle passes through the vertex, various configurations can be adopted to identify the vertex that has passed through the vertex specifying unit. For example,

상기 자동 주행 차량이 현재지점에 있어서의 세계 좌표를 계측하는 좌표 계측부를 구비하고,The automatic driving vehicle is provided with a coordinate measuring unit for measuring the world coordinate at the current point,

상기 정점 식별정보는 각각의 상기 정점이 배치되어 있는 세계 좌표에 관한 정보를 포함하고,The vertex identification information includes information about world coordinates in which each vertex is disposed;

상기 정점 특정부는 상기 정점 검지부가 상기 정점을 통과한 것을 검지한 시점에서, 상기 좌표 계측부에서 계측된 세계 좌표와 상기 정점 식별정보에 기재된 세계 좌표에 관한 정보를 대조함으로써 통과한 상기 정점을 특정하는 것으로 해도 관계없다.The vertex specifying unit specifies the vertex that has passed by matching the world coordinates measured in the vertex identification information with the world coordinates measured by the coordinate measuring unit at the time when the vertex detecting unit has passed the vertex. It does not matter.

여기에서, 좌표 계측부로서는, 예를 들면 GPS를 사용할 수 있다. 본 구성에 있어서는 GPS는 어디까지나 통과한 정점을 특정하기 위해서 사용된다. 즉, 주로 상에는 복수의 정점이 매설되어 있지만, 이들 정점 중 어느 정점인지를 특정하기 위한 수단으로서 GPS가 사용되고 있다. 정점의 세계 좌표가 미리 기억부에 기억되어 있기 때문에, GPS등의 좌표 계측부에서 계측된 세계 좌표와 가장 가까운 세계 좌표를 나타내고 있는 정점을 추출함으로써 통과한 정점을 특정할 수 있다.Here, as a coordinate measuring part, GPS can be used, for example. In this configuration, GPS is used to specify the vertices that have passed through. That is, although a plurality of vertices are mainly embedded in the image, GPS is used as a means for specifying which of these vertices. Since the world coordinates of the vertices are stored in advance in the storage unit, the vertices that have passed can be specified by extracting the vertices representing the world coordinates closest to the world coordinates measured by the coordinate measuring unit such as GPS.

또한, 상기 자동 주행 차량의 다른 구성으로서,Moreover, as another structure of the said automatic driving vehicle,

상기 정점 검지부는 상기 정점에 대응된 속도제어 명령의 판독이 가능한 구성이며,The vertex detection unit is a configuration capable of reading a speed control command corresponding to the vertex,

상기 정점 식별정보는 각각의 상기 정점에 대응된 상기 속도제어 명령에 관한 정보를 포함하고,The vertex identification information includes information about the speed control command corresponding to each vertex,

상기 정점 특정부는 상기 정점 검지부에 의해서 판독된 상기 정점에 대응된 상기 속도제어 명령과 상기 정점 식별정보에 기재된 상기 속도제어 명령에 관한 정보를 대조함으로써 통과한 상기 정점을 특정하는 것으로 해도 관계없다.The vertex specifying unit may specify the vertex passed by matching the speed control command corresponding to the vertex read by the vertex detection unit with the information about the speed control command described in the vertex identification information.

속도제어 명령으로서는 정점의 위치에 따른 내용이 부가되어 있다. 따라서, 정점을 통과한 시점에서 그 통과한 정점에 부가되어 있는 속도제어 명령을, 상기 정점 식별정보에 기재된 속도제어 명령과 대조함으로써 통과한 정점을 특정할 수 있다.As the speed control command, the content corresponding to the position of the vertex is added. Therefore, it is possible to specify a vertex that has passed by comparing the speed control command added to the passed vertex with the speed control command described in the vertex identification information at the time when the vertex passes.

또한, 상기 자동 주행 차량의 다른 구성으로서,Moreover, as another structure of the said automatic driving vehicle,

상기 정점 식별정보는 상기 기정 주로 상에서 직렬적으로 인접하는 2개의 상기 정점간의 주행거리에 관한 정보를 포함하고,The vertex identification information includes information about a travel distance between two vertices adjacent in series on the predetermined main route,

상기 정점 특정부는 상기 정점을 통과한 것을 검지한 시점에서, 상기 주행거리 계측부가 계측한 상기 주행거리와 상기 정점 식별정보에 기재된 상기 주행거리에 관한 정보를 대조함으로써 통과한 상기 정점을 특정하는 것으로 해도 관계없다.When the vertex specifying unit detects that the vertex has passed, the vertex specifying unit may specify the vertex that has passed by comparing the traveling distance measured by the traveling distance measurement unit with the information about the traveling distance described in the vertex identification information. It doesn't matter.

정점은 차량의 주행상태를 제어하는 목적으로 기정 주로의 아래에 매설되어 있고, 인접하는 정점간의 거리는 다르다. 따라서, 정점을 통과한 시점에서 주행거리 계측부가 계측한 상기 주행거리와 상기 정점 식별정보에 기재된 상기 주행거리에 관한 정보를 대조함으로써 통과한 정점을 특정할 수 있다.The vertices are buried beneath the predetermined column for the purpose of controlling the running state of the vehicle, and the distance between adjacent vertices is different. Therefore, it is possible to specify the vertex that has passed by comparing the travel distance measured by the travel distance measurement unit with the information about the travel distance described in the vertex identification information at the time when the vertex passes.

또한, 상기 자동 주행 차량의 구성으로서,Moreover, as a structure of the said autonomous vehicle,

상기 기정 주로 상을 주행 중에 상기 자동 주행 차량으로부터 보아서 소정의 방향을 촬상하는 촬상부를 갖고,It has an imaging part which picks up a predetermined direction by looking at the said predetermined | prescribed image from the said autonomous vehicle while traveling,

상기 정점 식별정보는 상기 정점을 통과하는 위치에 있어서 상기 자동 주행 차량으로부터 보아서 상기 소정의 방향을 촬상했을 때의 촬상 데이터에 관한 정보를 포함하며,The vertex identification information includes information about the imaging data when the predetermined direction is captured from the autonomous vehicle at a position passing through the vertex,

상기 정점 특정부는 상기 정점을 통과한 것을 검지한 시점에서, 상기 촬상부에 의해 촬상된 데이터와 상기 정점 식별정보에 기재된 상기 촬상 데이터에 관한 정보를 대조함으로써 통과한 상기 정점을 특정하는 것으로 해도 관계없다.At the time when the vertex specifying unit detects that the vertex has passed, the vertex specifying unit may specify the vertex that has passed by collating the data captured by the image capturing unit with the information about the image data described in the vertex identification information. .

여기에서, 촬상 데이터로서는, 예를 들면 화상 상의 특징점에 관한 좌표정보를 포함시킬 수 있다. 이 경우, 정점을 통과한 시점에서 촬상부에 있어서 촬상된 데이터 상에 포함되는 특징점의 좌표정보와 기억부에 기억되어 있는 정점 식별정보에 포함되는 특징점의 좌표정보를 대조함으로써 정점을 특정할 수 있다.Here, as the imaging data, for example, coordinate information about a feature point on the image can be included. In this case, the vertex can be specified by matching the coordinate information of the feature point included in the data captured by the image pickup unit with the coordinate information of the feature point included in the vertex identification information stored in the storage unit at the time when the vertex passes. .

또한, 촬상부가 복수의 카메라로 구성될 경우에는 촬상 데이터로서 시차화상에 관한 정보를 포함시킬 수 있다. 이 경우, 정점을 통과한 시점에서 촬상부에 있어서 촬상된 데이터로부터 작성된 시차화상과 기억부에 기억되어 있는 정점 식별정보에 포함되는 특징점의 좌표정보를 대조함으로써 정점을 특정할 수 있다.In addition, when the imaging section is composed of a plurality of cameras, the information on the parallax image can be included as the imaging data. In this case, a vertex can be specified by matching the parallax image created from the data image | photographed by the imaging part at the time which passed the vertex, and the coordinate information of the feature point contained in the vertex identification information stored in the memory | storage part.

또한, 상기 주행거리 계측부는 상기 자동 주행 차량에 탑재된 차륜의 회전각 에 의거하여 주행거리를 계측하는 구성으로 할 수 있다.The traveling distance measuring unit may be configured to measure the traveling distance based on the rotation angle of the wheel mounted on the automatic traveling vehicle.

그런데, 정점에 복수의 정보를 기억시키는 것이 가능한 구성의 경우에는 정점 그 자체에 정점이 배치되어 있는 위치에 관한 정보(상기의 「정점 위치정보」)를 기억시키는 것이 가능하다. 이러한 예로서는, 정점을 RFID로 구성하는 경우가 상정된다. 이러한 경우에는, 정점 검지부가 정점 위치정보를 판독하는 것으로 해도 관계없다.By the way, in the case of the structure which can store a some information in a vertex, it is possible to memorize | store the information regarding the position in which the vertex is arrange | positioned at the vertex itself ("vertex position information" mentioned above). As such an example, the case where a vertex is comprised by RFID is assumed. In such a case, the vertex detection unit may read the vertex position information.

즉, 본 발명은 기정 주로 상을 자동 주행 가능하게 구성되고, 또한 그 기정 주로의 아래에 매설된 정점에 의거하여 차량의 주행상태를 제어하는 자동 주행 차량으로서,That is, the present invention is an automatic driving vehicle which is configured to be capable of automatically traveling on a predetermined main road, and controls the running state of the vehicle based on a vertex embedded below the predetermined main road.

상기 정점에는 각 정점이 배치되어 있는 위치에 관한 정점 위치정보가 부가되어 있고,The vertex is attached with vertex position information regarding the position where each vertex is disposed,

상기 정점을 통과한 것, 및 통과한 상기 정점에 부가된 상기 정점 유지정보를 검지하는 정점 검지부와,A vertex detecting unit that detects the one that has passed the vertex and the vertex maintenance information added to the vertex that has passed;

상기 정점 검지부가 검지한 상기 정점의 위치로부터 현재지점까지의 주행거리를 계측하는 주행거리 계측부와,A mileage measurement unit that measures a mileage from the position of the vertex detected by the vertex detection unit to the current point;

상기 정점 검지부가 검지한 상기 정점의 위치와 상기 주행거리 계측부에 의해 계측된 상기 정점으로부터 현재지점까지의 주행거리에 의거하여 현재지점을 특정하는 현재지점 특정부를 구비한 것을 다른 특징으로 한다.And a current point specifying section for specifying a current point based on the position of the vertex detected by the vertex detecting unit and the traveling distance from the vertex measured by the traveling distance measuring unit to the current point.

이러한 구성으로 했을 경우에 있어서도, 정점의 위치와 그 정점의 위치로부터의 주행거리의 2개의 정보에 의거하여 고정밀도로 자동 주행 차량의 현재지점을 특정하는 것이 가능하다.Even in this configuration, it is possible to specify the current point of the autonomous vehicle with high precision based on two pieces of information, the position of the vertex and the travel distance from the position of the vertex.

또한, 상기 자동 주행 차량은 상기 기정 주로 상을 자동 주행하는 모드와, 상기 기정 주로 이외의 필드를 메뉴얼로 주행하는 모드를 스위칭하는 지시부를 구비하는 것으로 해도 관계없다.Further, the autonomous vehicle may be provided with an instruction unit for switching a mode for automatically driving the image on the predetermined state and a mode for manually driving a field other than the predetermined state.

이 구성에 의하면, 자동 주행 차량이 메뉴얼로 주행한 후에 기정 주로 상에 복귀했을 경우에 있어서 그 자동 주행 차량의 현재위치를 특정할 수 있다.According to this configuration, when the autonomous vehicle returns to the preset main road after running by manual, the present position of the autonomous vehicle can be specified.

또한, 본 발명에 의한 자동 주행 시스템은,In addition, the automatic traveling system according to the present invention,

상기 자동 주행 차량과,The automatic driving vehicle,

상기 자동 주행 차량이 자동 주행하기 위해서 부설된 유도선과,A guide line laid for the automatic driving vehicle to automatically run,

자동 주행 중에 상기 자동 주행 차량이 통과하는 복수의 지점에 상기 자동 주행 차량의 속도를 제어하기 위해서 부설된 정점을 포함하는 것을 특징으로 한다.And a vertex provided at a plurality of points through which the autonomous vehicle passes during autonomous driving to control the speed of the autonomous vehicle.

상기의 구성에 의하면, 자동 주행 중의 자동 주행 차량의 현재위치를 정밀도 좋게 특정할 수 있는 자동 주행 시스템이 실현된다.According to the above arrangement, an autonomous driving system capable of accurately specifying the current position of the autonomous vehicle during autonomous driving is realized.

(발명의 효과)(Effects of the Invention)

본 발명에 의하면, 보다 고정밀도로 현재위치를 인식할 수 있는, 기정 주로를 자동 주행 가능한 자동 주행 차량을 제공할 수 있다. 또한, 이러한 자동 주행 차량을 포함하는 자동 주행 시스템을 제공할 수 있다.According to the present invention, it is possible to provide an autonomous traveling vehicle capable of automatically driving a predetermined main road, which can recognize the current position with higher accuracy. In addition, it is possible to provide an autonomous driving system including such an autonomous vehicle.

도 1은 자동 주행 차량을 앞면으로부터 보았을 때의 모식도이다.
도 2는 자동 주행 차량의 제 1 실시형태의 구성을 기능적으로 나타내는 블럭도이다.
도 3은 자동 주행 차량이 주행하는 주로의 일례를 나타내는 모식도이다.
도 4는 기억부에 기억되어 있는 정보를 설명하기 위한 도면이다.
도 5는 자동 주행 차량의 제 2 실시형태의 구성을 기능적으로 나타내는 블럭도이다.
도 6은 기억부에 기억되어 있는 정보를 설명하기 위한 도면이다.
도 7은 자동 주행 차량의 제 3 실시형태의 구성을 기능적으로 나타내는 블럭도이다.
도 8은 제 4 실시형태의 자동 주행 차량을 앞면으로부터 보았을 때의 모식도이다.
도 9는 자동 주행 차량의 제 4 실시형태의 구성을 기능적으로 나타내는 블럭도이다.
도 10은 자동 주행 차량의 다른 실시형태의 구성을 기능적으로 나타내는 블럭도이다.
도 11은 자동 주행 차량의 다른 실시형태의 구성을 기능적으로 나타내는 블럭도이다.
BRIEF DESCRIPTION OF THE DRAWINGS It is a schematic diagram when the autonomous vehicle is seen from the front.
2 is a block diagram functionally showing the configuration of the first embodiment of the autonomous vehicle.
It is a schematic diagram which shows an example of the main run which an autonomous vehicle runs.
4 is a diagram for explaining information stored in a storage unit.
Fig. 5 is a block diagram functionally showing the configuration of the second embodiment of the autonomous vehicle.
6 is a diagram for explaining information stored in a storage unit.
7 is a block diagram functionally showing the configuration of a third embodiment of an autonomous vehicle.
It is a schematic diagram when the automatic traveling vehicle of 4th Embodiment is seen from the front surface.
9 is a block diagram functionally showing the configuration of a fourth embodiment of an autonomous vehicle.
10 is a block diagram functionally showing the configuration of another embodiment of an autonomous vehicle.
11 is a block diagram functionally showing the configuration of another embodiment of the autonomous vehicle.

[제 1 실시형태][First Embodiment]

본 발명의 자동 주행 차량의 제 1 실시형태의 구성에 대해 도면을 참조해서 설명한다. 또한, 이하의 도면에 있어서 실제의 치수비와 도면 상의 치수비는 반드시 일치하지는 않는다. The structure of 1st Embodiment of the automatic traveling vehicle of this invention is demonstrated with reference to drawings. In addition, in the following drawings, the actual dimension ratio and the dimension ratio on drawing do not necessarily correspond.

본 실시형태에서는 자동 주행 차량으로서 골프카를 예시해서 설명한다. 그러나, 자동 주행 차량으로서는 골프카에 한정되지 않고, 공장이나 과수원에서 주행하는 무인반송차도 포함된다. 또한, 본 발명에 있어서의 자동 주행 차량은 4륜차에 한정되지 않고, 삼륜차이어도 좋고, 모노레일형이라도 좋다. 후술하는 제 2 실시형태 이후에 있어서도 마찬가지이다.In the present embodiment, a golf car will be described as an example of an automatic traveling vehicle. However, the autonomous vehicle is not limited to a golf car, but also includes an unmanned transport vehicle traveling in a factory or an orchard. The autonomous vehicle in the present invention is not limited to a four-wheeled vehicle, but may be a three-wheeled vehicle or a monorail type. The same is true after the second embodiment described later.

도 1은 본 실시형태에 있어서의 자동 주행 차량을 앞면으로부터 보았을 때의 모식도이다. 도 1에 나타내는 자동 주행 차량(1)은 골프장 내를 자동 주행하는 골프카이다. 또한, 도 2는 이 자동 주행 차량(1)의 구성을 기능적으로 나타내는 블럭도이다.BRIEF DESCRIPTION OF THE DRAWINGS It is a schematic diagram when the automatic traveling vehicle in this embodiment is seen from the front surface. The autonomous vehicle 1 shown in FIG. 1 is a golf car which automatically runs in a golf course. 2 is a block diagram functionally showing the configuration of this autonomous vehicle 1.

도 1에 나타내는 자동 주행 차량(1)은 핸들(4)과, 그 핸들(4)의 회전에 의해 조타되는 우전륜(5) 및 좌전륜(6)을 구비한다. 또한, 자동 주행 차량(1)은 차체의 하부에 판독부(7)를 구비하고 있다. 판독부(7)는 정점 검지부(7a)와 유도선 검지부(7b)를 포함한다(도 2 참조). 정점 검지부(7a) 및 유도선 검지부(7b)의 설명은 후술된다.The autonomous traveling vehicle 1 shown in FIG. 1 includes a steering wheel 4, a right front wheel 5 and a left front wheel 6 steered by the rotation of the steering wheel 4. In addition, the autonomous vehicle 1 includes a reading unit 7 below the vehicle body. The reading unit 7 includes a vertex detecting unit 7a and a guide line detecting unit 7b (see Fig. 2). The description of the vertex detection unit 7a and the guide line detection unit 7b will be described later.

자동 주행 차량(1)의 우전륜(5)에는 우전륜(5)의 회전각을 검출하는 회전각 검지부(9)가 구비되어 있다. 회전각 센서(9)는 차륜의 회전각을 검출하는 것이며, 예를 들면 로터리 엔코더로 구성된다. 또한, 이 회전각 센서(9)는 우전륜(5) 대신에, 또는 이것에 추가해서 좌전륜(6)이나 후륜에 구비되어도 관계없다. The right front wheel 5 of the automatic traveling vehicle 1 is provided with a rotation angle detecting unit 9 for detecting the rotation angle of the right front wheel 5. The rotation angle sensor 9 detects the rotation angle of the wheel, and is comprised, for example with a rotary encoder. The rotation angle sensor 9 may be provided in the left front wheel 6 or the rear wheel instead of or in addition to the right front wheel 5.

도 2는 자동 주행 차량(1)의 구성을 모식적으로 나타내는 기능 블럭도이다. 자동 주행 차량(1)은 상술한 정점 검지부(7a), 유도선 검지부(7b) 및 회전각 검지부(9) 외에, 정점 특정부(11), 주행거리 계측부(13), 기억부(15), 현재지점 특정부(17), 및 자동운전 제어부(19)를 구비한다. 정점 특정부(11), 주행거리 계측부(13), 현재지점 특정부(17), 및 자동운전 제어부(19)는, 예를 들면 CPU 등의 연산 장치에 의해 구성된다. 또한, 기억부(15)는, 예를 들면 메모리나 하드디스크 등에 의해서 구성된다.2 is a functional block diagram schematically showing the configuration of the autonomous vehicle 1. The autonomous vehicle 1 includes a vertex specifying unit 11, a traveling distance measuring unit 13, a storage unit 15, in addition to the vertex detecting unit 7a, the guide line detecting unit 7b, and the rotation angle detecting unit 9 described above. A current point specifying unit 17 and an automatic driving control unit 19 are provided. The vertex specifying unit 11, the travel distance measuring unit 13, the current point specifying unit 17, and the automatic driving control unit 19 are configured by, for example, a computing device such as a CPU. The storage unit 15 is configured by, for example, a memory or a hard disk.

자동운전 제어부(19)는 자동 주행 차량(1)에 대하여 기정의 주로 상에 설치된 전자 유도선을 따르는 자동운전을 위한 제어를 행한다. 도 3은 자동 주행 차량(1)이 주행하는 것이 예정되어 있는 주로의 일례이다. 도 3에 나타나 있는 바와 같이, 주로(21)의 아래에는 전자 유도선(24)이 매입되어 있다. 유도선 검지부(7b)는 전자 유도선(24)으로부터 발생하는 전자파의 수신이 가능한 구성이며, 예를 들면 자기센서로 이루어진다. 유도선 검지부(7b)는 전자 유도선(24)으로부터 발생하는 전자파를 수신하면, 자동운전 제어부(19)에 대하여 검출 신호를 출력한다. 자동운전 제어부(19)는 이 검출 신호에 의거하여 도시하지 않은 조타기구를 제어한다. 이것에 의해, 자동 운전 차량(1)은 주로(21) 상을 자동운전한다.The autonomous driving control unit 19 controls the autonomous driving vehicle 1 for autonomous driving along the electromagnetic guidance line provided on the main road. 3 is an example of the main road in which the autonomous vehicle 1 is scheduled to travel. As shown in FIG. 3, the electromagnetic induction line 24 is embedded below the main body 21. The guide line detection unit 7b is a configuration capable of receiving electromagnetic waves generated from the electromagnetic guide line 24, and is made of, for example, a magnetic sensor. The guidance line detection unit 7b outputs a detection signal to the automatic driving control unit 19 when receiving the electromagnetic wave generated from the electromagnetic guidance line 24. The automatic driving control unit 19 controls the steering mechanism (not shown) based on this detection signal. As a result, the autonomous driving vehicle 1 automatically drives the main phase 21.

또한 도 3에 나타내는 와 같이, 주로(21) 상에 기점(C0)을 포함하는 미리 정해진 복수의 위치에 정점(23)이 매설되어 있다. 정점(23)은, 예를 들면 복수의 자석의 조합으로 구성되어 있다. 정점 검지부(7a)는 이 정점(23)으로부터의 자장정보의 판독이 가능한 구성이며, 예를 들면 자력 센서로 이루어진다. 이들 정점(23)은, 예를 들면 주행, 정지, 감속 등을 지시하는 지시 신호를 발신한다. 자동 운전 차량(1)이 정점(23) 상을 통과하면, 정점 검지부(7a)는 그 통과한 정점(23)로부터의 지시 신호를 수신하고, 그 지시 신호를 자동운전 제어부(19)에 대하여 출력한다. 자동운전 제어부(19)는 이 지시 신호에 따라 자동 주행 차량(1)을 제어한다. 이것에 의해, 자동 주행 차량(1)은 정점(23)에 의해 지정된 정보에 의거하여 자동적으로 주행, 정지, 감속 등의 제어가 행하여진다.As shown in FIG. 3, the vertices 23 are embedded at a plurality of predetermined positions including the starting point C0 on the main 21. The vertex 23 is comprised by the combination of several magnet, for example. The vertex detection unit 7a is a configuration capable of reading magnetic field information from the vertex 23, and is made of, for example, a magnetic force sensor. These vertices 23 transmit, for example, an instruction signal for instructing travel, stop, deceleration, and the like. When the autonomous driving vehicle 1 passes over the vertex 23, the vertex detection unit 7a receives an instruction signal from the vertex 23 that has passed, and outputs the instruction signal to the automatic driving controller 19. do. The autonomous driving control unit 19 controls the autonomous vehicle 1 in accordance with this instruction signal. As a result, the autonomous vehicle 1 automatically controls driving, stopping, deceleration, and the like based on the information designated by the vertex 23.

또한, 정점 검지부(7a)는 자동 주행 차량(1)이 정점(23)을 통과한 시점에서 그 취지의 정보를 주행거리 계측부(13)에 출력한다. 주행거리 계측부(13)는 정점 검지부(7a)로부터 보내지는 신호에 의거하여 자동 주행 차량(1)이 정점(23)을 통과한 시점을 인식한다. 그리고, 주행거리 계측부(13)는 회전각 검지부(9)로부터 출력되는 차륜의 회전각에 관한 정보에 의거하여, 자동 주행 차량(1)이 정점(23)을 통과하고나서 현재의 지점까지 주행한 거리를 계측한다. 주행거리 계측부(13)는 미리 우전륜(5)의 지름에 관한 정보를 기억하고 있는 것으로 할 수 있다. 이것에 의해, 정점(23)을 통과한 시점으로부터의 우전륜(5)의 회전각(회전수)과 우전륜(5)의 지름에 의거하여 정점(23)을 통과한 시점으로부터의 자동 주행 차량(1)의 주행거리를 연산으로 산출할 수 있다.In addition, the vertex detection unit 7a outputs the information to the traveling distance measuring unit 13 at the time when the autonomous vehicle 1 passes the vertex 23. The traveling distance measuring unit 13 recognizes the time point at which the autonomous vehicle 1 has passed the vertex 23 based on the signal sent from the vertex detecting unit 7a. Then, the traveling distance measuring unit 13 travels to the current point after the autonomous vehicle 1 passes through the vertex 23 based on the information about the rotation angle of the wheel output from the rotation angle detecting unit 9. Measure the distance. The traveling distance measuring unit 13 may be configured to store information regarding the diameter of the right front wheel 5 in advance. As a result, the autonomous traveling vehicle from the time of passing through the vertex 23 on the basis of the rotation angle (number of revolutions) of the right wheel 5 from the time of passing through the vertex 23 and the diameter of the right wheel 5. The travel distance of (1) can be calculated by calculation.

기억부(15)에는 주로(21)의 아래에 매입된 각 정점(23)을 식별하기 위한 정점 식별정보와, 각 정점(23)이 배치되어 있는 위치에 관한 정점 위치정보가 대응시켜서 기억되어 있다. 도 4는 기억부(15)에 기억되어 있는 정보의 일례를 설명하기 위한 모식적인 도면이다.In the storage unit 15, vertex identification information for identifying each vertex 23 embedded below the main portion 21 and vertex position information about a position where each vertex 23 is arranged are stored in association with each other. . 4 is a schematic diagram for explaining an example of information stored in the storage unit 15.

예를 들면, 각 정점(23)에는 각각을 식별하기 위한 부호(23a, 23b, 23c, …)가 부여되어 있다. 이 부호가 정점 식별정보에 대응한다. 또한, 정점 식별정보로서는 이와 같이 단지 정점을 식별하기 위한 부호뿐만 아니라, 정점(23)에 등록되어 있는 주행, 정지, 감속 등의 지시 신호에 관한 정보를 포함하는 것으로 해도 관계없다. 또한, 정점 식별정보로서는 주로(21)를 따라서 주행했을 경우에 기점(C0)에 배치되어 있는 정점(23)으로부터 카운트하여 몇번째의 정점(23)인지를 나타내는 정보가 포함되어 있는 것으로 해도 관계없다.For example, reference numerals 23a, 23b, 23c, ... are used to identify the vertices 23, respectively. This code corresponds to vertex identification information. In addition, the vertex identification information may include not only a code for identifying the vertex in this manner but also information on an instruction signal such as driving, stopping, and deceleration registered in the vertex 23. Note that the vertex identification information may include information indicating the number of vertices 23 counted from the vertices 23 arranged at the starting point C0 when the vehicle is driven along the main 21. .

또한, 기억부(15)에는 각 정점(23)에 배치된 위치에 관한 정보가, 예를 들면 위도와 경도에 의하여 나타나 있다. 일례로서, 기억부(15)에는 정점(23a)이 위도 xa, 경도 ya의 위치에 배치되어 있는 것이 기억되어 있다. 각 정점(23)의 위치에 관한 정보가 정점 위치정보에 대응한다.In addition, in the storage unit 15, information relating to a position arranged at each vertex 23 is shown by latitude and longitude, for example. As an example, in the storage unit 15, the vertices 23a are stored at latitude xa and longitude ya positions. Information about the position of each vertex 23 corresponds to the vertex position information.

정점 검지부(7a)는 자동 주행 차량(1)이 정점(23)을 통과한 것을 검지하면, 그 취지의 정보를 정점 특정부(11)에 출력한다. 정점 특정부(11)는 기억부(15)로부터 정점 식별정보를 판독하여 대조하고, 직전에 통과한 정점(23)이 어느 정점(23)인지를 특정한다. When the vertex detecting unit 7a detects that the autonomous vehicle 1 has passed the vertex 23, the vertex detecting unit 7a outputs the information to the vertex specifying unit 11. The vertex specifying unit 11 reads and verifies the vertex identification information from the storage unit 15, and specifies which vertices 23 are the vertices 23 that passed immediately before.

예를 들면, 정점 식별정보로서 각 정점(23)의 지시 신호가 기재되어 있을 경우에는, 정점 특정부(11)는 정점 검지부(7a)가 판독한 지시 신호에 관한 정보와 기억부(15)에 기억되어 있는 정보를 대조함으로써 정점(23)을 특정한다.For example, when the instruction signal of each vertex 23 is described as the vertex identification information, the vertex specifying unit 11 stores information on the instruction signal read by the vertex detection unit 7a and the storage unit 15. The vertex 23 is specified by matching the stored information.

또한, 정점 식별정보로서 각 정점(23)이 기점(C0)으로부터 카운트하여 몇번째에 배치되어 있는지에 관한 정보(이하, 「순서정보」라고 한다.)가 기재되어 있을 경우, 정점 특정부(11)는 정점 검지부(7a)로부터 정점(23)을 통과한 취지의 신호가 보내지는 횟수를 카운트한다. 그리고, 정점 특정부(11)는 이 카운트된 수와 기억부(15)에 기억되어 있는 정점 식별정보에 기재된 순서정보를 대조함으로써 정점(23)을 특정한다.In addition, when the vertex identification information describes information on how many times each vertex 23 is arranged from the origin C0 (hereinafter, referred to as "order information"), the vertex specifying unit 11 is described. ) Counts the number of times a signal indicating that the vertex 23 has passed through the vertex 23 is sent. The vertex specifying unit 11 identifies the vertex 23 by matching the counted number with the sequence information described in the vertex identification information stored in the storage unit 15.

또한, 정점 검지부(7a)가 정점(23)을 식별하기 위해서 부가되어 있는 부호에 관한 정보를 판독하는 기능이 있을 경우에는, 자동 주행 차량(1)이 정점(23)을 통과하면 이러한 부호에 관한 정보가 정점 검지부(7a)로부터 정점 특정부(11)에 대하여 출력된다. 정점 특정부(11)는 이 정점(23)에 부가된 부호에 관한 정보와 기억부(15)에 기억되어 있는 정점 식별정보에 기재된 부호에 관한 정보를 대조함으로써 정점(23)을 특정할 수 있다.In addition, when the vertex detection unit 7a has a function of reading information about a code added to identify the vertex 23, when the autonomous vehicle 1 passes through the vertex 23, Information is output from the vertex detection unit 7a to the vertex specifying unit 11. The vertex specifying unit 11 can identify the vertex 23 by matching the information about the code added to the vertex 23 with the information about the code described in the vertex identification information stored in the storage unit 15. .

상술한 바와 같은, 자동 주행 차량(1)이 통과한 정점(23)을 정점 특정부(11)가 특정하는 방법은 어디까지나 일례이며, 여러가지 방법을 채용할 수 있다. 정점 특정부(11)는, 이와 같이 자동 주행 차량(1)이 통과한 정점(23)을 특정하면 그 취지의 정보를 현재지점 특정부(17)에 출력한다.As described above, the vertex specifying unit 11 specifies the vertex 23 passed by the autonomous driving vehicle 1 as an example. Various methods can be adopted. When the vertex specification part 11 specifies the vertex 23 which the autonomous vehicle 1 passed in this way, it outputs the information to the present point specification part 17.

현재지점 특정부(17)는 정점 특정부(11)에 의해 특정된 정점(23)이 어느 위치에 배치되어 있는 것인지를, 해당 정점(23)에 대응한 정점 위치정보를 기억부(15)로부터 판독하여 인식한다. 이것에 의해, 현재지점 특정부(17)는 자동 주행 차량(1)이 직전에 통과한 정점(23)의 위치를 인식한다. 그리고, 현재지점 특정부(17)는 주행거리 계측부(13)로부터 직전에 정점(23)을 통과하고나서 현재의 위치까지 자동 주행 차량(1)이 주행한 거리에 관한 정보를 취득한다. 현재지점 특정부(17)는 이들 정보에 의거하여 자동 주행 차량(1)의 현재지점을 특정한다.The current point specifying unit 17 determines from which position the vertices 23 specified by the vertex specifying unit 11 are arranged. The vertex position information corresponding to the vertices 23 is stored from the storage unit 15. Read and recognize As a result, the current point specifying unit 17 recognizes the position of the vertex 23 that the automatic traveling vehicle 1 has just passed. Then, the current point specifying unit 17 obtains information on the distance traveled by the autonomous vehicle 1 to the current position after passing through the vertex 23 immediately before the traveling distance measuring unit 13. The present point specifying section 17 specifies the present point of the autonomous vehicle 1 based on these information.

본 실시형태의 자동 주행 차량(1)에 의하면, 기정의 주로(21) 상을 주행하고 있는 사이에 걸쳐서 현재의 지점을 자동적으로 검출할 수 있다. 또한, 통상 정점(23)은 주로(21) 상에 복수 매설되어 있다. 본 실시형태의 자동 주행 차량(1)은 복수 매설된 정점(23) 중, 직전에 통과한 정점(23)의 정보에 의거해서 현재의 위치를 검출하는 구성이기 때문에 검출 오차를 작게 할 수 있다.According to the automatic traveling vehicle 1 of the present embodiment, the current point can be detected automatically while traveling on the predetermined main 21. In addition, the normal vertex 23 is mainly embedded in the plurality 21. Since the automatic traveling vehicle 1 of this embodiment is a structure which detects a current position based on the information of the vertex 23 which passed just before among the some embedded vertices 23, a detection error can be made small.

[제 2 실시형태]Second Embodiment

자동 주행 차량의 제 2 실시형태의 구성에 대해 제 1 실시형태와 다른 개소만을 설명한다. 도 5는 본 실시형태의 자동 주행 차량(1)의 구성을 나타내는 기능 블럭도이다.Only the location different from 1st Embodiment is demonstrated about the structure of 2nd Embodiment of an automatic traveling vehicle. 5 is a functional block diagram showing the configuration of the automatic traveling vehicle 1 of the present embodiment.

본 실시형태의 자동 주행 차량(1)에 있어서, 주행거리 계측부(13)는 계측한 주행거리에 관한 정보를 정점 특정부(11)에도 출력한다. 정점 특정부(11)는 주행거리 계측부(13)로부터 입력된 주행거리에 관한 정보에 의거하여 직전에 통과한 정점(23)을 특정한다.In the automatic traveling vehicle 1 of the present embodiment, the traveling distance measuring unit 13 also outputs the information about the measured traveling distance to the vertex specifying unit 11 as well. The vertex specifying unit 11 specifies the vertex 23 that has just passed on the basis of the information about the traveling distance input from the traveling distance measuring unit 13.

도 6은 본 실시형태에 있어서의 자동 주행 차량(1)이 구비하는 기억부(15)에 기억되어 있는 정보의 일례를 설명하기 위한 모식적인 도면이다. FIG. 6: is a schematic diagram for demonstrating an example of the information memorize | stored in the memory | storage part 15 with which the automatic traveling vehicle 1 in this embodiment is equipped.

도 6에 나타나 있는 바와 같이, 기억부(15)에는 각 정점(23)이 배치된 위치와 직전의 정점(23)이 배치된 위치 사이의 거리에 관한 정보가 기억되어 있다. 일례로서, 기억부(15)에는 정점(23b)이 정점(23a)으로부터 거리 db만큼 진행한 위치에 배치되어 있는 것이 기억되어 있다. 이러한, 인접하는 2개의 정점(23)간의 거리에 관한 정보는 정점(23)을 식별하는 부호와 함께 정점 식별정보에 대응한다.As shown in FIG. 6, the memory | storage part 15 memorize | stores the information about the distance between the position where each vertex 23 is arrange | positioned, and the position where the previous vertex 23 was arrange | positioned. As an example, in the storage unit 15, the vertices 23b are stored at positions where the vertices 23a are advanced by a distance db. This information about the distance between two adjacent vertices 23 corresponds to vertex identification information with a code identifying the vertex 23.

제 1 실시형태의 구성과 마찬가지로, 정점 특정부(11)는 정점 검지부(7a)로부터 주어지는 정보에 의해 자동 주행 차량(1)이 정점(23)을 통과한 시점을 인식한다. 또한, 주행거리 계측부(13)는 자동 주행 차량(1)이 정점(23)을 통과한 시점으로부터, 현재의 위치까지 자동 주행 차량(1)이 주행한 거리를 계측한다.Similar to the configuration of the first embodiment, the vertex specifying unit 11 recognizes the time when the autonomous vehicle 1 has passed the vertex 23 based on the information provided from the vertex detecting unit 7a. In addition, the traveling distance measuring unit 13 measures the distance traveled by the automatic traveling vehicle 1 from the time when the automatic traveling vehicle 1 passes the vertex 23 to the current position.

정점 특정부(11)는 정점 검지부(7a)로부터 주어지는 정보에 의해 자동 주행 차량(1)이 다음 정점(23)을 통과한 시점을 인식하면, 주행거리 계측부(13)로부터 하나 전에 정점(23)을 통과하고나서 직전에 정점(23)을 통과할 때까지 자동 주행 차량(1)이 주행한 거리를 취득한다. 이것에 의해, 정점 특정부(11)는 직전에 통과한 정점(23)과, 그 하나 전에 통과한 정점(23)의 거리를 인식한다. 정점 특정부(11)는 이와 같이 주행거리 계측부(13)로부터의 정보에 의거하여 산출된 인접하는 2개의 정점(23)간의 거리를, 기억부(15)에 기억되어 있는 정점 식별정보에 기재되어 있는 인접 정점간 거리에 관한 정보와 대조한다. 그리고, 정점 특정부(23)는 산출된 거리에 가장 가까운 값이 기재되어 있는 정점(23)을 특정한다.When the vertex specifying unit 11 recognizes the point in time when the autonomous vehicle 1 passes the next vertex 23 based on the information given from the vertex detecting unit 7a, the vertex specifying unit 11 receives one vertex 23 from the mileage measuring unit 13. After passing through the vehicle, the distance traveled by the autonomous vehicle 1 until the vehicle passes the vertex 23 immediately before is acquired. Thereby, the vertex specification part 11 recognizes the distance of the vertex 23 which passed just before, and the vertex 23 which passed before the one. The vertex specifying unit 11 describes the distance between two adjacent vertices 23 calculated based on the information from the travel distance measuring unit 13 in the vertex identification information stored in the storage unit 15. Contrast this with information about the distance between adjacent vertices. And the vertex specification part 23 specifies the vertex 23 in which the value closest to the calculated distance is described.

상술한 바와 같이, 본 실시형태의 자동 주행 차량(1)은 정점 특정부(11)가 인접하는 2개의 정점(23)간의 거리에 관한 정보에 의거하여 정점(23)을 특정한다. 그러나, 정점 특정부(11)는 인접하는 2개의 정점(23)간의 거리에 관한 정보에 추가해서, 제 1 실시형태에서 예시한 다른 정점 식별정보도 포함시켜서 정점(23)을 특정하는 것으로 해도 관계없다.As described above, the autonomous traveling vehicle 1 of the present embodiment specifies the vertex 23 based on information about the distance between two vertices 23 adjacent to the vertex specifying unit 11. However, even if the vertex specification part 11 specifies the vertex 23 in addition to the information regarding the distance between two adjacent vertices 23, also including the other vertex identification information illustrated in 1st Embodiment, none.

자동 주행 차량(1)이 직전에 통과한 정점(23)이 정점 특정부(11)에 의해서 특정된 후의 처리 내용은 제 1 실시형태와 공통이기 때문에 설명을 활애한다.Since the process content after the vertex 23 which the autonomous vehicle 1 passed immediately before is specified by the vertex specifying unit 11 is common to the first embodiment, the description is given.

[제 3 실시형태][Third Embodiment]

자동 주행 차량의 제 3 실시형태의 구성에 대해 제 1 실시형태와 다른 개소만을 설명한다. 도 7은 본 실시형태의 자동 주행 차량(1)의 구성을 모식적으로 나타내는 기능 블럭도이다.Only the location different from 1st Embodiment is demonstrated about the structure of 3rd Embodiment of an automatic traveling vehicle. 7 is a functional block diagram schematically showing the configuration of the autonomous traveling vehicle 1 of the present embodiment.

본 실시형태의 자동 주행 차량(1)은 자동 주행 차량(1)의 현재의 지점에 있어서의 세계 좌표를 계측하는 좌표 계측부(31)를 구비하고 있다. 좌표 계측부(31)로서는, 예를 들면 GPS 시스템을 사용할 수 있다. 기억부(15)에는, 예를 들면 도 4에 기재한 바와 같이, 각 정점(23)이 배치되어 있는 위치정보가 기억되어 있다. 특히 본 실시형태에서는 각 정점(23)이 배치되어 있는 위치정보가 세계 좌표의 형식으로 기재되어 있다.The automatic traveling vehicle 1 of this embodiment is provided with the coordinate measuring part 31 which measures the world coordinate in the current point of the automatic traveling vehicle 1. As the coordinate measuring unit 31, for example, a GPS system can be used. For example, as shown in FIG. 4, the storage unit 15 stores positional information where the vertices 23 are arranged. In particular, in the present embodiment, the positional information where the vertices 23 are arranged is described in the form of world coordinates.

정점 특정부(11)는 정점 검지부(7a)로부터 주어지는 정보에 의해 자동 주행 차량(1)이 정점(23)을 통과한 것을 검지하면, 좌표 계측부(31)로부터 자동 주행 차량(1)의 현재위치를 나타내는 세계 좌표를 취득한다. 그리고, 정점 특정부(11)는 좌표 계측부(31)로부터 취득한 세계 좌표와 기억부(15)에 기억되어 있는 정점 식별정보에 기재되어 있는 세계 좌표에 관한 정보를 대조하고, 정점(23)을 특정한다.When the vertex specifying unit 11 detects that the autonomous vehicle 1 has passed the vertex 23 by the information given from the vertex detecting unit 7a, the current position of the autonomous vehicle 1 from the coordinate measuring unit 31 is detected. Get the world coordinates representing. The vertex specifying unit 11 compares the world coordinates acquired from the coordinate measuring unit 31 with the information about the world coordinates described in the vertex identification information stored in the storage unit 15, and identifies the vertices 23. do.

상술한 바와 같이, 본 실시형태의 자동 주행 차량(1)은 정점 특정부(11)가 좌표 계측부(31)로부터 취득한 세계 좌표와 기억부(15)에 기억되어 있는 정점 식별정보에 기재되어 있는 세계 좌표에 관한 정보를 대조함으로써 정점(23)을 특정한다. 그러나, 정점 특정부(11)는 좌표 계측부(31)로부터 취득한 세계 좌표에 추가해서, 제 1 실시형태에서 예시한 다른 정점 식별정보도 포함시켜서 정점(23)을 특정하는 것으로 해도 관계없다.As described above, the autonomous vehicle 1 of the present embodiment includes the world described in the world coordinates obtained by the vertex specifying unit 11 from the coordinate measuring unit 31 and the vertex identification information stored in the storage unit 15. The vertex 23 is specified by collating information about the coordinates. However, the vertex specifying unit 11 may specify the vertex 23 by including other vertex identification information exemplified in the first embodiment in addition to the world coordinates acquired from the coordinate measuring unit 31.

또한, 본 실시형태의 자동 주행 차량(1)은 좌표 계측부(31)에 의해서 현재의 지점에 있어서의 세계 좌표를 계측하는 기능을 갖추고 있다. 그러나, 본 실시형태의 자동 주행 차량(1)은 단지 좌표 계측부(31)에서 계측된 세계 좌표의 정보 자체를 가지고 자동 주행 차량(1)의 현재위치를 특정하는 구성으로는 되어 있지 않다. 이것은 자동 주행 차량(1)이 골프카로서 이용될 경우, 주로(21)의 매우 가까운 영역에 많은 수목이 심어져 있는 것 같은 상황이 상정되기 때문이다. 즉, 자동 주행 차량(1)의 위치에 따라서는 GPS로 구성된 좌표 계측부(31)에 의해 현재의 위치를 특정할 수 없는 경우도 생길 수 있다. 그러나, 본 실시형태에서는 좌표 계측부(31)에서 계측된 세계 좌표에 관한 정보는 직전에 통과한 정점(23)을 특정하기 위해서 이용된다. 이 때문에, 좌표 계측부(31)에서 계측되는 세계 좌표는 기억부(15)에 기억되어 있는 각 정점(23)의 세계 좌표 중, 그 계측된 세계 좌표에 가장 근사하고 있는 것을 특정할 수 있는 정도의 정밀도를 갖고 있으면 충분한다.In addition, the automatic traveling vehicle 1 of this embodiment is equipped with the function which measures the world coordinate in the present point by the coordinate measuring part 31. FIG. However, the autonomous vehicle 1 of this embodiment does not have the structure which specifies the present position of the autonomous vehicle 1 only with the information of the world coordinate measured by the coordinate measuring part 31 itself. This is because, when the autonomous vehicle 1 is used as a golf car, a situation in which many trees are planted in a region very close to the main 21 is assumed. In other words, depending on the position of the autonomous vehicle 1, the current position may not be specified by the coordinate measuring unit 31 composed of GPS. However, in this embodiment, the information about the world coordinate measured by the coordinate measuring part 31 is used for specifying the vertex 23 which passed just before. For this reason, the world coordinate measured by the coordinate measuring part 31 is the degree which can specify what is the closest to the measured world coordinate among the world coordinates of each vertex 23 memorize | stored in the memory | storage part 15. It is enough to have precision.

자동 주행 차량(1)이 직전에 통과한 정점(23)이 정점 특정부(11)에 의해 특정된 후의 처리 내용은 제 1 실시형태와 공통이기 때문에 설명을 활애한다.Since the process content after the vertex 23 which the autonomous vehicle 1 passed immediately before is specified by the vertex specifying unit 11 is common to the first embodiment, the description is given.

[제 4 실시형태]Fourth Embodiment

자동 주행 차량의 제 4 실시형태의 구성에 대해 제 1 실시형태와 다른 개소만을 설명한다. 도 8은 본 실시형태에 있어서의 자동 주행 차량을 앞면으로부터 보았을 때의 모식도이다. 또한, 도 9는 본 실시형태의 자동 주행 차량(1)의 구성을 기능적으로 나타내는 블럭도이다.Only the location different from 1st Embodiment is demonstrated about the structure of 4th Embodiment of an automatic traveling vehicle. 8 is a schematic view of the automatic traveling vehicle according to the present embodiment as viewed from the front. 9 is a block diagram functionally showing the structure of the automatic traveling vehicle 1 of this embodiment.

본 실시형태의 자동 주행 차량(1)은 앞면 중앙부에 촬상부(3)를 구비한다. 촬상부(3)는, 예를 들면 스테레오 카메라로 구성되고, 좌화상 센서(3a)와 우화상 센서(3b)를 갖는다. 이들 화상 센서(3a, 3b)는 CCD(Charge-Coupled Device)나 CMOS(Complementary MOS) 등의 일반적인 가시광 센서로 구성된다.The automatic traveling vehicle 1 of the present embodiment includes an imaging unit 3 in the front center portion. The imaging part 3 is comprised, for example with a stereo camera, and has the left image sensor 3a and the right image sensor 3b. These image sensors 3a and 3b are constituted by a general visible light sensor such as a charge-coupled device (CCD) or a complementary MOS (CMOS).

본 실시형태에 있어서 기억부(15)에 기억된 정점 식별정보에는 각 정점(23)의 위치에 있어서 촬상부(3)가 전방을 촬상한 데이터가 포함된다. 또한, 촬상부(3)가 촬상하는 방향은 반드시 자동 주행 차량(1)의 전방일 필요는 없다.In the present embodiment, the vertex identification information stored in the storage unit 15 includes data obtained by imaging the front part at the position of each vertex 23. In addition, the direction which the imaging part 3 picks up does not necessarily need to be ahead of the automatic traveling vehicle 1.

정점 특정부(11)는 정점 검지부(7a)로부터 주어지는 정보에 의해 자동 주행 차량(1)이 정점(23)을 통과한 것을 검지하면, 이 시점에 있어서 촬상부(3)가 자동 주행 차량(1)의 전방을 촬상한 데이터가 입력된다. 그리고, 정점 특정부(11)는 촬상부(3)로부터 입력된 촬상 데이터와, 기억부(15)로부터 판독된 정점 식별정보에 기재되어 있는 촬상 데이터에 관한 정보를 대조함으로써 정점(23)을 특정한다.When the vertex specifying unit 11 detects that the autonomous vehicle 1 has passed the vertex 23 by the information given from the vertex detecting unit 7a, the imaging unit 3 at this point in time detects that the autonomous vehicle 1 Data obtained by capturing the front side of the image is input. The vertex specifying unit 11 identifies the vertex 23 by matching the image data input from the image capturing unit 3 with the information about the image data described in the vertex identification information read out from the storage unit 15. do.

촬상부(3)로부터 입력된 촬상 데이터와, 기억부(15)로부터 판독한 촬상 데이터에 관한 정보의 대조 방법으로서는 여러가지 방법을 채용할 수 있다. 일례로서, 촬상 데이터로부터 작성된 시차화상을 비교해서 대조할 수 있다. 시차화상은 주지 의 방법으로 작성된다.Various methods can be adopted as a method of collating the imaging data input from the imaging unit 3 with the information about the imaging data read out from the storage unit 15. As an example, the parallax image created from the imaging data can be compared and contrasted. Parallax images are made in a known manner.

상술한 바와 같이, 본 실시형태의 자동 주행 차량(1)은 정점 특정부(11)가 정점(23)을 통과한 시점에서 촬상부(3)가 생성한 촬상 데이터에 의거하여 정점(23)을 특정한다. 그러나, 정점 특정부(11)는 이 촬상 데이터에 추가해서, 상기 각 실시형태에서 예시한 다른 정점 식별정보도 포함시켜서 정점(23)을 특정하는 것으로 해도 관계없다. 예를 들면, 본 실시형태의 자동 주행 차량(1)이 좌표 계측부(31)를 더 구비하는 것으로 해도 관계없다.As described above, the autonomous vehicle 1 of the present embodiment uses the vertex 23 based on the imaging data generated by the imaging unit 3 at the time when the vertex specifying unit 11 passes the vertex 23. It is specified. However, the vertex specifying unit 11 may also specify the vertex 23 by including the other vertex identification information exemplified in the above embodiments in addition to the image data. For example, the automatic traveling vehicle 1 of the present embodiment may be further provided with the coordinate measuring unit 31.

자동 주행 차량(1)이 직전에 통과한 정점(23)이 정점 특정부(11)에 의해서 특정된 후의 처리 내용은 제 1 실시형태와 공통이기 때문에 설명을 활애한다.Since the process content after the vertex 23 which the autonomous vehicle 1 passed immediately before is specified by the vertex specifying unit 11 is common to the first embodiment, the description is given.

[다른 실시형태][Other Embodiments]

이하, 다른 실시형태에 대하여 설명한다.Hereinafter, another embodiment is described.

<1> 자동 주행 차량(1)은 주로(21) 상을 자율 주행하는 모드와, 주로(21) 이외의 필드를 메뉴얼로 주행하는 모드를 스위칭하는 지시부를 구비하는 것으로 해도 관계없다. 도 10은 제 1 실시형태에서 상술한 자동 주행 차량(1)이 지시부(33)를 구비했을 경우의 구성을 모식적으로 도시한 것이다.The <1> autonomous vehicle 1 may be equipped with the instruction | indication part which switches the mode which autonomously runs on the main 21, and the mode which runs the field other than the main 21 manually. FIG. 10 schematically shows a configuration in the case where the autonomous vehicle 1 described above in the first embodiment is provided with the indicating unit 33.

이러한 구성에 의하면, 자동 주행 차량(1)은 주로(21) 이외의 필드를 주행한 후에 주로(21) 상을 주행하는 모드로 이행하는 타이밍을 검지할 수 있다. 자동 주행 차량(1)은 주로(21) 상을 자동 주행하는 모드로 이행하면 결국은 정점(23)을 통과하는 것이기 때문에, 상술한 방법에 의해 자동 주행 차량(1)의 현재의 위치를 특정할 수 있다. 또한, 제 2 실시형태 이후의 각 실시형태에서 상술한 자동 주행 차량(1)이 지시부(33)를 구비해도 관계없다.According to such a structure, the autonomous vehicle 1 can detect the timing which shifts to the mode which travels on the main 21 after running the fields other than the main 21. Since the autonomous vehicle 1 mainly passes the vertices 23 when the vehicle 21 enters the mode of autonomous driving, the current position of the autonomous vehicle 1 can be specified by the above-described method. Can be. In addition, the autonomous vehicle 1 mentioned above in each embodiment after 2nd Embodiment may be equipped with the instruction | indication part 33.

<2> 정점(23)에 대하여 그 정점(23)이 배치되어 있는 위치에 관한 정보 자체(정점 위치정보)가 기억되어 있는 것으로 해도 관계없다. 일례로서, 정점(23)이 RFID와 같은 많은 정보를 기억한 형태로 매입되어 있을 경우에는, 정점(23)에 대하여 정점 식별정보와 정점 위치정보의 양자를 기억시키는 것이 가능하다. 이 경우, 자동 주행 차량(1)이 정점(23)을 통과한 시점에서 정점 검지부(7a)는 정점(23)을 통과한 것 뿐만 아니라, 통과한 정점(23)의 위치에 대해서도 인식하는 것이 가능한 구성으로 할 수 있다.<2> The information itself (vertex position information) regarding the position where the vertex 23 is disposed with respect to the vertex 23 may be stored. As one example, when the vertex 23 is embedded in a form in which a lot of information such as RFID is stored, it is possible to store both vertex identification information and vertex position information in the vertex 23. In this case, when the autonomous vehicle 1 passes through the vertex 23, the vertex detection unit 7a can recognize not only the vertex 23 but also the position of the vertex 23 that has passed. You can make it a configuration.

이러한 구성의 경우에는, 자동 주행 차량(1)을 예를 들면 도 11에 나타내는 바와 같은 구성으로 할 수 있다. 즉, 정점 검지부(7a)는 정점(23)을 통과한 시점에서 정점(23)을 통과한 것 뿐만 아니라, 그 통과한 정점(23)의 위치에 관한 정보도 검지할 수 있다. 따라서, 이 다른 실시형태의 구성에서는 상술한 각 실시형태의 구성과 같이, 반드시 정점 식별정보와 정점 위치정보가 관련지어서 기억되어 있는 기억부(15)를 구비할 필요가 없다.In the case of such a structure, the automatic traveling vehicle 1 can be set as the structure shown, for example in FIG. That is, the vertex detection unit 7a can not only pass the vertex 23 at the time when the vertex 23 has passed, but also detect information on the position of the vertex 23 that has passed. Therefore, in the structure of this other embodiment, like the structure of each embodiment mentioned above, it is not necessary to necessarily provide the memory | storage part 15 in which vertex identification information and vertex position information are stored in association.

<3> 본원 발명 및 본 명세서의 자동 주행 차량(automatically driven vehicle)은 자동 주행 가능한 차량이다. 자동 주행 차량은 오퍼레이터에 의한 조타 없이 자동 주행 가능한 차량이다. 자동 주행 차량은 오퍼레이터에 의한 가속 및 감속 없이 자동 주행 가능한 차량이다. 또한, 자동 주행 차량은 적어도 하나의 센서를 탑재하고, 그 센서의 신호에 따라서 자율적으로 주행 가능한 자율 주행 차량(autonomously driven vehicle)을 포함한다.<3> The present invention and the automatically driven vehicle of the present specification are vehicles capable of autonomous driving. The autonomous vehicle is a vehicle which can autonomously run without steering by an operator. The autonomous vehicle is a vehicle capable of autonomous driving without acceleration and deceleration by the operator. In addition, the autonomous vehicle includes at least one sensor and includes an autonomously driven vehicle that can autonomously drive in accordance with the signal of the sensor.

1 : 자동 주행 차량 4 : 핸들
5 : 우전륜 6 : 좌전륜
7 : 판독부 7a : 정점 검지부
7b : 유도선 검지부 9 : 회전각 검지부
11 : 정점 특정부 13 : 주행거리 계측부
15 : 기억부 17 : 현재지점 특정부
19 : 자동운전 제어부 21 : 주로
23 : 정점 24 : 전자 유도선
31 : 좌표 계측부 33 : 지시부
1: autonomous vehicle 4: steering wheel
5: right front wheel 6: left front wheel
7 reading part 7a vertex detection part
7b: guide line detection unit 9: rotation angle detection unit
11: vertex specifying unit 13: mileage measurement unit
15: storage unit 17: current point specifying unit
19: automatic operation control unit 21: mainly
23 vertex 24: electromagnetic induction line
31: coordinate measuring unit 33: indicating unit

Claims (8)

기정 주로 상을 자동 주행 가능하게 구성되고, 또한 그 기정 주로의 아래에 매설된 정점에 의거하여 차량의 주행상태를 제어하는 자동 주행 차량으로서,
상기 정점을 통과한 것을 검지하는 정점 검지부와,
복수의 상기 정점의 각각에 관해서, 각 정점이 배치되어 있는 위치에 관한 정점 위치정보와 각 정점을 식별하기 위한 정점 식별정보를 대응시켜서 기억하는 기억부와,
상기 정점 검지부에서 통과한 것이 검지된 상기 정점을 상기 정점 식별정보에 의거해서 특정하는 정점 특정부와,
상기 정점 특정부에 의해서 특정된 상기 정점으로부터 현재지점까지의 주행거리를 계측하는 주행거리 계측부와,
상기 정점 위치정보에 의거하여 상기 정점 특정부에 의해서 특정된 상기 정점의 위치를 검출함과 아울러, 그 검출된 상기 정점의 위치와 상기 주행거리 계측부에 의해 계측된 상기 정점으로부터 현재지점까지의 주행거리에 의거하여 현재지점을 특정하는 현재지점 특정부를 구비하고,
상기 정점 검지부는 상기 정점에 대응된 속도제어 명령의 판독이 가능한 구성이며,
상기 정점 식별정보는 각각의 상기 정점에 대응된 상기 속도제어 명령에 관한 정보를 포함하고,
상기 정점 특정부는 상기 정점 검지부에 의해서 판독된 상기 정점에 대응된 상기 속도제어 명령과 상기 정점 식별정보에 기재된 상기 속도제어 명령에 관한 정보를 대조함으로써 통과한 상기 정점을 특정하는 것을 특징으로 하는 자동 주행 차량.
An automatic driving vehicle configured to be capable of automatically traveling on a predetermined main road and controlling the running state of the vehicle based on a vertex embedded below the predetermined main road,
A vertex detection unit for detecting that the vertex has passed;
A storage unit that associates and stores vertex position information about a position where each vertex is disposed and vertex identification information for identifying each vertex with respect to each of the plurality of vertices;
A vertex specifying unit specifying the vertex detected by the vertex detecting unit on the basis of the vertex identification information;
A mileage measurement unit for measuring a mileage from the vertex specified by the vertex specifying unit to the current point;
The position of the vertex specified by the vertex specifying unit is detected based on the vertex position information, and the position of the detected vertex and the traveling distance from the vertex measured by the traveling distance measuring unit to the current point. A current point specifying unit specifying a current point based on
The vertex detection unit is a configuration capable of reading a speed control command corresponding to the vertex,
The vertex identification information includes information about the speed control command corresponding to each vertex,
The vertex specifying unit specifies the vertex that has passed by matching the speed control command corresponding to the vertex read by the vertex detection unit with the information about the speed control command described in the vertex identification information. vehicle.
기정 주로 상을 자동 주행 가능하게 구성되고, 또한 그 기정 주로의 아래에 매설된 정점에 의거하여 차량의 주행상태를 제어하는 자동 주행 차량으로서,
상기 정점을 통과한 것을 검지하는 정점 검지부와,
복수의 상기 정점의 각각에 관해서, 각 정점이 배치되어 있는 위치에 관한 정점 위치정보와 각 정점을 식별하기 위한 정점 식별정보를 대응시켜서 기억하는 기억부와,
상기 정점 검지부에서 통과한 것이 검지된 상기 정점을 상기 정점 식별정보에 의거해서 특정하는 정점 특정부와,
상기 정점 특정부에 의해서 특정된 상기 정점으로부터 현재지점까지의 주행거리를 계측하는 주행거리 계측부와,
상기 정점 위치정보에 의거하여 상기 정점 특정부에 의해서 특정된 상기 정점의 위치를 검출함과 아울러, 그 검출된 상기 정점의 위치와 상기 주행거리 계측부에 의해 계측된 상기 정점으로부터 현재지점까지의 주행거리에 의거하여 현재지점을 특정하는 현재지점 특정부를 구비하고,
상기 기정 주로 상을 주행 중에 상기 자동 주행 차량으로부터 보아서 소정의 방향을 촬상하는 촬상부를 갖고,
상기 정점 식별정보는 상기 정점을 통과하는 위치에 있어서 상기 자동 주행 차량으로부터 보아서 상기 소정의 방향을 촬상했을 때의 촬상 데이터에 관한 정보를 포함하고,
상기 정점 특정부는 상기 정점을 통과한 것을 검지한 시점에서, 상기 촬상부에 의해서 촬상된 데이터와 상기 정점 식별정보에 기재된 상기 촬상 데이터에 관한 정보를 대조함으로써 통과한 상기 정점을 특정하는 것을 특징으로 하는 자동 주행 차량.
An automatic driving vehicle configured to be capable of automatically traveling on a predetermined main road and controlling the running state of the vehicle based on a vertex embedded below the predetermined main road,
A vertex detection unit for detecting that the vertex has passed;
A storage unit that associates and stores vertex position information about a position where each vertex is disposed and vertex identification information for identifying each vertex with respect to each of the plurality of vertices;
A vertex specifying unit specifying the vertex detected by the vertex detecting unit on the basis of the vertex identification information;
A mileage measurement unit for measuring a mileage from the vertex specified by the vertex specifying unit to the current point;
The position of the vertex specified by the vertex specifying unit is detected based on the vertex position information, and the position of the detected vertex and the traveling distance from the vertex measured by the traveling distance measuring unit to the current point. A current point specifying unit specifying a current point based on
It has an imaging part which picks up a predetermined direction by looking at the said predetermined | prescribed image from the said autonomous vehicle while traveling,
The vertex identification information includes information about the imaging data when the predetermined direction is captured from the autonomous vehicle at a position passing through the vertex,
The vertex specifying unit specifies the vertex that has passed by comparing the data imaged by the image capturing unit with the information about the image capturing data described in the vertex identification information at the point of time when the vertex specifying unit has passed the vertex. Auto driving vehicle.
제 1 항 또는 제 2 항에 있어서,
현재지점의 세계 좌표를 계측하는 좌표 계측부를 구비하고,
상기 정점 식별정보는 각각의 상기 정점이 배치되어 있는 세계 좌표에 관한 정보를 포함하고,
상기 정점 특정부는 상기 정점 검지부가 상기 정점을 통과한 것을 검지한 시점에서, 상기 좌표 계측부에서 계측된 세계 좌표와 상기 정점 식별정보에 기재된 세계 좌표에 관한 정보를 대조함으로써 통과한 상기 정점을 특정하는 것을 특징으로 하는 자동 주행 차량.
The method according to claim 1 or 2,
It is provided with a coordinate measuring unit for measuring the world coordinates of the current point,
The vertex identification information includes information about world coordinates in which each vertex is disposed;
The vertex specifying unit specifies the vertex that has passed by comparing the world coordinates measured by the coordinate measuring unit with the information about the world coordinates described in the vertex identification information when the vertex detecting unit detects that the vertex has passed the vertex. An autonomous vehicle characterized by the above-mentioned.
제 1 항 또는 제 2 항에 있어서,
상기 정점 식별정보는 상기 기정 주로 상에서 직렬적으로 인접하는 2개의 상기 정점간의 주행거리에 관한 정보를 포함하고,
상기 정점 특정부는 상기 정점을 통과한 것을 검지한 시점에서, 상기 주행거리 계측부가 계측한 상기 주행거리와 상기 정점 식별정보에 기재된 상기 주행거리에 관한 정보를 대조함으로써 통과한 상기 정점을 특정하는 것을 특징으로 하는 자동 주행 차량.
The method according to claim 1 or 2,
The vertex identification information includes information about a travel distance between two vertices adjacent in series on the predetermined main route,
The vertex specifying unit specifies the vertex that has passed by matching the information about the mileage described in the vertex identification information with the mileage measured by the mileage measurement unit at a time point when the vertex has been detected. Running vehicle.
제 1 항 또는 제 2 항에 있어서,
상기 기정 주로 상을 자율 주행하는 모드와 상기 기정 주로 이외의 필드를 메뉴얼로 주행하는 모드를 스위칭하는 지시부를 구비한 것을 특징으로 하는 자동 주행 차량.
The method according to claim 1 or 2,
And an instruction unit for switching a mode for autonomous driving of the image on the predetermined main road and a mode for manually driving a field other than the predetermined main road.
제 1 항 또는 제 2 항에 기재된 자동 주행 차량과,
상기 자동 주행 차량이 자동 주행하기 위해서 부설된 유도선과,
자동 주행 중에 상기 자동 주행 차량이 통과하는 복수의 지점에 상기 자동 주행 차량의 주행상태를 제어하기 위해서 부설된 정점을 포함하는 것을 특징으로 하는 자동 주행 차량 자주 시스템.
The automatic driving vehicle according to claim 1 or 2,
A guide line laid for the automatic driving vehicle to automatically run,
An autonomous vehicle autonomous system, characterized in that it comprises a vertex provided to control the driving state of the autonomous vehicle at a plurality of points through which the autonomous vehicle passes during autonomous driving.
삭제delete 삭제delete
KR1020160040998A 2015-07-29 2016-04-04 Automatic driving vehicle and automatic driving system with the same KR102079524B1 (en)

Applications Claiming Priority (8)

Application Number Priority Date Filing Date Title
JP2015149524 2015-07-29
JPJP-P-2015-149524 2015-07-29
JP2015157183A JP6690904B2 (en) 2015-08-07 2015-08-07 Self-driving vehicle
JPJP-P-2015-157183 2015-08-07
JP2015175792A JP6651313B2 (en) 2015-09-07 2015-09-07 Automatic traveling vehicle and automatic traveling system including the same
JPJP-P-2015-175792 2015-09-07
JP2016043199 2016-03-07
JPJP-P-2016-043199 2016-03-07

Publications (2)

Publication Number Publication Date
KR20170015107A KR20170015107A (en) 2017-02-08
KR102079524B1 true KR102079524B1 (en) 2020-02-20

Family

ID=58006247

Family Applications (3)

Application Number Title Priority Date Filing Date
KR1020160040994A KR102146311B1 (en) 2015-07-29 2016-04-04 Automatic driving vehicle
KR1020160040998A KR102079524B1 (en) 2015-07-29 2016-04-04 Automatic driving vehicle and automatic driving system with the same
KR1020170172378A KR101839813B1 (en) 2015-07-29 2017-12-14 Abnormal image detecting apparatus, image processing system with abnormal image detecting apparatus and vehicle mounted with image processing system

Family Applications Before (1)

Application Number Title Priority Date Filing Date
KR1020160040994A KR102146311B1 (en) 2015-07-29 2016-04-04 Automatic driving vehicle

Family Applications After (1)

Application Number Title Priority Date Filing Date
KR1020170172378A KR101839813B1 (en) 2015-07-29 2017-12-14 Abnormal image detecting apparatus, image processing system with abnormal image detecting apparatus and vehicle mounted with image processing system

Country Status (3)

Country Link
KR (3) KR102146311B1 (en)
CN (2) CN106406303B (en)
TW (3) TWI704437B (en)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR102072161B1 (en) 2018-01-19 2020-02-03 주식회사 만도 Vehicle control apparatus and vehicle control method
GB201804082D0 (en) * 2018-03-14 2018-04-25 Five Ai Ltd Image annotation
WO2020100267A1 (en) * 2018-11-15 2020-05-22 ヤマハ発動機株式会社 Straddled vehicle traveling data processing device, and straddled vehicle traveling data processing method
TWI695243B (en) * 2019-01-25 2020-06-01 孟菁 Obstacle avoiding guidance system
TWI684085B (en) * 2019-04-24 2020-02-01 揚昇育樂事業股份有限公司 Self-driving travel path central controlling device of self-driving car
EP4318306A1 (en) * 2021-03-24 2024-02-07 Medit Corp. Data processing device and data processing method
CN113815643A (en) * 2021-09-06 2021-12-21 达魔重卡电动汽车制造(杭州)有限公司 Automatic vehicle running system for realizing high-precision processing for unmanned vehicle

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009271608A (en) * 2008-04-30 2009-11-19 Murata Mach Ltd Travelling vehicle and travelling vehicle system
KR101319526B1 (en) * 2013-03-26 2013-10-21 고려대학교 산학협력단 Method for providing location information of target using mobile robot
JP2014137710A (en) * 2013-01-17 2014-07-28 Toyota Industries Corp Control method of automatic guided vehicle

Family Cites Families (25)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH04100126A (en) * 1990-08-18 1992-04-02 Yaskawa Electric Corp Position sensor for moving robot
JP2944814B2 (en) 1992-03-17 1999-09-06 ヤンマー農機株式会社 Autonomous vehicle with obstacle sensor
JP3355354B2 (en) * 1993-10-12 2002-12-09 ヤマハ発動機株式会社 Fixed point information discriminating device for track running vehicles
JP3718886B2 (en) * 1995-11-01 2005-11-24 神鋼電機株式会社 Driving control method for electric vehicle
JPH1069219A (en) * 1996-08-28 1998-03-10 Honda Motor Co Ltd Automatic traveling road and automatic traveling system
JP2000181540A (en) 1998-12-17 2000-06-30 Yamaha Motor Co Ltd Automatic traveling vehicle
CN100515840C (en) * 2005-10-09 2009-07-22 比亚迪股份有限公司 Automobile automatic brake system and method based on image processing
JP2008129696A (en) * 2006-11-17 2008-06-05 Toyota Motor Corp Mobile robot, mobile robot charging system, and mobile robot charging method
TWM335688U (en) * 2008-01-03 2008-07-01 Univ Kao Yuan Route positioning navigation system for unmanned ground vehicle
JP4937933B2 (en) 2008-01-18 2012-05-23 富士重工業株式会社 Outside monitoring device
JP5207057B2 (en) 2008-11-28 2013-06-12 サクサ株式会社 Dirt detection device and method for detecting contamination of an imaging device
KR101214474B1 (en) * 2009-09-15 2012-12-24 한국전자통신연구원 Navigation apparatus and driving route information offering method using by it, automatic driving system and its method
CN102666185B (en) * 2009-11-19 2014-10-15 株式会社冈村制作所 Article conveyance device
JP5503419B2 (en) * 2010-06-03 2014-05-28 株式会社日立製作所 Automated guided vehicle and travel control method
US8527121B2 (en) * 2010-06-04 2013-09-03 GM Global Technology Operations LLC Method and system for calculating and displaying travel range information
JP5693994B2 (en) * 2011-02-16 2015-04-01 富士重工業株式会社 Vehicle detection device
TWI426241B (en) * 2011-05-16 2014-02-11 Nat Univ Chung Hsing Self - propelled device for the tracking system
TWI455073B (en) * 2011-12-14 2014-10-01 Ind Tech Res Inst Road-condition warning device, system and method for a vehicle
JP6066048B2 (en) * 2012-10-18 2017-01-25 ヤマハ発動機株式会社 Obstacle detection device and vehicle using the same
WO2014076844A1 (en) * 2012-11-19 2014-05-22 株式会社日立製作所 Autonomous movement system and control device
CN103092202B (en) * 2012-12-31 2015-07-08 浙江国自机器人技术有限公司 Robot track positioning method and robot track positioning system
JP6135289B2 (en) * 2013-05-07 2017-05-31 村田機械株式会社 Autonomous mobile object movement control device, autonomous mobile object, and autonomous mobile object control method
TW201444543A (en) * 2013-05-21 2014-12-01 Univ Nat Chiao Tung Self-propelled cart
KR101463464B1 (en) * 2013-06-03 2014-11-21 국방과학연구소 Driveable path detection apparatus, moving objection having th same and method of detectiing driveable path
JP6271212B2 (en) * 2013-10-17 2018-01-31 ヤマハ発動機株式会社 Autonomous vehicle

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009271608A (en) * 2008-04-30 2009-11-19 Murata Mach Ltd Travelling vehicle and travelling vehicle system
JP2014137710A (en) * 2013-01-17 2014-07-28 Toyota Industries Corp Control method of automatic guided vehicle
KR101319526B1 (en) * 2013-03-26 2013-10-21 고려대학교 산학협력단 Method for providing location information of target using mobile robot

Also Published As

Publication number Publication date
TWI704437B (en) 2020-09-11
CN106406303A (en) 2017-02-15
KR20170141640A (en) 2017-12-26
TW201704915A (en) 2017-02-01
KR20170015106A (en) 2017-02-08
CN106406302A (en) 2017-02-15
TW201809939A (en) 2018-03-16
KR101839813B1 (en) 2018-03-19
KR20170015107A (en) 2017-02-08
TWI624743B (en) 2018-05-21
CN106406303B (en) 2020-12-29
KR102146311B1 (en) 2020-08-20
TWI668543B (en) 2019-08-11
TW201704916A (en) 2017-02-01

Similar Documents

Publication Publication Date Title
KR102079524B1 (en) Automatic driving vehicle and automatic driving system with the same
US9921585B2 (en) Detailed map format for autonomous driving
CN111417556A (en) Vehicle position estimation device and vehicle control device
US10635106B2 (en) Automated driving apparatus
CN107836017B (en) Semaphore identification device and semaphore recognition methods
KR101971444B1 (en) Automatically driven vehicle
CN104271432B (en) For the method and apparatus determining the track match parameter of the Lane Keeping System for vehicle and the method and apparatus guided for the track of vehicle
JP2014034251A (en) Vehicle traveling control device and method thereof
US20200364470A1 (en) Traveling lane recognition apparatus and traveling lane recognition method
US20190331496A1 (en) Locating a vehicle
JP2020067698A (en) Partition line detector and partition line detection method
JP2020056733A (en) Vehicle control device
US9715634B2 (en) Method and device for determining a distance of a vehicle from a traffic-regulating object
KR20180012128A (en) Apparatus for estimating 3d position of vehicle and method thereof
JP6690904B2 (en) Self-driving vehicle
CN107914600B (en) Automatic collection equipment, collection control method and control device for road marking coordinates
KR101980509B1 (en) Inter-vehicle distance estimation method and inter-vehicle distance estimation device
JP6651313B2 (en) Automatic traveling vehicle and automatic traveling system including the same
US20230136710A1 (en) Systems and methods for harvesting images for vehicle navigation
JP2018169924A (en) Learning data collection apparatus, learning data collection system, and learning data collection method
KR20180137904A (en) Apparatus for correcting vehicle driving information and method thereof
CN108007460A (en) The method and system of mobile object location are determined in environment is predicted
CN104210493A (en) Linear array image sensor based following vehicle road lane line detection device
CN108630002A (en) Method and apparatus at least one most probable path for determining vehicle
JP2022150919A (en) Vehicle control apparatus

Legal Events

Date Code Title Description
A201 Request for examination
E902 Notification of reason for refusal
AMND Amendment
E601 Decision to refuse application
X091 Application refused [patent]
AMND Amendment
E902 Notification of reason for refusal
E902 Notification of reason for refusal
AMND Amendment
X701 Decision to grant (after re-examination)