JP2019043396A - Driving control method and driving control device for driving support vehicle - Google Patents
Driving control method and driving control device for driving support vehicle Download PDFInfo
- Publication number
- JP2019043396A JP2019043396A JP2017169381A JP2017169381A JP2019043396A JP 2019043396 A JP2019043396 A JP 2019043396A JP 2017169381 A JP2017169381 A JP 2017169381A JP 2017169381 A JP2017169381 A JP 2017169381A JP 2019043396 A JP2019043396 A JP 2019043396A
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- target travel
- travel route
- route
- obstacle
- Prior art date
- Legal status (The legal status 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 status listed.)
- Granted
Links
Landscapes
- Navigation (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Traffic Control Systems (AREA)
Abstract
【課題】短い区間に変曲ポイントが複数存在する道路を走行するとき、乗員に与える違和感を抑制すること。【解決手段】目標走行経路に基づいて、自車旋回のための制御を行う自動運転用認識判断プロセッサ3を備える運転支援車両の走行制御装置において、GPS/ナビゲーションシステム2と、地図データ4と、対向車A2を検出する認識センサ1と、変曲ポイントIPを検出する左右旋回ポイント検出部32と、自車前方の対向側に対向車の有無を判定する障害物判定部34と、を有する。目標走行経路生成部35は、対向車有りと判定されたとき、ルートを基準に第1目標走行経路R1を生成し、変曲ポイントIPが複数有り、かつ、対向車無しと判定されたとき、第1目標走行経路R1を生成する場合よりも、各変曲ポイントIP1,IP2の相対距離D1´,D2´を、一方の変曲ポイントIP1とは長く、他方の変曲ポイントIP2とは短くなる第2目標走行経路R2を生成する。【選択図】図10BPROBLEM TO BE SOLVED: To suppress a sense of discomfort given to an occupant when traveling on a road in which a plurality of inflection points exist in a short section. SOLUTION: In a driving control device for a driving support vehicle including an automatic driving recognition determination processor 3 that controls for turning the own vehicle based on a target driving route, a GPS / navigation system 2, map data 4, and the like. It has a recognition sensor 1 that detects an oncoming vehicle A2, a left / right turning point detection unit 32 that detects a turning point IP, and an obstacle determination unit 34 that determines the presence or absence of an oncoming vehicle on the opposite side in front of the own vehicle. When it is determined that there is an oncoming vehicle, the target travel route generation unit 35 generates the first target travel route R1 based on the route, and when it is determined that there are a plurality of inflection point IPs and there is no oncoming vehicle. The relative distances D1'and D2' of each inflection point IP1 and IP2 are longer than one inflection point IP1 and shorter than the other inflection point IP2 than when the first target travel path R1 is generated. The second target travel path R2 is generated. [Selection diagram] FIG. 10B
Description
本開示は、運転支援車両の走行制御方法及び走行制御装置に関する。 The present disclosure relates to a driving control method and a driving control device for a driving assistance vehicle.
従来、目標経路に対する追従性と安定性の両立を目的として、道路境界に沿って目標経路を生成して、前方注視点に基づき算出された旋回目標値に追従するよう、車両制御を行う車両の運転支援制御装置が知られている(例えば、特許文献1参照)。このような従来装置では、カーブ路での旋回走行シーンでは、目標経路は道路境界に沿って生成され、自車位置と左右道路境界とのマージンを大きくとるために、道路の中心部を走行する経路を生成することが一般的である。また、そのような従来装置では、路上のランドマークにより走行車線が明確に規定されている場合は、走行車線の範囲内で曲率を抑えた経路を生成することもある。 Conventionally, a vehicle that performs vehicle control to generate a target route along a road boundary and to follow a turning target value calculated based on a forward gazing point for the purpose of achieving both tracking and stability with respect to the target route. A driving assistance control device is known (see, for example, Patent Document 1). In such a conventional device, in a turning traveling scene on a curved road, the target route is generated along the road boundary, and the vehicle travels in the center of the road to increase the margin between the vehicle position and the left and right road boundaries. It is common to generate a route. Further, in such a conventional apparatus, when the travel lane is clearly defined by the landmarks on the road, a route with a reduced curvature may be generated within the travel lane.
ここで、一般公道の中では、短い区間に変曲ポイントが複数存在する道路が存在する。代表例としては、クランク路やS字曲線路、そして変則的に交わる丁字路/交差点などが挙げられる。このような形状の道路にて、従来装置を基に経路生成を行うと、道路境界に沿って生成された経路も当然道路形状に沿った形状となる。また、その経路を追従しようとすると、旋回の後にすぐ逆方向に旋回という動作となり、走行車線の範囲内で曲率を抑えた経路を走行する場合に比べて、車両挙動が大きくなる。また、従来装置を基に経路生成を行うと、走行車線の範囲内で曲率を抑えた経路を生成することもあるが、自車の対向側に障害物となる立体物が有る場合、自車と立体物が接近するおそれがある。このように、従来装置を基に経路生成を行うと、短い区間に変曲ポイントが複数存在する道路を走行するとき、乗員に違和感を与えるおそれがある、という問題が生じる。 Here, among general public roads, there are roads having a plurality of inflection points in a short section. Typical examples include crank roads, S-curve roads, and irregular roads / intersections. When a route is generated based on a conventional device on a road having such a shape, the route generated along the road boundary naturally also has a shape along the road shape. Further, when trying to follow the route, the vehicle turns immediately in the opposite direction after the turn, and the vehicle behavior becomes larger than when traveling on a route with a reduced curvature within the travel lane. In addition, when the route is generated based on the conventional device, a route with a reduced curvature may be generated within the range of the traveling lane, but if there is a three-dimensional object that becomes an obstacle on the opposite side of the own vehicle, There is a risk of the three-dimensional object approaching. As described above, when the route is generated based on the conventional device, there is a problem that when the vehicle travels on a road having a plurality of inflection points in a short section, there is a possibility that the passenger may feel uncomfortable.
本開示は、上記問題に着目してなされたもので、短い区間に変曲ポイントが複数存在する道路を走行するとき、乗員に与える違和感を抑制する運転支援車両の走行制御方法及び走行制御装置を提供すること目的とする。 The present disclosure has been made paying attention to the above problem, and provides a driving control method and a driving control device for a driving assistance vehicle that suppress a sense of incongruity given to an occupant when driving on a road having a plurality of inflection points in a short section. The purpose is to provide.
上記目的を達成するため、本開示は、目標走行経路に基づいて、自車旋回のための制御を行うコントローラを備える。
この運転支援車両の走行制御方法において、目的地までのルートを設定する。
ルート周囲の道路情報を取得する。
自車周辺の障害物を検出する。
道路情報から、自車前方の走路を構成する走路境界に対して、所定距離の間に存在する曲率の変曲ポイントを検出する。
自車前方の対向側に障害物の有無を判定する。
変曲ポイントが2つ以上無いとき、又は、障害物有りと判定されたとき、ルートを基準に第1目標走行経路を生成する。
変曲ポイントが2つ以上有り、かつ、障害物無しと判定されたとき、第2目標走行経路を生成する。第2目標走行経路では、第1目標走行経路を生成する場合よりも、各変曲ポイントの相対距離を、一方の変曲ポイントとは短く、他方の変曲ポイントとは長くなる。
In order to achieve the above object, the present disclosure includes a controller that performs control for turning the host vehicle based on a target travel route.
In this driving support vehicle driving control method, a route to a destination is set.
Get road information around the route.
Detect obstacles around your vehicle.
From the road information, an inflection point of curvature existing within a predetermined distance is detected with respect to a road boundary that forms a road ahead of the host vehicle.
The presence or absence of an obstacle is determined on the opposite side in front of the host vehicle.
When there are no more than two inflection points, or when it is determined that there is an obstacle, the first target travel route is generated based on the route.
When it is determined that there are two or more inflection points and there is no obstacle, a second target travel route is generated. In the second target travel route, the relative distance of each inflection point is shorter than one inflection point and longer than the other inflection point than when the first target travel route is generated.
このように、第1目標走行経路と第2目標走行経路を生成することで、短い区間に変曲ポイントが複数存在する道路を走行するとき、乗員に与える違和感を抑制することができうる。 As described above, by generating the first target travel route and the second target travel route, it is possible to suppress a sense of discomfort given to the occupant when traveling on a road having a plurality of inflection points in a short section.
以下、本開示による運転支援車両(自車/自車両)の走行制御方法及び走行制御装置を実現する最良の実施形態を、図面に示す実施例1〜実施例4に基づいて説明する。 Hereinafter, a best mode for realizing a driving control method and a driving control device of a driving assistance vehicle (own vehicle / own vehicle) according to the present disclosure will be described based on Examples 1 to 4 shown in the drawings.
まず、構成を説明する。実施例1における走行制御方法及び走行制御装置は、モータ駆動するハイブリッド車両(電動車両の一例)をベースとし、操舵/駆動/制動を外部制御することが可能な自動運転車両(運転支援車両の一例)に適用したものである。以下、実施例1の構成を、「自動運転システム構成」、「自動運転用認識判断プロセッサの詳細構成」、「自動運転車両の走行制御処理構成」に分けて説明する。 First, the configuration will be described. The travel control method and the travel control apparatus according to the first embodiment are based on a hybrid vehicle (an example of an electric vehicle) that is driven by a motor, and an autonomous driving vehicle (an example of a driving support vehicle) that can externally control steering / driving / braking. ). Hereinafter, the configuration of the first embodiment will be described by dividing it into “automatic driving system configuration”, “detailed configuration of recognition determination processor for automatic driving”, and “travel control processing configuration of automatic driving vehicle”.
[自動運転システム構成]
図1は、実施例1の自動運転車両の走行制御方法及び走行制御装置が適用された自動運転車両の自動運転システム構成を示す。以下、図1に基づき、自動運転システムの全体構成を説明する。
[Automatic driving system configuration]
FIG. 1 shows an automatic driving system configuration of an automatic driving vehicle to which a driving control method and a driving control device for an automatic driving vehicle according to a first embodiment are applied. Hereinafter, the overall configuration of the automatic driving system will be described with reference to FIG.
自動運転システムは、認識センサ1(障害物検出部)と、GPS/ナビゲーションシステム2(ルート設定部)と、自動運転用認識判断プロセッサ3(コントローラ)と、地図データ4(道路形状取得部)と、を備えている。また、自動運転システムは、自動運転用制御コントローラ5(車両制御部)と、電動パワーステアリング6と、駆動/回生モータ7と、油圧ブレーキ8と、を備えている。つまり、自動運転用認識判断プロセッサ3と、各制御指令値を計算して各アクチュエータECUへ送信する自動運転用制御コントローラ5が処理系として車載されている。なお、各アクチュエータECUの記載は省略する。 The automatic driving system includes a recognition sensor 1 (obstacle detection unit), a GPS / navigation system 2 (route setting unit), an automatic driving recognition determination processor 3 (controller), and map data 4 (road shape acquisition unit). It is equipped with. The automatic driving system includes an automatic driving control controller 5 (vehicle control unit), an electric power steering 6, a drive / regenerative motor 7, and a hydraulic brake 8. That is, the automatic driving recognition determination processor 3 and the automatic driving control controller 5 that calculates and transmits each control command value to each actuator ECU are mounted on the vehicle as a processing system. Note that description of each actuator ECU is omitted.
認識センサ1は、自車前方や自車後方等の自車周囲の外部環境(走路境界等)を認識するために設けられたセンサである。また、認識センサ1は、自車周辺の障害物を検出するセンサでもある。代表的には、自車前部と自車後部にそれぞれ搭載された車載カメラやレーザーレーダ等をいう。ここで、「走路境界」とは、道路幅・道路形状・車線などの境界のことである。 The recognition sensor 1 is a sensor provided to recognize an external environment (such as a road boundary) around the host vehicle such as the front of the host vehicle or the rear of the host vehicle. The recognition sensor 1 is also a sensor that detects an obstacle around the host vehicle. Typically, it refers to an in-vehicle camera, a laser radar, or the like mounted on the front part of the host vehicle and the rear part of the host vehicle. Here, the “runway boundary” is a boundary such as a road width, a road shape, and a lane.
GPS/ナビゲーションシステム2のうちGPSは、自車に搭載され、走行中の自車の走行位置(緯度・経度)を検出する位置検出手段である。なお、「GPS」は、グローバル・ポジショニング・システム(Global Positioning System)の略称である。また、ナビゲーションシステム(ルート設定部)は、乗員又は車外オペレータの目的地入力に基づき、初期地から目的地に至るまでのルートを自動で算出するルート設定手段である。このルートの定義として、初期地から目的地に至るまでの各分岐点を、経路長や道路幅、一方通行などの交通ルールや、工事中や渋滞中などの交通変化を総合的に考慮して繋ぎ合わせてできあがるものとする。また、分解能は分岐点を繋いだレベルのもので、どの車線を通るか、どんなライン取りで通るかまでの詳細化は、されていないものとする。このルートの設定方法に関しての詳細な記述は省略する。 GPS of the GPS / navigation system 2 is a position detection means that is mounted on the own vehicle and detects the traveling position (latitude / longitude) of the traveling vehicle. Note that “GPS” is an abbreviation for Global Positioning System. The navigation system (route setting unit) is route setting means for automatically calculating a route from the initial location to the destination based on the destination input of the occupant or the outside operator. As a definition of this route, each branch point from the initial location to the destination is considered comprehensively considering traffic rules such as route length, road width, one-way traffic, and traffic changes during construction and traffic jams. It shall be created by joining together. In addition, the resolution is at a level where the branch points are connected, and it is assumed that the lanes and the line taking are not detailed. A detailed description of the route setting method is omitted.
自動運転用認識判断プロセッサ3は、地図データ4やGPS/ナビゲーションシステム2や認識センサ1の情報を統合処理し、目標速度プロファイル(=目標車速プロファイル)等の各プロファイルの計算をする。つまり、乗員等が指定した目的地までの基本ルートと車速を、車載メモリに格納された地図データ4に基づいて算出する。また、GPSによる位置情報に基づいて基本ルートと車速に従いながら、車載した認識センサ1による車両周囲のセンシング結果に基づいて、近傍の目標走行経路(目標経路)や目標速度(目標車速)をプロファイルとして逐次修正する。 The automatic driving recognition determination processor 3 integrates the map data 4, the GPS / navigation system 2 and the information of the recognition sensor 1, and calculates each profile such as a target speed profile (= target vehicle speed profile). That is, the basic route to the destination designated by the occupant and the vehicle speed are calculated based on the map data 4 stored in the in-vehicle memory. Further, while following the basic route and the vehicle speed based on the position information by GPS, based on the sensing result around the vehicle by the on-board recognition sensor 1, a nearby target travel route (target route) and target speed (target vehicle speed) are used as a profile. Correct sequentially.
地図データ4は、車載メモリに格納され、勾配や制限速度等の道路情報が書き込まれた地図データである。この地図データ4は、GPSにて走行中の自車の走行位置が検出されると、自車の走行位置を中心とする地図情報が自動運転用認識判断プロセッサ3から読み出される。 The map data 4 is map data that is stored in an in-vehicle memory and road information such as a gradient and a speed limit is written. In the map data 4, when the traveling position of the host vehicle traveling by GPS is detected, map information centered on the traveling position of the host vehicle is read from the automatic driving recognition determination processor 3.
自動運転用制御コントローラ5は、自動運転用認識判断プロセッサ3からのプロファイル情報(目標走行経路や目標車速等)に基づいて、操舵量・駆動量・制動量の各指令値を決める。操舵制御は、操舵アクチュエータである電動パワーステアリング6で行うものとする。駆動制御は、駆動源アクチュエータである駆動/回生モータ7で行うものとする。制動制御は、駆動/回生モータ7による回生分と油圧ブレーキ8によるメカブレーキ分の配分で行うものとする。なお、操舵制御、駆動制御、制動制御は、アクチュエータ毎に設けられた各ECUで行われる。 The automatic driving controller 5 determines each command value of the steering amount, the driving amount, and the braking amount based on the profile information (target travel route, target vehicle speed, etc.) from the automatic driving recognition determination processor 3. Steering control is performed by the electric power steering 6 that is a steering actuator. Drive control is performed by the drive / regeneration motor 7 which is a drive source actuator. The braking control is performed by distributing the regeneration by the drive / regeneration motor 7 and the mechanical brake by the hydraulic brake 8. Steering control, drive control, and braking control are performed by each ECU provided for each actuator.
電動パワーステアリング6は、自動運転用制御コントローラ5からの制御指令値にしたがって自動操舵する操舵アクチュエータである。電動パワーステアリング6は、旋回目標値が算出されると、旋回目標値を実現するため、自車の転舵(駆動輪転舵)と各輪に発生する制駆動力差の少なくとも一方に基づいて、旋回制御を行う。 The electric power steering 6 is a steering actuator that automatically steers in accordance with a control command value from the control controller 5 for automatic driving. When the turning target value is calculated, the electric power steering 6 realizes the turning target value based on at least one of the turning of the own vehicle (drive wheel turning) and the braking / driving force difference generated in each wheel, Turn control.
駆動/回生モータ7は、自動運転用制御コントローラ5からの制御指令値にしたがって駆動による定速走行や加速走行、或いは、回生による減速走行を行う駆動源アクチュエータである。 The drive / regenerative motor 7 is a drive source actuator that performs constant speed traveling or acceleration traveling by driving or decelerating traveling by regeneration in accordance with a control command value from the controller 5 for automatic operation.
油圧ブレーキ8は、自動運転用制御コントローラ5からの制御指令値にしたがって油圧制動を作動させるブレーキアクチュエータである。 The hydraulic brake 8 is a brake actuator that operates hydraulic braking in accordance with a control command value from the automatic operation controller 5.
[自動運転用認識判断プロセッサの詳細構成]
図2は、実施例1の自動運転用認識判断プロセッサにて実行される自動運転車両の走行制御処理のブロック図を示す。以下、図2に基づき、自動運転用認識判断プロセッサの詳細構成を説明する。
[Detailed configuration of recognition judgment processor for automatic driving]
FIG. 2 is a block diagram of the traveling control process for the autonomous driving vehicle executed by the recognition determination processor for autonomous driving according to the first embodiment. The detailed configuration of the automatic driving recognition determination processor will be described below with reference to FIG.
自動運転用認識判断プロセッサ3は、走路境界補間部31と、左右旋回ポイント検出部32と、対向車線ランドマーク判定部33と、障害物判定部34と、目標走行経路生成部35と、目標プロファイル生成部36と、を備えている。なお、自動運転用認識判断プロセッサ3には、ルート等の情報が入力される。 The automatic driving recognition determination processor 3 includes a road boundary interpolation unit 31, a left / right turning point detection unit 32, an oncoming lane landmark determination unit 33, an obstacle determination unit 34, a target travel route generation unit 35, and a target profile. And a generation unit 36. Information such as a route is input to the automatic driving recognition determination processor 3.
走路境界補間部31は、認識センサ1や地図データ4等からランドマーク情報を入力する。走路境界補間部31は、走路境界を規定するランドマークが無いエリア(図4A〜Dを参照)では、取得できたランドマーク情報から走路境界の補間を行う(図5A〜Dを参照)。この走路境界補間部31は、走路境界の補間結果を、左右旋回ポイント検出部32へ出力する。 The runway boundary interpolation unit 31 inputs landmark information from the recognition sensor 1, the map data 4, and the like. The runway boundary interpolation unit 31 interpolates a runway boundary from the acquired landmark information in an area without a landmark that defines the runway boundary (see FIGS. 4A to 4D) (see FIGS. 5A to 5D). The road boundary interpolation unit 31 outputs the result of interpolation of the road boundary to the left / right turning point detection unit 32.
ここで、「ランドマーク情報」は、走路境界を規定する情報である。この情報の対象としては、路面ペイントによる区画線、縁石や壁、ポールやガードレールなどの立体物の他、側溝などが挙げられ、車両が物理的に進入できない境界、もしくは交通ルール的に進入してはいけない境界を規定するものである。また、導流帯(ゼブラゾーン)のように、交通ルールとして進入は禁止されていないが、心理的に進入を妨げる境界も含まれる。 Here, “landmark information” is information that defines the road boundary. This information includes lane markings by road surface paint, curbstones and walls, solid objects such as poles and guardrails, side grooves, etc., and boundaries where vehicles cannot physically enter or traffic rules. It defines the boundaries that should not be used. In addition, as in the convection zone (zebra zone), entry is not prohibited as a traffic rule, but a boundary that psychologically prevents entry is also included.
左右旋回ポイント検出部32は、認識センサ1や地図データ4等の道路情報と、走路境界の補間結果と、を入力する。左右旋回ポイント検出部32は、道路情報や補間結果、自車前方の走路を構成する走路境界に対して、所定距離の間に存在する曲率の変曲ポイントとその数を検出する。また、左右旋回ポイント検出部32は、検出された変曲ポイントの数が、2つ以上(複数)か否かを判定する。この左右旋回ポイント検出部32は、変曲ポイントの検出結果を、対向車線ランドマーク判定部33と目標走行経路生成部35へ出力する。 The left / right turning point detection unit 32 inputs the road information such as the recognition sensor 1 and the map data 4 and the interpolation result of the road boundary. The left / right turning point detection unit 32 detects inflection points and the number of curvatures existing within a predetermined distance with respect to road information, an interpolation result, and a road boundary constituting a road ahead of the host vehicle. The left / right turning point detection unit 32 determines whether the number of detected inflection points is two or more (plural). The left / right turning point detection unit 32 outputs the detection result of the inflection point to the oncoming lane landmark determination unit 33 and the target travel route generation unit 35.
対向車線ランドマーク判定部33は、ランドマーク情報から、対向車線を規定する対向車線ランドマークが存在するか否かを判定する。この対向車線ランドマーク判定部33は、対向車線ランドマーク有り信号又は無し信号を、目標走行経路生成部35へ出力する。対向車線ランドマーク判定部33は、対向車線ランドマーク有り信号を、障害物判定部34へ出力する。 The oncoming lane landmark determination unit 33 determines whether there is an oncoming lane landmark that defines the oncoming lane from the landmark information. The oncoming lane landmark determination unit 33 outputs an oncoming lane landmark presence signal or no signal to the target travel route generation unit 35. The oncoming lane landmark determination unit 33 outputs an oncoming lane landmark presence signal to the obstacle determination unit 34.
障害物判定部34は、認識センサ1の障害物情報から、自車前方の対向側に障害物の有無を判定する。この障害物判定部34は、障害物有り信号又は無し信号を、目標走行経路生成部35へ出力する。 The obstacle determination unit 34 determines the presence or absence of an obstacle on the opposite side in front of the host vehicle from the obstacle information of the recognition sensor 1. The obstacle determination unit 34 outputs an obstacle presence signal or an absence signal to the target travel route generation unit 35.
目標走行経路生成部35は、地図データ4やGPS/ナビゲーションシステム2や認識センサ1の情報(自車周囲の環境情報等)を入力する。また、目標走行経路生成部35は、変曲ポイントの検出結果と、対向車線ランドマーク有り信号又は無し信号と、障害物有り信号又は無し信号と、を入力する。目標走行経路生成部35は、これらの情報等に基づいて、目標走行経路としての第1目標走行経路又は第2目標走行経路を生成する。即ち、目標走行経路生成部35は、ルートを基準に、自車が将来通過する自車将来位置と自車の通過時の自車将来姿勢を設定する。次に、目標走行経路生成部35は、自車の現時点における現在位置及び現在姿勢と自車将来位置及び自車将来姿勢とを滑らかに繋ぐことにより、第1目標走行経路又は第2目標走行経路を生成する。この目標走行経路生成部35は、第1目標走行経路又は第2目標走行経路を、目標プロファイル生成部36へ出力する。 The target travel route generation unit 35 inputs the map data 4, the GPS / navigation system 2 and the information of the recognition sensor 1 (environmental information around the vehicle). In addition, the target travel route generation unit 35 inputs an inflection point detection result, an oncoming lane landmark presence signal or absence signal, and an obstacle presence signal or absence signal. The target travel route generation unit 35 generates a first target travel route or a second target travel route as a target travel route based on such information and the like. That is, the target travel route generation unit 35 sets the future position of the host vehicle through which the host vehicle will pass in the future and the future posture of the host vehicle when the host vehicle passes. Next, the target travel route generation unit 35 smoothly connects the current position and current posture of the host vehicle to the future position of the host vehicle and the future posture of the host vehicle, so that the first target travel route or the second target travel route. Is generated. The target travel route generation unit 35 outputs the first target travel route or the second target travel route to the target profile generation unit 36.
目標プロファイル生成部36は、第1目標走行経路又は第2目標走行経路等に基づいて、目標走行経路プロファイルと目標速度プロファイルと舵角プロファイル等を生成する。この目標プロファイル生成部36は、生成した目標走行経路プロファイルと目標速度プロファイルと舵角プロファイル等を、自動運転用制御コントローラ5へ出力する。 The target profile generation unit 36 generates a target travel route profile, a target speed profile, a steering angle profile, and the like based on the first target travel route or the second target travel route. The target profile generation unit 36 outputs the generated target travel route profile, target speed profile, steering angle profile, and the like to the automatic operation control controller 5.
[自動運転車両の走行制御処理構成]
図3は、実施例1の自動運転用認識判断プロセッサにて実行される自動運転車両の走行制御処理の流れを示す。即ち、図3は、図2における自動運転車両の走行制御処理の流れを示す。以下、自動運転車両の走行制御処理構成をあらわす図3に示すフローチャートの各ステップについて、図3〜図7に基づき説明する。なお、図3に示す自動運転車両の走行制御処理は、所定の制御周期にて繰り返し実行される。また、図4〜図7において、自車を「A1」で示し、対向車(対向車両、障害物)を「A2」で示す。
[Running control processing configuration of autonomous driving vehicle]
FIG. 3 shows a flow of the traveling control process for the autonomous driving vehicle executed by the recognition determination processor for autonomous driving of the first embodiment. That is, FIG. 3 shows the flow of the traveling control process of the autonomous driving vehicle in FIG. Hereinafter, each step of the flowchart shown in FIG. 3 showing the traveling control processing configuration of the autonomous driving vehicle will be described with reference to FIGS. Note that the traveling control process for the autonomous vehicle shown in FIG. 3 is repeatedly executed at a predetermined control cycle. Moreover, in FIGS. 4-7, the own vehicle is shown by "A1" and an oncoming vehicle (an oncoming vehicle, an obstruction) is shown by "A2".
図3のフローチャートでは、ルートが設定済みで、自動運転に必要な条件が満たされ、自動運転モードで走行中の状態からのものとする。なお、自動運転の性能向上のため、GPSは高精度に位置情報を取得できるシステムであり、地図データ4は現実環境を正しく高精度に表したデジタルデータであるとする。 In the flowchart of FIG. 3, it is assumed that the route has been set, the conditions necessary for automatic driving are satisfied, and the vehicle is traveling in the automatic driving mode. In order to improve the performance of automatic driving, the GPS is a system that can acquire position information with high accuracy, and the map data 4 is digital data that accurately represents the real environment with high accuracy.
ステップS11では、走路情報を取得し、走路境界の補間を行って、ステップS12へ進む。即ち、ステップS11では、設定されたルートに従い、自車近傍のルートの両脇に存在する、走路境界を規定するランドマーク情報を、認識センサ1及び地図データ4から取得する。また、ステップS11では、図4A〜Dに示すように、走路境界を規定するランドマークが無いエリアでは、図5A〜Dに示すように、取得できたランドマーク情報から走路境界の補間を行う。ステップS11のうち、走路境界の補間が走路境界補間部31に相当する。以下、走路境界の補間について説明する。 In step S11, the road information is acquired, the road boundary is interpolated, and the process proceeds to step S12. That is, in step S <b> 11, landmark information that defines the road boundary existing on both sides of the route near the host vehicle is acquired from the recognition sensor 1 and the map data 4 according to the set route. In step S11, as shown in FIGS. 4A to 4D, in an area where there is no landmark that defines the road boundary, as shown in FIGS. 5A to 5D, the road boundary is interpolated from the acquired landmark information. In step S <b> 11, the road boundary interpolation corresponds to the road boundary interpolation unit 31. Hereinafter, interpolation of the road boundary will be described.
まず、ランドマーク情報を、認識センサ1の情報から、実環境としての走路境界を規定する第1ランドマーク情報と、GPSのデータと地図データ4を照合して、ルート両脇の走路境界を規定する第2ランドマーク情報と、とする。 First, the landmark information is identified from the information of the recognition sensor 1, the first landmark information that defines the road boundary as a real environment, the GPS data and the map data 4, and the road boundary on both sides of the route is defined. And second landmark information.
この第1ランドマーク情報と第2ランドマーク情報との使い分けは、認識センサ1で自車近傍の第1ランドマーク情報を検出可能な部分は、第1ランドマーク情報を利用する。一方、認識センサ1で自車遠方もしくはオクル―ジョンにより第1ランドマーク情報を検出できていない部分は、第2ランドマーク情報を利用する。なお、「オクル―ジョン」とは、第1ランドマークが障害物等により遮られてしまい、認識センサ1で認識できないことである。 The first landmark information and the second landmark information are selectively used in a portion where the recognition sensor 1 can detect the first landmark information in the vicinity of the host vehicle, using the first landmark information. On the other hand, the second landmark information is used for a portion in which the first landmark information cannot be detected by the recognition sensor 1 far away from the subject vehicle or by occlusion. “Occlusion” means that the first landmark cannot be recognized by the recognition sensor 1 because it is blocked by an obstacle or the like.
具体的には、図4Aのようなクランク路で、中央線が無くかつ一方通行ではなく対向車A2が走行しうるシーンにおいて、第1ランドマーク情報として道路幅RWのみを取得できた場合は、図5Aに示すように、道路幅RWの半分の幅を走行路Cとして設定する。なお、図4BのようなS字カーブ路では図4Aと同様に、図5Bに示すように、道路幅RWの半分の幅を走行路Cとして設定する。 Specifically, in a crank road as shown in FIG. 4A, where the center line is not present and the oncoming vehicle A2 can travel instead of one-way, if only the road width RW can be acquired as the first landmark information, As shown in FIG. 5A, a half width of the road width RW is set as the travel path C. 4B, a half width of the road width RW is set as the traveling road C as shown in FIG. 5B, as in FIG. 4A.
また、図4Cのような変則的な形をした交差点や丁字路で、中央線が無くかつ一方通行ではなく対向車A2が走行しうるシーンにおいて、進入手前の道幅RW1と進入後の道幅RW2とルートに対して反対側のランドマーク情報を取得できた場合について説明する。この図4Cのような場合、それらの取得できたランドマーク情報を基に、図5Cに示すように、スプライン曲線や多項式関数等の曲線表現で滑らかに繋ぎ合わせを行う。 In addition, in a scene where an oncoming vehicle A2 can travel on an irregularly shaped intersection or a straight road as shown in FIG. 4C, where there is no center line and one-way traffic, the road width RW1 before getting on and the road width RW2 after entering A case where landmark information on the opposite side to the route can be acquired will be described. In the case as shown in FIG. 4C, based on the acquired landmark information, as shown in FIG. 5C, smooth connection is performed by a curved line expression such as a spline curve or a polynomial function.
さらに、図4Dのような変則的な形をした交差点や丁字路で、交差点や丁字路の真ん中でランドマーク情報が切れるような道路シーンについて説明する。このシーンにおいて、切れる前後の第1ランドマーク情報M1とルートに対して反対側の第2ランドマーク情報M2を取得できた場合について説明する。この図4Dのような場合、それらの取得できたランドマーク情報を用いて、図5Dに示すように、スプライン曲線や多項式関数等の曲線表現で切れる前後の間を滑らかに繋ぎ合わせる。 Further, a description will be given of a road scene in which landmark information is cut off in the middle of an intersection or a tangential road at an irregularly shaped intersection or a tangential road as shown in FIG. 4D. In this scene, the case where the first landmark information M1 before and after cutting and the second landmark information M2 on the opposite side to the route can be acquired will be described. In the case as shown in FIG. 4D, using the acquired landmark information, as shown in FIG. 5D, the portions before and after being cut by the curve expression such as a spline curve or a polynomial function are smoothly connected.
ステップS12では、ステップS11での走路情報の取得と走路境界の補間に続き、変曲ポイントが2つ以上検出されたか否かを判定する。YES(変曲ポイント複数有り)の場合はステップS13へ進み、NO(変曲ポイント複数無し)の場合はステップS15へ進む。なお、ステップS12が、左右旋回ポイント検出部32に相当する。 In step S12, it is determined whether two or more inflection points have been detected following the acquisition of the road information and the interpolation of the road boundary in step S11. If YES (there is a plurality of inflection points), the process proceeds to step S13, and if NO (there is no plurality of inflection points), the process proceeds to step S15. Step S <b> 12 corresponds to the left / right turning point detection unit 32.
ここで、「変曲ポイント」とは、ステップS11で取得した自車前方の走路を構成する走路境界の曲率に注目し、曲率変化率がピークとなるポイントである。そして、自車直近の変曲ポイントから、所定の距離までの間に2つ以上の変曲ポイントがあるか否かを判定する。また、「所定の距離」の区間長は、自車走行速度に応じて可変とし、自車走行速度が小さいほど区間長は短く設定される。なお、この時の距離の定義は、走路境界に沿って換算された距離が理想的であるが、計算負荷低減のために、自車を中心に円状に広げた距離を代替利用することも可能である。また、走路境界の左右のどちら側を使って判定するかは、実際のランドマーク数が多い方を優先して判定する。具体的には、図6A〜Dに示す道路の長さが区間長である。この図6A〜Dの左側の走路境界を使って変曲ポイントIPを検出・判定すると、図6Aの場合は、変曲ポイントIPが1つと検出されるので、変曲ポイント複数無しと判定される。また、図6B〜Dの場合は、いずれの場合も変曲ポイントIPが2つと検出されるので、変曲ポイント複数有りと判定される。 Here, the “inflection point” refers to a point at which the curvature change rate reaches a peak, paying attention to the curvature of the road boundary that forms the road ahead of the host vehicle acquired in step S11. Then, it is determined whether there are two or more inflection points between the inflection point closest to the vehicle and a predetermined distance. In addition, the section length of the “predetermined distance” is variable according to the host vehicle traveling speed, and the section length is set shorter as the host vehicle traveling speed decreases. In addition, the definition of the distance at this time is ideally the distance converted along the road boundary, but in order to reduce the calculation load, the distance spread in a circle around the host vehicle may be used instead. Is possible. In addition, which of the left and right sides of the road boundary is used for the determination is preferentially determined based on the actual number of landmarks. Specifically, the road length shown in FIGS. When the inflection point IP is detected and determined using the left-side lane boundary in FIGS. 6A to 6D, in the case of FIG. 6A, since one inflection point IP is detected, it is determined that there are not a plurality of inflection points. . 6B to 6D, in any case, since two inflection points IP are detected, it is determined that there are a plurality of inflection points.
ステップS13では、ステップS12での変曲ポイント複数有りとの判定に続き、対向車線ランドマークMMが存在するか否かを判定する。YES(対向車線ランドマーク有り)の場合はステップS15へ進み、NO(対向車線ランドマーク無し)の場合はステップS14へ進む。なお、ステップS13が、対向車線ランドマーク判定部33に相当する。 In step S13, following the determination that there are a plurality of inflection points in step S12, it is determined whether there is an oncoming lane landmark MM. If YES (with oncoming lane landmark), the process proceeds to step S15, and if NO (no oncoming lane landmark), the process proceeds to step S14. Step S13 corresponds to the oncoming lane landmark determination unit 33.
ここで、「対向車線ランドマークMM」とは、自車走行車線と対向車線とを規定する路上ランドマークであって、実際のランドマークである。例えば、図7の対向車線ランドマークMMである。この情報は、ステップS11で取得した走路情報である。また、図5A〜Cに示すように、走路境界の補間が行われた場合は、対向車線ランドマーク無しと判定される。 Here, the “opposite lane landmark MM” is a road landmark that defines the host vehicle travel lane and the opposite lane, and is an actual landmark. For example, the opposite lane landmark MM in FIG. This information is the track information acquired in step S11. Further, as shown in FIGS. 5A to 5C, when the road boundary is interpolated, it is determined that there is no oncoming lane landmark.
ステップS14では、ステップS13での対向車線ランドマーク無しとの判定に続き、自車前方の対向側に障害物が無いか否かを判定する。YES(障害物無し)の場合はステップS16へ進み、NO(障害物有り)の場合はステップS15へ進む。なお、ステップS14が、障害物判定部34に相当する。 In step S14, following the determination that there is no oncoming lane landmark in step S13, it is determined whether or not there is an obstacle on the opposite side in front of the host vehicle. If YES (no obstacle), the process proceeds to step S16, and if NO (has an obstacle), the process proceeds to step S15. Step S14 corresponds to the obstacle determination unit 34.
ここで、「自車前方の対向側」とは、左側通行の場合は右側が対向側となり、右側通行の場合は左側が対向側となる。また、「障害物」は、自車に接近する方向に移動する障害物のことである。例えば、対向車線を走行する対向車A2である(図4〜図7参照)。 Here, the “opposite side in front of the host vehicle” is the opposite side in the case of left-hand traffic and the opposite side in the case of right-hand traffic. The “obstacle” is an obstacle that moves in a direction approaching the host vehicle. For example, the oncoming vehicle A2 traveling in the oncoming lane (see FIGS. 4 to 7).
次のステップS15とステップS16は共に、目標走行経路を生成するステップである。このため、両ステップに共通する事項を説明してから、それぞれのステップについて説明する。 Both the next step S15 and step S16 are steps for generating a target travel route. For this reason, after explaining matters common to both steps, each step will be explained.
「目標走行経路」は、地図データ4やGPSや認識センサ1の情報を、最適化計算に基づいた手法や、複数経路の中から最も評点の良い経路を選択する手法などにより目標走行経路を生成する。目標走行経路生成時には、予め設定した目的地までのルートを基準に生成する。目標走行経路生成時の指標としては、車が走行できる道路境界を超えないこと、他車両や歩行者等の自車周囲に存在する立体障害物と接触しないこと、を前提として、その他、経路曲率が過大にならないことなどを加味する。 “Target travel route” is a method for generating a target travel route by using a method based on optimization calculation based on the map data 4, GPS, or recognition sensor 1 or a method for selecting the best-rated route from a plurality of routes. To do. When the target travel route is generated, it is generated based on a route to a preset destination. As an index for generating the target travel route, the path curvature is assumed on the premise that it does not exceed the road boundary where the vehicle can travel and that it does not contact with three-dimensional obstacles around the vehicle such as other vehicles and pedestrians. Take into account that the is not excessive.
また、目標走行経路は、図7に示すように、経路生成時点での自車位置を原点として、自車の向き方向をx、自車の幅方向をyとして座標を設定し、その座標上で、等間隔もしくはある規則に従って区切られた離散的なノード情報で扱われる。また、実施例1では、目標走行経路を構成する各ノードは、2次元座標情報であるxiとyiが記録されている。なお、各情報は、自車が経路端に到達するまで、不図示の記録部に記録される。 In addition, as shown in FIG. 7, the target travel route is set with coordinates where the vehicle position at the time of route generation is the origin, the direction of the vehicle is x, and the width direction of the vehicle is y. Thus, it is handled with discrete node information that is equally spaced or divided according to a certain rule. In the first embodiment, each node constituting the target travel route is recorded with two-dimensional coordinate information x i and y i . Each information is recorded in a recording unit (not shown) until the vehicle reaches the end of the route.
ステップS15では、ステップS12での変曲ポイント複数無しとの判定、ステップS13での対向車線ランドマーク有りとの判定、或いは、ステップS14での障害物有りとの判定に続き、走路境界に沿った第1目標走行経路を生成し、エンドへ進む。なお、ステップS15が、目標走行経路生成部35に相当する。 In step S15, following the determination that there are no inflection points in step S12, the determination that there is an oncoming lane landmark in step S13, or the determination that there is an obstacle in step S14, along the road boundary A first target travel route is generated and the process proceeds to the end. Step S15 corresponds to the target travel route generation unit 35.
この第1目標走行経路が生成される場合は、ステップS12での変曲ポイント複数無いと判定された場合、ステップS13での対向車線ランドマーク有りと判定された場合、又は、ステップS14で障害物無しと判定された場合である。ここで、「第1目標走行経路」は、ルートを基準に、自車が追従可能で、走路境界からの逸脱や障害物との接触のない及び接触するおそれのない直近の経路である。即ち、走路境界を逸脱しない範囲の経路である。つまり、第1目標走行経路生成時の指標の中で、「車が走行できる道路境界を超えないこと」という指標が、「車が走行する走路境界を超えないこと」となる。 When this first target travel route is generated, when it is determined that there are not a plurality of inflection points at step S12, when it is determined that there is an oncoming lane landmark at step S13, or at step S14 an obstacle This is the case when it is determined that there is none. Here, the “first target travel route” is an immediate route that the vehicle can follow based on the route, and that is free from deviation from the boundary of the travel route, contact with an obstacle, and contact. That is, the route is within a range that does not depart from the road boundary. That is, among the indices used when the first target travel route is generated, the index “does not exceed the road boundary on which the car can travel” is “does not exceed the travel path boundary on which the vehicle travels”.
ステップS16では、ステップS14での障害物無しとの判定に続き、第1目標走行経路よりも曲率を抑えた第2目標走行経路を生成し、エンドへと進む。なお、ステップS16が、目標走行経路生成部35に相当する。 In step S16, following the determination that there is no obstacle in step S14, a second target travel route with a curvature lower than that of the first target travel route is generated, and the process proceeds to the end. Step S16 corresponds to the target travel route generation unit 35.
この第2目標走行経路が生成される場合は、ステップS12での変曲ポイント複数有りと判定され、ステップS13での対向車線ランドマーク無しと判定され、ステップS14で障害物無しと判定された場合である。このため、実際の対向車線ランドマークMMはなく、自車前方の対向側の障害物を気にする必要がないシーンである。これにより、ステップS11で走路境界を補間した部分に関しては、交通ルール上も超えて問題はなく、「車が物理的に走行できる道路境界を超えないこと」が第2目標走行経路生成時の指標となる。 When this second target travel route is generated, it is determined that there are a plurality of inflection points in step S12, it is determined that there is no oncoming lane landmark in step S13, and it is determined that there is no obstacle in step S14. It is. Therefore, there is no actual oncoming lane landmark MM, and there is no need to worry about the obstacle on the opposite side in front of the host vehicle. As a result, there is no problem with the part where the road boundary is interpolated in step S11, even in terms of traffic rules, and “the road does not exceed the road boundary where the car can physically travel” is an indicator for generating the second target travel route. It becomes.
次に作用を説明する。
実施例1の作用を、「自動運転車両の走行制御処理作用」、「自動運転車両の走行制御の特徴作用」に分けて説明する。
Next, the operation will be described.
The operation of the first embodiment will be described by dividing it into “automatically driven vehicle travel control processing effect” and “automatically driven vehicle travel control characteristic effect”.
[自動運転車両の走行制御処理作用]
以下、図3のフローチャートについて、図3と図6と図8〜図10に基づいて、自動運転車両の走行制御の処理作用を説明する。また、図8〜図10において自車の現在位置を「A1」で示し、図8と図9において車の進行方向を「DM」で示し自車将来位置を「P11〜P13」で示し、図8と図10において対向車(対向車両、障害物)を「A2」で示す。
[Operation control processing operation of autonomous driving vehicle]
Hereinafter, the processing operation of the travel control of the autonomous driving vehicle will be described with reference to FIGS. 3, 6, and 8 to 10 in the flowchart of FIG. 3. 8 to 10, the current position of the vehicle is indicated by “A1”, the traveling direction of the vehicle is indicated by “DM” and the future position of the vehicle is indicated by “P11 to P13” in FIGS. 8 and FIG. 10, an oncoming vehicle (an oncoming vehicle or an obstacle) is indicated by “A2”.
まず、図6Aのように変曲ポイントIPが1つのときは、ステップS11→ステップS12→ステップS15→エンドへと進む。このとき、ステップS15では、図8Aに示す第1目標走行経路R1が生成される。 First, when there is one inflection point IP as shown in FIG. 6A, the process proceeds from step S11 → step S12 → step S15 → end. At this time, in step S15, a first target travel route R1 shown in FIG. 8A is generated.
次に、図6Bのように変曲ポイントIPは2つあるが、対向車線ランドマークMMが存在するときは、ステップS11→ステップS12→ステップS13→ステップS15→エンドへと進む。このとき、ステップS15では、図8Bに示す第1目標走行経路R1が生成される。 Next, there are two inflection points IP as shown in FIG. 6B, but when the oncoming lane landmark MM exists, the process proceeds from step S11 to step S12 to step S13 to step S15 to end. At this time, in step S15, a first target travel route R1 shown in FIG. 8B is generated.
次に、図6Bのように変曲ポイントIPは2つあり、対向車線ランドマークMMは無いが、自車前方の対向側に対向車A2が有るときは、ステップS11→ステップS12→ステップS13→ステップS14→ステップS15→エンドへと進む。このとき、ステップS15では、図8Bと同様に、図8Cに示す第1目標走行経路R1が生成される。 Next, as shown in FIG. 6B, there are two inflection points IP and no oncoming lane landmark MM, but when the oncoming vehicle A2 is on the opposite side in front of the host vehicle, step S11 → step S12 → step S13 → The process proceeds from step S14 to step S15 to the end. At this time, in step S15, as in FIG. 8B, the first target travel route R1 shown in FIG. 8C is generated.
次に、図6Bのように変曲ポイントIPは2つあり、対向車線ランドマークMMは無く、自車前方の対向側に対向車A2が無いときは、ステップS11→ステップS12→ステップS13→ステップS14→ステップS16→エンドへと進む。このとき、ステップS16では、図9に示す第2目標走行経路R2が生成される。 Next, as shown in FIG. 6B, there are two inflection points IP, no oncoming lane landmark MM, and no oncoming vehicle A2 on the opposite side in front of the host vehicle, step S11 → step S12 → step S13 → step. The process proceeds from S14 to step S16 to the end. At this time, in step S16, the second target travel route R2 shown in FIG. 9 is generated.
ここで、第1目標走行経路R1と第2目標走行経路R2について、変曲ポイントIPを基準に比較する。例えば、図8Cと同条件の図10Aに示すように、第1目標走行経路R1(一点鎖線)では、各変曲ポイントIP1,IP2と第1目標走行経路R1との相対距離D1,D2は、相対距離D2よりも相対距離D1の方が長くなる(D1>D2)。これに対し、各変曲ポイントIP1,IP2と第2目標走行経路R2(破線)との相対距離D1´,D2´は、図9と同条件の図10Bに示すようになる。即ち、第2目標走行経路R2では、第1目標走行経路R1と比較すると、各変曲ポイントIP1,IP2と第2目標走行経路R2との相対距離D1´,D2´は、一方の変曲ポイントIP1とは長く(D1<D1´)、他方の変曲ポイントIP2とは短くなる(D2>D2´)。即ち、自車が走行する経路において、手前側の変曲ポイントIP1とは長く(D1<D1´)、奥側の変曲ポイントIP2とは短くなる(D2>D2´)。このため、第2目標走行経路は、各変曲ポイントIP1,IP2との相対距離を変えることにより、第1目標走行経路よりも曲率を抑えた経路となる。なお、図10Aと図10Bの道路形状等は同一である。 Here, the first target travel route R1 and the second target travel route R2 are compared based on the inflection point IP. For example, as shown in FIG. 10A under the same conditions as FIG. 8C, in the first target travel route R1 (dashed line), the relative distances D1, D2 between the inflection points IP1, IP2 and the first target travel route R1 are: The relative distance D1 is longer than the relative distance D2 (D1> D2). On the other hand, relative distances D1 ′ and D2 ′ between the inflection points IP1 and IP2 and the second target travel route R2 (broken line) are as shown in FIG. 10B under the same conditions as in FIG. That is, in the second target travel route R2, compared to the first target travel route R1, the relative distances D1 ′ and D2 ′ between the inflection points IP1 and IP2 and the second target travel route R2 are one inflection point. IP1 is long (D1 <D1 ′) and the other inflection point IP2 is short (D2> D2 ′). That is, in the route along which the vehicle travels, the inflection point IP1 on the near side is long (D1 <D1 ′) and the inflection point IP2 on the back side is short (D2> D2 ′). For this reason, the second target travel route is a route in which the curvature is suppressed more than that of the first target travel route by changing the relative distance between the inflection points IP1 and IP2. In addition, the road shape etc. of FIG. 10A and FIG. 10B are the same.
このように、短い区間に変曲ポイントが複数存在するルートを走行するとき、変曲ポイントIPの数と対向車線ランドマークMMの有無と対向車A2の有無により、第1目標走行経路R1又は第2目標走行経路R2が生成される。即ち、第1目標走行経路R1が生成されるときは、走路境界に沿った経路が生成されるので、自車A1と対向車A2の接近が抑制される。また、第2目標走行経路R2が生成されるときは、曲率を抑えた経路が生成されるので、過大な車両挙動が抑制される。従って、短い区間に変曲ポイントが複数存在する道路を走行するとき、過大な車両挙動と、自車A1と対向車A2の接近と、が抑制される。加えて、対向車線を規定する対向車線ランドマークMMが有る場合は、走路境界に沿った第1目標走行経路R1が生成されるので、対向車線ランドマークMMから自車がはみ出すことなく交通ルールを守った走行を可能とする。 Thus, when traveling on a route having a plurality of inflection points in a short section, depending on the number of inflection points IP, the presence or absence of the oncoming lane landmark MM, and the presence or absence of the oncoming vehicle A2, the first target travel route R1 or A two target travel route R2 is generated. That is, when the first target travel route R1 is generated, a route along the travel route boundary is generated, so that the approach of the host vehicle A1 and the oncoming vehicle A2 is suppressed. Further, when the second target travel route R2 is generated, a route with a reduced curvature is generated, so that excessive vehicle behavior is suppressed. Therefore, when traveling on a road having a plurality of inflection points in a short section, excessive vehicle behavior and the approach of the host vehicle A1 and the oncoming vehicle A2 are suppressed. In addition, when there is an oncoming lane landmark MM that defines the oncoming lane, the first target travel route R1 along the road boundary is generated, so the traffic rules can be set without causing the vehicle to protrude from the oncoming lane landmark MM. Enables safe driving.
なお、ステップS15での第1目標走行経路R1の生成の後、又はステップS16での第2目標走行経路R2の生成の後は、エンドへ進む。この後は、生成された目標走行経路が自動運転用認識判断プロセッサ3のメモリ上に格納される。次いで、生成された目標走行経路と自車の現在運動情報に基づいて、前方注視点が設定され、旋回目標値が算出される。その後、自動運転用制御コントローラ5にて、電動パワーステアリング6の操舵角目標値(操舵量の指令値)が算出され、これを外部指令情報として電動パワーステアリング6の操舵制御がECUで行われる。 Note that after the generation of the first target travel route R1 in step S15 or after the generation of the second target travel route R2 in step S16, the process proceeds to the end. Thereafter, the generated target travel route is stored in the memory of the automatic driving recognition determination processor 3. Next, a forward gazing point is set based on the generated target travel route and the current movement information of the host vehicle, and a turning target value is calculated. Thereafter, the steering angle target value (the command value of the steering amount) of the electric power steering 6 is calculated by the controller 5 for automatic driving, and the steering control of the electric power steering 6 is performed by the ECU using this as external command information.
[自動運転車両の走行制御の特徴作用]
実施例1では、変曲ポイントIPが2つ以上無いとき、又は、障害物有りと判定されるとき、ルートを基準に第1目標走行経路R1が生成される。変曲ポイントが2つ以上有り、かつ、障害物A2無しと判定されるとき、第2目標走行経路R2が生成される。第2目標走行経路R2では、第1目標走行経路R1を生成する場合よりも、各変曲ポイントIP1,IP2と第2目標走行経路R2との相対距離D1´,D2´は、一方の変曲ポイントIP1とは長く(D1<D1´)、他方の変曲ポイントIP2とは短くなる(D2>D2´)。即ち、第1目標走行経路R1が生成されるときは、走路境界に沿った経路が生成されるので、自車A1と対向車A2の接近が抑制される。また、第2目標走行経路R2が生成されるときは、曲率を抑えた経路が生成されるので、過大な車両挙動が抑制される。この結果、短い区間に変曲ポイントIPが複数存在する道路を走行するとき、乗員に与える違和感が抑制される。
[Characteristic effects of driving control for autonomous vehicles]
In the first embodiment, when there are not two or more inflection points IP or when it is determined that there is an obstacle, the first target travel route R1 is generated based on the route. When it is determined that there are two or more inflection points and there is no obstacle A2, the second target travel route R2 is generated. In the second target travel route R2, the relative distances D1 ′ and D2 ′ between the inflection points IP1 and IP2 and the second target travel route R2 are one of the inflections as compared with the case where the first target travel route R1 is generated. The point IP1 is long (D1 <D1 ′) and the other inflection point IP2 is short (D2> D2 ′). That is, when the first target travel route R1 is generated, a route along the travel route boundary is generated, so that the approach of the host vehicle A1 and the oncoming vehicle A2 is suppressed. Further, when the second target travel route R2 is generated, a route with a reduced curvature is generated, so that excessive vehicle behavior is suppressed. As a result, when driving on a road having a plurality of inflection points IP in a short section, an uncomfortable feeling given to the occupant is suppressed.
実施例1では、所定距離の区間長は、自車走行速度に応じて可変とし、自車走行速度が小さいほど区間長が短く設定される。従って、自車走行速度に応じて適切な経路が生成される。 In the first embodiment, the section length of the predetermined distance is variable according to the host vehicle traveling speed, and the section length is set shorter as the host vehicle traveling speed decreases. Accordingly, an appropriate route is generated according to the traveling speed of the vehicle.
実施例1では、ランドマークが無い箇所に関しては、走路境界を規定する反対側のランドマーク又はランドマークが途切れる前後のランドマークで補間が行われる。従って、走路境界を規定するランドマークがない道路に関しても、適切に経路の生成が行える。 In the first embodiment, with respect to a place where there is no landmark, interpolation is performed with the landmark on the opposite side that defines the road boundary or landmarks before and after the landmark is interrupted. Therefore, a route can be appropriately generated even for a road that does not have a landmark that defines the road boundary.
次に、効果を説明する。
実施例1の自動運転車両の走行制御方法及び走行制御装置にあっては、下記に列挙する効果を得ることができる。
Next, the effect will be described.
In the traveling control method and the traveling control device for the autonomous driving vehicle according to the first embodiment, the effects listed below can be obtained.
(1) 目標走行経路に基づいて、自車旋回のための制御を行うコントローラ(自動運転用認識判断プロセッサ3)を備える。
この運転支援車両(自動運転車両)の走行制御方法において、目的地までのルートを設定する。
ルート周囲の道路情報を取得する。
自車A1周辺の障害物(対向車A2)を検出する。
道路情報から、自車A1前方の走路を構成する走路境界に対して、所定距離の間に存在する曲率の変曲ポイントIPを検出する。
自車A1前方の対向側に障害物(対向車A2)の有無を判定する。
変曲ポイントIPが2つ以上無いとき、又は、障害物(対向車A2)有りと判定されたとき、ルートを基準に第1目標走行経路R1を生成する。
変曲ポイントIPが2つ以上有り、かつ、障害物(対向車A2)無しと判定されたとき、第2目標走行経路R2を生成する。第2目標走行経路R2では、第1目標走行経路R1を生成する場合よりも、各変曲ポイントIP1,IP2の相対距離D1´,D2´を、一方の変曲ポイントIP1とは長く(D1<D1´)、他方の変曲ポイントIP2とは短くなる(D2>D2´)。
このため、短い区間に変曲ポイントIPが複数存在する道路を走行するとき、乗員に与える違和感を抑制する運転支援車両(自動運転車両)の走行制御方法を提供することができる。
(1) A controller (automatic driving recognition determination processor 3) that performs control for turning the vehicle based on the target travel route is provided.
In the driving control method for this driving assistance vehicle (automatic driving vehicle), a route to the destination is set.
Get road information around the route.
An obstacle (oncoming vehicle A2) around the host vehicle A1 is detected.
From the road information, the inflection point IP of the curvature existing within a predetermined distance is detected with respect to the road boundary constituting the road ahead of the host vehicle A1.
The presence or absence of an obstacle (oncoming vehicle A2) is determined on the opposite side in front of the host vehicle A1.
When there are no more than two inflection points IP, or when it is determined that there is an obstacle (oncoming vehicle A2), the first target travel route R1 is generated based on the route.
When it is determined that there are two or more inflection points IP and there is no obstacle (oncoming vehicle A2), the second target travel route R2 is generated. In the second target travel route R2, the relative distances D1 ′ and D2 ′ of the inflection points IP1 and IP2 are longer than the one inflection point IP1 (D1 < D1 ′), the other inflection point IP2 becomes shorter (D2> D2 ′).
For this reason, when driving on a road having a plurality of inflection points IP in a short section, it is possible to provide a driving control method for a driving assistance vehicle (automatic driving vehicle) that suppresses discomfort given to the occupant.
(2) 所定距離の区間長は、自車走行速度に応じて可変とし、自車走行速度が小さいほど区間長を短く設定する。
このため、(1)の効果に加え、自車走行速度に応じて適切な経路を生成することができる。
(2) The section length of the predetermined distance is variable according to the host vehicle traveling speed, and the section length is set shorter as the host vehicle traveling speed is lower.
For this reason, in addition to the effect of (1), an appropriate route can be generated according to the traveling speed of the host vehicle.
(3) ルート周囲の道路情報のうち走路境界として、ルートの左右方向に存在する走行車線を規定するランドマークを参照する。
ランドマークが無い箇所に関しては、走路境界を規定する反対側のランドマーク又はランドマークが途切れる前後のランドマークで補間を行う。
このため、(1)〜(2)の効果に加え、走路境界を規定するランドマークがない道路に関しても、適切に経路の生成を行うことができる。
(3) Refer to landmarks that define the driving lanes that exist in the left-right direction of the route as the road boundary in the road information around the route.
For the places where there are no landmarks, interpolation is performed with landmarks on the opposite side that define the road boundary or landmarks before and after the landmark is interrupted.
For this reason, in addition to the effects (1) and (2), a route can be appropriately generated even for a road that does not have a landmark that defines the road boundary.
(4) 目標走行経路に基づいて、自車旋回のための制御を行うコントローラ(自動運転用認識判断プロセッサ3)を備える。
この運転支援車両(自動運転車両)の走行制御装置において、コントローラ(自動運転用認識判断プロセッサ3)は、ルート設定部(GPS/ナビゲーションシステム2)と、道路形状取得部(地図データ4)と、を有する。また、コントローラ(自動運転用認識判断プロセッサ3)は、障害物検出部(認識センサ1)と、左右旋回ポイント検出部32と、障害物判定部34と、目標走行経路生成部35と、を有する。
ルート設定部(GPS/ナビゲーションシステム2)は、目的地までのルートを設定する。
道路形状取得部(地図データ4)は、ルート周囲の道路情報を取得する。
障害物検出部(認識センサ1)は、自車A1周辺の障害物(対向車A2)を検出する。
左右旋回ポイント検出部32は、道路情報から、自車A1前方の走路を構成する走路境界に対して、所定距離の間に存在する曲率の変曲ポイントIPを検出する。
障害物判定部34は、自車A1前方の対向側に障害物(対向車A2)の有無を判定する。
目標走行経路生成部35は、変曲ポイントIPが2つ以上無いとき、又は、障害物(対向車A2)有りと判定されたとき、ルートを基準に第1目標走行経路R1を生成する。また、目標走行経路生成部35は、変曲ポイントIPが2つ以上有り、かつ、障害物(対向車A2)無しと判定されたとき、第2目標走行経路R2を生成する。第2目標走行経路R2では、第1目標走行経路R1を生成する場合よりも、各変曲ポイントIP1,IP2の相対距離D1´,D2´を、一方の変曲ポイントIP1とは長く(D1<D1´)、他方の変曲ポイントIP2とは短くなる(D2>D2´)。
このため、短い区間に変曲ポイントIPが複数存在する道路を走行するとき、乗員に与える違和感を抑制する運転支援車両(自動運転車両)の走行制御装置を提供することができる。
(4) A controller (automatic driving recognition determination processor 3) that performs control for turning the vehicle based on the target travel route is provided.
In the driving control device of the driving assistance vehicle (automatic driving vehicle), the controller (automatic driving recognition determination processor 3) includes a route setting unit (GPS / navigation system 2), a road shape acquisition unit (map data 4), Have The controller (automatic driving recognition determination processor 3) includes an obstacle detection unit (recognition sensor 1), a left / right turning point detection unit 32, an obstacle determination unit 34, and a target travel route generation unit 35. .
The route setting unit (GPS / navigation system 2) sets a route to the destination.
The road shape acquisition unit (map data 4) acquires road information around the route.
The obstacle detection unit (recognition sensor 1) detects an obstacle (oncoming vehicle A2) around the own vehicle A1.
The left / right turning point detection unit 32 detects, from the road information, an inflection point IP having a curvature existing within a predetermined distance with respect to a road boundary constituting the road ahead of the host vehicle A1.
The obstacle determination unit 34 determines the presence or absence of an obstacle (oncoming vehicle A2) on the opposite side in front of the host vehicle A1.
The target travel route generation unit 35 generates the first target travel route R1 based on the route when there are not two or more inflection points IP or when it is determined that there is an obstacle (oncoming vehicle A2). The target travel route generation unit 35 generates the second target travel route R2 when it is determined that there are two or more inflection points IP and there is no obstacle (oncoming vehicle A2). In the second target travel route R2, the relative distances D1 ′ and D2 ′ of the inflection points IP1 and IP2 are longer than the one inflection point IP1 (D1 < D1 ′), the other inflection point IP2 becomes shorter (D2> D2 ′).
For this reason, when driving on a road having a plurality of inflection points IP in a short section, it is possible to provide a driving control device for a driving assistance vehicle (automatic driving vehicle) that suppresses the uncomfortable feeling given to the occupant.
実施例2は、障害物の将来の移動予測を行い、目標走行経路を生成した例である。また、移動予測が外れた場合には、目標走行経路を障害物から離れる側の経路へと連続的に切り替えた例である。 Example 2 is an example in which the future travel of an obstacle is predicted and a target travel route is generated. Further, in the case where the movement prediction is deviated, the target travel route is continuously switched to the route on the side away from the obstacle.
まず、構成を説明する。実施例2における走行制御方法及び走行制御装置は、モータ駆動するハイブリッド車両(電動車両の一例)をベースとし、操舵/駆動/制動を外部制御することが可能な自動運転車両(運転支援車両の一例)に適用したものである。以下、実施例2の構成を、「自動運転用認識判断プロセッサの詳細構成」と、「自動運転車両の走行制御処理構成」に分けて説明する。なお、実施例2の「自動運転システム構成」は実施例1と同様であるから説明を省略する。 First, the configuration will be described. The travel control method and the travel control apparatus according to the second embodiment are based on a hybrid vehicle (an example of an electric vehicle) that is driven by a motor, and an autonomous driving vehicle (an example of a driving support vehicle) that can externally control steering / driving / braking. ). Hereinafter, the configuration of the second embodiment will be described by dividing it into “a detailed configuration of the recognition determination processor for automatic driving” and “a travel control processing configuration of the automatic driving vehicle”. The “automatic operation system configuration” of the second embodiment is the same as that of the first embodiment, and thus the description thereof is omitted.
[自動運転用認識判断プロセッサの詳細構成]
自動運転用認識判断プロセッサ3は、実施例1の自動運転用認識判断プロセッサ3の詳細構成に加えて、移動予測部を有する。
[Detailed configuration of recognition judgment processor for automatic driving]
The automatic driving recognition determination processor 3 includes a movement prediction unit in addition to the detailed configuration of the automatic driving recognition determination processor 3 of the first embodiment.
移動予測部は、認識センサ1の情報(自車周囲の環境情報等)と障害物有り信号を入力する。移動予測部は、障害物有り信号の入力により、自車と障害物との相対距離及び相対速度に基づいて、障害物の将来の移動予測を行う。この移動予測部は、移動予測の結果を、目標走行経路生成部35へ出力する。 The movement predicting unit inputs information of the recognition sensor 1 (environmental information around the vehicle) and an obstacle signal. The movement prediction unit performs future movement prediction of the obstacle based on the relative distance and relative speed between the host vehicle and the obstacle by inputting the obstacle presence signal. The movement prediction unit outputs the result of the movement prediction to the target travel route generation unit 35.
目標走行経路生成部35は、実施例1と同様に種々の情報や信号の入力に加え、移動予測の結果を入力する。目標走行経路生成部35は、実施例1と同様に種々の情報や信号に基づいて、目標走行経路としての第1目標走行経路R1又は第2目標走行経路R2を生成する。この目標走行経路生成部35は、生成された目標走行経路を、目標プロファイル生成部36へ出力する。 The target travel route generation unit 35 inputs the result of the movement prediction in addition to the input of various information and signals as in the first embodiment. The target travel route generation unit 35 generates the first target travel route R1 or the second target travel route R2 as the target travel route based on various information and signals as in the first embodiment. The target travel route generation unit 35 outputs the generated target travel route to the target profile generation unit 36.
また、目標走行経路生成部35は、種々の情報と障害物有り信号が入力されると、第1目標走行経路R1と第2目標走行経路R2の両方を生成する。続いて、目標走行経路生成部35は、移動予測の結果の入力により、自車に接近する障害物の有無を判定する。次に、目標走行経路生成部35は、その自車に接近する障害物の有無に基づいて、第1目標走行経路R1と第2目標走行経路R2の両方を生成して、第1目標走行経路R1と第2目標走行経路R2の切り替えタイミング及び各経路の重みの設定を調整する。また、この重みは、移動予測の接近度合いに対して、実際の接近度合いが近い場合、新たな重みに変更される。目標走行経路生成部35は、重み変更が発生すると、障害物から離れる側の経路へと連続的に切り替えられる目標走行経路を生成する。この目標走行経路生成部35は、生成された目標走行経路を、目標プロファイル生成部36へ出力する。 Further, when various information and an obstacle presence signal are input, the target travel route generation unit 35 generates both the first target travel route R1 and the second target travel route R2. Subsequently, the target travel route generation unit 35 determines the presence or absence of an obstacle approaching the host vehicle by inputting the result of the movement prediction. Next, the target travel route generation unit 35 generates both the first target travel route R1 and the second target travel route R2 based on the presence or absence of an obstacle approaching the host vehicle, and the first target travel route. The switching timing between R1 and the second target travel route R2 and the setting of the weight of each route are adjusted. Also, this weight is changed to a new weight when the actual approach degree is close to the approach degree of the movement prediction. When the weight change occurs, the target travel route generation unit 35 generates a target travel route that is continuously switched to a route on the side away from the obstacle. The target travel route generation unit 35 outputs the generated target travel route to the target profile generation unit 36.
なお、他の構成は、実施例1と同様であるので、図示及び説明を省略する。 Since other configurations are the same as those of the first embodiment, illustration and description thereof are omitted.
[自動運転車両の走行制御処理構成]
図11は、実施例2の自動運転用認識判断プロセッサにて実行される自動運転車両の走行制御処理の流れを示す。以下、自動運転車両の走行制御処理構成をあらわす図11に示すフローチャートの各ステップについて、図11と図12に基づき説明する。なお、図11に示す自動運転車両の走行制御処理は、所定の制御周期にて繰り返し実行される。また、図12において、自車の現在位置を「P11」で示し自車将来位置を「P12〜P14」で示し、障害物(対向車)の現在位置を「P21」で示し障害物の移動予測を「P22〜P24」で示す。
[Running control processing configuration of autonomous driving vehicle]
FIG. 11 shows the flow of a traveling control process for an autonomous driving vehicle executed by the recognition determination processor for autonomous driving according to the second embodiment. Hereafter, each step of the flowchart shown in FIG. 11 showing the traveling control processing configuration of the autonomous driving vehicle will be described with reference to FIGS. 11 and 12. In addition, the traveling control process of the automatic driving vehicle shown in FIG. 11 is repeatedly executed at a predetermined control cycle. In FIG. 12, the current position of the host vehicle is indicated by “P11”, the future position of the host vehicle is indicated by “P12 to P14”, and the current position of the obstacle (oncoming vehicle) is indicated by “P21”. Is indicated by “P22 to P24”.
図11のフローチャートでは、ルートが設定済みで、自動運転に必要な条件が満たされ、自動運転モードで走行中の状態からのものとする。なお、自動運転の性能向上のため、GPSは高精度に位置情報を取得できるシステムであり、地図データ4は現実環境を正しく高精度に表したデジタルデータであるとする。 In the flowchart of FIG. 11, it is assumed that the route has been set, the conditions necessary for automatic driving are satisfied, and the vehicle is traveling in the automatic driving mode. In order to improve the performance of automatic driving, the GPS is a system that can acquire position information with high accuracy, and the map data 4 is digital data that accurately represents the real environment with high accuracy.
ステップS21〜ステップS26のそれぞれは、ステップS11〜ステップS16のそれぞれに対応するため、説明を省略する。ただし、ステップS24で障害物無しと判定されたときはステップS26へ進み、ステップS24で障害物有りと判定されたときはステップS27へ進む。 Since each of step S21-step S26 respond | corresponds to each of step S11-step S16, description is abbreviate | omitted. However, when it is determined that there is no obstacle in step S24, the process proceeds to step S26, and when it is determined that there is an obstacle in step S24, the process proceeds to step S27.
ステップS27では、ステップS24での障害物有りとの判定に続き、第1目標走行経路R1と第2目標走行経路R2の両方を生成し、ステップS28へ進む(図8Cと図9参照)。つまり、ステップS27では、ステップS25とステップS26の処理を両方行うことになる。なお、ステップS27が、目標走行経路生成部35に相当する。また、このステップS27で生成された第1目標走行経路R1と第2目標走行経路R2の双方とも、自動運転用認識判断プロセッサ3のメモリ上に格納される。 In step S27, following the determination that there is an obstacle in step S24, both the first target travel route R1 and the second target travel route R2 are generated, and the process proceeds to step S28 (see FIGS. 8C and 9). That is, in step S27, both steps S25 and S26 are performed. Step S27 corresponds to the target travel route generation unit 35. Further, both the first target travel route R1 and the second target travel route R2 generated in step S27 are stored in the memory of the automatic driving recognition determination processor 3.
ステップS28では、ステップS27での第1目標走行経路R1と第2目標走行経路R2の両方の生成に続き、障害物の将来の移動予測を行う。なお、ステップS28が、移動予測部に相当する。 In step S28, following the generation of both the first target travel route R1 and the second target travel route R2 in step S27, the future movement of the obstacle is predicted. Step S28 corresponds to a movement prediction unit.
ここで、「移動予測」は、自車と障害物との相対距離及び相対速度に基づいて、所定時間将来までの障害物の移動予測を行う。相対距離と相対速度は、図12に示すように、認識センサ1により2次元情報を取得する。即ち、相対距離と相対速度の情報を(Dx,Dy,Vx,Vy)として取得する。また、「所定時間」とは、少なくとも自車が障害物を通り過ぎるまでの時間である。例えば、図12に示すように、障害物が現在位置P21の場合、障害物の将来の移動予測を位置P22からP24まで行う。また、ステップS28では、自車と障害物の相対距離と相対速度を記録しておき、相対距離や相対速度情報からTTC(Time to Collision)やTHW(Time HeadWay)が計算され、自車と障害物の接近度合を数値化することで障害物との相対情報が取得される。 Here, “movement prediction” performs the movement prediction of the obstacle until a predetermined time in the future based on the relative distance and relative speed between the vehicle and the obstacle. As for the relative distance and the relative speed, two-dimensional information is acquired by the recognition sensor 1 as shown in FIG. That is, information on relative distance and relative speed is acquired as (D x , D y , V x , V y ). Further, the “predetermined time” is a time until at least the own vehicle passes an obstacle. For example, as shown in FIG. 12, when the obstacle is the current position P21, the future movement prediction of the obstacle is performed from positions P22 to P24. In step S28, the relative distance and relative speed between the host vehicle and the obstacle are recorded, and TTC (Time to Collision) and THW (Time HeadWay) are calculated from the relative distance and relative speed information. Relative information with the obstacle is acquired by digitizing the degree of approach of the object.
ステップS29では、ステップS28での障害物の将来の移動予測に続き、第1目標走行経路R1と第2目標走行経路R2の重み設定を行い、目標走行経路を生成して、エンドへと進む。なお、ステップS29が、目標走行経路生成部35に相当する。 In step S29, following the prediction of the future movement of the obstacle in step S28, weights are set for the first target travel route R1 and the second target travel route R2, a target travel route is generated, and the process proceeds to the end. Step S29 corresponds to the target travel route generation unit 35.
このステップS29において、具体的には、まず、ステップS28での移動予測を踏まえて、図12に示すように、自車と障害物との時系列の移動推移から、移動予測に伴う自車と障害物の接近度合いに基づいて、自車に接近する障害物の有無が判定される。なお、図12において、自車が位置P12のとき、障害物は位置P22に移動するものと予測する。その「接近度合い」は、ステップS28での自車と障害物の相対距離や相対速度から算出されたTTCやTHWである。その接近度いと予め試験等により設定した接近度合閾値に基づいて、自車に接近する障害物の有無が判定される。接近度合いが接近度合閾値以下の場合は、自車に接近する障害物有りと判定され、接近度合いが接近度合閾値より大きい場合は、自車に接近する障害物無しと判定される。なお、自車に接近する障害物の有無の判定結果は、相対速度や相対距離の変化によって変わる。 In step S29, specifically, based on the movement prediction in step S28, as shown in FIG. 12, from the time-series movement transition between the own vehicle and the obstacle, Based on the approaching degree of the obstacle, the presence / absence of an obstacle approaching the host vehicle is determined. In FIG. 12, when the vehicle is at the position P12, the obstacle is predicted to move to the position P22. The “degree of approach” is TTC or THW calculated from the relative distance and relative speed between the vehicle and the obstacle in step S28. The presence / absence of an obstacle approaching the host vehicle is determined based on the approach degree and an approach degree threshold value set in advance by a test or the like. When the approach degree is less than or equal to the approach degree threshold value, it is determined that there is an obstacle approaching the host vehicle, and when the approach degree is greater than the approach degree threshold value, it is determined that there is no obstacle approaching the host vehicle. In addition, the determination result of the presence or absence of an obstacle approaching the own vehicle varies depending on changes in relative speed and relative distance.
次に、自車に接近する障害物の有無によって、ステップS27でメモリ上に格納された第1目標走行経路R1と第2目標走行経路R2の2つの経路から、目標走行経路を生成する。具体的には、まず、ステップS27でメモリ上に格納された第1目標走行経路R1と第2目標走行経路R2の2つの経路から、第2目標走行経路R2を読み出す。次に、ステップS28での移動予測を踏まえて、図12に示すように、自車と障害物との時系列の移動推移から、最も互いが接近する最接近ポイントを割り出す。例えば、自車が第2目標走行経路R2を走行した場合、図12において、同時刻に自車が自車位置P13へ移動し、障害物が障害物位置P23へ移動すると予測されるとき、このポイントを最接近ポイントとする。そして、この最接近ポイントの接近度合いから、第1目標走行経路R1と第2目標走行経路R2の各経路の重みづけを行う。 Next, a target travel route is generated from the two routes of the first target travel route R1 and the second target travel route R2 stored in the memory in step S27 depending on whether there is an obstacle approaching the host vehicle. Specifically, first, the second target travel route R2 is read out from the two routes of the first target travel route R1 and the second target travel route R2 stored in the memory in step S27. Next, based on the movement prediction in step S28, as shown in FIG. 12, the closest approach point is determined from the time-series movement transition of the vehicle and the obstacle. For example, when the vehicle travels on the second target travel route R2, in FIG. 12, when it is predicted that the vehicle moves to the vehicle position P13 and the obstacle moves to the obstacle position P23 at the same time, The point is the closest point. Then, each route of the first target travel route R1 and the second target travel route R2 is weighted from the degree of approach of this closest approach point.
ここで、第1目標走行経路R1と第2目標走行経路R2の重みの総和は「1」とする。メモリ上に格納された2つの経路情報と対応する重みから、重みづけ平均を取ったものを、最終的に旋回目標値を算出する上での目標走行経路とする。例えば、自車に接近する障害物有りと判定されると、障害物から離れる側の第1目標走行経路R1又は第2目標走行経路R2の重みが大きくなる。これに対し、自車に接近する障害物無しと判定されると、第2目標走行経路R2の重みが大きくなる。このように、自車と障害物との将来の移動予測に基づいて、自車に接近する障害物の有無が判定されるので、将来を踏まえた適切な目標走行経路(予測目標走行経路)の設定を行うことができる。つまり、移動予測に基づいて、自車の走行軌跡と障害物がどれだけ接近するかを指標として、適切な目標走行経路の設定を行うことができる。 Here, the sum of the weights of the first target travel route R1 and the second target travel route R2 is “1”. A weighted average obtained from the weights corresponding to the two route information stored in the memory is used as a target travel route for finally calculating the turning target value. For example, when it is determined that there is an obstacle approaching the host vehicle, the weight of the first target travel route R1 or the second target travel route R2 on the side away from the obstacle is increased. On the other hand, if it is determined that there is no obstacle approaching the host vehicle, the weight of the second target travel route R2 increases. In this way, since the presence or absence of an obstacle approaching the host vehicle is determined based on the future movement prediction between the host vehicle and the obstacle, an appropriate target driving route (predicted target driving route) based on the future is determined. Settings can be made. That is, based on the movement prediction, an appropriate target travel route can be set using as an index how close the travel locus of the host vehicle and the obstacle are.
また、移動予測は逐次行われ、互いの接近度合いの予測に基づいた重みづけは逐次行われる。例えば、制御周期毎に移動予測が行われ、重みづけが設定される。このため、移動予測の接近度合いと実際の自車と障害物の接近度合い(実際の接近度合い)を比較して、移動予測の接近度合いに対して、実際の接近度合いが近い場合、重み変更が発生する。即ち、予想が外れた場合、重み変更が発生する。即ち、この場合が、目標走行経路を切り替えるタイミングとなる。 Further, the movement prediction is performed sequentially, and the weighting based on the prediction of the degree of approach to each other is performed sequentially. For example, movement prediction is performed for each control period, and weighting is set. For this reason, when the approach degree of the movement prediction is compared with the approach degree (actual approach degree) between the actual vehicle and the obstacle, and the actual approach degree is close to the approach degree of the movement prediction, the weight change is performed. Occur. That is, if the prediction is not met, a weight change occurs. That is, this is the timing for switching the target travel route.
このように、移動予測が外れた場合、目標走行経路は、今までの重みで算出された目標走行経路から新たな重みで算出された目標走行経路へと連続的に切り替えられる。即ち、目標走行経路は、今までの重みで算出された目標走行経路から、障害物から離れる側の経路へと連続的に切り替えられる。この連続的な切り替えは、第1目標走行経路R1及び第2目標走行経路R2の重みの変更を連続的にすることで行われる。なお、障害物から離れる側の経路へと連続的に切り替えられる経路を、以下「切り替え目標走行経路」ともいう。 As described above, when the movement prediction is deviated, the target travel route is continuously switched from the target travel route calculated with the current weight to the target travel route calculated with the new weight. That is, the target travel route is continuously switched from the target travel route calculated with the weight so far to the route away from the obstacle. This continuous switching is performed by continuously changing the weights of the first target travel route R1 and the second target travel route R2. A route that can be continuously switched to a route away from the obstacle is also referred to as a “switching target travel route”.
次に作用を説明する。
実施例2の作用は、実施例1と同様に、「自動運転車両の走行制御の特徴作用」を示す。また、実施例2の作用を、「自動運転車両の走行制御処理作用」と、「実施例2の特徴作用」に分けて説明する。
Next, the operation will be described.
The operation of the second embodiment is similar to that of the first embodiment, and shows “characteristic operation of travel control of an automatically driven vehicle”. Further, the operation of the second embodiment will be described by dividing it into “a travel control processing operation of an automatically driven vehicle” and “a characteristic operation of the second embodiment”.
[自動運転車両の走行制御処理作用]
以下、図11のフローチャートについて、図11と図13に基づいて、自動運転車両の走行制御の処理作用を説明する。図13において、自車の位置を「P11、P12」で示し、障害物(対向車)の位置を「P21、P22、P22´」で示す。
[Operation control processing operation of autonomous driving vehicle]
Hereinafter, the processing operation of the travel control of the autonomous driving vehicle will be described with reference to FIGS. 11 and 13 in the flowchart of FIG. In FIG. 13, the position of the own vehicle is indicated by “P11, P12”, and the position of the obstacle (oncoming vehicle) is indicated by “P21, P22, P22 ′”.
ただし、図11において、ステップS21→ステップS22へと進む流れは、実施例1のステップS11→ステップS12へと進む流れと同様であるので、説明を省略する。また、ステップS22→ステップS25→エンドへと進む流れは、実施例1のステップS12→ステップS15→エンドへと進む流れと同様であるので、説明を省略する。また、ステップS22→ステップS23→ステップS25→エンドへと進む流れは、実施例1のステップS12→ステップS13→ステップS15→エンドへと進む流れと同様であるので、説明を省略する。さらに、ステップS22→ステップS23→ステップS24→ステップS26→エンドへと進む流れは、実施例1のステップS12→ステップS13→ステップS14→ステップS16→エンドへと進む流れと同様であるので、説明を省略する。 However, in FIG. 11, the flow from step S21 to step S22 is the same as the flow from step S11 to step S12 in the first embodiment, and thus the description thereof is omitted. Further, since the flow from step S22 to step S25 to the end is the same as the flow from step S12 to step S15 to the end of the first embodiment, description thereof is omitted. Further, the flow of going from step S22 → step S23 → step S25 → end is the same as the flow going from step S12 → step S13 → step S15 → end of the first embodiment, so the description is omitted. Furthermore, since the flow of going from step S22 → step S23 → step S24 → step S26 → end is the same as the flow going to step S12 → step S13 → step S14 → step S16 → end of the first embodiment, the explanation will be given. Omitted.
そして、変曲ポイントIPは2つあり、対向車線ランドマークは無いが、自車前方の対向側に障害物が有るときは、ステップS22→ステップS23→ステップS24へと進む。これは、実施例1のステップS12→ステップS13→ステップS14へと進む流れと同様であるので、説明を省略する。 Then, there are two inflection points IP and no oncoming lane landmark, but when there is an obstacle on the opposite side in front of the host vehicle, the process proceeds from step S22 to step S23 to step S24. This is the same as the flow from step S12 to step S13 to step S14 in the first embodiment, and a description thereof will be omitted.
ステップS24では、障害物有りと判定され、ステップS27→ステップS28→ステップS29→エンドへと進む。このとき、ステップS27では、第1目標走行経路R1と第2目標走行経路R2の両方が生成される。また、ステップS28では、自車と障害物との相対距離及び相対速度に基づいて、所定時間将来までの障害物の移動予測が行われる。さらに、ステップS29では、移動予測に伴う自車と障害物の接近度合いに基づいて、自車に接近する障害物の有無が判定される。次に、自車に接近する障害物の有無に基づいて、第1目標走行経路R1と第2目標走行経路R2の重み設定により予測目標走行経路が生成される。例えば、移動予測に基づいて、自車に接近する障害物の有無と最接近ポイントの接近度合いから、第1目標走行経路R1と第2目標走行経路R2の各経路の重みづけが行われる。そして、自車が走行する目標走行経路を、重みで算出された予測目標走行経路とする。 In step S24, it is determined that there is an obstacle, and the process proceeds from step S27 → step S28 → step S29 → end. At this time, in step S27, both the first target travel route R1 and the second target travel route R2 are generated. In step S28, the movement prediction of the obstacle up to a predetermined time in the future is performed based on the relative distance and relative speed between the vehicle and the obstacle. Furthermore, in step S29, the presence or absence of an obstacle approaching the host vehicle is determined based on the degree of approach between the host vehicle and the obstacle accompanying the movement prediction. Next, based on the presence or absence of an obstacle approaching the host vehicle, a predicted target travel route is generated by setting the weights of the first target travel route R1 and the second target travel route R2. For example, based on the movement prediction, the first target travel route R1 and the second target travel route R2 are weighted based on the presence or absence of an obstacle approaching the host vehicle and the approach degree of the closest approach point. Then, the target travel route on which the host vehicle travels is set as the predicted target travel route calculated by weight.
これに対し、図13に示すように、移動予測が外れた場合、重み変更が発生する。例えば、図13に示すように、自車が位置P11のときに、位置P21に障害物を検出した。そして、移動予測では、その時の相対距離と相対速度に基づいて、自車が位置P11からP12まで移動する際に、障害物は位置P21からP22へ到達するだろうと予測した。しかし、実際には、自車が位置P12へ移動した際、障害物は速度を上げて位置P21からP22´へ到達してしまった場合、重み変更が発生する。この場合、目標走行経路は、今までの重みで算出された目標走行経路から、障害物から離れる側の経路へと連続的に切り替えられる。この「障害物から離れる側の経路」は、図13において、例えば第1目標走行経路R1である。 On the other hand, as shown in FIG. 13, when the movement prediction is lost, a weight change occurs. For example, as shown in FIG. 13, when the vehicle is at the position P11, an obstacle is detected at the position P21. In the movement prediction, based on the relative distance and relative speed at that time, it is predicted that the obstacle will reach the positions P21 to P22 when the vehicle moves from the positions P11 to P12. However, in practice, when the own vehicle moves to the position P12, if the obstacle increases in speed and reaches the position P21 ′ from the position P21, a weight change occurs. In this case, the target travel route is continuously switched from the target travel route calculated with the weight so far to the route away from the obstacle. This “route on the side away from the obstacle” is, for example, the first target travel route R1 in FIG.
このように、短い区間に変曲ポイントが複数存在するルートを走行するとき、実施例1と同様に、過大な車両挙動と、自車と立体物の接近と、が抑制される。加えて、対向車線を規定するランドマークが有る場合は、走路境界に沿った第1目標走行経路R1が生成されるので、ランドマークから自車がはみ出すことなく交通ルールを守った走行を可能とする。また、障害物有りと判定されるとき、障害物の将来の移動予測を行って、自車に接近する障害物の有無を判定することにより、将来起きうる事態を踏まえた上での適切な予測目標走行経路が生成される。さらに、逐次移動予測とこの予測に基づいた重みづけを行うことで、仮に移動予測が外れても、目標走行経路が障害物から離れる側の経路へと連続的に切り替えられる。このため、仮に移動予測が外れた際にも、状況に合わせて適切に車両が制御される。 As described above, when traveling on a route having a plurality of inflection points in a short section, excessive vehicle behavior and the approach of the host vehicle and the three-dimensional object are suppressed as in the first embodiment. In addition, when there is a landmark that defines the oncoming lane, the first target travel route R1 along the road boundary is generated, so that it is possible to travel according to traffic rules without the vehicle protruding from the landmark. To do. In addition, when it is determined that there is an obstacle, it is possible to predict the future movement of the obstacle and determine whether there is an obstacle approaching the host vehicle. A target travel route is generated. Furthermore, by performing sequential movement prediction and weighting based on this prediction, even if the movement prediction is deviated, the target travel route is continuously switched to a route on the side away from the obstacle. For this reason, even when the movement prediction is deviated, the vehicle is appropriately controlled according to the situation.
なお、ステップS25での第1目標走行経路R1の生成の後、ステップS26での第2目標走行経路R2の生成の後、又は、ステップS29での目標走行経路の生成の後は、エンドへ進む。この後は、実施例1と同様であるので説明を省略する。 After the generation of the first target travel route R1 in step S25, after the generation of the second target travel route R2 in step S26, or after the generation of the target travel route in step S29, the process proceeds to the end. . Since the subsequent steps are the same as those in the first embodiment, description thereof is omitted.
[実施例2の特徴作用]
実施例2では、障害物有りと判定されたとき、自車と障害物との相対距離及び相対速度に基づいて障害物の将来の移動予測が行われる。そして、移動予測に伴う自車と障害物の接近度合いに基づいて、自車に接近する障害物の有無が判定される。即ち、移動予測に伴う自車と障害物の接近度合いに基づいて自車の走行軌跡と障害物がどれだけ接近するかを指標として目標走行経路が生成される。従って、将来起きうる事態を踏まえた上での適切な目標走行経路が生成される。
[Characteristic Action of Example 2]
In Example 2, when it is determined that there is an obstacle, future movement prediction of the obstacle is performed based on the relative distance and relative speed between the vehicle and the obstacle. And the presence or absence of the obstruction which approaches the own vehicle is determined based on the approach degree of the own vehicle and an obstruction accompanying movement prediction. That is, a target travel route is generated using as an index how close the travel locus of the host vehicle and the obstacle are based on the degree of approach between the host vehicle and the obstacle accompanying the movement prediction. Accordingly, an appropriate target travel route is generated in consideration of situations that may occur in the future.
実施例2では、移動予測の接近度合いに対して、実際の接近度合いが近い場合、目標走行経路は障害物から離れる側の第1目標走行経路R1へと連続的に切り替えられる。即ち、移動予測が外れて予測以上に障害物と接近してしまった際は、目標走行経路が障害物から離れる側の経路へと連続的に切り替えられる。従って、移動予測が外れた際にも、状況に合わせて適切に車両が制御される。 In the second embodiment, when the actual approach degree is close to the approach degree of the movement prediction, the target travel route is continuously switched to the first target travel route R1 on the side away from the obstacle. That is, when the movement prediction is deviated and the vehicle approaches the obstacle more than predicted, the target travel route is continuously switched to a route on the side away from the obstacle. Therefore, even when the movement prediction is lost, the vehicle is appropriately controlled according to the situation.
次に、効果を説明する。
実施例2の自動運転車両の走行制御方法及び走行制御装置にあっては、実施例1の(1)〜(3)に記載した効果が得られる。また、実施例2の自動運転車両の走行制御方法にあっては、下記(4)〜(5)の効果を得ることができる。
Next, the effect will be described.
In the traveling control method and the traveling control device for the autonomous driving vehicle according to the second embodiment, the effects described in the first embodiment (1) to (3) can be obtained. Moreover, in the traveling control method for an autonomous driving vehicle according to the second embodiment, the following effects (4) to (5) can be obtained.
(4) 障害物(対向車A2)有りと判定されたとき、自車A1と障害物(対向車A2)との相対距離及び相対速度に基づいて障害物(対向車A2)の将来の移動予測を行う。
移動予測に伴う自車A1と障害物(対向車A2)の接近度合いに基づいて、自車A1に接近する障害物(対向車A2)の有無を判定する。
このため、将来起きうる事態を踏まえた上での適切な目標走行経路を生成することができる。
(4) When it is determined that there is an obstacle (oncoming vehicle A2), future movement prediction of the obstacle (oncoming vehicle A2) based on the relative distance and relative speed between the own vehicle A1 and the obstacle (oncoming vehicle A2) I do.
The presence / absence of an obstacle (an oncoming vehicle A2) approaching the own vehicle A1 is determined based on the degree of approach between the own vehicle A1 and the obstacle (oncoming vehicle A2) associated with the movement prediction.
For this reason, it is possible to generate an appropriate target travel route in consideration of situations that may occur in the future.
(5) 移動予測の接近度合いに対して、実際の自車と障害物の接近度合いが近い場合、目標走行経路を障害物から離れる側の第1目標走行経路又は第2目標走行経路へと連続的に切り替える。
このため、(4)の効果に加え、移動予測が外れた際にも、状況に合わせて適切に車両を制御することができる。
(5) When the approach degree of the actual vehicle and the obstacle is close to the approach degree of the movement prediction, the target travel path is continuously connected to the first target travel path or the second target travel path on the side away from the obstacle. Switch.
For this reason, in addition to the effect of (4), the vehicle can be appropriately controlled according to the situation even when the movement prediction is lost.
実施例3は、障害物の将来の移動予測を行い、目標走行経路を生成した例である。また、移動予測が外れた場合には、自車将来位置及び自車将来姿勢の設定を修正した目標走行経路を再生成した例である。 The third embodiment is an example in which a future travel prediction of an obstacle is performed and a target travel route is generated. Further, in the case where the movement prediction is deviated, the target travel route in which the setting of the future position of the own vehicle and the future posture of the own vehicle is corrected is regenerated.
まず、構成を説明する。実施例3における走行制御方法及び走行制御装置は、モータ駆動するハイブリッド車両(電動車両の一例)をベースとし、操舵/駆動/制動を外部制御することが可能な自動運転車両(運転支援車両の一例)に適用したものである。以下、実施例3の構成を、「自動運転用認識判断プロセッサの詳細構成」と、「自動運転車両の走行制御処理構成」に分けて説明する。なお、実施例3の「自動運転システム構成」は実施例1と同様であるから説明を省略する。 First, the configuration will be described. The travel control method and travel control apparatus according to the third embodiment is based on a hybrid vehicle (an example of an electric vehicle) that is driven by a motor, and is an automatic driving vehicle (an example of a driving support vehicle) that can externally control steering / driving / braking. ). Hereinafter, the configuration of the third embodiment will be described by dividing it into “a detailed configuration of a recognition determination processor for automatic driving” and “a travel control processing configuration of an automatic driving vehicle”. The “automatic operation system configuration” of the third embodiment is the same as that of the first embodiment, and thus the description thereof is omitted.
[自動運転用認識判断プロセッサの詳細構成]
自動運転用認識判断プロセッサ3は、実施例1の自動運転用認識判断プロセッサ3の詳細構成に加えて、移動予測部と経路追従判定部を有する。なお、移動予測部については、実施例2と同様であるので説明を省略する。
[Detailed configuration of recognition judgment processor for automatic driving]
The automatic driving recognition determination processor 3 includes a movement prediction unit and a path following determination unit in addition to the detailed configuration of the automatic driving recognition determination processor 3 of the first embodiment. Note that the movement prediction unit is the same as that of the second embodiment, and thus the description thereof is omitted.
経路追従判定部は、予測目標走行経路や切り替え目標走行経路を入力する。経路追従判定部は、予測目標走行経路や切り替え目標走行経路を、自車が追従することが困難であるか否かを判定する。この経路追従判定部は、追従困難信号又は追従可能信号を、目標走行経路生成部35へ出力する。 The route tracking determination unit inputs a predicted target travel route and a switching target travel route. The route follow-up determination unit determines whether or not it is difficult for the vehicle to follow the predicted target travel route and the switching target travel route. This route follow-up determination unit outputs a follow-up difficulty signal or a followable signal to the target travel route generation unit 35.
目標走行経路生成部35は、予測目標走行経路や切り替え目標走行経路を生成する。次に、目標走行経路生成部35は、追従可能信号が入力されると、生成された目標走行経路を、目標プロファイル生成部36へ出力する。これに対し、目標走行経路生成部35は、追従困難信号が入力されると、自車が追従することが可能な目標走行経路を再生成する。即ち、第3目標走行経路R3が生成される(図15参照)。そして、目標走行経路生成部35は、生成された第3目標走行経路R3を、目標プロファイル生成部36へ出力する。他の目標走行経路生成部35の構成は、実施例2と同様であるので、説明を省略する。 The target travel route generation unit 35 generates a predicted target travel route and a switching target travel route. Next, when the followable signal is input, the target travel route generation unit 35 outputs the generated target travel route to the target profile generation unit 36. On the other hand, the target travel route generation unit 35 regenerates a target travel route that can be followed by the host vehicle when a follow-up difficulty signal is input. That is, the third target travel route R3 is generated (see FIG. 15). Then, the target travel route generation unit 35 outputs the generated third target travel route R3 to the target profile generation unit 36. Since the configuration of the other target travel route generation unit 35 is the same as that of the second embodiment, the description thereof is omitted.
なお、他の構成は、実施例1と同様であるので、図示及び説明を省略する。 Since other configurations are the same as those of the first embodiment, illustration and description thereof are omitted.
[自動運転車両の走行制御処理構成]
図14は、実施例3の自動運転用認識判断プロセッサにて実行される自動運転車両の走行制御処理の流れを示す。以下、自動運転車両の走行制御処理構成をあらわす図14に示すフローチャートの各ステップについて、図14と図15に基づき説明する。なお、図14に示す自動運転車両の走行制御処理は、所定の制御周期にて繰り返し実行される。また、図15において、自車の位置を「P11、P12、P14、P14´」で示し、障害物の位置を「P21、P22、P22´」で示す。
[Running control processing configuration of autonomous driving vehicle]
FIG. 14 shows the flow of a traveling control process for an autonomous driving vehicle that is executed by the autonomous driving recognition determination processor of the third embodiment. Hereinafter, each step of the flowchart shown in FIG. 14 showing the traveling control processing configuration of the autonomous driving vehicle will be described with reference to FIGS. 14 and 15. Note that the traveling control process for the autonomous vehicle shown in FIG. 14 is repeatedly executed at a predetermined control cycle. In FIG. 15, the position of the vehicle is indicated by “P11, P12, P14, P14 ′”, and the position of the obstacle is indicated by “P21, P22, P22 ′”.
ステップS31とステップS32を除き、ステップS21〜ステップS29のそれぞれは、実施例2と同様であるので、対応するステップに同一の符号を付して説明を省略する。ただし、ステップS29の処理の後は、ステップS31へ進む。 Except for step S31 and step S32, each of step S21 to step S29 is the same as that of the second embodiment, and therefore, the corresponding step is denoted by the same reference numeral and description thereof is omitted. However, after step S29, the process proceeds to step S31.
ステップS31では、ステップS29の目標走行経路の生成に続き、その目標走行経路を自車が追従することが困難であるか否かを判定する。YES(追従困難)の場合はステップS32へ進み、NO(追従可能)の場合はエンドへ進む。なお、ステップS31が、経路追従判定部に相当する。 In step S31, following the generation of the target travel route in step S29, it is determined whether it is difficult for the vehicle to follow the target travel route. If YES (difficult to follow), the process proceeds to step S32. If NO (followable), the process proceeds to the end. Step S31 corresponds to a path follow-up determination unit.
ここで、まず、ステップS31で対象とする経路は、ステップS29で生成される目標走行経路のうち、予測が外れた場合に生成される目標走行経路である。即ち、切り替え目標走行経路である。このため、ステップS29で予測目標走行経路が生成されるときは、ステップS31では追従可能と判定される。次いで、ステップS31の「その目標走行経路を自車が追従することが困難である」場合とは、ステップS29にて生成された切り替え目標走行経路が、自車のハード的な性能を超えた経路である場合である。この「自車のハード的な性能を超えた」とは、自車の最少旋回半径を下回る目標走行経路となった場合や、電動パワーステアリング6が出せる操舵速度の限界を超える場合等が考えられる。 Here, first, the target route in step S31 is the target travel route generated when the prediction is out of the target travel routes generated in step S29. That is, it is a switching target travel route. For this reason, when a predicted target travel route is generated in step S29, it is determined in step S31 that follow-up is possible. Next, in the case of “it is difficult for the vehicle to follow the target travel route” in step S31, the switching target travel route generated in step S29 is a route that exceeds the hardware performance of the own vehicle. This is the case. This “exceeding the hardware performance of the own vehicle” may be a case where the target traveling route is less than the minimum turning radius of the own vehicle or a case where the limit of the steering speed that the electric power steering 6 can output is exceeded. .
以下、ステップS31にて追従困難と判定される場合について説明する。例えば、実施例2で説明したように、障害物の急加速により、移動予測の接近度合いに対して、実際の接近度合いが近い場合、重み変更が発生する(図13と図15参照)。具体的には、図15に示すように、自車が位置P11のときに、位置P21に障害物を検出した。そして、移動予測では、その時の相対距離と相対速度に基づいて、自車が位置P11からP12まで移動する際に、障害物は位置P21からP22へ到達するだろうと予測した。しかし、実際には、自車が位置P12へ移動した際、障害物は速度を上げて位置P21からP22´へ到達してしまった。この場合が、予測が外れた場合であり、重み変更が発生する。このように予測が外れたとき、今までの重みで生成された目標走行経路から新たな重みで生成された目標走行経路に切り替わることで自車の経路追従が困難となる場合があり得る。このような場合は、ステップS31では追従困難と判定される。 Hereinafter, the case where it is determined in step S31 that tracking is difficult will be described. For example, as described in the second embodiment, when the actual approach degree is close to the approach degree of the movement prediction due to the sudden acceleration of the obstacle, the weight change occurs (see FIGS. 13 and 15). Specifically, as shown in FIG. 15, when the host vehicle is at position P11, an obstacle is detected at position P21. In the movement prediction, based on the relative distance and relative speed at that time, it is predicted that the obstacle will reach the positions P21 to P22 when the vehicle moves from the positions P11 to P12. However, in actuality, when the vehicle moved to the position P12, the obstacle increased in speed and reached from the position P21 to P22 ′. This case is a case where the prediction is lost, and a weight change occurs. In this way, when the prediction is lost, it may be difficult to follow the route of the host vehicle by switching from the target travel route generated with the current weight to the target travel route generated with the new weight. In such a case, it is determined in step S31 that it is difficult to follow.
ステップS32では、ステップS31での追従困難との判定に続き、自車の現在位置P12を始点として、目標走行経路の再生成を行い、エンドへと進む。即ち、自車が追従することが可能な第3目標走行経路R3が生成される。なお、ステップS32が、目標走行経路生成部35に相当する。 In step S32, following the determination that tracking is difficult in step S31, the target travel route is regenerated starting from the current position P12 of the host vehicle, and the process proceeds to the end. That is, a third target travel route R3 that can be followed by the host vehicle is generated. Step S32 corresponds to the target travel route generation unit 35.
このとき、再生成される第3目標走行経路R3の終点となる新自車将来位置Pnと新自車将来姿勢P14´は、図15に示すように、今までの目標走行経路における旧自車将来位置Poと旧自車将来姿勢P14と同一である必要はない。即ち、旧自車将来位置Poと旧自車将来姿勢P14の設定は、新自車将来位置Pnと新自車将来姿勢P14´の設定に修正される。その新自車将来位置Pnと新自車将来姿勢P14´は、図15に示すように、走路境界の範囲内で設定する。そして、始点P12(自車の現在位置)と終点(新自車将来位置Pnと新自車将来姿勢P14´)を滑らかに繋ぐことにより、第3目標走行経路R3の再生成を行う。 At this time, the new host vehicle future position Pn and the new host vehicle future posture P14 ′, which are the end points of the regenerated third target travel route R3, are shown in FIG. The future position Po and the old vehicle future attitude P14 need not be the same. That is, the setting of the old vehicle future position Po and the old vehicle future posture P14 is corrected to the setting of the new vehicle future position Pn and the new vehicle future posture P14 ′. The new vehicle future position Pn and the new vehicle future posture P14 ′ are set within the range of the road boundary as shown in FIG. Then, the third target travel route R3 is regenerated by smoothly connecting the start point P12 (the current position of the host vehicle) and the end point (the new host vehicle future position Pn and the new host vehicle future posture P14 ').
次に作用を説明する。
実施例3の作用は、実施例1と同様に、「自動運転車両の走行制御の特徴作用」を示す。また、実施例3の作用は、実施例2と同様に、「実施例2の特徴作用」を示す。さらに、実施例3の作用を、「自動運転車両の走行制御処理作用」と、「実施例3の特徴作用」に分けて説明する。
Next, the operation will be described.
The operation of the third embodiment is similar to that of the first embodiment, and shows “characteristic operation of travel control of an autonomous driving vehicle”. Further, the action of the third embodiment shows the “characteristic action of the second embodiment” as in the second embodiment. Further, the operation of the third embodiment will be described by dividing it into “a travel control processing operation of an autonomous driving vehicle” and “a characteristic operation of the third embodiment”.
[自動運転車両の走行制御処理作用]
以下、図14のフローチャートに基づいて、自動運転車両の走行制御の処理作用を説明する。ただし、ステップS21から1つ以上のステップを経由してステップS25へと進む流れ、及び、ステップS21から3つのステップを経由してステップS26へと進む流れは、実施例2と同様であるので、説明を省略する。また、ステップS21から5つのステップを経由してステップS29へと進む流れは、実施例2と同様であるので、説明を省略する。
[Operation control processing operation of autonomous driving vehicle]
Hereinafter, based on the flowchart of FIG. 14, the processing operation of the traveling control of the autonomous driving vehicle will be described. However, the flow from Step S21 to Step S25 via one or more steps and the flow from Step S21 to Step S26 via three steps are the same as in Example 2. Description is omitted. Further, the flow from step S21 to step S29 via five steps is the same as that in the second embodiment, and thus the description thereof is omitted.
ステップS29で、切り替え目標走行経路が生成される。次に、その切り替え目標走行経路を自車が追従することが困難であるときは、ステップS31→ステップS32→エンドへと進む。ステップS32では、図15に示すように、自車が追従することが可能な第3目標走行経路R3が生成される。即ち、目標走行経路が再生成される。 In step S29, a switching target travel route is generated. Next, when it is difficult for the vehicle to follow the switching target travel route, the process proceeds from step S31 to step S32 to end. In step S32, as shown in FIG. 15, a third target travel route R3 that can be followed by the host vehicle is generated. That is, the target travel route is regenerated.
また、ステップS29で生成された切り替え目標走行経路を自車が追従することが可能であるときは、ステップS31→エンドへと進む。このとき、ステップS32の第3目標走行経路R3ではなく、ステップS29で生成された切り替え目標走行経路又は予測目標走行経路となる。 Further, when the vehicle can follow the switching target travel route generated in step S29, the process proceeds from step S31 to end. At this time, it is not the third target travel route R3 in step S32 but the switching target travel route or the predicted target travel route generated in step S29.
このように、短い区間に変曲ポイントが複数存在するルートを走行するとき、実施例1と同様に、過大な車両挙動と、自車と立体物の接近と、が抑制される。加えて、対向車線を規定するランドマークが有る場合は、走路境界に沿った第1目標走行経路が生成されるので、ランドマークから自車がはみ出すことなく交通ルールを守った走行を可能とする。また、実施例2と同様に、障害物有りと判定されるとき、将来起きうる事態を踏まえた上での適切な目標走行経路が生成される。さらに、逐次移動予測とこの予測に基づいた重みづけを行うことで、仮に移動予測が外れても、目標走行経路が障害物から離れる側の経路へと連続的に切り替えられる。また、ステップS29での切り替え目標走行経路を自車が追従することが困難であるとき、第3目標走行経路R3が生成されるので、自車にとって無理な軌跡追従が抑制される。そして、仮に移動予測が外れた際にも、状況に合わせて適切に車両が制御される。 As described above, when traveling on a route having a plurality of inflection points in a short section, excessive vehicle behavior and the approach of the host vehicle and the three-dimensional object are suppressed as in the first embodiment. In addition, when there is a landmark that defines the oncoming lane, the first target travel route along the track boundary is generated, so that the vehicle can travel while following the traffic rules without protruding from the landmark. . Similarly to the second embodiment, when it is determined that there is an obstacle, an appropriate target travel route is generated in consideration of a situation that may occur in the future. Furthermore, by performing sequential movement prediction and weighting based on this prediction, even if the movement prediction is deviated, the target travel route is continuously switched to a route on the side away from the obstacle. In addition, when it is difficult for the vehicle to follow the switching target travel route in step S29, the third target travel route R3 is generated, so that trajectory tracking that is unreasonable for the vehicle is suppressed. Even when the movement prediction is deviated, the vehicle is appropriately controlled according to the situation.
なお、ステップS25での第1目標走行経路R1の生成の後、ステップS26での第2目標走行経路R2の生成の後、又は、ステップS29での目標走行経路の生成の後は、エンドへ進む。また、ステップS32での第3目標走行経路R3の生成の後は、エンドへ進む。この後は、実施例1と同様であるので説明を省略する。 After the generation of the first target travel route R1 in step S25, after the generation of the second target travel route R2 in step S26, or after the generation of the target travel route in step S29, the process proceeds to the end. . Further, after the generation of the third target travel route R3 in step S32, the process proceeds to the end. Since the subsequent steps are the same as those in the first embodiment, description thereof is omitted.
[実施例3の特徴作用]
実施例3では、移動予測の接近度合いに対して、実際の自車と障害物の接近度合いが近い場合、旧自車将来位置Poと旧自車将来姿勢P14の設定を修正した目標走行経路が再生成される。即ち、予測が外れた場合、第3目標走行経路R3が生成される。従って、移動予測が外れた際にも、状況に合わせて適切に車両が制御される。
[Characteristic Action of Example 3]
In the third embodiment, when the approach degree of the actual vehicle and the obstacle is close to the approach degree of the movement prediction, the target travel route in which the settings of the old car future position Po and the old car future posture P14 are corrected is set. Regenerated. That is, when the prediction is not true, the third target travel route R3 is generated. Therefore, even when the movement prediction is lost, the vehicle is appropriately controlled according to the situation.
加えて、実施例3では、切り替え目標走行経路を、自車が追従することが困難であるか否かが判定される。そして、追従困難と判定されたとき、旧自車将来位置Poと旧自車将来姿勢P14の設定を修正した目標走行経路が再生成される。従って、自車が追従することが困難であると判定されたとき、自車にとって無理な軌跡追従が抑制される。 In addition, in the third embodiment, it is determined whether or not it is difficult for the vehicle to follow the switching target travel route. When it is determined that it is difficult to follow, the target travel route in which the settings of the old vehicle future position Po and the old vehicle future posture P14 are corrected is regenerated. Accordingly, when it is determined that it is difficult for the host vehicle to follow, trajectory tracking that is impossible for the host vehicle is suppressed.
次に、効果を説明する。
実施例3の自動運転車両の走行制御方法及び走行制御装置にあっては、実施例1の(1)〜(3)と実施例2の(4)〜(5)に記載した効果が得られる。また、実施例3の自動運転車両の走行制御方法にあっては、下記(6)の効果を得ることができる。
Next, the effect will be described.
In the traveling control method and the traveling control device for the autonomous driving vehicle according to the third embodiment, the effects described in the first embodiment (1) to (3) and the second embodiment (4) to (5) can be obtained. . Further, in the traveling control method for an automatically driven vehicle according to the third embodiment, the following effect (6) can be obtained.
(6) ルートを基準に、自車A1が将来通過する自車将来位置(旧自車将来位置Po)と自車A1の通過時の自車将来姿勢(旧自車将来姿勢P14)を設定する。
自車の現時点における現在位置及び現在姿勢と自車将来位置(旧自車将来位置Po)及び自車将来姿勢(旧自車将来姿勢P14)とを滑らかに繋ぐ目標走行経路を生成する。
移動予測の接近度合いに対して、実際の自車A1と障害物(対向車A2)の接近度合いが近い場合、自車将来位置(旧自車将来位置Po)及び自車将来姿勢(旧自車将来姿勢P14)の設定を修正した目標走行経路(第3目標走行経路R3)を再生成する。
このため、移動予測が外れた際にも、状況に合わせて適切に車両を制御することができる。
(6) Based on the route, set the future position of the vehicle that the vehicle A1 will pass in the future (old vehicle future position Po) and the future posture of the vehicle when the vehicle A1 passes (old vehicle future position P14). .
A target travel route that smoothly connects the current position and current posture of the host vehicle, the host vehicle future position (old host vehicle future position Po), and the host vehicle future posture (old host vehicle future posture P14) is generated.
When the actual vehicle A1 and the obstacle (the oncoming vehicle A2) are close to the degree of approach of the movement prediction, the vehicle future position (old vehicle future position Po) and the vehicle future attitude (old vehicle) The target travel route (third target travel route R3) in which the setting of the future posture P14) is corrected is regenerated.
For this reason, even when the movement prediction is deviated, the vehicle can be appropriately controlled according to the situation.
実施例4は、障害物の将来の移動予測を行い、目標走行経路を生成した例である。また、移動予測が外れた場合には、自車を一時停止した例である。 The fourth embodiment is an example in which a future travel of an obstacle is predicted and a target travel route is generated. In addition, in the case where the movement prediction is lost, the own vehicle is temporarily stopped.
まず、構成を説明する。実施例4における走行制御方法及び走行制御装置は、モータ駆動するハイブリッド車両(電動車両の一例)をベースとし、操舵/駆動/制動を外部制御することが可能な自動運転車両(運転支援車両の一例)に適用したものである。以下、実施例4の構成を、「自動運転用認識判断プロセッサの詳細構成」と、「自動運転車両の走行制御処理構成」に分けて説明する。なお、実施例4の「自動運転システム構成」は実施例1と同様であるから説明を省略する。 First, the configuration will be described. The travel control method and travel control apparatus according to the fourth embodiment is based on a motor-driven hybrid vehicle (an example of an electric vehicle), and is an automatic driving vehicle (an example of a driving support vehicle) capable of externally controlling steering / driving / braking. ). Hereinafter, the configuration of the fourth embodiment will be described by dividing it into “a detailed configuration of the recognition determination processor for automatic driving” and “a travel control processing configuration of the automatic driving vehicle”. The “automatic driving system configuration” of the fourth embodiment is the same as that of the first embodiment, and thus the description thereof is omitted.
[自動運転用認識判断プロセッサの詳細構成]
自動運転用認識判断プロセッサ3は、実施例1の自動運転用認識判断プロセッサ3の詳細構成に加えて、移動予測部と経路追従判定部と目標速度設定部を有する。なお、移動予測部は、実施例2と同様であるので説明を省略する。
[Detailed configuration of recognition judgment processor for automatic driving]
In addition to the detailed configuration of the automatic driving recognition determination processor 3 of the first embodiment, the automatic driving recognition determination processor 3 includes a movement prediction unit, a path follow-up determination unit, and a target speed setting unit. Note that the movement prediction unit is the same as that of the second embodiment, and thus the description thereof is omitted.
経路追従判定部は、追従困難信号又は追従可能信号を、目標速度設定部と目標走行経路生成部35へ出力する。他の経路追従判定部の構成は、実施例3と同様であるので説明を省略する。 The route follow-up determination unit outputs a follow-up difficulty signal or a followable signal to the target speed setting unit and the target travel route generation unit 35. Since the configuration of the other path follow-up determination unit is the same as that of the third embodiment, description thereof is omitted.
目標速度設定部は、目標走行経路と、予め設定した自車の横加速度制限(横G制限)及びヨーレイト制限と、障害物有り信号又は障害物無し信号と、追従困難信号又は追従可能信号と、を入力する。この目標速度設定部は、目標走行経路を走行する時の目標速度を設定する。目標速度は、予め設定した自車の最大横Gと最大ヨーレイト(自車の横加速度制限とヨーレイト制限)を超えない速度に設定する。また、目標速度設定部は、追従困難信号が入力されると、自車を一時停止するために目標速度を補正(調整)する。加えて、目標速度設定部は、一時停止の後の再発進時のために目標速度を補正する。この目標速度設定部は、設定した目標速度を、目標走行経路生成部35と目標プロファイル生成部36へ出力する。 The target speed setting unit includes a target travel route, a preset lateral acceleration limit (horizontal G limit) and a yaw rate limit of the own vehicle, an obstacle signal or an obstacle signal, a tracking difficulty signal or a tracking enable signal, Enter. The target speed setting unit sets a target speed when traveling on the target travel route. The target speed is set to a speed that does not exceed the preset maximum lateral G and maximum yaw rate (the lateral acceleration limit and the yaw rate limit of the host vehicle). Further, the target speed setting unit corrects (adjusts) the target speed in order to temporarily stop the own vehicle when the follow-up difficulty signal is input. In addition, the target speed setting unit corrects the target speed for the restart after the temporary stop. The target speed setting unit outputs the set target speed to the target travel route generation unit 35 and the target profile generation unit 36.
目標走行経路生成部35は、予測目標走行経路や切り替え目標走行経路を生成する。次に、目標走行経路生成部35は、追従可能信号が入力されると、生成された目標走行経路を、目標速度設定部と目標プロファイル生成部36へ出力する。これに対し、目標走行経路生成部35は、追従困難信号が入力されると、目標走行経路を、予測目標走行経路とする。この目標走行経路生成部35は、予測目標走行経路を、目標速度設定部と目標プロファイル生成部36へ出力する。他の目標走行経路生成部35の構成は、実施例2と同様であるので、説明を省略する。 The target travel route generation unit 35 generates a predicted target travel route and a switching target travel route. Next, when the followable signal is input, the target travel route generation unit 35 outputs the generated target travel route to the target speed setting unit and the target profile generation unit 36. On the other hand, when the follow difficult signal is input, the target travel route generation unit 35 sets the target travel route as the predicted target travel route. The target travel route generation unit 35 outputs the predicted target travel route to the target speed setting unit and the target profile generation unit 36. Since the configuration of the other target travel route generation unit 35 is the same as that of the second embodiment, the description thereof is omitted.
なお、他の構成は、実施例1と同様であるので、図示及び説明を省略する。 Since other configurations are the same as those of the first embodiment, illustration and description thereof are omitted.
[自動運転車両の走行制御処理構成]
図16は、実施例4の自動運転用認識判断プロセッサにて実行される自動運転車両の走行制御処理の流れを示す。以下、自動運転車両の走行制御処理構成をあらわす図16に示すフローチャートの各ステップについて、図16と図17に基づき説明する。なお、図16に示す自動運転車両の走行制御処理は、所定の制御周期にて繰り返し実行される。また、図17において、自車を「A1」で示し、対向車(対向車両、障害物)を「A2」で示す。
[Running control processing configuration of autonomous driving vehicle]
FIG. 16 shows the flow of a traveling control process for an autonomous driving vehicle that is executed by the autonomous driving recognition determination processor of the fourth embodiment. Hereinafter, each step of the flowchart shown in FIG. 16 showing the traveling control processing configuration of the autonomous driving vehicle will be described with reference to FIGS. 16 and 17. In addition, the traveling control process of the autonomous driving vehicle shown in FIG. 16 is repeatedly executed at a predetermined control cycle. In FIG. 17, the own vehicle is indicated by “A1”, and the oncoming vehicle (oncoming vehicle, obstacle) is indicated by “A2”.
ステップS41とステップS42を除き、ステップS21〜ステップS29のそれぞれは、実施例2と同様であるので、対応するステップに同一の符号を付して説明を省略する。ただし、ステップS25とステップS26とステップS27の処理が一部異なる。また、ステップS29の後は、ステップS41へ進む。 Except for step S41 and step S42, each of step S21 to step S29 is the same as that of the second embodiment, and therefore, the corresponding step is denoted by the same reference numeral and description thereof is omitted. However, steps S25, S26, and S27 are partially different. Further, after step S29, the process proceeds to step S41.
まず、ステップS25〜ステップS27について説明する。実施例2のステップS27では、ステップS25とステップS26の処理を両方行うと説明した。また、実施例2において、そのステップS25とステップS26は、ステップS15とステップS16に対応すると説明した。さらに、実施例1において、そのステップS15とステップS16では、目標走行経路を構成する各ノードは、2次元座標情報であるxiとyiが記録されていると説明した。 First, step S25 to step S27 will be described. In step S27 of the second embodiment, it has been described that both the processes of step S25 and step S26 are performed. In the second embodiment, it has been described that step S25 and step S26 correspond to step S15 and step S16. Further, in the first embodiment, it has been described in steps S15 and S16 that each node constituting the target travel route is recorded with two-dimensional coordinate information x i and y i .
これに対し、実施例4のステップS25とステップS26においては、目標走行経路を構成する各ノードは、図17に示すように、2次元座標情報であるxiとyiの他、曲率情報ρi、速度情報νiが、併せて記録される。曲率情報ρiは、前後のノード情報から算出された情報であり、速度情報νiは各ノードを通過するときの情報である。なお、各情報は、自車が経路端に到達するまで、不図示の記録部に記録される。 On the other hand, in step S25 and step S26 of the fourth embodiment, each node constituting the target travel route includes, as shown in FIG. 17, curvature information ρ in addition to x i and y i that are two-dimensional coordinate information. i and velocity information ν i are recorded together. The curvature information ρ i is information calculated from the preceding and following node information, and the velocity information ν i is information when passing through each node. Each information is recorded in a recording unit (not shown) until the vehicle reaches the end of the route.
ここで、速度情報νiは、曲率情報ρiに基づいて、発生する横Gやヨーレイトが過大にならないように決定する。例えば、最大横Gと最大ヨーレイトを、それぞれGymax、γmaxとして予め設定し、生成経路を構成するノードの中で最も曲率の大きいノードに対して、式(1)で以下を算出する。
・・・(1)
Here, the speed information ν i is determined based on the curvature information ρ i so that the generated lateral G and yaw rate do not become excessive. For example, the maximum lateral G and the maximum yaw rate are set in advance as Gy max and γ max , respectively, and the following is calculated using Expression (1) for the node with the largest curvature among the nodes constituting the generation path.
... (1)
この速度情報νiに格納し、それを予め設定した最大縦G(最大前後G)であるGxmaxの範囲の中で連続して繋ぎ合わせる形で、各ノードに対する目標速度を算出する。ここで、「自車の横加速度制限及びヨーレイト制限」は、車種ごとに実験等により予め設定される。なお、最大縦Gも同様である。他のステップS25〜ステップS27のそれぞれは、実施例2のステップS25〜ステップS27と同様であるので、説明を省略する。 The target speed for each node is calculated in such a manner that it is stored in this speed information ν i and is continuously connected within a range of Gx max that is a preset maximum vertical G (maximum longitudinal G). Here, “the lateral acceleration limit and the yaw rate limit of the own vehicle” are set in advance by experiments or the like for each vehicle type. The same applies to the maximum vertical G. Since each of other step S25-step S27 is the same as that of step S25-step S27 of Example 2, description is abbreviate | omitted.
次いで、ステップS41では、ステップS29の目標走行経路の生成に続き、その目標走行経路を自車が追従することが困難であるか否かを判定する。YES(追従困難)の場合はステップS42へ進み、NO(追従可能)の場合はエンドへ進む。なお、ステップS41が、経路追従判定部に相当する。この他は、実施例3のステップS31と同様であるので、説明を省略する。 Next, in step S41, following the generation of the target travel route in step S29, it is determined whether it is difficult for the vehicle to follow the target travel route. If YES (following difficulty), the process proceeds to step S42, and if NO (following is possible), the process proceeds to the end. Step S41 corresponds to a path follow-up determination unit. The rest is the same as step S31 of the third embodiment, and a description thereof will be omitted.
ステップS42では、ステップS41での追従困難との判定に続き、自車を一時停止して、エンドへと進む。即ち、自車の目標速度が補正される。なお、ステップS42が、目標速度設定部と目標走行経路生成部35に相当する。 In step S42, following the determination that it is difficult to follow in step S41, the host vehicle is temporarily stopped and the process proceeds to the end. That is, the target speed of the own vehicle is corrected. Step S42 corresponds to the target speed setting unit and the target travel route generation unit 35.
ここで、「一時停止」は、駆動/回生モータ7や油圧ブレーキ8により行われる。即ち、まず、目標速度設定部が補正した目標速度は、目標プロファイル生成部36を介して、自動運転用制御コントローラ5へ入力される。即ち、補正した目標速度により、目標速度のプロファイルを修正する。次に、この自動運転用制御コントローラ5から駆動/回生モータ7や油圧ブレーキ8へ制御指令値が出力される。次に、その制御指令値にしたがって、駆動/回生モータ7が回生による減速走行を行ったり、油圧ブレーキ8が油圧制動を作動させたりすることにより、自車を一時停止させる。また、自車を一時停止した後は、障害物を通過させる。次に、自車の一時停止を解除して、切り替え目標走行経路ではなく予測目標走行経路にて、自車を再発進させる。 Here, the “temporary stop” is performed by the drive / regenerative motor 7 and the hydraulic brake 8. That is, first, the target speed corrected by the target speed setting unit is input to the automatic operation controller 5 via the target profile generation unit 36. In other words, the target speed profile is corrected based on the corrected target speed. Next, a control command value is output from the controller 5 for automatic operation to the drive / regenerative motor 7 and the hydraulic brake 8. Next, according to the control command value, the drive / regenerative motor 7 performs decelerating traveling by regeneration, or the hydraulic brake 8 activates hydraulic braking to temporarily stop the vehicle. In addition, after the vehicle is temporarily stopped, the obstacle is allowed to pass. Next, the suspension of the host vehicle is released, and the host vehicle is restarted on the predicted target travel route instead of the switching target travel route.
次に作用を説明する。
実施例4の作用は、実施例1と同様に、「自動運転車両の走行制御の特徴作用」を示す。また、実施例4の作用は、実施例2と同様に、「実施例2の特徴作用」を示す。さらに、実施例4の作用を、「自動運転車両の走行制御処理作用」と、「実施例4の特徴作用」に分けて説明する。
Next, the operation will be described.
The operation of the fourth embodiment shows the “characteristic operation of the traveling control of the autonomous driving vehicle” as in the first embodiment. Further, the action of the fourth embodiment shows the “characteristic action of the second embodiment” as in the second embodiment. Further, the operation of the fourth embodiment will be described by dividing it into “a travel control processing operation of an autonomous driving vehicle” and “a characteristic operation of the fourth embodiment”.
[自動運転車両の走行制御処理作用]
以下、図16のフローチャートについて、図16と図18に基づいて、自動運転車両の走行制御の処理作用を説明する。なお、図18において、自車を「P11〜P13」で示し、障害物を「P21、P22、P22´〜P24´」で示す。ただし、ステップS21から1つ以上のステップを経由してステップS25へと進む流れ、及び、ステップS21から3つのステップを経由してステップS26へと進む流れは、実施例2と同様であるので、説明を省略する。また、ステップS21から5つのステップを経由してステップS29へと進む流れは、実施例2と同様であるので、説明を省略する。
[Operation control processing operation of autonomous driving vehicle]
Hereinafter, the processing operation of the traveling control of the autonomous driving vehicle will be described with reference to FIGS. In FIG. 18, the own vehicle is indicated by “P11 to P13”, and the obstacle is indicated by “P21, P22, P22 ′ to P24 ′”. However, the flow from Step S21 to Step S25 via one or more steps and the flow from Step S21 to Step S26 via three steps are the same as in Example 2. Description is omitted. Further, the flow from step S21 to step S29 via five steps is the same as that in the second embodiment, and thus the description thereof is omitted.
ステップS29では、第1目標走行経路と第2目標走行経路の重み設定により目標走行経路が生成される。次に、その目標走行経路を自車が追従することが困難であるときは、ステップS41→ステップS42→エンドへと進む。 In step S29, the target travel route is generated by setting the weights of the first target travel route and the second target travel route. Next, when it is difficult for the vehicle to follow the target travel route, the process proceeds from step S41 to step S42 to the end.
例えば、図18に示すように、移動予測では、その時の相対距離と相対速度に基づいて、自車が位置P11からP12まで移動する際に、障害物は位置P21からP22へ到達するだろうと予測した。しかし、実際には、自車が位置P12へ移動した際、障害物は速度を上げて位置P21からP22´へ到達してしまった場合、重み変更が発生する。このとき、ステップS29では、目標走行経路は、今までの重みで算出された目標走行経路から新たな重みで算出された目標走行経路となる。しかし、この新たな重みで算出された目標走行経路を、自車が追従することが困難である場合、目標走行経路は今までの重みで算出された予測目標走行経路とされる。そして、位置P13で自車を一時停止させる。次に、この自車の一時停止の間に、対象となる障害物を通過させる(位置P23´)。次に、障害物が位置P24´へ到達した後、対向側に障害物が無いことを確認して、自車の一時停止が解除される。続いて、自車を再度速度復帰させることで自車の再発進が行われ、自車は予測目標走行経路を追従する。 For example, as shown in FIG. 18, in the movement prediction, it is predicted that the obstacle will reach the positions P21 to P22 when the host vehicle moves from the positions P11 to P12 based on the relative distance and the relative speed at that time. did. However, in practice, when the own vehicle moves to the position P12, if the obstacle increases in speed and reaches the position P21 ′ from the position P21, a weight change occurs. At this time, in step S29, the target travel route becomes a target travel route calculated with a new weight from the target travel route calculated with the weight up to now. However, when it is difficult for the host vehicle to follow the target travel route calculated with the new weight, the target travel route is set as the predicted target travel route calculated with the current weight. Then, the vehicle is temporarily stopped at position P13. Next, during the temporary stop of the own vehicle, the target obstacle is passed (position P23 ′). Next, after the obstacle reaches the position P24 ′, it is confirmed that there is no obstacle on the opposite side, and the temporary stop of the host vehicle is released. Subsequently, the vehicle is restarted by returning the speed again, and the vehicle follows the predicted target travel route.
また、ステップS29で生成された切り替え目標走行経路を自車が追従することが可能であるときは、ステップS41→エンドへと進む。このとき、ステップS42の自車の一時停止は行われず、ステップS29で生成された切り替え目標走行経路又は予測目標走行経路となる。 Further, when the vehicle can follow the switching target travel route generated in step S29, the process proceeds from step S41 to end. At this time, the vehicle is not temporarily stopped in step S42, but becomes the switching target travel route or the predicted target travel route generated in step S29.
このように、短い区間に変曲ポイントが複数存在するルートを走行するとき、実施例1と同様に、過大な車両挙動と、自車と立体物の接近と、が抑制される。加えて、対向車線を規定するランドマークが有る場合は、走路境界に沿った第1目標走行経路が生成されるので、ランドマークから自車がはみ出すことなく交通ルールを守った走行を可能とする。また、実施例2と同様に、障害物有りと判定されるとき、将来起きうる事態を踏まえた上での適切な目標走行経路が生成される。さらに、逐次移動予測とこの予測に基づいた重みづけを行うことで、仮に移動予測が外れても、目標走行経路が障害物から離れる側の経路へと連続的に切り替えられる。また、ステップS29での切り替え目標走行経路を自車が追従することが困難であるとき、自車を一時停止させるので、自車にとって無理な軌跡追従が抑制される。そして、仮に移動予測が外れた際にも、状況に合わせて適切に車両が制御される。 As described above, when traveling on a route having a plurality of inflection points in a short section, excessive vehicle behavior and the approach of the host vehicle and the three-dimensional object are suppressed as in the first embodiment. In addition, when there is a landmark that defines the oncoming lane, the first target travel route along the track boundary is generated, so that the vehicle can travel while following the traffic rules without protruding from the landmark. . Similarly to the second embodiment, when it is determined that there is an obstacle, an appropriate target travel route is generated in consideration of a situation that may occur in the future. Furthermore, by performing sequential movement prediction and weighting based on this prediction, even if the movement prediction is deviated, the target travel route is continuously switched to a route on the side away from the obstacle. In addition, when it is difficult for the host vehicle to follow the switching target travel route in step S29, the host vehicle is temporarily stopped. Even when the movement prediction is deviated, the vehicle is appropriately controlled according to the situation.
なお、ステップS25での第1目標走行経路の生成の後、ステップS26での第2目標走行経路の生成の後、ステップS29での目標走行経路の生成の後、又は、ステップS42での予測目標走行経路とされた後は、エンドへ進む。この後は、実施例1と同様であるので説明を省略する。 Note that after the generation of the first target travel route in step S25, the generation of the second target travel route in step S26, the generation of the target travel route in step S29, or the predicted target in step S42. After making the travel route, proceed to the end. Since the subsequent steps are the same as those in the first embodiment, description thereof is omitted.
[実施例4の特徴作用]
実施例4では、目標速度は、目標走行経路の曲率に応じて、予め設定した自車の最大横Gと最大ヨーレイトを超えない速度に設定される。即ち、目標走行経路を追従するための旋回時における目標速度は、最大横Gと最大ヨーレイトが所定値を超えない速度に設定される。従って、走行中に過大な車両挙動が抑えられる。
[Characteristic Action of Example 4]
In the fourth embodiment, the target speed is set to a speed that does not exceed the preset maximum lateral G and maximum yaw rate according to the curvature of the target travel route. That is, the target speed during the turn for following the target travel route is set to a speed at which the maximum lateral G and the maximum yaw rate do not exceed predetermined values. Accordingly, excessive vehicle behavior can be suppressed during traveling.
実施例4では、移動予測の接近度合いに対して、実際の自車と障害物の接近度合いが近い場合、自車を一時停止させる。即ち、予測が外れた場合、自車を一時停止させる。従って、移動予測が外れた際にも、状況に合わせて適切に車両が制御される。 In the fourth embodiment, when the actual vehicle and the obstacle are close to the movement predicted approach, the vehicle is temporarily stopped. In other words, if the prediction is wrong, the host vehicle is temporarily stopped. Therefore, even when the movement prediction is lost, the vehicle is appropriately controlled according to the situation.
加えて、実施例4では、切り替え目標走行経路を、自車が追従することが困難であるか否かが判定される。そして、追従困難と判定されたとき、自車を一時停止させる。従って、自車が追従することが困難であると判定されたとき、自車にとって無理な軌跡追従が抑制される。 In addition, in Example 4, it is determined whether it is difficult for the vehicle to follow the switching target travel route. When it is determined that it is difficult to follow, the host vehicle is temporarily stopped. Accordingly, when it is determined that it is difficult for the host vehicle to follow, trajectory tracking that is impossible for the host vehicle is suppressed.
次に、効果を説明する。
実施例4の自動運転車両の走行制御方法及び走行制御装置にあっては、実施例1の(1)〜(3)と実施例2の(4)〜(5)に記載した効果が得られる。また、実施例4の自動運転車両の走行制御方法にあっては、下記(7)〜(8)の効果を得ることができる。
Next, the effect will be described.
In the traveling control method and the traveling control device for the autonomous driving vehicle according to the fourth embodiment, the effects described in the first embodiment (1) to (3) and the second embodiment (4) to (5) can be obtained. . Further, in the traveling control method for an autonomous driving vehicle according to the fourth embodiment, the following effects (7) to (8) can be obtained.
(7) 目標走行経路を走行する際の目標速度を生成する。
目標速度は、目標走行経路の曲率に応じて、予め設定した自車の横加速度制限及びヨーレイト制限(最大横Gと最大ヨーレイト)を超えない速度に設定する。
このため、走行中に過大な車両挙動を抑えることができる。
(7) Generate a target speed when traveling on the target travel route.
The target speed is set to a speed that does not exceed the preset lateral acceleration limit and yaw rate limit (maximum lateral G and maximum yaw rate) of the vehicle according to the curvature of the target travel route.
For this reason, excessive vehicle behavior can be suppressed during traveling.
(8) 移動予測の接近度合いに対して、実際の自車A1と障害物(対向車A2)の接近度合いが近い場合、自車A1を一時停止する。
このため、(7)の効果に加え、移動予測が外れた際にも、状況に合わせて適切に車両を制御することができる。
(8) When the approach degree of the actual vehicle A1 and the obstacle (the oncoming vehicle A2) is close to the approach degree of the movement prediction, the host vehicle A1 is temporarily stopped.
For this reason, in addition to the effect of (7), the vehicle can be appropriately controlled according to the situation even when the movement prediction is lost.
以上、本開示の自動運転車両の走行制御方法及び走行制御装置を実施例1〜実施例4に基づき説明してきた。しかし、具体的な構成については、これらの実施例1〜実施例4に限られるものではなく、請求の範囲の各請求項に係る発明の要旨を逸脱しない限り、設計の変更や追加等は許容される。 As described above, the traveling control method and the traveling control device for the autonomous driving vehicle according to the present disclosure have been described based on the first to fourth embodiments. However, the specific configuration is not limited to the first to fourth embodiments, and design changes and additions are allowed without departing from the gist of the invention according to each claim of the claims. Is done.
実施例1〜実施例4では、第2目標走行経路R2は、第1目標走行経路R1と比較すると、相対距離D1´,D2´は、一方の変曲ポイントIP1とは長く(D1<D1´)、他方の変曲ポイントIP2とは短くなる(D2>D2´)例を示した。しかし、これに限られない。例えば、米国のように右側通行の場合には、各変曲ポイントと第2目標走行経路との相対距離は、第1目標走行経路R1と比較すると、実施例1〜実施例4の奥側の変曲ポイントとは短く、実施例1〜実施例4の手前側の変曲ポイントとは長くなる。即ち、日本のような左側通行の場合と米国のように右側通行の場合で、第1目標走行経路R1を生成する場合よりも、各変曲ポイントと第2目標走行経路との相対距離は変わる。このように構成しても、実施例1〜実施例4に記載した効果が得られる。 In Example 1 to Example 4, the second target travel route R2 is longer than the first target travel route R1 in that the relative distances D1 ′ and D2 ′ are longer than one inflection point IP1 (D1 <D1 ′). ), An example in which the other inflection point IP2 is shorter (D2> D2 ′) is shown. However, it is not limited to this. For example, in the case of right-hand traffic, such as in the United States, the relative distance between each inflection point and the second target travel route is greater than that of the first target travel route R1. The inflection point is short, and the inflection point on the near side of Examples 1 to 4 is long. That is, the relative distance between each inflection point and the second target travel route is different in the case of the left-hand traffic as in Japan and the right-hand traffic as in the United States than in the case of generating the first target travel route R1. . Even if comprised in this way, the effect described in Example 1- Example 4 is acquired.
実施例1〜実施例4では、障害物無しと判定され、変曲ポイントが2つの場合における各変曲ポイントIP1,IP2と第2目標走行経路R2との相対距離D1´、D2´を例示した。しかし、これに限られない。例えば、障害物無しと判定され、変曲ポイントが3つの場合には、第1目標走行経路R1を生成する場合よりも、各変曲ポイントと第2目標走行経路との相対距離は、自車が走行する経路において、手前側の変曲ポイントとは長く、手前側と一番奥側との中間の変曲ポイントとは短く、一番奥側の変曲ポイントとは長くなる経路を生成する。即ち、交互に変曲ポイントとの長さを変更する第2目標走行経路を生成する。このように構成しても、実施例1〜実施例4に記載した効果が得られる。 In Examples 1 to 4, the relative distances D1 ′ and D2 ′ between the inflection points IP1 and IP2 and the second target travel route R2 in the case where it is determined that there is no obstacle and there are two inflection points are exemplified. . However, it is not limited to this. For example, when it is determined that there are no obstacles and there are three inflection points, the relative distance between each inflection point and the second target travel route is greater than that in the case where the first target travel route R1 is generated. In the path traveled by, the inflection point on the near side is long, the inflection point in the middle between the near side and the farthest side is short, and the path that is longer than the inflection point on the farthest side is generated . That is, a second target travel route that alternately changes the length of the inflection point is generated. Even if comprised in this way, the effect described in Example 1- Example 4 is acquired.
実施例1〜実施例4では、「障害物」を、自車に接近する方向に移動する障害物のこととする例を示した。しかし、これに限られない。例えば、移動しない障害物でも良い。要するに、自車前方の対向側の障害物であれば良い。なお、移動しない障害物の場合、実施例4では、自車を一時減速させる。このように構成しても、実施例1〜実施例4に記載した効果が得られる。 In Examples 1 to 4, an example in which the “obstacle” is an obstacle that moves in a direction approaching the host vehicle is shown. However, it is not limited to this. For example, an obstacle that does not move may be used. In short, any obstacle on the opposite side in front of the host vehicle may be used. In the case of an obstacle that does not move, the vehicle is temporarily decelerated in the fourth embodiment. Even if comprised in this way, the effect described in Example 1- Example 4 is acquired.
実施例1〜実施例4では、電動パワーステアリング6を操舵アクチュエータとし、駆動/回生モータ7を駆動源アクチュエータとし、油圧ブレーキ8をブレーキアクチュエータとする例を示した。しかし、これに限られない。即ち、各制御系は、駆動輪(タイヤ)に対して転舵/駆動/制動の制御を外部指令に基づいて行えれば、上記手段(各アクチュエータ)以外のものでも、置換可能である。例えば、インホイールモータ等で、各輪を独立に制駆動できる手段を有する場合は、電動パワーステアリング6の制御に加え、制駆動力差で旋回動作をアシストする方法も考えられる。 In the first to fourth embodiments, the electric power steering 6 is a steering actuator, the drive / regenerative motor 7 is a drive source actuator, and the hydraulic brake 8 is a brake actuator. However, it is not limited to this. That is, each control system can be replaced with other than the above means (each actuator) as long as the steering / driving / braking control can be performed on the driving wheel (tire) based on the external command. For example, in the case where an in-wheel motor or the like has a means capable of braking / driving each wheel independently, a method of assisting the turning operation with a braking / driving force difference in addition to the control of the electric power steering 6 is conceivable.
実施例2〜実施例4では、相対距離と相対速度の情報を認識センサ1により2次元情報で取得する例を示した。しかし、これに限られない。例えば、相対距離と相対速度の情報を認識センサ1により1次元情報で取得しても良い。1次元情報で取得する場合でも、自車と障害物との相対距離及び相対速度に基づいて、所定時間将来までの障害物の移動予測を行うことが可能である。 In the second to fourth embodiments, the example in which the information on the relative distance and the relative speed is acquired as the two-dimensional information by the recognition sensor 1 has been described. However, it is not limited to this. For example, information on relative distance and relative speed may be acquired by the recognition sensor 1 as one-dimensional information. Even when acquiring with one-dimensional information, it is possible to predict the movement of the obstacle until a predetermined time in the future based on the relative distance and relative speed between the vehicle and the obstacle.
実施例2〜実施例4では、目標走行経路を障害物から離れる側の経路へと連続的に切り替える例を示した。しかし、これに限られない。例えば、目標走行経路を障害物から離れる側の経路へと段階的に切り替えても良い。このように構成しても、実施例2〜実施例4に記載した効果が得られる。また、障害物から離れる側の経路は、第1目標走行経路に限られず、自車の位置によって、第1目標走行経路又は第2目標走行経路となる。 In the second to fourth embodiments, the example in which the target travel route is continuously switched to the route on the side away from the obstacle is shown. However, it is not limited to this. For example, the target travel route may be switched stepwise to a route on the side away from the obstacle. Even if comprised in this way, the effect described in Example 2-Example 4 is acquired. Further, the route on the side away from the obstacle is not limited to the first target travel route, and becomes the first target travel route or the second target travel route depending on the position of the host vehicle.
実施例3では、予測が外れ、切り替え目標走行経路が生成され、この経路を自車が追従困難と判定されたとき、第3目標走行経路R3を生成する例を示した。しかし、これに限られない。例えば、予測が外れた場合、切り替え目標走行経路を生成せずに、第3目標走行経路R3を生成しても良い。このように構成しても、実施例3に記載した効果が得られる。 In the third embodiment, an example in which the third target travel route R3 is generated when the prediction is lost, a switching target travel route is generated, and the vehicle is determined to be difficult to follow the route is shown. However, it is not limited to this. For example, when the prediction is wrong, the third target travel route R3 may be generated without generating the switching target travel route. Even if comprised in this way, the effect described in Example 3 is acquired.
実施例4では、予測が外れ、切り替え目標走行経路が生成され、この経路を自車が追従困難と判定されたとき、自車を一時停止する例を示した。しかし、これに限られない。例えば、予測が外れた場合、切り替え目標走行経路を生成せずに、自車を一時減速又は一時停止しても良い。このように構成しても、実施例4に記載した効果が得られる。 In the fourth embodiment, an example is shown in which a prediction target is lost, a switching target travel route is generated, and the vehicle is temporarily stopped when it is determined that the vehicle is difficult to follow the route. However, it is not limited to this. For example, when the prediction is wrong, the host vehicle may be temporarily decelerated or temporarily stopped without generating the switching target travel route. Even if comprised in this way, the effect described in Example 4 is acquired.
実施例4では、自車を一時停止する例を示した。しかし、これに限られない。例えば、自車を一時減速させても良い。また、状況に合わせて、自車を一時減速又は一時停止しても良い。このように構成しても、実施例4に記載した効果が得られる。 In Example 4, the example which pauses the own vehicle was shown. However, it is not limited to this. For example, the host vehicle may be temporarily decelerated. Further, the host vehicle may be temporarily decelerated or temporarily stopped according to the situation. Even if comprised in this way, the effect described in Example 4 is acquired.
実施例1〜実施例4では、本開示の走行制御方法及び走行制御装置を、モータ駆動するハイブリッド車両(電動車両の一例)をベースとし、操舵/駆動/制動を外部制御することが可能な自動運転車両に適用する例を示した。しかし、本開示の走行制御方法及び走行制御装置は、ドライバーによる操舵運転/駆動運転/制動運転のうち、一部の運転を支援する運転支援車両であっても良い。要するに、走行ルートを表示することでドライバーの運転支援をする車両であれば適用することができる。また、本開示の走行制御方法及び走行制御装置は、ハイブリッド車両に限られず、電気自動車やエンジン車両に適用することもできる。 In the first to fourth embodiments, the traveling control method and the traveling control device of the present disclosure are based on a hybrid vehicle (an example of an electric vehicle) that is motor-driven, and can automatically control steering / driving / braking. The example applied to a driving vehicle was shown. However, the traveling control method and the traveling control device of the present disclosure may be a driving support vehicle that supports a part of driving among steering driving / driving driving / braking driving by a driver. In short, the present invention can be applied to any vehicle that supports driving by a driver by displaying a travel route. Moreover, the traveling control method and the traveling control device of the present disclosure are not limited to hybrid vehicles, and can be applied to electric vehicles and engine vehicles.
1 認識センサ(障害物検出部)
2 GPS/ナビゲーションシステム(ルート設定部)
3 自動運転用認識判断プロセッサ(コントローラ)
31 走路境界補間部
32 左右旋回ポイント検出部
33 対向車線ランドマーク判定部
34 障害物判定部
35 目標走行経路生成部
36 目標プロファイル生成部
4 地図データ4(道路形状取得部)
5 自動運転用制御コントローラ5(車両制御部)
A1 自車(自車両)
A2 障害物(対向車、対向車両)
D1,D2,D1´,D2´ 相対距離
IP,IP1,IP2 変曲ポイント
R1 第1目標走行経路
R2 第2目標走行経路
1 Recognition sensor (obstacle detection unit)
2 GPS / navigation system (route setting unit)
3 Recognition judgment processor (controller) for automatic driving
31 Road boundary interpolation unit 32 Left / right turning point detection unit 33 Oncoming lane landmark determination unit 34 Obstacle determination unit 35 Target travel route generation unit 36 Target profile generation unit 4 Map data 4 (road shape acquisition unit)
5. Controller 5 for automatic driving (vehicle control unit)
A1 Own vehicle (own vehicle)
A2 Obstacle (oncoming vehicle, oncoming vehicle)
D1, D2, D1 ′, D2 ′ Relative distances IP, IP1, IP2 Inflection point R1 First target travel route R2 Second target travel route
Claims (9)
目的地までのルートを設定し、
前記ルート周囲の道路情報を取得し、
自車周辺の障害物を検出し、
前記道路情報から、自車前方の走路を構成する走路境界に対して、所定距離の間に存在する曲率の変曲ポイントを検出し、
自車前方の対向側に前記障害物の有無を判定し、
前記変曲ポイントが2つ以上無いとき、又は、前記障害物有りと判定されたとき、前記ルートを基準に第1目標走行経路を生成し、
前記変曲ポイントが2つ以上有り、かつ、前記障害物無しと判定されたとき、前記第1目標走行経路を生成する場合よりも、前記各変曲ポイントの相対距離を、一方の変曲ポイントとは短く、他方の変曲ポイントとは長くなる第2目標走行経路を生成する
ことを特徴とする運転支援車両の走行制御方法。 In a driving control method for a driving assistance vehicle including a controller that performs control for turning the vehicle based on a target driving route,
Set the route to the destination,
Get road information around the route,
Detect obstacles around your vehicle,
From the road information, the inflection point of the curvature existing between a predetermined distance is detected with respect to the road boundary constituting the road ahead of the host vehicle,
Determine the presence or absence of the obstacle on the opposite side in front of the vehicle,
When there are no more than two inflection points, or when it is determined that there is an obstacle, a first target travel route is generated based on the route,
When it is determined that there are two or more inflection points and there is no obstacle, the relative distance of each inflection point is set as one inflection point, compared to the case of generating the first target travel route. And a second target travel route that is shorter than the other inflection point is generated.
前記所定距離の区間長は、自車走行速度に応じて可変とし、前記自車走行速度が小さいほど前記区間長を短く設定する
ことを特徴とする運転支援車両の走行制御方法。 In the driving control method of the driving assistance vehicle according to claim 1,
The section length of the predetermined distance is variable in accordance with the host vehicle traveling speed, and the section length is set shorter as the host vehicle traveling speed is lower.
前記ルート周囲の道路情報のうち走路境界として、前記ルートの左右方向に存在する走行車線を規定するランドマークを参照し、
前記ランドマークが無い箇所に関しては、前記走路境界を規定する反対側のランドマーク又は前記ランドマークが途切れる前後のランドマークで補間を行う
ことを特徴とする運転支援車両の走行制御方法。 In the driving control method of the driving assistance vehicle according to claim 1 or 2,
Refer to landmarks that define the driving lanes that exist in the left-right direction of the route as the road boundary in the road information around the route,
A driving control method for a driving assistance vehicle, characterized in that, with respect to a place without the landmark, interpolation is performed using a landmark on the opposite side that defines the road boundary or a landmark before and after the landmark is interrupted.
前記障害物有りと判定されたとき、自車と前記障害物との相対距離及び相対速度に基づいて前記障害物の将来の移動予測を行い、
前記移動予測に伴う自車と前記障害物の接近度合いに基づいて、自車に接近する前記障害物の有無を判定する
ことを特徴とする運転支援車両の走行制御方法。 In the driving control method of the driving assistance vehicle according to any one of claims 1 to 3,
When it is determined that there is an obstacle, a future movement of the obstacle is predicted based on a relative distance and a relative speed between the vehicle and the obstacle,
A driving control method for a driving assistance vehicle, wherein the presence or absence of the obstacle approaching the host vehicle is determined based on a degree of approach between the host vehicle and the obstacle accompanying the movement prediction.
前記移動予測の前記接近度合いに対して、実際の自車と前記障害物の接近度合いが近い場合、前記目標走行経路を前記障害物から離れる側の前記第1目標走行経路又は前記第2目標走行経路へと連続的又は段階的に切り替える
ことを特徴とする運転支援車両の走行制御方法。 In the driving control method of the driving assistance vehicle according to claim 4,
When the approach degree of the actual vehicle and the obstacle is close to the approach degree of the movement prediction, the first target travel path or the second target travel on the side away from the obstacle on the target travel path A driving control method for a driving assistance vehicle, wherein the driving assistance vehicle is switched to a route continuously or stepwise.
前記ルートを基準に、自車が将来通過する自車将来位置と自車の通過時の自車将来姿勢を設定し、
自車の現時点における現在位置及び現在姿勢と前記自車将来位置及び前記自車将来姿勢とを滑らかに繋ぐ目標走行経路を生成し、
前記移動予測の前記接近度合いに対して、実際の自車と前記障害物の接近度合いが近い場合、前記自車将来位置及び前記自車将来姿勢の設定を修正した前記目標走行経路を再生成する
ことを特徴とする運転支援車両の走行制御方法。 In the driving control method of the driving assistance vehicle according to claim 4 or claim 5,
Based on the route, set the future position of the vehicle where the vehicle will pass in the future and the future posture of the vehicle when the vehicle passes,
Generating a target travel route that smoothly connects the current position and current posture of the host vehicle to the future position of the host vehicle and the future posture of the host vehicle;
When the degree of approach between the actual vehicle and the obstacle is close to the degree of approach in the movement prediction, the target travel route in which the settings of the future position of the own vehicle and the future posture of the own vehicle are corrected is regenerated. A driving control method for a driving support vehicle.
前記目標走行経路を走行する際の目標速度を生成し、
前記目標速度は、前記目標走行経路の曲率に応じて、予め設定した自車の横加速度制限及びヨーレイト制限の少なくとも一方の制限を超えない速度に設定する
ことを特徴とする運転支援車両の走行制御方法。 In the driving control method of the driving assistance vehicle according to any one of claims 4 to 6,
Generate a target speed when traveling on the target travel route,
The target speed is set to a speed that does not exceed at least one of a lateral acceleration limit and a yaw rate limit set in advance according to the curvature of the target travel route. Method.
前記移動予測の前記接近度合いに対して、実際の自車と前記障害物の接近度合いが近い場合、自車を一時減速又は一時停止する
ことを特徴とする運転支援車両の走行制御方法。 In the driving control method of the driving assistance vehicle according to claim 7,
A driving control method for a driving assistance vehicle, characterized in that the host vehicle is temporarily decelerated or temporarily stopped when the approaching degree of the actual vehicle and the obstacle is close to the approaching degree of the movement prediction.
前記コントローラは、
目的地までのルートを設定するルート設定部と、
前記ルート周囲の道路情報を取得する道路形状取得部と、
自車周辺の障害物を検出する障害物検出部と、
前記道路情報から、自車前方の走路を構成する走路境界に対して、所定距離の間に存在する曲率の変曲ポイントを検出する左右旋回ポイント検出部と、
自車前方の対向側に前記障害物の有無を判定する障害物判定部と、
前記変曲ポイントが2つ以上無いとき、又は、前記障害物有りと判定されたとき、前記ルートを基準に第1目標走行経路を生成し、
前記変曲ポイントが2つ以上有り、かつ、前記障害物無しと判定されたとき、前記第1目標走行経路を生成する場合よりも、前記各変曲ポイントの相対距離を、一方の変曲ポイントとは短く、他方の変曲ポイントとは長くなる第2目標走行経路を生成する目標走行経路生成部と、
を有することを特徴とする運転支援車両の走行制御装置。 In a driving control device for a driving assistance vehicle including a controller that performs control for turning the vehicle based on a target driving route,
The controller is
A route setting section for setting a route to the destination;
A road shape acquisition unit for acquiring road information around the route;
An obstacle detector for detecting obstacles around the vehicle;
From the road information, a left and right turning point detection unit that detects an inflection point of curvature existing between a predetermined distance with respect to a road boundary constituting a road ahead of the host vehicle,
An obstacle determination unit for determining the presence or absence of the obstacle on the opposite side in front of the vehicle;
When there are no more than two inflection points, or when it is determined that there is an obstacle, a first target travel route is generated based on the route,
When it is determined that there are two or more inflection points and there is no obstacle, the relative distance of each inflection point is set as one inflection point, compared to the case of generating the first target travel route. A target travel route generating unit that generates a second target travel route that is short and is long with the other inflection point;
A driving control device for a driving assistance vehicle, comprising:
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2017169381A JP6972793B2 (en) | 2017-09-04 | 2017-09-04 | Driving control method and driving control device for driving support vehicles |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2017169381A JP6972793B2 (en) | 2017-09-04 | 2017-09-04 | Driving control method and driving control device for driving support vehicles |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2019043396A true JP2019043396A (en) | 2019-03-22 |
| JP6972793B2 JP6972793B2 (en) | 2021-11-24 |
Family
ID=65815318
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2017169381A Active JP6972793B2 (en) | 2017-09-04 | 2017-09-04 | Driving control method and driving control device for driving support vehicles |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP6972793B2 (en) |
Cited By (13)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110696826A (en) * | 2019-10-09 | 2020-01-17 | 北京百度网讯科技有限公司 | Method and apparatus for controlling a vehicle |
| WO2021230387A1 (en) * | 2020-05-11 | 2021-11-18 | 엘지전자 주식회사 | Device for providing route and method for providing route therefor |
| EP3945737A1 (en) | 2020-07-28 | 2022-02-02 | Toyota Jidosha Kabushiki Kaisha | Vehicle management system, management method, and program |
| CN114132311A (en) * | 2021-12-28 | 2022-03-04 | 联创汽车电子有限公司 | Method and module for screening dangerous targets for automatic emergency braking of vehicle |
| CN114287025A (en) * | 2019-06-14 | 2022-04-05 | 日产自动车株式会社 | Driving assistance method and driving assistance device |
| CN114397897A (en) * | 2022-01-20 | 2022-04-26 | 阿维塔科技(重庆)有限公司 | Method and device for generating boundary curve of vehicle driving area and storage medium |
| CN114721363A (en) * | 2020-12-18 | 2022-07-08 | 上海快仓智能科技有限公司 | Vehicle control method, automatic guided vehicle, and computer-readable storage medium |
| JP2023514869A (en) * | 2020-02-28 | 2023-04-11 | ズークス インコーポレイテッド | Systems and methods for adjusting planned trajectories for self-driving vehicles |
| KR102523146B1 (en) * | 2022-03-28 | 2023-04-18 | 주식회사 라이드플럭스 | Method, apparatus and computer program for modeling driving route for automatic driving of vehicle |
| JP2023069806A (en) * | 2021-11-08 | 2023-05-18 | 日産自動車株式会社 | Vehicle travel control method and travel control device |
| CN116399358A (en) * | 2023-02-13 | 2023-07-07 | 金龙联合汽车工业(苏州)有限公司 | A path planning method, device, storage medium and electronic equipment |
| CN116811914A (en) * | 2023-06-29 | 2023-09-29 | 重庆亿连信息科技有限公司 | Unmanned vehicle-mounted obstacle sensing system and method |
| CN117853975A (en) * | 2023-12-29 | 2024-04-09 | 广东智视云控科技有限公司 | Multi-lane vehicle speed detection line generation method, system and storage medium |
Citations (15)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2005309955A (en) * | 2004-04-23 | 2005-11-04 | Nissan Motor Co Ltd | Front road control system |
| JP2006131107A (en) * | 2004-11-05 | 2006-05-25 | Toyota Motor Corp | Vehicle control device |
| JP2006298294A (en) * | 2005-04-25 | 2006-11-02 | Honda Motor Co Ltd | Vehicle travel safety device |
| JP2008247328A (en) * | 2007-03-30 | 2008-10-16 | Honda Motor Co Ltd | Vehicle travel safety device |
| JP2009234543A (en) * | 2008-03-28 | 2009-10-15 | Mazda Motor Corp | Lane deviation alarm device for vehicle |
| JP2010217988A (en) * | 2009-03-13 | 2010-09-30 | Aisin Aw Co Ltd | Device, method, and program for supporting driving |
| JP2011204125A (en) * | 2010-03-26 | 2011-10-13 | Toyota Motor Corp | Situation predicting device and route generation device |
| JP2015013545A (en) * | 2013-07-04 | 2015-01-22 | 富士重工業株式会社 | Vehicle driving support control device |
| JP2015063201A (en) * | 2013-09-25 | 2015-04-09 | 日産自動車株式会社 | Vehicle travel control device |
| US20150158526A1 (en) * | 2013-12-09 | 2015-06-11 | Hyundai Motor Company | Apparatus and method for controlling automatic steering of vehicle |
| JP2016062308A (en) * | 2014-09-18 | 2016-04-25 | 富士重工業株式会社 | Outside environment recognition device |
| JP2016162191A (en) * | 2015-03-02 | 2016-09-05 | トヨタ自動車株式会社 | Travel control device |
| JP2017052414A (en) * | 2015-09-09 | 2017-03-16 | 株式会社デンソー | Vehicle control device |
| JP2017052393A (en) * | 2015-09-09 | 2017-03-16 | トヨタ自動車株式会社 | Vehicular travel control apparatus |
| JP2017100652A (en) * | 2015-12-04 | 2017-06-08 | 株式会社デンソー | Traveling locus generating device and traveling locus generating method |
-
2017
- 2017-09-04 JP JP2017169381A patent/JP6972793B2/en active Active
Patent Citations (15)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2005309955A (en) * | 2004-04-23 | 2005-11-04 | Nissan Motor Co Ltd | Front road control system |
| JP2006131107A (en) * | 2004-11-05 | 2006-05-25 | Toyota Motor Corp | Vehicle control device |
| JP2006298294A (en) * | 2005-04-25 | 2006-11-02 | Honda Motor Co Ltd | Vehicle travel safety device |
| JP2008247328A (en) * | 2007-03-30 | 2008-10-16 | Honda Motor Co Ltd | Vehicle travel safety device |
| JP2009234543A (en) * | 2008-03-28 | 2009-10-15 | Mazda Motor Corp | Lane deviation alarm device for vehicle |
| JP2010217988A (en) * | 2009-03-13 | 2010-09-30 | Aisin Aw Co Ltd | Device, method, and program for supporting driving |
| JP2011204125A (en) * | 2010-03-26 | 2011-10-13 | Toyota Motor Corp | Situation predicting device and route generation device |
| JP2015013545A (en) * | 2013-07-04 | 2015-01-22 | 富士重工業株式会社 | Vehicle driving support control device |
| JP2015063201A (en) * | 2013-09-25 | 2015-04-09 | 日産自動車株式会社 | Vehicle travel control device |
| US20150158526A1 (en) * | 2013-12-09 | 2015-06-11 | Hyundai Motor Company | Apparatus and method for controlling automatic steering of vehicle |
| JP2016062308A (en) * | 2014-09-18 | 2016-04-25 | 富士重工業株式会社 | Outside environment recognition device |
| JP2016162191A (en) * | 2015-03-02 | 2016-09-05 | トヨタ自動車株式会社 | Travel control device |
| JP2017052414A (en) * | 2015-09-09 | 2017-03-16 | 株式会社デンソー | Vehicle control device |
| JP2017052393A (en) * | 2015-09-09 | 2017-03-16 | トヨタ自動車株式会社 | Vehicular travel control apparatus |
| JP2017100652A (en) * | 2015-12-04 | 2017-06-08 | 株式会社デンソー | Traveling locus generating device and traveling locus generating method |
Cited By (20)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN114287025A (en) * | 2019-06-14 | 2022-04-05 | 日产自动车株式会社 | Driving assistance method and driving assistance device |
| CN110696826A (en) * | 2019-10-09 | 2020-01-17 | 北京百度网讯科技有限公司 | Method and apparatus for controlling a vehicle |
| CN110696826B (en) * | 2019-10-09 | 2022-04-01 | 北京百度网讯科技有限公司 | Method and device for controlling a vehicle |
| JP2023514869A (en) * | 2020-02-28 | 2023-04-11 | ズークス インコーポレイテッド | Systems and methods for adjusting planned trajectories for self-driving vehicles |
| JP7662655B2 (en) | 2020-02-28 | 2025-04-15 | ズークス インコーポレイテッド | SYSTEM AND METHOD FOR ADJUSTING PLANTED TRAJECTORY OF AN AUTONOMOUS VEHICLE |
| WO2021230387A1 (en) * | 2020-05-11 | 2021-11-18 | 엘지전자 주식회사 | Device for providing route and method for providing route therefor |
| US12466399B2 (en) | 2020-05-11 | 2025-11-11 | Lg Electronics Inc. | Device for providing route and method for providing route therefor |
| EP3945737A1 (en) | 2020-07-28 | 2022-02-02 | Toyota Jidosha Kabushiki Kaisha | Vehicle management system, management method, and program |
| US20220032907A1 (en) * | 2020-07-28 | 2022-02-03 | Toyota Jidosha Kabushiki Kaisha | Vehicle management system, management method, and program |
| CN114721363A (en) * | 2020-12-18 | 2022-07-08 | 上海快仓智能科技有限公司 | Vehicle control method, automatic guided vehicle, and computer-readable storage medium |
| JP7788045B2 (en) | 2021-11-08 | 2025-12-18 | 日産自動車株式会社 | Vehicle driving control method and driving control device |
| JP2023069806A (en) * | 2021-11-08 | 2023-05-18 | 日産自動車株式会社 | Vehicle travel control method and travel control device |
| CN114132311B (en) * | 2021-12-28 | 2024-05-14 | 联创汽车电子有限公司 | Dangerous target screening method and module for automatic emergency braking of vehicle |
| CN114132311A (en) * | 2021-12-28 | 2022-03-04 | 联创汽车电子有限公司 | Method and module for screening dangerous targets for automatic emergency braking of vehicle |
| CN114397897A (en) * | 2022-01-20 | 2022-04-26 | 阿维塔科技(重庆)有限公司 | Method and device for generating boundary curve of vehicle driving area and storage medium |
| KR102523146B1 (en) * | 2022-03-28 | 2023-04-18 | 주식회사 라이드플럭스 | Method, apparatus and computer program for modeling driving route for automatic driving of vehicle |
| US12330666B2 (en) | 2022-03-28 | 2025-06-17 | Rideflux Inc. | Method, apparatus, and computer program for modeling driving route for automatic driving of vehicle |
| CN116399358A (en) * | 2023-02-13 | 2023-07-07 | 金龙联合汽车工业(苏州)有限公司 | A path planning method, device, storage medium and electronic equipment |
| CN116811914A (en) * | 2023-06-29 | 2023-09-29 | 重庆亿连信息科技有限公司 | Unmanned vehicle-mounted obstacle sensing system and method |
| CN117853975A (en) * | 2023-12-29 | 2024-04-09 | 广东智视云控科技有限公司 | Multi-lane vehicle speed detection line generation method, system and storage medium |
Also Published As
| Publication number | Publication date |
|---|---|
| JP6972793B2 (en) | 2021-11-24 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP6972793B2 (en) | Driving control method and driving control device for driving support vehicles | |
| JP7295012B2 (en) | Vehicle control system and vehicle control method | |
| CN110316183B (en) | Driving assistance devices for vehicles | |
| RU2760046C1 (en) | Driving assistance and driving assistance device | |
| CN110053619B (en) | vehicle control device | |
| JP6811738B2 (en) | Vehicle lane change control method, vehicle lane change control device and related equipment | |
| JP6859907B2 (en) | Vehicle control unit | |
| JP6380920B2 (en) | Vehicle control device | |
| JP5130638B2 (en) | Avoidance operation calculation device, avoidance control device, vehicle including each device, avoidance operation calculation method, and avoidance control method | |
| JP6525402B2 (en) | Vehicle control device | |
| JP6269534B2 (en) | Travel control device | |
| JP7435787B2 (en) | Route confirmation device and route confirmation method | |
| JP6647361B2 (en) | Vehicle driving support device | |
| JP6525401B2 (en) | Vehicle control device | |
| KR20170091144A (en) | Target path generation device and travel control device | |
| JP6972792B2 (en) | Driving control method and driving control device for driving support vehicles | |
| JP6521487B2 (en) | Vehicle control device | |
| CN103935361A (en) | Efficient data flow algorithms for autonomous lane changing, passing and overtaking behaviors | |
| CN110799403A (en) | vehicle control device | |
| JP7162464B2 (en) | Driving support method and driving support device | |
| WO2023032092A1 (en) | Vehicle control method and vehicle control device | |
| JP7789540B2 (en) | Vehicle control device | |
| JP7258677B2 (en) | Operation control method and operation control device | |
| JPWO2018047232A1 (en) | Vehicle control device | |
| WO2016189727A1 (en) | Travel control device and method |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20200707 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20210617 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20210706 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20210903 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20211005 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20211018 |
|
| R151 | Written notification of patent or utility model registration |
Ref document number: 6972793 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |