KR102657973B1 - 차량 거동 예측 방법 및 차량 거동 예측 장치 - Google Patents

Abstract

차량 거동 예측 장치는, 자기 차량의 전방 또는 측방의 물체의 자기 차량에 대한 위치, 및 자기 차량에서 보아 물체보다 먼 곳을 주행하는 이동 물체를 검출하는 물체 검출 장치(1)와, 거동 예측부(10)를 구비한다. 거동 예측부(10)는, 물체 검출 장치(1)에 의해 검출된 위치에 기초하여, 물체에 의해 형성되는, 물체 검출 장치(1)가 검출할 수 없는 자기 차량의 사각 영역을 산출한다. 거동 예측부(10)는, 물체 검출 장치(1)에 의해 이동 물체가 검출된 후에 이동 물체가 미리 정해진 진로에서 진행한 경우의, 이동 물체가 검출되었을 때부터 이동 물체가 사각 영역에 진입하기까지의 시간인 검출 가능 시간을 추측한다. 거동 예측부(10)는, 검출 가능 시간과, 이동 물체가 검출되었을 때부터 이동 물체가 실제로 사각 영역에 진입하기까지의 시간인 실제 검출 가능 시간을 비교하고, 비교한 결과에 기초하여, 이동 물체의 진로를 예측한다.

Description

차량 거동 예측 방법 및 차량 거동 예측 장치

본 발명은, 차량 거동 예측 방법 및 차량 거동 예측 장치에 관한 것이다.

종래부터, 자기 차량이 교차점을 우회전할 때에, 자기 차량의 전방의 대향 차량에 관한 지원 정보를 자기 차량의 운전자에게 알리는 발명이 알려져 있다(특허문헌 1). 특허문헌 1에 기재된 발명은, 대향 도로를 직진하는 대향 차량(선행 차량)과, 선행 차량의 후방을 주행하는 후방 차량의 차종 관계에 기초하여 후방 차량이 선행 차량의 사각 (死角)에 들어가는 정도에 따른 사각 랭크를 설정한다. 그리고, 특허문헌 1에 기재된 발명은, 설정한 사각 랭크에 기초하여 지원 정보를 운전자에게 알린다.

특허문헌 1: 일본공개특허 2011-90582호 공보

그러나, 특허문헌 1에 기재된 발명은, 후방 차량이 선행 차량의 사각에 들어가는 정도에 따른 사각 랭크를 설정하지만, 후방 차량의 진로를 예측하지 못한다. 후방 차량의 진로의 예측은, 자기 차량의 원활한 주행에 기여하는데, 특허문헌 1에 기재된 발명은 후방 차량의 진로를 예측하지 못하기 때문에 개선의 여지가 있다. 또한, 후방 차량의 진로의 예측은, 자기 차량의 원활한 주행에 기여하기 때문에, 조기의 예측이 요구된다.

본 발명은, 상기 문제를 감안하여 이루어진 것으로, 그 목적은, 자기 차량의 전방 또는 측방을 주행하는 이동 물체의 진로를 조기에 예측하는 차량 거동 예측 방법 및 차량 거동 예측 장치를 제공하는 것이다.

본 발명의 일 형태에 관한 차량 거동 예측 방법은, 자기 차량의 전방 또는 측방의 물체의 자기 차량에 대한 위치를 검출하고, 자기 차량에서 보아 물체보다 먼 곳을 주행하는 이동 물체를 검출한다. 차량 거동 예측 방법은, 이동 물체를 검출한 후에 이동 물체가 미리 정해진 진로에서 진행한 경우의, 이동 물체를 검출하였을 때부터 이동 물체가 사각 영역에 진입하기까지의 시간인 검출 가능 시간을 추측한다. 차량 거동 예측 방법은, 추측한 검출 가능 시간과, 이동 물체를 검출하였을 때부터 이동 물체가 실제로 사각 영역에 진입하기까지의 시간인 실제 검출 가능 시간을 비교하고, 비교한 결과에 기초하여 이동 물체의 진로를 예측한다.

본 발명에 의하면, 자기 차량의 전방 또는 측방을 주행하는 이동 물체의 진로를 조기에 예측할 수 있다.

도 1은, 본 발명의 실시형태에 관한 차량 거동 예측 장치의 개략 구성도이다.
도 2는, 이동 물체의 진로 예측 방법의 일 실시예(교차점)에 대해 설명하는 도면이다.
도 3은, 이동 물체의 진로 예측 방법의 일 실시예(교차점)에 대해 설명하는 도면이다.
도 4는, 이동 물체의 진로 예측 방법의 일 실시예(교차점)에 대해 설명하는 도면이다.
도 5는, 차선 변경의 가능성의 증감에 대해 설명하는 도면이다.
도 6은, 이동 물체의 진로 예측 방법의 일 실시예(커브)에 대해 설명하는 도면이다.
도 7은, 이동 물체의 진로 예측 방법의 일 실시예(커브)에 대해 설명하는 도면이다.
도 8은, 이동 물체의 진로 예측 방법의 일 실시예(커브)에 대해 설명하는 도면이다.
도 9는, 이동 물체의 진로 예측 방법의 일 실시예(측도 (側道))에 대해 설명하는 도면이다.
도 10은, 이동 물체의 진로 예측 방법의 일 실시예(측도)에 대해 설명하는 도면이다.
도 11은, 이동 물체의 진로 예측 방법의 일 실시예(측도)에 대해 설명하는 도면이다.
도 12는, 이동 물체의 진로 예측 방법의 일 실시예(주차장)에 대해 설명하는 도면이다.
도 13은, 이동 물체의 진로 예측 방법의 일 실시예(주차장)에 대해 설명하는 도면이다.
도 14는, 이동 물체의 진로 예측 방법의 일 실시예(주차장)에 대해 설명하는 도면이다.
도 15a는, 본 발명의 실시형태에 관한 차량 거동 예측 장치의 일 동작예를 설명하는 흐름도이다.
도 15b는, 본 발명의 실시형태에 관한 차량 거동 예측 장치의 일 동작예를 설명하는 흐름도이다.
도 16은, 본 발명의 실시형태에 관한 차량 거동 예측 장치의 일 동작예를 설명하는 흐름도이다.

이하, 본 발명의 실시형태에 대해, 도면을 참조하여 설명한다. 도면의 기재에서 동일 부분에는 동일 부호를 부여하고 설명을 생략한다.

(차량 거동 예측 장치의 구성)

도 1을 참조하여, 차량 거동 예측 장치의 구성을 설명한다. 차량 거동 예측 장치는, 물체 검출 장치(1)와, 자기 차량 위치 추정 장치(2)와, 지도 취득 장치(3)와, 컨트롤러(100)를 구비한다. 차량 거동 예측 장치는, 자동 운전 기능을 갖는 차량에 적용될 수 있으며, 자동 운전 기능을 가지지 않는 차량에 적용될 수도 있다. 또한, 차량 거동 예측 장치는, 자동 운전과 수동 운전을 전환하는 것이 가능한 차량에 적용될 수 있다. 또, 본 실시형태에서의 자동 운전이란, 예를 들어 브레이크, 액셀, 스티어링 등의 액추에이터 중 적어도 어느 하나의 액추에이터가 승객의 조작 없이 제어되고 있는 상태를 가리킨다. 그 때문에, 그 밖의 액추에이터가 승객의 조작에 의해 작동하였다고 해도 상관없다. 또한, 자동 운전이란, 가감속 제어, 횡위치 제어 등의 어느 하나의 제어가 실행되고 있는 상태일 수 있다. 또한, 본 실시형태에서의 수동 운전이란, 예를 들어 브레이크, 액셀, 스티어링을 승객이 조작하고 있는 상태를 가리킨다.

물체 검출 장치(1)는, 자기 차량에 탑재된, 레이저 레이더, 밀리파 레이더, 카메라 등의 물체 검출 센서를 구비한다. 물체 검출 장치(1)는, 복수의 물체 검출 센서를 이용하여 자기 차량의 주위의 물체를 검출한다. 또한, 물체 검출 장치(1)는, 자기 차량의 전방 또는 측방의 물체를 검출한다. 물체 검출 장치(1)는, 다른 차량, 오토바이, 자전거, 보행자를 포함한 이동 물체, 및 주차 차량, 건물을 포함한 정지 물체를 검출한다. 예를 들어, 물체 검출 장치(1)는, 이동 물체 및 정지 물체의 자기 차량에 대한 위치, 자세(요각(yaw angle)), 크기, 속도, 가속도, 저크 (jerk), 감속도, 요레이트(yaw rate)를 검출한다.

자기 차량 위치 추정 장치(2)는, 자기 차량에 탑재된, GPS(Global Positioning System), 오도메트리 (odometry) 등 자기 차량의 절대 위치를 계측하는 위치 검출 센서를 구비한다. 자기 차량 위치 추정 장치(2)는, 위치 검출 센서를 이용하여, 자기 차량의 절대 위치, 즉 미리 정해진 기준점에 대한 자기 차량의 위치, 자세 및 속도를 계측한다.

지도 취득 장치(3)는, 자기 차량이 주행하는 도로의 구조를 나타내는 지도 정보를 취득한다. 지도 취득 장치(3)가 취득하는 지도 정보에는, 차선의 절대 위치, 차선의 접속 관계, 상대 위치 관계 등의 도로 구조의 정보가 포함된다. 또한, 지도 취득 장치(3)가 취득하는 지도 정보에는, 주차장, 주유소 등의 시설 정보도 포함된다. 지도 취득 장치(3)는, 지도 정보를 저장한 지도 데이터베이스를 소유할 수 있으며, 클라우드 컴퓨팅에 의해 지도 정보를 외부의 지도 데이터 서버로부터 취득할 수 있다. 또한, 지도 취득 장치(3)는, 차차간 통신, 로차간 통신을 이용하여 지도 정보를 취득할 수 있다.

컨트롤러(100)는, 물체 검출 장치(1) 및 자기 차량 위치 추정 장치(2)에 의한 검출 결과 및 지도 취득 장치(3)에 의한 취득 정보에 기초하여, 다른 차량의 진로를 예측한다. 컨트롤러(100)는, CPU(중앙 처리 장치), 메모리 및 입출력부를 구비하는 범용의 마이크로컴퓨터이다. 마이크로컴퓨터에는, 차량 거동 예측 장치로서 기능시키기 위한 컴퓨터 프로그램이 인스톨되어 있다. 컴퓨터 프로그램을 실행함으로써, 마이크로컴퓨터는, 차량 거동 예측 장치가 구비하는 복수의 정보 처리 회로로서 기능한다. 또, 여기서는, 소프트웨어에 의해 차량 거동 예측 장치가 구비하는 복수의 정보 처리 회로를 실현하는 예를 나타내지만, 물론 이하에 나타내는 각 정보 처리를 실행하기 위한 전용 하드웨어를 마련하여, 정보 처리 회로를 구성하는 것도 가능하다. 또한, 복수의 정보 처리 회로를 개별 하드웨어에 의해 구성할 수 있다.

컨트롤러(100)는, 복수의 정보 처리 회로로서, 검출 통합부(4)와, 물체 추적부(5)와, 지도 내 위치 연산부(6)와, 거동 예측부(10)와, 차량 제어부(30)를 구비한다. 나아가 거동 예측부(10)는, 차선 판정부(11)와, 의도 예측부(12)와, 사각 영역 산출부(13)와, 진입 타이밍 추측부(14)와, 진입 판정부(15)와, 궤도 취득부(16)와, 진로 예측부(17)를 구비한다.

검출 통합부(4)는, 물체 검출 장치(1)가 구비하는 복수의 물체 검출 센서 각각으로부터 얻어진 복수의 검출 결과를 통합하여, 각 물체에 대해 하나의 검출 결과를 출력한다. 구체적으로는, 물체 검출 센서 각각으로부터 얻어진 물체의 거동으로부터, 각 물체 검출 센서의 오차 특성 등을 고려한 후에 가장 오차가 적어지는 가장 합리적인 물체의 거동을 산출한다. 구체적으로는, 이미 알려진 센서 퓨전 기술을 이용함으로써, 복수 종류의 센서에서 취득한 검출 결과를 종합적으로 평가하여, 보다 정확한 검출 결과를 얻는다.

물체 추적부(5)는, 검출 통합부(4)에 의해 검출된 물체를 추적한다. 구체적으로, 물체 추적부(5)는, 다른 시각에 출력된 물체의 거동으로부터, 다른 시각 동안에서의 물체의 동일성 검증(대응시킴)을 행하고, 또한 그 대응을 기초로 물체를 추적한다.

지도 내 위치 연산부(6)는, 자기 차량 위치 추정 장치(2)에 의해 얻어진 자기 차량의 절대 위치 및 지도 취득 장치(3)에 의해 취득된 지도 데이터로부터, 지도상에서의 자기 차량의 위치를 추정한다.

차선 판정부(11)는, 물체 추적부(5)로부터 취득한 물체 정보 및 지도 내 위치 연산부(6)에 의해 추정된 자기 위치를 이용하여, 지도상에서의 자기 차량 및 물체의 주행 차선을 특정한다.

의도 예측부(12)는, 차선 판정부(11)로부터 취득한 주행 차선에 관한 정보 및 도로 구조에 기초하여, 물체가 진행될 가능성이 있는 모든 후보 차선을 예측한다. 예를 들어, 물체가 주행하고 있는 주행 차선이 1차선 도로인 경우, 물체가 진행될 가능성이 있는 후보 차선은 1개가 된다. 한편, 물체가 주행하고 있는 주행 차선이 2차선 도로인 경우, 물체가 진행되고자 하는 후보 차선은, 그대로 주행 차선을 직진하는 차선과, 주행 차선에 인접하는 차선의 2개가 있다. 또한, 의도 예측부(12)는, 물체의 위치, 방향, 자세 등에 기초하여 물체의 거동을 예측할 수 있다.

사각 영역 산출부(13)는, 자기 차량의 주위의 물체에 의해 형성되는, 자기 차량의 사각 영역을 산출한다. 자기 차량의 사각 영역이란, 자기 차량의 주위의 물체에 의해 형성된 사각에 의해, 물체 검출 장치(1)가 물체를 검출할 수 없는 영역을 말한다.

진입 타이밍 추측부(14)는, 이동 물체가 검출된 후에 이동 물체가 직진한 경우의, 이동 물체가 검출되었을 때부터 이동 물체가 사각 영역에 진입하기까지의 시간인 검출 가능 시간을 추측한다. 상세는 후술한다.

진입 판정부(15)는, 진입 타이밍 추측부(14)에 의해 추측된 검출 가능 시간이 경과하기 전에, 이동 물체가 사각 영역에 진입하였는지 여부를 판정한다. 즉, 진입 판정부(15)는, 진입 타이밍 추측부(14)에 의해 추측된 검출 가능 시간과 실제 검출 가능 시간을 비교하여, 추측된 검출 가능 시간보다 실제 검출 가능 시간이 짧은지 여부를 판정한다.

궤도 취득부(16)는, 이동 물체가 검출되었을 때부터 이동 물체가 사각 영역에 진입하기 직전까지의, 이동 물체의 궤도를 취득한다.

진로 예측부(17)는, 진입 판정부(15)에 의해 판정된 결과에 기초하여, 이동 물체의 진로를 예측한다. 또한, 진로 예측부(17)는, 진입 판정부(15)에 의해 판정된 결과 및 궤도 취득부(16)로부터 취득한 정보에 기초하여, 이동 물체의 진로를 예측할 수 있다.

차량 제어부(30)는, 미리 설정된 진로로 진행되기 때문에, 각종 센서의 정보를 이용하여 자기 차량의 각종 액추에이터(스티어링 액추에이터, 액셀 페달 액추에이터, 브레이크 액추에이터 등)를 제어하여 자동 운전 제어 또는 운전 지원 제어(예를 들어, 자동 브레이크)를 실행한다.

다음에, 도 2 내지 도 5를 참조하여, 진로 예측 방법의 일례에 대해 설명한다.

도 2에 도시된 바와 같이, 자기 차량(50)은, 2차선 도로의 우측을 주행하고 있고, 다음 교차점을 우회전할 예정이다. 또한, 다른 차량(51)은, 2차선 도로의 우측을 주행하고 있고, 다음 교차점을 우회전할 예정이다. 또, 의도 예측부(12)는, 다른 차량(51)의 위치, 방향, 자세, 방향 지시등의 점등 유무 등에 기초하여, 다른 차량(51)이 다음 교차점을 우회전할 예정인지 여부를 예측할 수 있다. 또한, 다른 차량(51)은, 자기 차량(50)과 동일한 도로를 자기 차량(50)이 주행하는 방향과 반대 방향으로 주행하는 대향 차량이다. 다른 차량(52)은, 다른 차량(51)의 후방을 주행하고 있다. 도 2에 나타내는 R은, 다른 차량(51)에 의해 형성되는, 자기 차량(50)의 사각 영역을 나타낸다. 사각 영역(R)은 사각 영역 산출부(13)에 의해 산출된다. 구체적으로는, 사각 영역 산출부(13)는, 물체 검출 장치(1)에 의해 검출된 다른 차량(51)의 위치에 기초하여 사각 영역(R)을 산출한다. 다른 차량(51) 및 다른 차량(52)은, 자기 차량(50)의 전방에 위치하고, 물체 검출 장치(1)에 의해 검출된다. 또한, 도 2에 도시된 주행 장면에서, 다른 차량(52)은 사각 영역(R)에 진입하지 않기 때문에, 물체 검출 장치(1)는 다른 차량(52)을 검출할 수 있다. 다른 차량(52)의 화살표로 나타내는 바와 같이, 다른 차량(52)의 진로로서 2가지 진로를 생각할 수 있다. 하나의 진로는, 다른 차량(52)이 그대로 직진하여, 다른 차량(51)에 추종하는 진로이다. 다른 하나의 진로는, 다른 차량(52)이 차선 변경하는 진로이다. 본 실시형태에서, 다른 차량(52)이 사각 영역(R)에 진입하였다는 것은, 물체 검출 장치(1)가 다른 차량(52)을 검출할 수 없게 되었다는 것을 의미한다.

다른 차량(52)이 차선 변경한 경우, 다른 차량(52)의 진로와 자기 차량(50)의 진로가 교차할 가능성이 있다. 이 경우, 다른 차량(52)이 우선이기 때문에, 자기 차량(50)은 감속 또는 정지를 행하게 된다. 한편, 다른 차량(52)이 그대로 직진하여, 다른 차량(51)에 추종하는 경우, 다른 차량(52)의 진로와 자기 차량(50)의 진로는 교차하지 않는다. 다른 차량(52)도 교차점을 우회전하기 때문이다. 이 경우, 자기 차량(50)은 감속 또는 정지를 행하지 않고 교차점을 통과할 수 있다. 따라서, 도 2에 도시된 주행 장면에서, 다른 차량(52)의 진로를 조기에 예측하는 것이 요구된다.

그래서 본 실시형태에서, 진입 타이밍 추측부(14)는, 다른 차량(52)이 검출된 후에 다른 차량(52)이 직진한 경우의, 다른 차량(52)이 검출되었을 때부터 다른 차량(52)이 사각 영역(R)에 진입하기까지의 시간인 검출 가능 시간을 추측한다. 이 검출 가능 시간은, 다른 차량(52)이 검출된 후에 다른 차량(52)이 직진한다는 가정 조건, 바꾸어 말하면 다른 차량(52)이 검출된 후에 다른 차량(52)의 거동은 변화하지 않는다는 가정 조건에서 추측되는 것이다.

도 3에 도시된 주행 장면은, 도 2에 도시된 주행 장면으로부터 검출 가능 시간(T1)이 경과한 후의 주행 장면이다. 사각 영역(R)은, 자기 차량(50) 및 다른 차량(51)의 위치, 속도 등에 따라 시시각각 변화한다. 그래서, 다른 차량(52)이 검출된 후에 다른 차량(52)이 직진한다는 가정 조건에서, 진입 타이밍 추측부(14)는, 자기 차량(50), 다른 차량(51) 및 다른 차량(52)의 속도, 위치 관계 등을 이용하여, 다른 차량(52)이 검출되었을 때부터 다른 차량(52)이 사각 영역(R)에 진입하기까지의 검출 가능 시간(T1)을 추측한다. 즉, 검출 가능 시간(T1)이 경과한 후에 다른 차량(52)이 검출되지 않게 되었다는 것은, 다른 차량(52)은 직진하였을 가능성이 높은 것을 의미한다. 따라서, 검출 가능 시간(T1)이 경과한 후에 다른 차량(52)이 검출되지 않게 된 경우, 즉 실제 검출 가능 시간이 추측된 검출 가능 시간(T1) 이상인 경우, 진로 예측부(17)는, 다른 차량(52)은 직진하였다고 예측한다.

도 4에 도시된 주행 장면은, 도 2에 도시된 주행 장면으로부터 검출 가능 시간(T1)이 경과하기 전의 주행 장면이다. 검출 가능 시간(T1)이 경과하기 전에 다른 차량(52)이 사각 영역(R)에 진입하였다는 것은, 다른 차량(52)이 차선 변경하였을 가능성이 높은 것을 의미한다. 이유는, 도 2에 도시된 주행 장면에서 다른 차량(52)이 직진하였다면, 검출 가능 시간(T1)이 경과하기까지는, 물체 검출 장치(1)는 다른 차량(52)을 검출 가능하기 때문이다. 그럼에도 불구하고, 검출 가능 시간(T1)이 경과하기 전에 물체 검출 장치(1)가 다른 차량(52)을 검출할 수 없게 된, 즉 다른 차량(52)이 사각 영역(R)에 진입하였다는 것은, 다른 차량(52)이 차선 변경하였을 가능성이 높은 것을 의미한다. 따라서, 검출 가능 시간(T1)이 경과하기 전에 다른 차량(52)이 사각 영역(R)에 진입한 경우, 즉 실제 검출 가능 시간이 추측된 검출 가능 시간(T1) 미만인 경우, 진로 예측부(17)는, 다른 차량(52)은 차선 변경하였다고 예측한다. 또, 검출 가능 시간(T1)이 경과하기 전에 다른 차량(52)이 사각 영역(R)에 진입하였는지 여부에 대해서는, 진입 판정부(15)가 판단한다.

또, 진로 예측부(17)는, 다른 차량(52)의 진로를 예측한다고 설명하였지만, 이에 한정되지 않는다. 예를 들어, 도 5의 그래프 A에 도시된 바와 같이, 검출 가능 시간(T1)이 경과하기 전에 다른 차량(52)이 사각 영역(R)에 진입한 경우, 진로 예측부(17)는, 다른 차량(52)이 차선 변경하였을 가능성이 높다고 판정할 수 있다. 또한, 도 5의 그래프 B에 도시된 바와 같이, 검출 가능 시간(T1)이 경과한 후에 다른 차량(52)이 검출되지 않게 된 경우, 진로 예측부(17)는, 다른 차량(52)이 차선 변경하였을 가능성이 낮다고 판정할 수 있다. 다른 차량(52)이 차선 변경하였을 가능성이 낮다는 것은, 다른 차량(52)은 직진하였을 가능성이 높은 것을 의미한다.

다른 차량(51)은, 보통 자동차일 수도 되고, 트럭, 버스 등일 수 있다. 또한, 다른 차량(52)은 차량으로서 설명하였지만, 차량에 한정되지 않는다. 다른 차량(52)은, 다른 차량(51)의 후방을 주행 가능한 이동 물체이면 되고, 예를 들어 오토바이, 자전거일 수 있다.

또한, 상술한 예에서는, 진입 판정부(15)가, 다른 차량(52)이 직진하였을 경우를 가정한 검출 가능 시간(T1)과 실제 검출 가능 시간을 비교한다. 그리고, 진로 예측부(17)는, 실제 검출 가능 시간이 추측된 검출 가능 시간(T1) 이상인 경우에는 다른 차량(52)은 직진하였다고 예측하고, 실제 검출 가능 시간이 추측된 검출 가능 시간(T1) 미만인 경우에는 다른 차량(52)은 차선 변경하였다고 예측한다. 다만, 이에 한정되지 않는다. 즉, 검출 가능 시간(T1)은, 다른 차량(52)이 미리 정해진 소정의 진로에서 진행한 경우의 검출 가능 시간일 수 있다. 이 경우, 진입 판정부(15)가, 검출 가능 시간(T1)과 실제 검출 가능 시간을 비교함으로써, 진로 예측부(17)는 다른 차량(52)이 미리 정해진 진로에서 진행하였는지 여부를 예측하는 것이 가능하다. 예를 들어, 검출 가능 시간(T1)이, 다른 차량(52)이 직진이 아니라 차선 변경한 경우를 가정한 시간인 경우, 진로 예측부(17)는, 실제 검출 가능 시간이 검출 가능 시간(T1)보다 큰 경우에 다른 차량(52)은 직진하였다고 예측할 수 있으며, 실제 검출 가능 시간이 검출 가능 시간(T1) 이하인 경우에 다른 차량(52)은 차선 변경하였다고 예측할 수 있다. 다만, 검출 가능 시간(T1)을 보다 정확하게 추측하기 위해서는, 상술한 바와 같이 검출 가능 시간(T1)은 다른 차량(52)이 직진한 경우를 예상한 시간인 것이 바람직하다.

도 2 내지 도 4에서는, 직진 도로에 대해 설명하였지만, 본 발명이 적용되는 것은 직진 도로에 한정되지 않는다. 본 발명은 커브(도 6 내지 도 8)에서도 적용된다. 도 6에 도시된 커브에서도 다른 차량(52)의 화살표로 나타내는 바와 같이, 다른 차량(52)의 진로로서 2가지 진로를 생각할 수 있다. 도 7에 도시된 바와 같이, 검출 가능 시간(T1)이 경과한 후에 다른 차량(52)이 검출되지 않게 된 경우, 진로 예측부(17)는, 다른 차량(52)은 직진하였다고 예측한다. 또한, 도 8에 도시된 바와 같이, 검출 가능 시간(T1)이 경과하기 전에 다른 차량(52)이 사각 영역(R)에 진입한 경우, 진로 예측부(17)는, 다른 차량(52)은 직진하였다고 예측한다. 또, 도 6 내지 도 8에서, 다른 차량(51)이 정지하고 있는 이유는, 보행자(60)의 통과를 기다리고 있기 때문이다.

다음에, 도 9 내지 도 11을 참조하여, 진로 예측 방법의 다른 예에 대해 설명한다.

도 9에 도시된 바와 같이, 자기 차량(50)은, 1차선 도로를 주행하고 있고, 다음 교차점을 우회전할 예정이다. 또한, 다른 차량(51)은, 1차선 도로를 주행하고 있고, 다음 교차점을 우회전할 예정이다. 다른 차량(52)은, 다른 차량(51)의 후방을 주행하고 있다. 도 9에 도시된 주행 장면에서, 다른 차량(52)은 사각 영역(R)에 진입하지 않기 때문에, 물체 검출 장치(1)는 다른 차량(52)을 검출할 수 있다. 다른 차량(52)의 전방 좌측에는, 진입 가능한 측도(70)가 있다. 다른 차량(52)의 화살표로 나타내는 바와 같이, 다른 차량(52)의 진로로서 2가지 진로를 생각할 수 있다. 하나의 진로는, 다른 차량(52)이 그대로 직진하여, 다른 차량(51)에 추종하는 진로이다. 다른 하나의 진로는, 다른 차량(52)이 좌회전하여 측도(70)에 진입하는 진로이다.

도 10에 도시된 주행 장면은, 도 9에 도시된 주행 장면으로부터 검출 가능 시간(T1)이 경과한 후의 주행 장면이다. 도 10에 도시된 바와 같이, 검출 가능 시간(T1)이 경과한 후에 다른 차량(52)이 검출되지 않게 된 경우, 진로 예측부(17)는, 다른 차량(52)은 직진하였다고 예측한다.

도 11에 도시된 주행 장면은, 도 9에 도시된 주행 장면으로부터 검출 가능 시간(T1)이 경과하기 전의 주행 장면이다. 검출 가능 시간(T1)이 경과하기 전에 다른 차량(52)이 사각 영역(R)에 진입하였다는 것은, 다른 차량(52)이 좌회전하였을 가능성이 높은 것을 의미한다. 따라서, 검출 가능 시간(T1)이 경과하기 전에 다른 차량(52)이 사각 영역(R)에 진입한 경우, 진로 예측부(17)는, 다른 차량(52)은 좌회전하였다고 예측한다.

또, 도 9 내지 도 11에서, 다른 차량(52)이 좌회전 가능한 장소로서 측도(70)를 들어 설명하였지만, 다른 차량(52)이 좌회전 가능한 장소는 측도(70)에 한정되지 않는다. 다른 차량(52)이 좌회전 가능한 장소는, 주차장, 주유소, 편의점 등을 포함한다.

다음에, 도 12 내지 도 14를 참조하여, 진로 예측 방법의 다른 예에 대해 설명한다.

도 12에 도시된 바와 같이, 자기 차량(50)은, 1차선 도로를 주행하고 있고, 다음 교차점을 직진할 예정이다. 또한, 다른 차량(52)은, 1차선 도로를 주행하고 있다. 도 12에 나타내는 R은, 건물(80)에 의해 형성되는, 자기 차량(50)의 사각 영역을 나타낸다. 다른 차량(52) 및 건물(80)은, 자기 차량(50)의 측방(전측방)에 위치하고, 물체 검출 장치(1)에 의해 검출된다.

도 12에 도시된 주행 장면에서, 다른 차량(52)은 사각 영역(R)에 진입하지 않기 때문에, 물체 검출 장치(1)는 다른 차량(52)을 검출할 수 있다. 다른 차량(52)의 전방 우측에는, 진입 가능한 주차장(90)이 있다. 다른 차량(52)의 화살표로 나타내는 바와 같이, 다른 차량(52)의 진로로서 2가지 진로를 생각할 수 있다. 하나의 진로는, 다른 차량(52)이 그대로 직진하는 진로이다. 다른 하나의 진로는, 다른 차량(52)이 우회전하여 주차장(90)에 진입하는 진로이다.

도 13에 도시된 주행 장면은, 도 12에 도시된 주행 장면으로부터 검출 가능 시간(T1)이 경과한 후의 주행 장면이다. 도 13에 도시된 바와 같이, 검출 가능 시간(T1)이 경과한 후에 다른 차량(52)이 검출되지 않게 된 경우, 진로 예측부(17)는, 다른 차량(52)은 직진하였다고 예측한다.

도 14에 도시된 주행 장면은, 도 12에 도시된 주행 장면으로부터 검출 가능 시간(T1)이 경과하기 전의 주행 장면이다. 검출 가능 시간(T1)이 경과하기 전에 다른 차량(52)이 사각 영역(R)에 진입하였다는 것은, 다른 차량(52)이 우회전하였을 가능성이 높은 것을 의미한다. 따라서, 검출 가능 시간(T1)이 경과하기 전에 다른 차량(52)이 사각 영역(R)에 진입한 경우, 진로 예측부(17)는, 다른 차량(52)은 우회전하였다고 예측한다.

다음에, 도 15a 및 도 15b의 흐름도를 참조하여, 차량 거동 예측 장치의 일 동작예를 설명한다.

단계 S101에서, 물체 검출 장치(1)는, 복수의 물체 검출 센서를 이용하여, 자기 차량(50)의 전방의 물체(다른 차량(51))를 검출한다. 또한, 물체 검출 장치(1)는, 자기 차량(50)에서 보아 다른 차량(51)보다 먼 곳을 주행하는 이동 물체(다른 차량(52))를 검출한다. 처리는 단계 S103으로 진행되고, 검출 통합부(4)는, 복수의 물체 검출 센서 각각으로부터 얻어진 복수의 검출 결과를 통합하여, 각 다른 차량에 대해 하나의 검출 결과를 출력한다. 그리고, 물체 추적부(5)가, 검출 및 통합된 각 다른 차량을 추적한다.

처리는 단계 S105로 진행되고, 자기 차량 위치 추정 장치(2)는, 위치 검출 센서를 이용하여, 자기 차량(50)의 절대 위치를 계측한다. 처리는 단계 S107로 진행되고, 지도 취득 장치(3)는, 자기 차량(50)이 주행하는 도로의 구조를 나타내는 지도 정보를 취득한다. 처리는 단계 S109로 진행되고, 지도 내 위치 연산부(6)는, 단계 S105에서 계측된 자기 차량(50)의 절대 위치 및 단계 S107에서 취득된 지도 데이터로부터, 지도상에서의 자기 차량(50)의 위치를 추정한다.

처리는 단계 S111로 진행되고, 의도 예측부(12)는, 다른 차량(51) 및 다른 차량(52)의 거동(진로)을 예측한다. 도 2에 도시된 예에서는, 의도 예측부(12)는, 다른 차량(51)의 위치, 방향, 자세, 방향 지시등의 점등 유무 등에 기초하여, 다른 차량(51)이 다음 교차점을 우회전할 예정이라고 예측한다.

처리는 단계 S113으로 진행되고, 사각 영역 산출부(13)는, 물체 검출 장치(1)에 의해 검출된 다른 차량(51)의 위치에 기초하여, 다른 차량(51)에 의해 형성되는, 자기 차량(50)의 사각 영역(R)을 산출한다. 처리는 단계 S115로 진행되고, 진입 타이밍 추측부(14)는, 다른 차량(52)이 검출된 후에 다른 차량(52)이 직진한 경우의, 다른 차량(52)이 검출되었을 때부터 다른 차량(52)이 사각 영역(R)에 진입하기까지의 시간인 검출 가능 시간(T1)을 추측한다.

처리는 단계 S119로 진행되고, 진입 판정부(15)는, 검출 가능 시간(T1)이 경과하기 전에 다른 차량(52)이 사각 영역(R)에 진입하였는지 여부를 판정한다. 검출 가능 시간(T1)이 경과하기 전에 다른 차량(52)이 사각 영역(R)에 진입한 경우(단계 S119에서 Yes), 처리는 단계 S121, 단계 S125로 진행된다.

단계 S121에서, 물체 검출 장치(1)는, 다른 차량(52)이 사각 영역(R)에 진입하기 직전에서의 다른 차량(52)과 자기 차량(50)의 거리를 취득한다. 처리는 단계 S123으로 진행되고, 진로 예측부(17)는, 단계 S121에서 취득된 거리에 기초하여 다른 차량(52)의 거동이 변화하였을 가능성을 변경한다. 본 실시형태에서, 이동 물체의 거동의 변화란, 이동 물체의 차선 변경, 좌회전, 우회전 중 어느 하나를 의미한다. 예를 들어, 도 4에 도시된 예에서, 다른 차량(52)과 자기 차량(50)의 거리(도시생략)가 짧을수록, 진로 예측부(17)는, 다른 차량(52)이 차선 변경하였을 가능성을 증가시킨다. 센서의 오차는, 자기 차량(50)으로부터의 거리가 짧을수록 작기 때문이다.

단계 S125에서, 궤도 취득부(16)는, 다른 차량(52)이 검출되었을 때부터 다른 차량(52)이 사각 영역(R)에 진입하기 직전까지의, 다른 차량(52)의 궤도(다른 차량(52)의 차선상 위치)를 취득한다. 처리는 단계 S127로 진행되고, 진로 예측부(17)는, 단계 S125에서 취득된 궤도에 기초하여 다른 차량(52)의 거동이 변화하였을 가능성을 증가시킨다. 예를 들어, 도 4에 도시된 예에서, 다른 차량(52)이 검출되었을 때부터 다른 차량(52)이 사각 영역(R)에 진입하기 직전까지의, 다른 차량(52)의 궤도가 직진을 나타내는 궤도와 다른 경우, 진로 예측부(17)는, 다른 차량(52)이 차선 변경하였을 가능성을 증가시킨다. 또한, 도 11에 도시된 예에서, 다른 차량(52)이 검출되었을 때부터 다른 차량(52)이 측도(70)에 진입하기까지의, 다른 차량(52)의 궤도가 직진을 나타내는 궤도와 다른 경우, 진로 예측부(17)는, 다른 차량(52)은 좌회전하였을 가능성을 증가시킨다. 또, 진로 예측부(17)는, 단계 S121, 123, 125, 127에 관한 처리를 행하지 않고, 다른 차량(52)의 진로를 예측할 수 있다. 바꾸어 말하면, 검출 가능 시간(T1)이 경과하기 전에 다른 차량(52)이 사각 영역(R)에 진입한 것에만 기초하여, 진로 예측부(17)는 다른 차량(52)이 차선 변경하였거나 좌회전하였거나 혹은 우회전하였다고 예측할 수 있다. 또, 도 11에 도시된 예에서, 다른 차량(52)이 검출되었을 때부터 다른 차량(52)이 사각 영역(R)에 진입하기 직전까지의, 다른 차량(52)의 궤도가 주행 차선의 좌측(갓길측)을 주행하는 궤도를 나타내는 경우, 진로 예측부(17)는, 다른 차량(52)이 좌회전하였을 가능성을 증가시키고, 다른 차량(52)은 좌회전하였다고 예측할 수 있다.

한편, 검출 가능 시간(T1)이 경과한 후에 다른 차량(52)이 사각 영역(R)에 진입한 경우(단계 S119에서 No), 처리는 단계 S129로 진행된다. 단계 S129에서, 진로 예측부(17)는, 다른 차량(52)이 검출되었을 때부터 다른 차량(52)이 사각 영역(R)에 진입하기 직전까지의, 다른 차량(52)의 궤도를 취득한다. 다른 차량(52)의 궤도가 직진을 나타내는 경우, 진로 예측부(17)는, 다른 차량(52)이 직진하였을 가능성을 증가시키고, 다른 차량(52)은 직진하였다고 예측한다(단계 S137). 한편, 다른 차량(52)의 궤도가 취득되지 않는 경우(단계 S129에서 No), 처리는 단계 S131로 진행되고, 진로 예측부(17)는, 다른 차량(52)이 사각 영역(R)에 진입하기 직전의 다른 차량(52)의 속도 변화를 취득한다. 처리는 단계 S133으로 진행되고, 진로 예측부(17)는, 단계 S131에서 취득된 속도 변화에 기초하여 다른 차량(52)이 직진하였을 가능성을 증가시킨다. 또, 진로 예측부(17)는, 단계 S129, 131, 133에 관한 처리를 행하지 않고, 다른 차량(52)의 진로를 예측할 수 있다. 바꾸어 말하면, 검출 가능 시간(T1)이 경과한 후에 다른 차량(52)이 사각 영역(R)에 진입한 것에만 기초하여, 진로 예측부(17)는 다른 차량(52)이 직진하였다고 예측할 수 있다.

또, 차량 거동 예측 장치는, 예측한 다른 차량(52)의 진로에 기초하여 자기 차량을 제어할 수 있다. 이 점에 대해 도 16을 참조하여 설명한다.

단계 S201에서, 차량 제어부(30)는, 진로 예측부(17)에 의해 예측된 다른 차량(52)의 진로를 취득한다. 처리는 단계 S203으로 진행되고, 차량 제어부(30)는, 미리 설정된 자기 차량(50)의 진로를 취득한다.

처리는 단계 S205로 진행되고, 차량 제어부(30)는, 다른 차량(52)의 진로가 자기 차량(50)의 진로와 교차하는지 여부를 판정한다. 다른 차량(52)의 진로가 자기 차량(50)의 진로와 교차하는 경우(단계 S205에서 Yes), 처리는 단계 S207로 진행되고, 차량 제어부(30)는, 다른 차량(52)이 주행하는 도로가 우선 도로인지 여부를 판정한다. 우선 도로의 판단은, 도로 구조, 도로표지, 교통규칙 등에 기초하여 행해진다. 다른 차량(52)이 주행하는 도로가 우선 도로인 경우(단계 S207에서 Yes), 처리는 단계 S209로 진행되고, 차량 제어부(30)는, 자기 차량(50)을 감속 또는 정지시키기 위한 속도 프로파일을 산출한다. 속도 프로파일이란, 자기 차량(50)의 속도를 시간의 함수로서 나타내는 것이다. 도 4에 도시된 예에서는, 다른 차량(52)의 진로가 자기 차량(50)의 진로와 교차하고, 또한 다른 차량(52)이 주행하는 도로가 우선 도로이다. 이 경우, 차량 제어부(30)는 다른 차량(52)의 통과를 기다리기 위해, 자기 차량(50)을 감속 또는 정지시키기 위한 속도 프로파일을 산출한다. 처리는 단계 S217로 진행되고, 차량 제어부(30)는 속도 프로파일에 기초하여 브레이크 액추에이터 등을 제어하여 자동 운전 제어를 실행한다. 이에 의해, 급감속은 억제된다.

다른 차량(52)의 진로가 자기 차량(50)의 진로와 교차하지 않는 경우(단계 S205에서 No), 처리는 단계 S211로 진행되고, 차량 제어부(30)는, 다른 차량(52)의 진로의 가능성의 높음에 따라 속도 프로파일을 산출한다. 도 3에 도시된 바와 같이, 다른 차량(52)은 직진하였을 가능성이 높은 경우, 차량 제어부(30)는 일정한 속도를 나타내는 속도 프로파일을 산출한다. 처리는 단계 S217로 진행되고, 차량 제어부(30)는 속도 프로파일에 기초하여 자동 운전 제어를 실행한다. 이에 의해, 원활한 자동 운전이 실현된다.

다른 차량(52)이 주행하는 도로가 우선 도로가 아닌 경우(단계 S207에서 No), 즉 자기 차량(50)이 주행하는 도로가 우선 도로인 경우, 처리는 단계 S215로 진행된다. 단계 S215에서, 차량 제어부(30)는 일정한 속도를 나타내는 속도 프로파일을 산출한다. 처리는 단계 S217로 진행되고, 차량 제어부(30)는 속도 프로파일에 기초하여 자동 운전 제어를 실행한다. 이에 의해, 원활한 자동 운전이 실현된다.

이상 설명한 바와 같이, 본 실시형태에 관한 차량 거동 예측 장치에 의하면, 이하의 작용 효과를 얻을 수 있다.

물체 검출 장치(1)는, 자기 차량(50)의 전방 또는 측방의 물체(다른 차량(51) 또는 건물(80))를 검출한다. 또한, 물체 검출 장치(1)는, 자기 차량(50)의 전방 또는 측방의 물체의 자기 차량(50)에 대한 위치를 검출한다. 또한, 물체 검출 장치(1)는, 자기 차량(50)에서 보아 물체보다 먼 곳을 주행하는 이동 물체(다른 차량(52))를 검출한다. 사각 영역 산출부(13)는, 물체 검출 장치(1)에 의해 검출된 물체의 위치에 기초하여, 물체에 의해 형성되는, 자기 차량(50)의 사각 영역(R)을 산출한다. 진입 타이밍 추측부(14)는, 이동 물체를 검출한 후에 이동 물체가 직진한 경우의, 이동 물체를 검출하였을 때부터 이동 물체가 사각 영역(R)에 진입하기까지의 시간인 검출 가능 시간(T1)을 추측한다. 진입 판정부(15)는, 검출 가능 시간(T1)이 경과하기 전에 이동 물체가 사각 영역(R)에 진입하였는지 여부를 판정한다. 차량 제어부(30)는, 판정한 결과에 기초하여, 이동 물체의 진로를 예측한다. 도 4에 도시된 예에서는, 검출 가능 시간(T1)이 경과하기 전에 다른 차량(52)(이동 물체)이 사각 영역(R)에 진입한 경우, 진로 예측부(17)는, 다른 차량(52)은 차선 변경하였다고 예측한다. 따라서, 본 실시형태에 관한 차량 거동 예측 장치는, 이동 물체의 진로를 조기에 예측할 수 있다. 또, 상술한 바와 같이, 자기 차량(50)의 전방 또는 측방의 물체는, 이동 물체(다른 차량(51))일 수 있고, 정지 물체(건물(80))일 수도 있다. 또한, 다른 차량(51)은, 자기 차량(50)과 동일한 도로를 자기 차량(50)이 주행하는 방향과 반대 방향으로 주행하는 대향 차량이다. 또한, 정지 물체는 건물(80)에 한정되지 않는다. 정지 물체는 주차 차량을 포함한다. 또한, 검출 가능 시간(T1)은, 다른 차량(52)이 검출된 후에 다른 차량(52)이 미리 정해진 진로에서 진행한 경우의, 다른 차량(52)이 검출되었을 때부터 다른 차량(52)이 사각 영역(R)에 진입하기까지의 시간일 수 있다. 미리 정해진 진로란, 직진과 차선 변경을 포함한다. 물체 검출 장치(1)는, 추측한 검출 가능 시간(T1)과, 다른 차량(52)이 검출되었을 때부터 다른 차량(52)이 실제로 사각 영역(R)에 진입하기까지의 시간인 실제 검출 가능 시간을 비교하고, 비교한 결과에 기초하여, 다른 차량(52)의 진로를 예측할 수 있다.

이동 물체가 주행하는 도로가 복수의 차선으로 구성되고, 자기 차량(50)이 이동 물체를 검출하였을 때에 이동 물체가 복수의 차선 중, 자기 차량(50)에서 보아 가장 먼 차선 이외를 주행하고 있는 경우에서, 진입 판정부(15)가, 검출 가능 시간(T1)이 경과하기 전에 이동 물체가 사각 영역(R)에 진입하였다고 판정한 경우, 진로 예측부(17)는 이동 물체가 차선 변경하였다고 예측한다. 도 2에 도시된 예에서는, 다른 차량(52)(이동 물체)이 주행하는 도로가 복수의 차선(2차선)으로 구성되고, 자기 차량(50)이 다른 차량(52)을 검출하였을 때에 다른 차량(52)이 복수의 차선 중, 자기 차량(50)에서 보아 가장 먼 차선 이외를 주행하고 있다. 도 2에서, 다른 차량(52)이 주행하는 차선 중, 자기 차량(50)에서 보아 가장 먼 차선이란 좌측 차선이다. 도 2에서, 다른 차량(52)은 우측 차선을 주행하고 있다. 그리고, 도 4에 도시된 바와 같이, 검출 가능 시간(T1)이 경과하기 전에 다른 차량(52)이 사각 영역(R)에 진입한 경우, 진로 예측부(17)는, 다른 차량(52)은 차선 변경하였다고 예측한다. 따라서, 본 실시형태에 관한 차량 거동 예측 장치는, 이동 물체의 진로를 조기에 예측할 수 있다.

이동 물체가 주행하는 도로의 좌측으로 진입 가능한 장소가 존재하는 경우에서, 진입 판정부(15)가, 검출 가능 시간(T1)이 경과하기 전에 이동 물체가 사각 영역(R)에 진입하였다고 판정한 경우, 진로 예측부(17)는 이동 물체가 좌회전하였다고 예측한다. 도 9에 도시된 예에서는, 다른 차량(52)(이동 물체)이 주행하는 도로의 좌측으로 진입 가능한 장소(측도(70))가 존재한다. 그리고, 도 11에 도시된 바와 같이, 검출 가능 시간(T1)이 경과하기 전에 다른 차량(52)이 사각 영역(R)에 진입한 경우, 진로 예측부(17)는, 다른 차량(52)은 좌회전하였다고 예측한다. 따라서, 본 실시형태에 관한 차량 거동 예측 장치는, 이동 물체의 진로를 조기에 예측할 수 있다.

이동 물체가 주행하는 도로의 우측으로 진입 가능한 장소가 존재하는 경우에서, 진입 판정부(15)가, 검출 가능 시간(T1)이 경과하기 전에 이동 물체가 사각 영역(R)에 진입하였다고 판정한 경우, 진로 예측부(17)는 이동 물체가 우회전하였다고 예측한다. 도 12에 도시된 예에서는, 다른 차량(52)(이동 물체)이 주행하는 도로의 우측으로 진입 가능한 장소(주차장(90))가 존재한다. 그리고, 도 14에 도시된 바와 같이, 검출 가능 시간(T1)이 경과하기 전에 다른 차량(52)이 사각 영역(R)에 진입한 경우, 진로 예측부(17)는, 다른 차량(52)은 우회전하였다고 예측한다. 따라서, 본 실시형태에 관한 차량 거동 예측 장치는, 이동 물체의 진로를 조기에 예측할 수 있다.

진입 판정부(15)가, 검출 가능 시간(T1)이 경과하기 전에 이동 물체가 사각 영역(R)에 진입하였다고 판정한 경우, 진로 예측부(17)는 이동 물체와 자기 차량(50)의 거리가 짧을수록, 이동 물체의 거동이 변화하였을 가능성을 증가시킨다. 본 실시형태에서, 이동 물체의 거동의 변화란, 이동 물체의 차선 변경, 좌회전, 우회전 중 어느 하나를 의미한다. 즉, 진로 예측부(17)는 이동 물체와 자기 차량(50)의 거리가 짧을수록, 이동 물체는 차선 변경하였을 가능성, 또는 좌회전하였을 가능성, 또는 우회전하였을 가능성을 증가시킨다. 센서의 오차는, 자기 차량(50)으로부터의 거리가 짧을수록 작기 때문에, 상술한 바와 같이, 진로 예측부(17)는 가능성을 증가시킴으로써, 정밀도 높게 이동 물체의 진로를 예측할 수 있다.

진입 판정부(15)가, 검출 가능 시간(T1)이 경과하기 전에 이동 물체가 사각 영역(R)에 진입하였다고 판정한 경우, 진로 예측부(17)는 이동 물체가 검출되었을 때부터 이동 물체가 사각 영역(R)에 진입하기 직전까지의, 이동 물체의 궤도에 기초하여 이동 물체의 거동이 변화하였을 가능성을 증가시킨다. 도 4에 도시된 예에서, 다른 차량(52)(이동 물체)이 검출되었을 때부터 다른 차량(52)이 사각 영역(R)에 진입하기 직전까지의, 다른 차량(52)의 궤도가 직진을 나타내는 궤도와 다른 경우, 진로 예측부(17)는, 다른 차량(52)이 차선 변경하였을 가능성을 증가시킨다. 이와 같이, 진로 예측부(17)는 이동 물체의 궤도에 기초하여 이동 물체의 거동이 변화하였을 가능성을 증가시킴으로써, 정밀도 높게 이동 물체의 진로를 예측할 수 있다.

진입 판정부(15)가, 검출 가능 시간(T1)이 경과한 후에 이동 물체가 사각 영역(R)에 진입하였다고 판정한 경우, 진로 예측부(17)는 이동 물체가 직진하였다고 예측한다. 이에 의해, 도 3에 도시된 바와 같이, 자기 차량(50)은 다른 차량(52)(이동 물체)을 기다리지 않고 교차점을 통과할 수 있다. 즉, 자기 차량(50)의 원활한 주행에 기여한다.

진입 판정부(15)가, 검출 가능 시간(T1)이 경과한 후에 이동 물체가 사각 영역(R)에 진입하였다고 판정한 경우, 진로 예측부(17)는 이동 물체와 자기 차량(50)의 거리가 짧을수록, 이동 물체가 직진하였을 가능성을 증가시킬 수 있다. 또한, 이동 물체가 검출되었을 때부터 이동 물체가 사각 영역(R)에 진입하기 직전까지의, 이동 물체의 궤도가 직진을 나타내는 경우, 진로 예측부(17)는 다른 차량(52)이 직진하였을 가능성을 증가시킬 수도 있다. 진로 예측부(17)는 가능성을 증가시킴으로써, 정밀도 높게 이동 물체의 진로를 예측할 수 있다.

차량 제어부(30)는, 진로 예측부(17)에 의해 예측된 다른 차량(52)의 진로에 기초하여, 자기 차량(50)의 속도 프로파일을 산출한다. 그리고, 차량 제어부(30)는, 산출한 속도 프로파일에 기초하여 자기 차량(50)을 제어한다. 이에 의해, 급감속의 억제 또는 원활한 자동 운전이 실현될 수 있다. 예를 들어, 도 4에 도시된 바와 같이, 다른 차량(52)의 진로가 자기 차량(50)의 진로와 교차하고, 또한 다른 차량(52)이 주행하는 도로가 우선 도로인 경우, 차량 제어부(30)는 다른 차량(52)의 통과를 기다리기 위해, 자기 차량(50)을 감속 또는 정지시키기 위한 속도 프로파일을 산출한다. 차량 제어부(30)는 속도 프로파일에 기초하여 브레이크 액추에이터 등을 제어하여 자동 운전 제어를 실행한다. 이에 의해, 급감속은 억제된다.

또한, 이동 물체의 진로가 자기 차량(50)의 진로와 교차하고, 또한 자기 차량(50)이 주행하는 도로가 우선 도로인 경우, 차량 제어부(30)는, 일정한 속도를 나타내는 속도 프로파일을 산출하고, 이 속도 프로파일에 기초하여 자기 차량(50)을 제어할 수도 있다. 또한, 이동 물체의 진로가 자기 차량(50)의 진로와 교차하지 않는 경우, 차량 제어부(30)는, 일정한 속도를 나타내는 속도 프로파일을 산출하고, 이 속도 프로파일에 기초하여 자기 차량(50)을 제어할 수도 있다. 이에 의해, 원활한 자동 운전이 실현된다.

상술한 실시형태에 기재되는 각 기능은, 하나 또는 복수의 처리 회로에 의해 실장될 수 있다. 처리 회로는, 전기 회로를 포함한 처리 장치 등의 프로그램된 처리 장치를 포함한다. 처리 회로는, 또한, 기재된 기능을 실행하도록 배열된 특정 용도용 집적 회로(ASIC)나 회로 부품 등의 장치를 포함한다. 또한, 차량 거동 예측 장치는, 컴퓨터의 기능을 개선할 수 있다.

상기와 같이, 본 발명의 실시형태를 기재하였지만, 이 개시의 일부를 이루는 논술 및 도면은 이 발명을 한정하는 것이라고 이해해서는 안 된다. 이 개시로부터 당업자에게는 다양한 대체 실시형태, 실시예 및 운용 기술이 명백해질 것이다.

1 물체 검출 장치
2 자기 차량 위치 추정 장치
3 지도 취득 장치
4 검출 통합부
5 물체 추적부
6 지도 내 위치 연산부
10 거동 예측부
11 차선 판정부
12 의도 예측부
13 사각 영역 산출부
14 진입 타이밍 추측부
15 진입 판정부
16 궤도 취득부
17 진로 예측부
30 차량 제어부

Claims (17)

1. 자기 차량에 탑재된 센서를 이용하여 상기 자기 차량의 전방 또는 측방의 물체의 상기 자기 차량에 대한 위치를 검출하고,
   상기 센서를 이용하여 상기 자기 차량에서 보아 상기 물체보다 먼 곳을 주행하는 이동 물체를 검출하며,
   상기 위치에 기초하여, 상기 물체에 의해 형성되는, 상기 센서가 검출할 수 없는 상기 자기 차량의 사각 영역을 산출하고,
   상기 이동 물체를 검출한 후에 상기 이동 물체가 미리 정해진 진로에서 진행한 경우의, 상기 이동 물체를 검출하였을 때부터 상기 이동 물체가 상기 사각 영역에 진입하기까지의 시간인 검출 가능 시간을 추측하며,
   추측한 상기 검출 가능 시간과, 상기 이동 물체를 검출하였을 때부터 상기 이동 물체가 실제로 상기 사각 영역에 진입하기까지의 시간인 실제 검출 가능 시간을 비교하고,
   비교한 결과에 기초하여, 상기 이동 물체의 진로를 예측하는 것을 특징으로 하는 차량 거동 예측 방법.
2. 청구항 1에 있어서,
   상기 미리 정해진 진로는 직진이며,
   추측한 상기 검출 가능 시간보다 상기 실제 검출 가능 시간이 짧은지 여부를 비교한 결과에 기초하여, 상기 이동 물체의 진로를 예측하는 것을 특징으로 하는 차량 거동 예측 방법.
3. 청구항 1 또는 청구항 2에 있어서,
   상기 물체는, 상기 자기 차량과 동일한 도로를 상기 자기 차량이 주행하는 방향과 반대 방향으로 주행하는 대향 차량인 것을 특징으로 하는 차량 거동 예측 방법.
4. 청구항 1 또는 청구항 2에 있어서,
   상기 물체는, 정지 물체인 것을 특징으로 하는 차량 거동 예측 방법.
5. 청구항 1 또는 청구항 2에 있어서,
   상기 미리 정해진 진로는 직진이며, 상기 이동 물체가 주행하는 도로가 복수의 차선으로 구성되고, 상기 자기 차량이 상기 이동 물체를 검출하였을 때에 상기 이동 물체가 상기 복수의 차선 중, 상기 자기 차량에서 보아 가장 먼 차선 이외를 주행하고 있는 경우에 있어서,
   추측한 상기 검출 가능 시간보다 상기 실제 검출 가능 시간이 짧은 경우, 상기 이동 물체는 차선 변경하였다고 예측하는 것을 특징으로 하는 차량 거동 예측 방법.
6. 청구항 1 또는 청구항 2에 있어서,
   상기 미리 정해진 진로는 직진이며, 상기 이동 물체가 주행하는 도로의 좌측으로 진입 가능한 장소가 존재하는 경우에,
   추측한 상기 검출 가능 시간보다 상기 실제 검출 가능 시간이 짧은 경우, 상기 이동 물체는 좌회전하였다고 예측하는 것을 특징으로 하는 차량 거동 예측 방법.
7. 청구항 1 또는 청구항 2에 있어서,
   상기 미리 정해진 진로는 직진이며, 상기 이동 물체가 주행하는 도로의 우측으로 진입 가능한 장소가 존재하는 경우에,
   추측한 상기 검출 가능 시간보다 상기 실제 검출 가능 시간이 짧은 경우, 상기 이동 물체는 우회전하였다고 예측하는 것을 특징으로 하는 차량 거동 예측 방법.
8. 청구항 1 또는 청구항 2에 있어서,
   상기 미리 정해진 진로는 직진이며, 추측한 상기 검출 가능 시간보다 상기 실제 검출 가능 시간이 짧은 경우, 상기 이동 물체와 상기 자기 차량의 거리가 짧을수록, 상기 이동 물체의 거동이 변화하였을 가능성을 증가시키고,
   상기 가능성 및 상기 비교한 결과에 기초하여, 상기 이동 물체의 진로를 예측하는 것을 특징으로 하는 차량 거동 예측 방법.
9. 청구항 1 또는 청구항 2에 있어서,
   상기 미리 정해진 진로는 직진이며, 추측한 상기 검출 가능 시간보다 상기 실제 검출 가능 시간이 짧은 경우, 상기 이동 물체를 검출하였을 때부터 상기 이동 물체가 상기 사각 영역에 진입하기 직전까지의, 상기 이동 물체의 궤도에 기초하여 상기 이동 물체의 거동이 변화하였을 가능성을 증가시키고,
   상기 가능성 및 상기 비교한 결과에 기초하여, 상기 이동 물체의 진로를 예측하는 것을 특징으로 하는 차량 거동 예측 방법.
10. 청구항 1 또는 청구항 2에 있어서,
    상기 미리 정해진 진로는 직진이며, 상기 실제 검출 가능 시간이 추측한 상기 검출 가능 시간 이상인 경우, 상기 이동 물체는 직진하였다고 예측하는 것을 특징으로 하는 차량 거동 예측 방법.
11. 청구항 10에 있어서,
    상기 이동 물체와 상기 자기 차량의 거리가 짧을수록, 상기 이동 물체가 직진하였을 가능성을 증가시키고, 또는 상기 이동 물체를 검출하였을 때부터 상기 이동 물체가 상기 사각 영역에 진입하기 직전까지의, 상기 이동 물체의 궤도에 기초하여 상기 이동 물체가 직진하였을 가능성을 증가시키며,
    상기 이동 물체는 직진하였다고 예측하는 것을 특징으로 하는 차량 거동 예측 방법.
12. 청구항 1 또는 청구항 2에 있어서,
    상기 이동 물체의 진로의 예측 결과에 기초하여, 상기 자기 차량의 속도를 시간의 함수로서 나타내는 속도 프로파일을 산출하는 것을 특징으로 하는 차량 거동 예측 방법.
13. 청구항 12에 기재된 차량 거동 예측 방법을 이용하여 상기 자기 차량을 제어하는 차량 제어 방법으로서,
    상기 이동 물체의 진로가 상기 자기 차량의 진로와 교차하고, 또한 상기 이동 물체가 주행하는 도로가 우선 도로인 경우, 상기 자기 차량을 감속 또는 정지시키기 위한 상기 속도 프로파일을 산출하고,
    상기 속도 프로파일에 기초하여 상기 자기 차량을 제어하는 것을 특징으로 하는 차량 제어 방법.
14. 청구항 12에 기재된 차량 거동 예측 방법을 이용하여 상기 자기 차량을 제어하는 차량 제어 방법으로서,
    상기 이동 물체의 진로가 상기 자기 차량의 진로와 교차하고, 또한 상기 자기 차량이 주행하는 도로가 우선 도로인 경우, 일정한 속도를 나타내는 상기 속도 프로파일을 산출하고,
    상기 속도 프로파일에 기초하여 상기 자기 차량을 제어하는 것을 특징으로 하는 차량 제어 방법.
15. 청구항 12에 기재된 차량 거동 예측 방법을 이용하여 상기 자기 차량을 제어하는 차량 제어 방법으로서,
    상기 이동 물체의 진로가 상기 자기 차량의 진로와 교차하지 않는 경우, 일정한 속도를 나타내는 상기 속도 프로파일을 산출하고,
    상기 속도 프로파일에 기초하여 상기 자기 차량을 제어하는 것을 특징으로 하는 차량 제어 방법.
16. 자기 차량의 전방 또는 측방의 물체의 상기 자기 차량에 대한 위치, 및 상기 자기 차량에서 보아 상기 물체보다 먼 곳을 주행하는 이동 물체를 검출하는 센서; 및
    제어부;를 구비하며,
    상기 제어부는,
    상기 센서에 의해 검출된 상기 위치에 기초하여, 상기 물체에 의해 형성되는, 상기 센서가 검출할 수 없는 상기 자기 차량의 사각 영역을 산출하고,
    상기 센서에 의해 상기 이동 물체가 검출된 후에 상기 이동 물체가 미리 정해진 진로에서 진행한 경우의, 상기 이동 물체를 검출하였을 때부터 상기 이동 물체가 상기 사각 영역에 진입하기까지의 시간인 검출 가능 시간을 추측하며,
    상기 검출 가능 시간과, 상기 이동 물체를 검출하였을 때부터 상기 이동 물체가 실제로 상기 사각 영역에 진입하기까지의 시간인 실제 검출 가능 시간을 비교하고,
    비교한 결과에 기초하여, 상기 이동 물체의 진로를 예측하는 것을 특징으로 하는 차량 거동 예측 장치.
17. 청구항 16에 있어서,
    상기 미리 정해진 진로는 직진이며,
    상기 제어부는,
    추측한 상기 검출 가능 시간보다 상기 실제 검출 가능 시간이 짧은지 여부를 비교한 결과에 기초하여, 상기 이동 물체의 진로를 예측하는 것을 특징으로 하는 차량 거동 예측 장치.