JP5552948B2 - Course decision device - Google Patents
Course decision device Download PDFInfo
- Publication number
- JP5552948B2 JP5552948B2 JP2010173982A JP2010173982A JP5552948B2 JP 5552948 B2 JP5552948 B2 JP 5552948B2 JP 2010173982 A JP2010173982 A JP 2010173982A JP 2010173982 A JP2010173982 A JP 2010173982A JP 5552948 B2 JP5552948 B2 JP 5552948B2
- Authority
- JP
- Japan
- Prior art keywords
- course
- obstacles
- obstacle
- vehicle
- host vehicle
- 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.)
- Expired - Fee Related
Links
- 206010000117 Abnormal behaviour Diseases 0.000 claims description 39
- 230000002093 peripheral effect Effects 0.000 description 47
- 230000002159 abnormal effect Effects 0.000 description 31
- 238000011156 evaluation Methods 0.000 description 23
- 208000012661 Dyskinesia Diseases 0.000 description 15
- 238000010586 diagram Methods 0.000 description 10
- 230000000694 effects Effects 0.000 description 4
- 238000000034 method Methods 0.000 description 4
- 230000001133 acceleration Effects 0.000 description 1
- 230000001747 exhibiting effect Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
Images
Description
本発明は進路決定装置に関する。 The present invention relates to a course decision device.
特許文献1には、自車両の周辺車両が走行し得る軌道を周辺車両ごとに全部算出し、周辺車両が予測不可能な異常行動を起こすことを想定して、周辺車両との接触を回避する自車両の目標進路を立てる干渉評価方法等に関する技術が開示されている。 In Patent Document 1, all the tracks on which the surrounding vehicle of the host vehicle can travel are calculated for each surrounding vehicle, and the contact with the surrounding vehicle is avoided on the assumption that the surrounding vehicle causes an unpredictable abnormal behavior. A technique related to an interference evaluation method for setting a target course of the host vehicle is disclosed.
なお、特許文献2には、先行車両の異常行動を回避する進路パターンを立てる技術、特に、異常行動が行われない場合は走行効率の良い進路を選択し、異常行動が行われた場合は衝突を回避する進路を選択する進路評価装置に関する技術が開示されている。また、特許文献3には、カメラで検出した歩行者の歩幅および両足が地面に着いている時間から歩行者が将来存在し得る範囲を特定し、その範囲を回避するルートを立てる走行支援システムに関する技術が開示されている。 Patent Document 2 discloses a technique for creating a course pattern that avoids the abnormal behavior of the preceding vehicle, and in particular, when the abnormal behavior is not performed, a course with good traveling efficiency is selected, and when the abnormal behavior is performed, the collision occurs. A technique related to a course evaluation device that selects a course that avoids the problem is disclosed. Further, Patent Document 3 relates to a driving support system that specifies a range in which a pedestrian can exist in the future based on the pedestrian's stride detected by a camera and the time when both feet are on the ground, and establishes a route that avoids the range. Technology is disclosed.
しかしながら、従来技術では、全ての周辺車両が異常行動を起こすことを想定した場合において全周辺車両との接触を回避できる自車両の進路がないとき、自車両の目標進路を決定することができない虞がある、という問題点があった。 However, in the prior art, when it is assumed that all the surrounding vehicles cause abnormal behavior, there is a possibility that the target route of the own vehicle cannot be determined when there is no course of the own vehicle that can avoid contact with all the surrounding vehicles. There was a problem that there was.
本発明は、上記の事情に鑑みてなされたものであって、自車両の目標進路が決定される可能性を高めて自車両に現実的な走行を行わせることができる進路決定装置を提供することを目的とする。 The present invention has been made in view of the above circumstances, and provides a course determination device that can increase the possibility that the target course of the host vehicle is determined and cause the host vehicle to perform realistic travel. For the purpose.
本発明にかかる進路決定装置は、自車両の周辺に存在する障害物の挙動に関する情報を取得する周辺障害物挙動情報取得手段と、前記障害物が異常な挙動をした場合に、前記障害物が存在しうる領域である異常挙動領域を予測する異常挙動領域予測手段と、自車両の周辺に存在する複数の前記障害物のうち、異常な挙動をする一部の前記障害物と前記自車両との接触を回避する目標進路を導出する目標進路導出手段と、を備えたことを特徴とする。 The course determination device according to the present invention includes a peripheral obstacle behavior information acquisition unit that acquires information on the behavior of an obstacle existing around the host vehicle, and the obstacle is detected when the obstacle behaves abnormally. An abnormal behavior region predicting means for predicting an abnormal behavior region that is a region that can exist, and among the plurality of obstacles existing around the host vehicle, some of the obstacles exhibiting an abnormal behavior and the host vehicle, And a target course deriving means for deriving a target course that avoids the contact of.
なお、前記目標進路導出手段は、前記異常挙動領域を予測しない一部の前記障害物のパターンを変更し、複数パターンの前記目標進路を導出すること、が好ましい。 It is preferable that the target course deriving unit derives a plurality of patterns of the target course by changing a part of the obstacle patterns that do not predict the abnormal behavior region.
また、前記目標進路導出手段は、自車両の周辺において回避対象とする前記障害物を回避可能な前記目標進路が導出出来ない場合、回避対象とする前記障害物の数を更に減少して前記目標進路を導出すること、が好ましい。 The target route deriving means further reduces the number of the obstacles to be avoided when the target route that can avoid the obstacles to be avoided in the vicinity of the host vehicle cannot be derived. Deriving is preferable.
本発明によれば、自車両の周辺に存在する障害物の挙動に関する情報を取得し、障害物が異常な挙動をした場合に、障害物が存在しうる領域である異常挙動領域を予測し、自車両の周辺に存在する複数の障害物のうち、異常な挙動をする一部の障害物と自車両との接触を回避する目標進路を導出する。これにより、自車両の目標進路が決定される可能性を高めて自車両に現実的な走行を行わせることができる、という効果を奏する。全障害物が異常行動を起こす場合の進路だけでなく、一部の障害物のみが異常行動を起こすと想定した進路を用意しておくことで、最終的に進路が決定される可能性を高め、現実的な走行をさせることが可能となる、という効果を奏する。 According to the present invention, information on the behavior of an obstacle existing around the host vehicle is acquired, and when the obstacle behaves abnormally, an abnormal behavior area that is an area where the obstacle can exist is predicted, A target course that avoids contact between a part of obstacles that behave abnormally and a host vehicle among a plurality of obstacles existing around the host vehicle is derived. Thereby, there is an effect that the possibility that the target course of the host vehicle is determined can be increased and the host vehicle can be made to travel realistically. By preparing not only the path when all obstacles cause abnormal behavior but also the path assuming that only some obstacles cause abnormal behavior, the possibility that the course will be finally decided is increased. There is an effect that it is possible to make the vehicle run realistically.
本発明によれば、異常挙動領域を予測しない一部の障害物のパターンを変更し、複数パターンの目標進路を導出する。これにより、複数の異常行動パターンを想定して周辺障害物との接触リスクを低下させることができる、という効果を奏する。 According to the present invention, a pattern of some obstacles that do not predict an abnormal behavior region is changed, and a plurality of target courses are derived. Thereby, there exists an effect that a contact risk with a surrounding obstacle can be reduced supposing a plurality of abnormal action patterns.
本発明によれば、自車両の周辺において回避対象とする障害物を回避可能な目標進路が導出出来ない場合、回避対象とする障害物の数を更に減少して目標進路を導出する。これにより、全回避対象が異常行動を起こす場合の進路だけでなく、現在の回避対象のうち一部の障害物のみが異常行動を起こすと想定した進路を用意しておくことで、最終的に進路が決定される可能性を高め、現実的な走行をさせることが可能となる、という効果を奏する。 According to the present invention, when a target route that can avoid an obstacle to be avoided cannot be derived around the host vehicle, the target route is derived by further reducing the number of obstacles to be avoided. In this way, by preparing not only the path when all the avoidance targets cause abnormal behavior but also the path assumed that only some obstacles among the current avoidance targets cause abnormal behavior, There is an effect that it is possible to increase the possibility that the course is determined and to make a realistic driving.
以下に、本発明にかかる進路決定装置の実施形態(第1実施形態、第2実施形態および第3実施形態)を図面に基づいて説明する。なお、本発明は、これらの実施形態により限定されるものではない。 DESCRIPTION OF EMBODIMENTS Embodiments (first embodiment, second embodiment, and third embodiment) of a route determination device according to the present invention will be described below with reference to the drawings. Note that the present invention is not limited to these embodiments.
[第1実施形態]
ここでは、本発明にかかる進路決定装置の第1実施形態を図面に基づいて説明する。
[First Embodiment]
Here, a first embodiment of a course decision device according to the present invention will be described with reference to the drawings.
まず、本発明にかかる進路決定装置の第1実施形態の概要について説明する。特開2009−157502号公報に開示されている従来技術は、周辺障害物が異常な動きを取る(例えば先行車両が急ブレーキをかける等)ことを想定した上で当該周辺障害物との衝突を回避できる自車両の進路グループを選択することで、自車両の安全な進路を選択するものである。 First, the outline | summary of 1st Embodiment of the course determination apparatus concerning this invention is demonstrated. The conventional technology disclosed in Japanese Patent Application Laid-Open No. 2009-157502 is based on the assumption that the surrounding obstacle takes an abnormal movement (for example, the preceding vehicle applies a sudden brake) and the collision with the surrounding obstacle. By selecting a course group of the host vehicle that can be avoided, a safe course of the host vehicle is selected.
ところで、実交通環境では大抵、衝突を回避すべき周辺障害物が複数存在するが、このような環境で安全な自車両進路の選択を実現することは、車両の自動運転技術の商品性成立に必須である。 By the way, in the actual traffic environment, there are usually multiple surrounding obstacles that should avoid collisions. In such an environment, the realization of safe vehicle path selection is the realization of the commerciality of automatic vehicle driving technology. It is essential.
しかし、従来技術のように、複数の周辺障害物の動きの安全性について評価せずに単純に全ての周辺障害物が異常な動きを取ることを想定し、これら全ての周辺障害物との衝突を同時に回避しようとすると、周辺障害物の配置に因っては、衝突を回避できる自車両の適切な回避進路が存在せず、自車両進路を決定することができない虞がある。また、従来技術では、各々の周辺障害物の異常な動きに対する回避進路が存在することを基準に自車両進路を選択すると、異常な動きの周辺障害物以外の周辺障害物と干渉する進路も安全と評価されるので、自車両進路のさらなる安全性の向上について改善の余地が残されていた。また、従来技術では、周辺障害物の異常な動きと通常の動きの範囲を区別していないので、複数の周辺障害物のうちの一部が異常行動を取るという現実的なシナリオでの自車両の進路の安全さを適切に評価することができない。 However, as in the prior art, it is assumed that all peripheral obstacles take abnormal movement without evaluating the safety of movement of multiple peripheral obstacles, and collision with all these peripheral obstacles If there is an attempt to avoid the vehicle at the same time, there is no appropriate avoidance route of the host vehicle that can avoid a collision due to the arrangement of surrounding obstacles, and the host vehicle route may not be determined. In addition, in the prior art, when the course of the vehicle is selected based on the existence of an avoidance path for abnormal movement of each surrounding obstacle, the path that interferes with surrounding obstacles other than the peripheral obstacle of abnormal movement is also safe. As a result, there was room for improvement in terms of further improving the safety of the vehicle. Further, since the conventional technology does not distinguish between the abnormal movement of the surrounding obstacles and the range of the normal movement, the vehicle in a realistic scenario in which some of the plurality of surrounding obstacles take an abnormal action. The safety of the course cannot be properly evaluated.
そこで、第1実施形態では、全ての周辺障害物が同時に異常行動を取ることは現実的に極希であり大多数の周辺障害物は通常の動きを取ると想定した上で、複数の周辺障害物の各々に対して複数の動き範囲(異常な動き範囲、通常の動き範囲など)を設定し、これら複数の動き範囲を組み合わせることで自車両が回避すべき範囲を算出し、算出した回避すべき範囲を自車両が回避できることを基準に自車両の進路を選択する。すなわち、各周辺障害物に対し複数設定した動き範囲の組み合わせを回避する進路グループを高く評価する。これにより、周辺障害物が複数存在する実交通環境において自車両の安全な進路選択を実現することができる。 Therefore, in the first embodiment, it is practically rare for all peripheral obstacles to take abnormal actions at the same time, and it is assumed that the majority of peripheral obstacles take normal movement, and then a plurality of peripheral obstacles are assumed. A plurality of movement ranges (abnormal movement range, normal movement range, etc.) are set for each of the objects, and a range to be avoided by the own vehicle is calculated by combining the plurality of movement ranges, and the calculated avoidance is performed. The course of the host vehicle is selected based on the fact that the host vehicle can avoid the power range. That is, a route group that avoids a combination of a plurality of movement ranges set for each peripheral obstacle is highly evaluated. Thereby, the safe course selection of the own vehicle is realizable in the actual traffic environment where two or more surrounding obstacles exist.
つぎに、第1実施形態の進路決定装置の構成について図1を参照しながら説明する。図1は、第1実施形態の進路決定装置の構成を示すブロック図である。 Next, the configuration of the course decision device of the first embodiment will be described with reference to FIG. FIG. 1 is a block diagram illustrating a configuration of a route determination apparatus according to the first embodiment.
図1において、符号1は、自身の自動運転車両(自車両)に搭載されたECU(電子制御ユニット)に組み込まれた進路決定装置である。符号10は走行情報取得部であり、符号11は障害物動き範囲設定部であり、符号12は回避範囲設定部であり、符号13は進路評価部である。
In FIG. 1, the code | symbol 1 is the course determination apparatus integrated in ECU (electronic control unit) mounted in own self-driving vehicle (own vehicle).
走行情報取得部10は、自車両に搭載される各種センサやナビゲーションシステムの信号を入力することにより、自車両の位置・速度・操舵角などの走行状態や、周辺障害物(車両や歩行者など)の位置・速度などのセンシング結果、地図などの事前知識などの走行情報を取得して、取得した走行情報を障害物動き範囲設定部11へ必要に応じて適宜出力する。
The travel
障害物動き範囲設定部11は、走行情報取得部10から出力された走行情報を利用して、複数の周辺障害物の少なくとも1つに対して複数の動き範囲(異常な動き範囲、通常の動き範囲など)を設定し、設定した複数の動き範囲を回避範囲設定部12へ出力する。
The obstacle movement
回避範囲設定部12は、障害物動き範囲設定部11から出力された複数の動き範囲の組み合わせから、自車両が回避すべき範囲を設定し、設定した回避すべき範囲を進路評価部13へ出力する。
The avoidance range setting unit 12 sets a range to be avoided by the host vehicle from a combination of a plurality of motion ranges output from the obstacle movement
進路評価部13は、回避範囲設定部12から出力された回避すべき範囲を自車両が回避できる進路を、高く評価する。ここで、走行安全の基準だけでなく、走行効率や走行ルール遵守などの基準も併用して評価する場合には、進路評価部13は、特開2009−157502号公報で開示された技術概念を利用して、互いに類似する複数の進路からなる進路グループを評価してもよい。
The
つぎに、上述した構成の進路決定装置1で行われる進路決定動作の一例について、図2および図3を参照して説明する。図2は、第1実施形態の進路決定動作の一例を示すフローチャートである。図3は、第1実施形態の進路決定動作の適用場面の一例を示す図である。 Next, an example of a course determination operation performed by the course determination apparatus 1 having the above-described configuration will be described with reference to FIGS. 2 and 3. FIG. 2 is a flowchart illustrating an example of a course determination operation according to the first embodiment. FIG. 3 is a diagram illustrating an example of an application scene of the course determination operation of the first embodiment.
例えば、自車両が丁字路を走行中に、先行車両(周辺車両1)と路地から出てくる車両(周辺車両2)とが存在する場合、従来技術では、図3の(A)に示すように周辺車両1と2が同時に異常行動を取ることを想定して自車両が回避すべき範囲を設定し、設定した回避すべき範囲を回避できる自車両の進路(異常行動を取ると想定した全ての周辺車両との衝突を回避できる自車両の進路)を選択していた。 For example, when the host vehicle travels on a road with a leading vehicle (peripheral vehicle 1) and a vehicle that exits from the alley (peripheral vehicle 2), as shown in FIG. Assuming that neighboring vehicles 1 and 2 take abnormal actions at the same time, the range that the own vehicle should avoid is set, and the course of the own vehicle that can avoid the set avoidable range (all assumed to take abnormal action) The course of the own vehicle that can avoid a collision with a neighboring vehicle is selected.
しかし、全ての周辺車両が自車両に近接している図示したような状況では、全ての周辺車両が異常行動を取ることを想定すると、自車両が回避すべき範囲が大きくなり過ぎるため、設定した回避すべき範囲を回避できる自車両の進路が存在せず、結果として自車両の適切な進路を決定することができない虞がある。 However, in the situation shown in the figure where all the surrounding vehicles are close to the host vehicle, assuming that all the surrounding vehicles take an abnormal action, the range to be avoided by the own vehicle becomes too large. There is no course of the host vehicle that can avoid the range to be avoided, and as a result, an appropriate course of the host vehicle may not be determined.
そこで、周辺車両1と2が同時に異常行動を取ることは現実的に極希であることを考慮した上で、進路決定装置1は、先行の周辺車両1が異常行動を取り、路地の周辺車両2は通常の動きを取ると想定して自車両が回避すべき範囲を設定し、設定した回避すべき範囲を回避できる自車両の進路を決定する。具体的には、進路決定装置1は、以下の進路決定動作を実行する。これにより、複数の周辺車両のうちの一部が異常行動を取るという現実的なシナリオでの安全を担保できる自車両の進路を決定することができる。 Accordingly, in consideration of the fact that it is extremely rare for the surrounding vehicles 1 and 2 to take abnormal behavior at the same time, the course determination device 1 takes the abnormal behavior of the preceding surrounding vehicle 1 and the surrounding vehicles in the alley No. 2 sets a range that the host vehicle should avoid assuming normal movement, and determines a course of the host vehicle that can avoid the set avoidable range. Specifically, the course decision device 1 executes the following course decision operation. Thereby, the course of the own vehicle which can ensure the safety in the realistic scenario that some of several surrounding vehicles take abnormal action can be determined.
まず、走行情報取得部10は、自車両に搭載される各種センサやナビゲーションシステムの信号を入力することにより走行情報を取得し、取得した走行情報を障害物動き範囲設定部11へ出力する(ステップSA1)。
First, the travel
つぎに、障害物動き範囲設定部11は、ステップSA1で出力された走行情報を利用して、周辺車両1に対して異常な動き範囲を、周辺車両2に対して通常の動き範囲を設定し、設定したこれら複数の動き範囲を回避範囲設定部12へ出力する(ステップSA2)。
Next, the obstacle movement
つぎに、回避範囲設定部12は、ステップSA2で出力された複数の動き範囲の組み合わせから、自車両が回避すべき範囲を設定し、設定した回避すべき範囲を進路評価部13へ出力する(ステップSA3)。 Next, the avoidance range setting unit 12 sets a range to be avoided by the host vehicle from the combination of the plurality of motion ranges output in step SA2, and outputs the set range to be avoided to the course evaluation unit 13 ( Step SA3).
そして、進路評価部13は、ステップSA3で出力された回避すべき範囲を回避できることを基準に自車両の進路が導出できた場合には、それを高く評価して自車両の目標進路として選択・決定する(ステップSA4)。
Then, when the course of the host vehicle can be derived based on the fact that the range to be avoided output in step SA3 can be avoided, the
[第2実施形態]
ここでは、本発明にかかる進路決定装置の第2実施形態を図面に基づいて説明する。なお、第2実施形態では、上述した第1実施形態と重複する説明を省略する場合がある。
[Second Embodiment]
Here, a second embodiment of the route determination apparatus according to the present invention will be described with reference to the drawings. In the second embodiment, the description overlapping that of the first embodiment described above may be omitted.
まず、本発明にかかる進路決定装置の第2実施形態の概要について説明する。上述した第1実施形態では、全ての周辺障害物が同時に異常行動を取ることは現実的に極希なので、一部の周辺障害物が異常行動を取るという現実的なシナリオを想定して自車両の進路を決定したが、異常行動を取ると想定してない周辺障害物が異常行動を取った場合には自車両の最適な進路を決定することができない虞がある。 First, the outline | summary of 2nd Embodiment of the course determination apparatus concerning this invention is demonstrated. In the first embodiment described above, since it is extremely rare for all the surrounding obstacles to take an abnormal action at the same time, it is assumed that there is a realistic scenario in which some surrounding obstacles take an abnormal action. However, there is a possibility that the optimum course of the host vehicle cannot be determined when a surrounding obstacle that is not supposed to take an abnormal action takes an abnormal action.
そこで、第2実施形態では、全ての周辺障害物の中の1つの周辺障害物が異常行動を取り、残りの周辺障害物が通常の動きを取ると想定し、異常行動を取る1つの周辺障害物を全ての周辺障害物の中で替えながら、複数組の回避すべき範囲を求め、自車両が回避すべき範囲を回避できることを基準に自車両の進路グループを選択する。つまり、異常行動を起こす周辺障害物と異常行動を起こさない周辺障害物との組合せを複数設定し、設定した各組合せに応じた自車両の進路を計算する。これにより、異常行動を取ると想定してない周辺障害物が異常行動を取った場合でも、自車両の最適な進路を決定することができる。 Therefore, in the second embodiment, it is assumed that one peripheral obstacle among all the peripheral obstacles takes an abnormal action, and the remaining peripheral obstacles take a normal movement, and one peripheral obstacle taking an abnormal action. While changing an object among all surrounding obstacles, a plurality of sets of areas to be avoided are obtained, and a route group of the own vehicle is selected based on the fact that the area to be avoided by the own vehicle can be avoided. That is, a plurality of combinations of peripheral obstacles that cause abnormal behavior and peripheral obstacles that do not cause abnormal behavior are set, and the course of the host vehicle corresponding to each set combination is calculated. Thereby, even when a peripheral obstacle that is not assumed to take an abnormal action takes an abnormal action, it is possible to determine the optimum course of the host vehicle.
つぎに、第2実施形態の進路決定装置の構成について図4を参照しながら説明する。図4は、第2実施形態の進路決定装置の構成を示すブロック図である。 Next, the configuration of the route determination apparatus of the second embodiment will be described with reference to FIG. FIG. 4 is a block diagram illustrating a configuration of the route determination apparatus according to the second embodiment.
図4において、符号14は複数回避範囲設定部であり、符号15は進路グループ評価部である。複数回避範囲設定部14は、障害物動き範囲設定部11から出力された動き範囲の組み合わせから、自車両が回避すべき範囲を複数設定し、設定した複数の回避すべき範囲を進路グループ評価部15へ出力する。進路グループ評価部15は、複数回避範囲設定部14から出力された複数の回避すべき範囲を回避できる進路グループを高く評価する。
In FIG. 4, reference numeral 14 is a multiple avoidance range setting unit, and
つぎに、上述した構成の進路決定装置1で行われる進路決定動作の一例について、図5および図6を参照して説明する。図5は、第2実施形態の進路決定動作の一例を示すフローチャートである。図6は、第2実施形態の進路決定動作の適用場面の一例を示す図である。 Next, an example of a course determination operation performed by the course determination apparatus 1 having the above-described configuration will be described with reference to FIGS. 5 and 6. FIG. 5 is a flowchart illustrating an example of a course determination operation according to the second embodiment. FIG. 6 is a diagram illustrating an example of an application scene of the course determination operation of the second embodiment.
例えば、自車両が丁字路を走行中に、先行車両(周辺車両1)と路地から出てくる車両(周辺車両2)とが存在する場合、上述した第1実施形態では、周辺車両1と2が同時に異常行動を取ることは現実的に極希であることを考慮した上で、先行の周辺車両1が異常行動を取り、路地の周辺車両2は通常の動きを取ると想定して自車両が回避すべき範囲を設定し、設定した回避すべき範囲を回避できる自車両の進路を決定していた。 For example, when the host vehicle travels on a street, there are a preceding vehicle (peripheral vehicle 1) and a vehicle (peripheral vehicle 2) coming out of the alley, in the first embodiment described above, the peripheral vehicles 1 and 2 In consideration of the fact that taking abnormal behavior at the same time is extremely rare, it is assumed that the preceding surrounding vehicle 1 takes abnormal behavior and the surrounding vehicle 2 in the alley takes normal movement. Sets a range to be avoided and determines a course of the host vehicle that can avoid the set range to be avoided.
しかし、異常行動を取ると想定してない周辺車両が異常行動を取った場合には自車両の最適な進路を決定することができない虞がある。 However, there is a possibility that the optimum course of the own vehicle cannot be determined when a surrounding vehicle that is not supposed to take abnormal behavior takes abnormal behavior.
そこで、第2実施形態では、全て(2つ)の周辺車両1、2の中の1つの周辺車両1が異常行動を取り、残りの周辺車両2が通常の動きを取ると想定し、異常行動を取る周辺車両を周辺車両2に替えながら、複数組の回避すべき範囲を求め、自車両が回避すべき範囲を回避できることを基準に自車両の進路グループを選択する。具体的には、進路決定装置1は、以下の進路決定動作を実行する。これにより、異常行動を取ると想定してない周辺車両が異常行動を取った場合でも自車両の最適な進路を決定することができる。 Therefore, in the second embodiment, it is assumed that one (1) peripheral vehicle 1 of all (two) peripheral vehicles 1 and 2 takes an abnormal action, and the remaining peripheral vehicles 2 take a normal movement, and the abnormal action is assumed. A plurality of sets of areas to be avoided are obtained while changing the surrounding vehicle to be the surrounding vehicle 2, and a course group of the own vehicle is selected based on the fact that the area to be avoided by the own vehicle can be avoided. Specifically, the course decision device 1 executes the following course decision operation. Thereby, even when a surrounding vehicle that is not supposed to take an abnormal action takes an abnormal action, the optimum course of the host vehicle can be determined.
まず、走行情報取得部10は、車両に搭載される各種センサやナビゲーションシステムの信号を入力することにより走行情報を取得し、取得した走行情報を障害物動き範囲設定部11へ出力する(ステップSB1)。
First, the travel
つぎに、障害物動き範囲設定部11は、ステップSB1で出力された走行情報を利用して、先行の周辺車両1に対して異常な動き範囲を、路地の周辺車両2に対して通常の動き範囲を設定し、設定したこれら複数の動き範囲の組合せ(組合せ1)を回避範囲設定部12へ出力する(ステップSB2)。また、障害物動き範囲設定部11は、周辺車両1に対して通常の動き範囲を、周辺車両2に対して異常な動き範囲を設定し、設定したこれら複数の動き範囲(組合せ2)を複数回避範囲設定部14へ出力する(ステップSB2)。
Next, the obstacle movement
つぎに、複数回避範囲設定部14、ステップSB2で出力された複数組の動き範囲(組合せ1、組合せ2)の組み合わせから、図6に示すように、組合せ1に対する自車両が回避すべき範囲(回避範囲1)および組合せ2に対する自車両が回避すべき範囲(回避範囲2)を設定し、設定した複数の回避すべき範囲(回避範囲1、回避範囲2)を進路グループ評価部15へ出力する(ステップSB3)。
Next, as shown in FIG. 6, the range to be avoided by the host vehicle with respect to the combination 1 from the combination of the plurality of movement ranges (combination 1, combination 2) output at the multiple avoidance range setting unit 14 and step SB2 ( A range to be avoided by the host vehicle for the avoidance range 1) and the combination 2 (avoidance range 2) is set, and the plurality of set ranges to be avoided (avoidance range 1 and avoidance range 2) are output to the course
そして、進路グループ評価部15は、ステップSB3で出力された複数の回避すべき範囲のどちらも回避できることを基準に自車両の進路が導出できた場合には、それを高く評価して自車両の目標進路として選択・決定する(ステップSB4)。
Then, when the course of the host vehicle can be derived based on the fact that both of the plurality of ranges to be avoided output in step SB3 can be avoided, the course
これにより、周辺車両1、2のどちらの異常行動にも対応した安全な進路を決定することができる。例えば、図6に示すように、周辺車両1が急減速という異常行動を取ることを想定した場合には自車両も減速し、周辺車両2が急加速という異常行動を取ることを想定した場合には自車両は速度を維持して通過するという進路を決定することができる。 Thereby, the safe course corresponding to any abnormal action of the surrounding vehicles 1 and 2 can be determined. For example, as shown in FIG. 6, when it is assumed that the surrounding vehicle 1 takes an abnormal action of sudden deceleration, the own vehicle also decelerates, and the surrounding vehicle 2 assumes an abnormal action of sudden acceleration. Can determine the course that the vehicle passes by maintaining speed.
[第3実施形態]
ここでは、本発明にかかる進路決定装置の第3実施形態を図面に基づいて説明する。なお、第3実施形態では、上述した第1実行形態や第2実施形態と重複する説明を省略する場合がある。
[Third Embodiment]
Here, a third embodiment of the course decision device according to the present invention will be described with reference to the drawings. In the third embodiment, the description overlapping the first execution mode and the second embodiment described above may be omitted.
まず、本発明にかかる進路決定装置の第3実施形態の概要について説明する。上述した第2実施形態では、全ての周辺障害物の中の1つの周辺障害物が異常行動を取り、残りの周辺障害物が通常の動きを取ると想定し、異常行動を取る1つの周辺障害物を全ての周辺障害物の中で替えながら複数組の回避すべき範囲を求めたが、複数の周辺障害物が同時に異常行動を取った場合には自車両の最適な進路を決定することができない虞がある。 First, an outline of a third embodiment of the route determination apparatus according to the present invention will be described. In the second embodiment described above, it is assumed that one peripheral obstacle among all the peripheral obstacles takes an abnormal action and the remaining peripheral obstacles take a normal movement, and one peripheral obstacle that takes an abnormal action. The range to be avoided was obtained while changing the object among all the surrounding obstacles, but when multiple surrounding obstacles took abnormal action at the same time, it is possible to determine the optimum course of the own vehicle There is a possibility that it cannot be done.
そこで、第3実施形態では、以下の(1)〜(3)の処理を実行する。
(1)まず、全ての周辺障害物が異常行動を取ると想定して、自車両の回避すべき範囲を設定し、設定した回避すべき範囲を回避できる自車両の進路グループを算出する。
(2)そして、回避すべき範囲を回避できる進路グループ(衝突を回避できる進路グループ)が存在しない場合には、1つの周辺障害物が通常の動きを取り、残りの周辺障害物が異常行動を取ると想定して(つまり、異常行動を取る周辺障害物を1つ減らし)、当該通常の動きを取る周辺障害物を全ての周辺障害物の中で替えながら、回避すべき範囲を回避できる自車両の進路グループを算出する。
(3)そして、回避すべき範囲を回避できる進路グループが求まるまで、通常の動きを取る周辺障害物の数を増やす(異常行動を取る周辺障害物の数を減らす)。
Therefore, in the third embodiment, the following processes (1) to (3) are executed.
(1) First, assuming that all surrounding obstacles take abnormal behavior, a range to be avoided of the own vehicle is set, and a course group of the own vehicle that can avoid the set range to be avoided is calculated.
(2) If there is no course group that can avoid the range to be avoided (a course group that can avoid a collision), one surrounding obstacle takes normal movement, and the remaining surrounding obstacles perform abnormal behavior. Assuming that it is taken (that is, reducing the surrounding obstacles that take abnormal action by one), the surrounding obstacles that take the normal movement are replaced with all the surrounding obstacles, and the range that should be avoided can be avoided Calculate the course group of the vehicle.
(3) The number of surrounding obstacles that take normal movement is increased (the number of surrounding obstacles that take abnormal action is reduced) until a course group that can avoid the range to be avoided is obtained.
換言すると、第3実施形態では、異常行動を起こす周辺障害物の数を減らしながら、減らすたびに、異常行動を起こす周辺障害物と異常行動を起こさない周辺障害物との組合せを複数設定し、設定した各組合せに応じた自車両の進路グループを計算する。これにより、複数の周辺障害物が同時に異常行動を取った場合でも、自車両の最適な進路を決定することができる。 In other words, in the third embodiment, each time a reduction is made while reducing the number of peripheral obstacles that cause abnormal behavior, a plurality of combinations of peripheral obstacles that cause abnormal behavior and peripheral obstacles that do not cause abnormal behavior are set and set. The route group of the own vehicle corresponding to each combination is calculated. Thereby, even when a plurality of surrounding obstacles take an abnormal action at the same time, the optimum course of the host vehicle can be determined.
つぎに、第3実施形態の進路決定装置1の構成について、図7を参照して説明する。図7は、第3実施形態の進路決定装置の構成を示すブロック図である。 Next, the configuration of the course decision device 1 of the third embodiment will be described with reference to FIG. FIG. 7 is a block diagram showing the configuration of the course decision device according to the third embodiment.
図7において、符号16は優先順位付複数回避範囲設定部である。優先順位付複数回避範囲設定部16は、障害物動き範囲設定部11から出力された複数の動き範囲の組み合わせから、自車両が回避すべき範囲を複数設定し、設定したこれら複数の回避すべき範囲をグループに分け、各グループに優先順位を付ける。
In FIG. 7, reference numeral 16 denotes a prioritized multiple avoidance range setting unit. The prioritized multiple avoidance range setting unit 16 sets a plurality of ranges to be avoided by the host vehicle from the combination of the plurality of motion ranges output from the obstacle movement
つぎに、上述した構成の進路決定装置1で行われる進路決定動作の一例について、図8等を参照して説明する。図8は、第3実施形態の進路決定動作の一例を示すフローチャートである。 Next, an example of a course determination operation performed by the course determination apparatus 1 having the above-described configuration will be described with reference to FIG. FIG. 8 is a flowchart illustrating an example of a course determination operation according to the third embodiment.
[ステップSC1:全ての周辺障害物が異常行動を取ると仮定]
まず、障害物動き範囲設定部11は、走行情報取得部10から出力された走行情報を利用して、全ての周辺障害物(周辺障害物1、周辺障害物2、周辺障害物3)が異常行動を取ると想定して、周辺障害物1、2および3に対してそれぞれ異常な動き範囲を設定し、設定したこれら複数の動き範囲(組合せ1)を優先順位付複数回避範囲設定部16へ出力する。つぎに、優先順位付複数回避範囲設定部16は、複数の動き範囲の組み合わせから、自車両が回避すべき範囲を設定し、設定した回避すべき範囲を進路グループ評価部15へ出力する。そして、進路グループ評価部15は、回避すべき範囲を回避できることを基準に自車両の進路が導出できた場合には、それを高く評価し自車両の目標進路として選択・決定する。
[Step SC1: Assume that all surrounding obstacles take abnormal behavior]
First, the obstacle movement
[ステップSC2:1つの周辺障害物が通常の行動を取ると仮定]
つぎに、ステップSC1で自車両の進路が存在しなかった場合には、障害物動き範囲設定部11は、1つの周辺障害物が通常の行動を取ると想定し、組合せ1として、周辺障害物1に対して通常の動き範囲を、残りの周辺障害物2および3に対してそれぞれ異常な動き範囲を設定し、また、組合せ2として、周辺障害物2に対して通常の動き範囲を、残りの周辺障害物1および3に対してそれぞれ異常な動き範囲を設定し、さらに、組合せ3として、周辺障害物3に対して通常の動き範囲を、残りの周辺障害物1および2に対してそれぞれ異常な動き範囲を設定し、設定した全て(3つ)の組合せの複数の動き範囲を優先順位付複数回避範囲設定部16へ出力する。つぎに、優先順位付複数回避範囲設定部16は、全ての組合せの複数の動き範囲の組み合わせから、各々の組合せに対して自車両が回避すべき範囲(回避範囲1、回避範囲2、回避範囲3)を設定し、設定した複数の回避すべき範囲を進路グループ評価部15へ出力する。そして、進路グループ評価部15は、複数の回避すべき範囲のどちらも回避できることを基準に自車両の進路が導出できた場合には、それを高く評価し自車両の目標進路として選択・決定する。
[Step SC2: Assume that one surrounding obstacle takes normal action]
Next, when the course of the host vehicle does not exist in step SC1, the obstacle movement
[ステップSC3:2つの周辺障害物が通常の行動を取ると仮定]
つぎに、ステップSC2で自車両の進路が存在しなかった場合には、障害物動き範囲設定部11は、2つの周辺障害物が通常の行動を取ると想定し、組合せ1として、周辺障害物2および3に対してそれぞれ通常の動き範囲を、残りの周辺障害物1に対して異常な動き範囲を設定し、また、組合せ2として、周辺障害物1および3に対してそれぞれ通常の動き範囲を、残りの周辺障害物2に対して異常な動き範囲を設定し、さらに、組合せ3として、周辺障害物1および2に対してそれぞれ通常の動き範囲を、残りの周辺障害物3に対して異常な動き範囲を設定し、設定した全て(3つ)の組合せの複数の動き範囲を優先順位付複数回避範囲設定部16へ出力する。つぎに、優先順位付複数回避範囲設定部16は、全ての組合せの複数の動き範囲の組み合わせから、各々の組合せに対して自車両が回避すべき範囲(回避範囲1、回避範囲2、回避範囲3)を設定し、設定した複数の回避すべき範囲を進路グループ評価部15へ出力する。そして、進路グループ評価部15は、複数の回避すべき範囲のどちらも回避できることを基準に自車両の進路が導出できた場合には、それを高く評価し自車両の目標進路として選択・決定する。
[Step SC3: Assume that two surrounding obstacles take normal action]
Next, when the course of the host vehicle does not exist in step SC2, the obstacle movement
[ステップSC4:全ての周辺障害物が通常の行動を取ると仮定]
そして、ステップSC3で自車両の進路が存在しなかった場合には、障害物動き範囲設定部11は、全ての周辺障害物(周辺障害物1、周辺障害物2、周辺障害物3)が通常の行動を取ると想定して、周辺障害物1、2および3に対してそれぞれ通常の動き範囲を設定し、設定したこれら複数の動き範囲(組合せ1)を優先順位付複数回避範囲設定部16へ出力する。つぎに、優先順位付複数回避範囲設定部16は、複数の動き範囲の組み合わせから、自車両が回避すべき範囲を設定し、設定した回避すべき範囲を進路グループ評価部15へ出力する。そして、進路グループ評価部15は、回避すべき範囲を回避できることを基準に自車両の進路が導出できた場合には、それを高く評価し自車両の目標進路として選択・決定する。
[Step SC4: Assuming that all surrounding obstacles take normal action]
If there is no course of the host vehicle in step SC3, the obstacle movement
[実施形態のまとめ、および他の実施形態]
以上説明したように、上述した実施形態によれば、自車両周辺の複数の障害物が異常行動を起こす場合を想定して全回避対象との接触を回避する自車両の目標進路が立たないときには、異常行動を起こすと想定する障害物の数を減らして、一部の異常行動を起こす回避対象との接触を回避する目標進路を再計算する。これにより、一部の障害物のみが異常行動を起こすと想定することで自車両の目標進路が決定される可能性を高め、自車両の現実的な走行を行わせることが可能となる。
[Summary of Embodiments and Other Embodiments]
As described above, according to the above-described embodiment, when the target course of the own vehicle that avoids contact with all the avoidance targets is not assumed assuming that a plurality of obstacles around the own vehicle cause abnormal behavior. Reduce the number of obstacles assumed to cause abnormal behavior, and recalculate the target course to avoid contact with the avoidance target that causes some abnormal behavior. Accordingly, it is possible to increase the possibility that the target course of the host vehicle is determined by assuming that only some of the obstacles cause abnormal behavior, and it is possible to cause the host vehicle to travel realistically.
また、上述した実施形態によれば、異常行動を起こす障害物と異常行動を起こさない障害物(通常の動きを取る障害物)との組合せ(パターン)を複数想定し、想定した各パターンに応じた自車両の目標進路を計算する。これにより、異常行動パターンを複数想定して障害物との接触リスクを低下させることができる。 Further, according to the above-described embodiment, a plurality of combinations (patterns) of obstacles that cause abnormal behavior and obstacles that do not cause abnormal behavior (obstacles that take normal movement) are assumed, and according to each assumed pattern. Calculate the target course of your vehicle. Thereby, a contact risk with an obstacle can be reduced assuming a plurality of abnormal behavior patterns.
以上のように、本発明にかかる進路決定装置は、自動車製造産業において有用であり、特に、周辺障害物との接触を回避する自車両の進路を決定するための利用に適している。 As described above, the route determination device according to the present invention is useful in the automobile manufacturing industry, and is particularly suitable for use in determining the route of the host vehicle that avoids contact with surrounding obstacles.
1 進路決定装置
10 走行情報取得部
11 障害物動き範囲設定部
12 回避範囲設定部
13 進路評価部
14 複数回避範囲設定部
15 進路グループ評価部
16 優先順位付複数回避範囲設定部
DESCRIPTION OF SYMBOLS 1
Claims (2)
前記障害物が異常な挙動をした場合に、前記障害物が存在しうる領域である異常挙動領域を予測する異常挙動領域予測手段と、
自車両の周辺に存在する複数の前記障害物のうち、異常な挙動をする一部の前記障害物と前記自車両との接触を回避する目標進路を導出する目標進路導出手段と、
を備え、
前記目標進路導出手段は、
自車両の周辺において回避対象とする前記障害物を回避可能な前記目標進路が導出出来ない場合、回避対象とする前記障害物の数を更に減少して前記目標進路を導出すること、
を特徴とする進路決定装置。 Surrounding obstacle behavior information acquisition means for acquiring information on the behavior of obstacles existing around the host vehicle,
When the obstacle behaves abnormally, an abnormal behavior region predicting means for predicting an abnormal behavior region that is a region where the obstacle can exist;
A target route deriving unit for deriving a target route that avoids contact between the obstacle and a part of the obstacle that behaves abnormally among the plurality of obstacles present around the host vehicle;
Equipped with a,
The target course deriving means includes
If the target route that can avoid the obstacle to be avoided in the vicinity of the host vehicle cannot be derived, the target route is derived by further reducing the number of obstacles to be avoided;
The course decision device characterized by this.
前記異常挙動領域を予測しない一部の前記障害物のパターンを変更し、複数パターンの前記目標進路を導出すること、
を特徴とする請求項1に記載の進路決定装置。 The target course deriving means includes
Changing the pattern of some of the obstacles that do not predict the abnormal behavior region, and deriving the target path of multiple patterns
The course decision device according to claim 1.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010173982A JP5552948B2 (en) | 2010-08-02 | 2010-08-02 | Course decision device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010173982A JP5552948B2 (en) | 2010-08-02 | 2010-08-02 | Course decision device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2012033114A JP2012033114A (en) | 2012-02-16 |
JP5552948B2 true JP5552948B2 (en) | 2014-07-16 |
Family
ID=45846410
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2010173982A Expired - Fee Related JP5552948B2 (en) | 2010-08-02 | 2010-08-02 | Course decision device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5552948B2 (en) |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4211794B2 (en) * | 2006-02-28 | 2009-01-21 | トヨタ自動車株式会社 | Interference evaluation method, apparatus, and program |
JP5110356B2 (en) * | 2007-07-10 | 2012-12-26 | オムロン株式会社 | Detection apparatus and method, and program |
-
2010
- 2010-08-02 JP JP2010173982A patent/JP5552948B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2012033114A (en) | 2012-02-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4957747B2 (en) | Vehicle environment estimation device | |
JP6787671B2 (en) | Merge support device | |
JP6428928B2 (en) | Occlusion controller | |
JP6507862B2 (en) | Peripheral monitoring device and driving support device | |
JP6468261B2 (en) | Automated driving system | |
JP6152673B2 (en) | Lane change support device | |
CN106004876A (en) | Gap-based speed control for automated driving system | |
JP6801116B2 (en) | Travel control device, vehicle and travel control method | |
JP4877364B2 (en) | Object detection device | |
JP4730378B2 (en) | Course evaluation device and course evaluation method | |
JP2018092484A (en) | Automatic driving system | |
WO2020241155A1 (en) | Electronic control device | |
JP7112658B2 (en) | Vehicle driving support system and method | |
JPWO2010140215A1 (en) | Vehicle periphery monitoring device | |
WO2021054051A1 (en) | Electronic control device | |
JP7185408B2 (en) | vehicle controller | |
JP2021111366A (en) | Method for forming stochastically free spatial map including static object and dynamic object | |
JP6638531B2 (en) | Peripheral object detection device | |
JP2019144691A (en) | Vehicle control device | |
JP7259716B2 (en) | Vehicle control system and vehicle control method | |
JPWO2020100408A1 (en) | Danger scene prediction device, danger scene prediction method and danger scene prediction program | |
JP2019070900A (en) | Vehicle controller | |
JP5663946B2 (en) | Vehicle travel control device | |
JP6861594B2 (en) | Train driving support device, train driving support system, and train driving support method | |
CN114787892A (en) | Control system and control method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20130520 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20140228 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20140304 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20140410 |
|
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: 20140430 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20140513 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 5552948 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |
|
LAPS | Cancellation because of no payment of annual fees |