JP2011233010A - Deviating vehicle determination device - Google Patents

Deviating vehicle determination device Download PDF

Info

Publication number
JP2011233010A
JP2011233010A JP2010103948A JP2010103948A JP2011233010A JP 2011233010 A JP2011233010 A JP 2011233010A JP 2010103948 A JP2010103948 A JP 2010103948A JP 2010103948 A JP2010103948 A JP 2010103948A JP 2011233010 A JP2011233010 A JP 2011233010A
Authority
JP
Japan
Prior art keywords
vehicle
physical quantity
value
lateral movement
statistical value
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.)
Pending
Application number
JP2010103948A
Other languages
Japanese (ja)
Inventor
Yusuke Nemoto
雄介 根本
Akira Nagae
明 永江
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Toyota Motor Corp
Original Assignee
Toyota Motor Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Toyota Motor Corp filed Critical Toyota Motor Corp
Priority to JP2010103948A priority Critical patent/JP2011233010A/en
Publication of JP2011233010A publication Critical patent/JP2011233010A/en
Pending legal-status Critical Current

Links

Images

Landscapes

  • Traffic Control Systems (AREA)

Abstract

PROBLEM TO BE SOLVED: To provide a deviating vehicle determination device to precisely determine a deviation of a vehicle from a plurality of vehicles moving in a raw.SOLUTION: In a situation where an own vehicle is driving with a plurality of other vehicles in a row, based on a physical quantity (for example a yaw angle) representing a lateral direction movement of the own vehicle and a physical quantity (for example a yaw angle) representing the lateral direction movement of a plurality of other vehicles, the device calculates a statistical value on the physical quantity (for example an average of yaw angle), judges whether or not a deviation of the physical quantity representing the lateral direction movement of each vehicle from the statistical value is larger than a threshold, and determines the vehicle having the deviation larger than the threshold as a vehicle deviating from the row.

Description

本発明は、隊列走行時に隊列から離脱する車両を判定する離脱車両判定装置に関する。   The present invention relates to a departure vehicle determination device that determines a vehicle that leaves a formation when traveling in a formation.

自動車専用道路では、先行車両に追従して走行した方が運転操作低減や空気抵抗削減等の観点から望ましい場合がある。このような追従走行が連鎖すると結果的に複数の車両が隊列を形成し、隊列走行を行う場合がある。隊列走行において、追従走行の利点を継続的に得るためには、隊列から車両が離脱する都度車間をつめ、隊列を再構築する必要がある。そこで、隊列走行時には、離脱車両を的確に判定することが重要となる。   On an automobile-only road, it may be desirable to travel following a preceding vehicle from the viewpoint of driving operation reduction or air resistance reduction. When such follow-up traveling is chained, a plurality of vehicles may form a convoy as a result, and the convoy traveling may be performed. In order to continuously obtain the advantages of follow-up in platooning, it is necessary to restructure the platoon each time the vehicle leaves the platoon. Therefore, it is important to accurately determine the leaving vehicle when running in a row.

隊列から離脱する車両を判定する手法としては、例えば特許文献1に示されているように、自車両から見た先行車両の横方向変位量及び横方向速度に基づいて、自車両が走行する車線から先行車両が離脱する傾向にあるかを判定することを利用するものが考えられる。   As a method for determining a vehicle that leaves the platoon, for example, as disclosed in Patent Document 1, a lane in which the host vehicle travels based on a lateral displacement amount and a lateral speed of a preceding vehicle viewed from the host vehicle. It may be possible to use the determination of whether the preceding vehicle has a tendency to leave.

特開2005−145153号公報JP 2005-145153 A

しかしながら、自車両と先行車両とが隊列の進行方向に対して互いに逆方向に傾くような瞬間も生じうる。このような場合、自車両から見た先行車両の横方向変位量及び横方向速度が大きくなり、誤って離脱の判定をしてしまう可能性がある。   However, there may be a moment when the host vehicle and the preceding vehicle are tilted in opposite directions with respect to the direction of travel of the formation. In such a case, the lateral displacement amount and the lateral speed of the preceding vehicle as seen from the host vehicle increase, and there is a possibility that the departure is erroneously determined.

そこで、本発明は、隊列からの離脱車両を高精度に判定することができる離脱車両判定装置の提供を目的とする。   Accordingly, an object of the present invention is to provide a departure vehicle determination device that can determine a departure vehicle from a platoon with high accuracy.

本発明は、隊列走行時に隊列から離脱する車両を判定する離脱車両判定装置において、自車両の横方向運動に関する物理量を取得する自車両物理量取得手段と、自車両と共に隊列走行する複数の他車両の横方向運動に関する物理量を取得する他車両物理量取得手段と、自車両の横方向運動に関する物理量と複数の他車両の横方向運動に関する物理量とに基づいて、隊列走行する各車両の横方向運動に関する物理量統計値を算出する物理量統計値算出手段と、各車両の横方向運動に関する物理量と物理量統計値との偏差に基づいて、隊列から離脱する車両を特定する離脱車両特定手段とを備えることを特徴とする。なお、横方向運動には、横方向への回転運動および並進運動を含む。   The present invention relates to a departure vehicle determination device for determining a vehicle leaving a platoon during platooning, a host vehicle physical quantity acquisition means for acquiring a physical quantity related to the lateral movement of the host vehicle, and a plurality of other vehicles traveling in tandem with the host vehicle. Physical quantity related to lateral movement of each vehicle traveling in a row based on other vehicle physical quantity acquisition means for acquiring physical quantity related to lateral movement, physical quantity related to lateral movement of the own vehicle, and physical quantity related to lateral movement of a plurality of other vehicles A physical quantity statistical value calculating means for calculating a statistical value; and a leaving vehicle specifying means for specifying a vehicle leaving the platoon based on a deviation between the physical quantity and the physical quantity statistical value relating to the lateral movement of each vehicle. To do. The lateral motion includes lateral rotational motion and translational motion.

本発明では、自車両の横方向運動に関する物理量と複数の他車両の横方向運動に関する物理量とに基づいて、隊列走行する各車両の横方向運動に関する物理量統計値を算出する。物理量統計値は、車両個々の横方向運動の瞬間的なばらつきに大きく左右されない安定した値である。そして、そのような安定性の高い物理量統計値を用いることで、各車両と隊列全体との相対関係が高精度に得られるようになる。よって、各車両の横方向運動に関する物理量と物理量統計値との偏差を求めることで、隊列からの離脱車両を高精度に判定することができる。   In the present invention, a physical quantity statistical value related to the lateral movement of each vehicle traveling in a row is calculated based on the physical quantity relating to the lateral movement of the host vehicle and the physical quantity relating to the lateral movement of a plurality of other vehicles. The physical quantity statistic value is a stable value that is not greatly affected by the instantaneous variation in the lateral movement of each vehicle. By using such a highly stable physical quantity statistic, the relative relationship between each vehicle and the entire platoon can be obtained with high accuracy. Therefore, by determining the deviation between the physical quantity related to the lateral movement of each vehicle and the physical quantity statistical value, it is possible to determine the vehicle leaving the platoon with high accuracy.

また、好ましくは、物理量統計値算出手段は、各車両の横方向運動に関する物理量平均値及び物理量中央値の少なくとも一方を物理量統計値として算出する。   Preferably, the physical quantity statistical value calculation means calculates at least one of the physical quantity average value and the physical quantity median value regarding the lateral movement of each vehicle as the physical quantity statistical value.

このような構成では、各車両の横方向運動に関する物理量統計値を単純な算出式で得ることができる。よって、離脱車両の判定処理を短い周期で繰り返すことができる。   In such a configuration, a physical quantity statistical value related to the lateral movement of each vehicle can be obtained by a simple calculation formula. Therefore, the determination process of the leaving vehicle can be repeated with a short cycle.

また、好ましくは、隊列走行する車両の台数を取得する隊列車両台数取得手段を更に備え、物理量統計値算出手段は、隊列走行する車両の台数に応じて、統計値の種類が異なる物理量統計値を算出する。   Preferably, the vehicle further includes a vehicle number acquisition means for acquiring the number of vehicles traveling in the platoon, and the physical quantity statistical value calculation means calculates the physical quantity statistical values having different types of statistical values according to the number of vehicles traveling in the platoon. calculate.

このような構成では、隊列走行する車両の台数が少ない場合に、横方向運動に関する物理量の変動の大きい車両の影響を除外して各車両の横方向運動に関する物理量統計値を算出し、物理量統計値の安定性を確保する等の処理が可能となる。よって、隊列からの離脱車両をより高精度に判定することができる。   In such a configuration, when the number of vehicles traveling in the platoon is small, the physical quantity statistical value related to the lateral movement of each vehicle is calculated by excluding the influence of the vehicle having the large fluctuation of the physical quantity related to the lateral movement, and the physical quantity statistical value It is possible to perform processing such as ensuring the stability. Therefore, it is possible to determine the leaving vehicle from the formation with higher accuracy.

また、好ましくは、物理量統計値算出手段は、隊列走行する車両の台数が所定台数よりも多いときは、各車両の横方向運動に関する物理量平均値を物理量統計値として算出し、隊列走行する車両の台数が所定台数よりも少ないときは、各車両の横方向運動に関する物理量中央値を物理量統計値として算出する。   Preferably, the physical quantity statistical value calculation means calculates the physical quantity average value related to the lateral movement of each vehicle as the physical quantity statistical value when the number of vehicles traveling in a row is greater than a predetermined number, When the number is smaller than the predetermined number, the median physical quantity related to the lateral movement of each vehicle is calculated as a physical quantity statistical value.

このような構成では、隊列走行する車両の台数が少ない場合に、横方向運動に関する物理量の変動の大きい車両の影響を除外して各車両の横方向運動に関する物理量統計値を算出する処理を、単純な算出式で実現することができる。よって、物理量統計値の安定性を確保しつつ、離脱車両の判定処理を短い周期で繰り返すことができる。   In such a configuration, when the number of vehicles traveling in the platoon is small, the process of calculating the physical quantity statistical value related to the lateral movement of each vehicle by excluding the influence of the vehicle having a large physical quantity fluctuation related to the lateral movement is simplified. It can be realized with a simple calculation formula. Therefore, the determination process of the leaving vehicle can be repeated in a short cycle while ensuring the stability of the physical quantity statistical value.

また、好ましくは、自車両物理量取得手段は、自車両の横方向運動に関する物理量として自車両のヨー角及びステアリング角積分値の少なくとも一方を取得し、他車両物理量取得手段は、他車両の横方向運動に関する物理量として他車両のヨー角及びステアリング角積分値の少なくとも一方を取得し、物理量統計値算出手段は、各車両の横方向運動に関する物理量統計値として各車両のヨー角統計値及びステアリング角積分値統計値の少なくとも一方を算出する。   Preferably, the own vehicle physical quantity acquisition means acquires at least one of the yaw angle and steering angle integral value of the own vehicle as a physical quantity related to the lateral movement of the own vehicle, and the other vehicle physical quantity acquisition means acquires the lateral direction of the other vehicle. At least one of the yaw angle and steering angle integral value of another vehicle is acquired as a physical quantity related to motion, and the physical quantity statistical value calculation means calculates the yaw angle statistical value and steering angle integral of each vehicle as the physical quantity statistical value related to the lateral motion of each vehicle. At least one of the value statistics is calculated.

このような構成では、車両の横方向運動の物理量から、隊列進行方向に対する車両の傾きの情報を得ることができる。この車両の傾きは、隊列からの車両の離脱と密接に関連するため、隊列からの離脱車両を確実に判定することができる。   In such a configuration, it is possible to obtain information on the inclination of the vehicle with respect to the formation direction from the physical quantity of the lateral movement of the vehicle. Since the inclination of the vehicle is closely related to the departure of the vehicle from the platoon, it is possible to reliably determine the detaching vehicle from the platoon.

また、好ましくは、隊列の走行環境に関する情報を取得する走行環境情報取得手段を更に備え、物理量統計値算出手段は、走行環境に関する情報に応じて、物理量の種類が異なる物理量統計値を算出する。   Preferably, the vehicle further includes traveling environment information acquisition means for acquiring information relating to the driving environment of the platoon, and the physical quantity statistical value calculation means calculates physical quantity statistical values having different types of physical quantities according to the information relating to the traveling environment.

このような構成では、その時の走行環境において各車両の横方向運動を高感度に検出可能な物理量を選択することができる。よって、隊列からの離脱車両をより高精度に判定することができる。   In such a configuration, it is possible to select a physical quantity that can detect the lateral movement of each vehicle with high sensitivity in the driving environment at that time. Therefore, it is possible to determine the leaving vehicle from the formation with higher accuracy.

また、好ましくは、走行環境情報取得手段は、走行環境に関する情報として各車両の隊列車速を取得し、物理量統計値算出手段は、隊列車速が所定速度よりも低いときは、各車両の横方向運動に関する物理量統計値として各車両のヨー角統計値を算出し、隊列車速が所定速度よりも高いときは、各車両の横方向運動に関する物理量統計値として各車両のステアリング角積分値統計値を算出する。   Preferably, the traveling environment information acquisition unit acquires the train speed of each vehicle as information on the traveling environment, and the physical quantity statistical value calculation unit calculates the lateral motion of each vehicle when the train speed is lower than a predetermined speed. The yaw angle statistic value of each vehicle is calculated as the physical quantity statistic value, and the steering angle integral value statistic value of each vehicle is calculated as the physical quantity statistic value related to the lateral movement of each vehicle when the train speed is higher than the predetermined speed. .

このような構成では、隊列車速が所定速度よりも高いためにステアリング操作が慎重になり、ヨー角変動の鈍くなる状況下においても、各車両の横方向運動に関する物理量を高感度に検出することができる。   In such a configuration, since the fleet train speed is higher than the predetermined speed, the steering operation is cautious and the physical quantity related to the lateral movement of each vehicle can be detected with high sensitivity even in a situation where the yaw angle fluctuation becomes dull. it can.

また、好ましくは、走行環境情報取得手段は、走行環境に関する情報として各車両の隊列車間距離を取得し、物理量統計値算出手段は、隊列車間距離が所定距離よりも長いときは、各車両の横方向運動に関する物理量統計値として各車両のヨー角統計値を算出し、隊列車間距離が所定距離よりも短いときは、各車両の横方向運動に関する物理量統計値として各車両のステアリング角積分値統計値を算出する。   Preferably, the traveling environment information acquisition unit acquires the distance between the trains of each vehicle as information on the traveling environment, and the physical quantity statistical value calculation unit determines that each vehicle has a longer distance than the predetermined distance. The yaw angle statistic of each vehicle is calculated as a physical quantity statistic related to the lateral movement of the vehicle. When the distance between the trains is shorter than the predetermined distance, the steering angle integral of each vehicle is calculated as the physical quantity statistic related to the lateral movement of each vehicle. Value statistics are calculated.

このような構成では、隊列車間距離が所定距離よりも短いためにステアリング操作が慎重になり、ヨー角変動の鈍くなる状況下においても、各車両の横方向運動に関する物理量を高感度に検出することができる。   In such a configuration, since the distance between the fleet trains is shorter than the predetermined distance, the steering operation is cautious and the physical quantity related to the lateral movement of each vehicle is detected with high sensitivity even in a situation where the yaw angle fluctuation becomes dull. be able to.

本発明によれば、隊列からの離脱車両を高精度に判定する離脱車両判定装置を提供することができる。これにより、隊列から車両が離脱しても直ちに車間をつめることができるので、隊列走行を効果的に継続させることが可能となる。   ADVANTAGE OF THE INVENTION According to this invention, the leaving vehicle determination apparatus which determines the leaving vehicle from a formation with high precision can be provided. As a result, even if the vehicle leaves the platoon, the distance between the vehicles can be immediately closed, so that the platooning can be effectively continued.

本発明に係わる離脱車両判定装置の第1実施形態を示す概略構成図である。BRIEF DESCRIPTION OF THE DRAWINGS It is a schematic block diagram which shows 1st Embodiment of the leaving vehicle determination apparatus concerning this invention. ECU4によって実行される離脱車両判定処理手順の詳細を示すフローチャートである。It is a flowchart which shows the detail of the departure vehicle determination processing procedure performed by ECU4. 車両5〜9が隊列走行している時に車両7が隊列から離脱する様子を例示する図である。It is a figure which illustrates a mode that the vehicle 7 detaches | leaves from a formation when the vehicles 5-9 are running in a formation. 図3に示す各車両のヨー角時間推移を示す図である。It is a figure which shows the yaw angle time transition of each vehicle shown in FIG. 本発明に係わる離脱車両判定装置の第2実施形態において、ECU4が行う離脱車両判定処理手順の詳細を示すフローチャートである。It is a flowchart which shows the detail of the leaving vehicle determination processing procedure which ECU4 performs in 2nd Embodiment of the leaving vehicle determination apparatus concerning this invention. 本発明に係わる離脱車両判定装置の第3実施形態を示す概略構成図である。It is a schematic block diagram which shows 3rd Embodiment of the leaving vehicle determination apparatus concerning this invention. ECU34によって実行される離脱車両判定処理手順の詳細を示すフローチャートである。4 is a flowchart showing details of a departure vehicle determination processing procedure executed by an ECU 34.

以下、本発明に係わる離脱車両判定装置の好適な実施形態について、図面を参照して詳細に説明する。   DESCRIPTION OF EMBODIMENTS Hereinafter, a preferred embodiment of a detached vehicle determination device according to the present invention will be described in detail with reference to the drawings.

図1は、本発明に係わる離脱車両判定装置の第1実施形態を示す概略構成図である。同図において、離脱車両判定装置1は、無線通信機2と、ヨーレートセンサ3と、これらの無線通信機2及びヨーレートセンサ3と接続されたECU(Electronic Control Unit)4とを備えている。   FIG. 1 is a schematic configuration diagram showing a first embodiment of a leaving vehicle determination device according to the present invention. In the figure, the leaving vehicle determination device 1 includes a wireless communication device 2, a yaw rate sensor 3, and an ECU (Electronic Control Unit) 4 connected to the wireless communication device 2 and the yaw rate sensor 3.

無線通信機2は、自車両と共に隊列走行を行う複数の他車両と無線による車車間通信を行う。ヨーレートセンサ3は、自車両のヨーレートを測定するセンサである。   The wireless communication device 2 performs vehicle-to-vehicle communication wirelessly with a plurality of other vehicles that travel in a row with the host vehicle. The yaw rate sensor 3 is a sensor that measures the yaw rate of the host vehicle.

ECU4は、無線通信機2から他車両に送信するデータを無線通信機2に送ると共に、無線通信機2で受信したデータとヨーレートセンサ3の測定結果とに基づき所定の処理を行い、隊列からの離脱車両を判定する。   The ECU 4 sends the data to be transmitted from the wireless communication device 2 to the other vehicle to the wireless communication device 2 and performs predetermined processing based on the data received by the wireless communication device 2 and the measurement result of the yaw rate sensor 3, Determining a leaving vehicle.

図2は、ECU4によって実行される離脱車両判定処理手順の詳細を示すフローチャートである。   FIG. 2 is a flowchart showing the details of the departure vehicle determination processing procedure executed by the ECU 4.

まず、隊列走行が開始されると、後述する自車両のヨー角が初期化される(手順S101)。次に、ヨーレートセンサ3で測定されたヨーレートを積算し、自車両のヨー角を算出する(手順S102)。そして、無線通信機2を介し、算出した自車両のヨー角を他車両に送信する。また、無線通信機2を介し、他車両のヨー角を受信する(手順S103)。   First, when platooning starts, the yaw angle of the host vehicle, which will be described later, is initialized (procedure S101). Next, the yaw rate measured by the yaw rate sensor 3 is integrated to calculate the yaw angle of the host vehicle (step S102). Then, the calculated yaw angle of the host vehicle is transmitted to the other vehicle via the wireless communication device 2. Further, the yaw angle of the other vehicle is received via the wireless communication device 2 (step S103).

隊列内にある全車両のヨー角を取得した後は、各車両のヨー角平均値を算出し(手順S104)、各車両のヨー角とヨー角平均値との差分の絶対値(ヨー角偏差)を算出する(手順S105)。そして、下記式(1)を満足するか、つまり予め決められた閾値よりもヨー角偏差の大きい車両が存在するかを判断する(手順S106)。

Figure 2011233010

:k番目の車両のヨー角
N:隊列台数
θth:閾値 After obtaining the yaw angles of all the vehicles in the formation, the yaw angle average value of each vehicle is calculated (step S104), and the absolute value of the difference between the yaw angle and the yaw angle average value of each vehicle (yaw angle deviation) ) Is calculated (step S105). Then, it is determined whether the following equation (1) is satisfied, that is, whether there is a vehicle having a yaw angle deviation larger than a predetermined threshold (step S106).
Figure 2011233010

Y k : yaw angle of k-th vehicle N: number of units θth: threshold

手順S106において、閾値θthよりもヨー角偏差の大きい車両が存在すれば、その車両が隊列から離脱中であると判定する。例えば、i台目車両のヨー角偏差が閾値θthよりも大きい場合は、i台目車両が隊列から離脱中であると判定する(S107)。そして、離脱車両判定処理を終了する。   In step S106, if there is a vehicle having a yaw angle deviation larger than the threshold value θth, it is determined that the vehicle is leaving the platoon. For example, when the yaw angle deviation of the i-th vehicle is larger than the threshold value θth, it is determined that the i-th vehicle is leaving the platoon (S107). Then, the leaving vehicle determination process ends.

一方、手順S106において、ヨー角偏差が閾値θthよりも大きい車両が存在しなければ、手順S102に戻る。   On the other hand, if there is no vehicle having a yaw angle deviation larger than the threshold value θth in step S106, the process returns to step S102.

以上において、ヨーレートセンサ3及びECU4の手順S101,S102は、自車両の横方向運動に関する物理量(ヨー角)を取得する自車両物理量取得手段を構成する。無線通信機2及びECU4の手順S103は、自車両と共に隊列走行する複数の他車両の横方向運動に関する物理量(ヨー角)を取得する他車両物理量取得手段を構成する。ECU4の手順S104は、自車両の横方向運動に関する物理量と複数の他車両の横方向運動に関する物理量とに基づいて、隊列走行する各車両の横方向運動に関する物理量統計値(ヨー角平均値)を算出する物理量統計値算出手段を構成する。ECU4の手順S105〜S107は、各車両の横方向運動に関する物理量と物理量統計値との偏差に基づいて、隊列から離脱する車両を特定する離脱車両特定手段を構成する。以上により、本実施形態の離脱車両判定装置1が構成されている。   In the above, the steps S101 and S102 of the yaw rate sensor 3 and the ECU 4 constitute own vehicle physical quantity acquisition means for acquiring a physical quantity (yaw angle) related to the lateral movement of the own vehicle. Step S103 of the wireless communication device 2 and the ECU 4 constitutes another vehicle physical quantity acquisition means for acquiring a physical quantity (yaw angle) related to the lateral movement of a plurality of other vehicles traveling in tandem with the host vehicle. Step S104 of the ECU 4 calculates a physical quantity statistical value (yaw angle average value) related to the lateral movement of each vehicle traveling in a row based on the physical quantity related to the lateral movement of the host vehicle and the physical quantity related to the lateral movement of a plurality of other vehicles. The physical quantity statistical value calculation means for calculating is configured. Steps S <b> 105 to S <b> 107 of the ECU 4 constitute a leaving vehicle specifying unit that specifies a vehicle that leaves the platoon based on the deviation between the physical quantity related to the lateral movement of each vehicle and the physical quantity statistical value. As described above, the detached vehicle determination device 1 of the present embodiment is configured.

本実施形態の離脱車両判定装置1の作用効果を、図3および図4を用いて説明する。図3は、車両5〜9が隊列走行している時に車両7が隊列から離脱する様子を例示する図である。図4は、図3に示す各車両のヨー角時間推移を示す図である。図4において、線P5〜P9が、車両5〜9のヨー角の時間推移を示し、線Qが全車両のヨー角平均値の時間推移を示している。図4に示すように、離脱しない車両5,6,8,9のヨー角は常に変動している。また、各車両が隊列進行方向に対し互いに逆方向に傾く瞬間も生じ得る。   The effect of the departure vehicle determination apparatus 1 of this embodiment is demonstrated using FIG. 3 and FIG. FIG. 3 is a diagram illustrating a state in which the vehicle 7 leaves the platoon when the vehicles 5 to 9 are traveling in the platoon. FIG. 4 is a diagram showing a yaw angle time transition of each vehicle shown in FIG. In FIG. 4, lines P5 to P9 indicate the time transition of the yaw angle of the vehicles 5 to 9, and the line Q indicates the time transition of the average yaw angle value of all the vehicles. As shown in FIG. 4, the yaw angles of the vehicles 5, 6, 8, and 9 that do not leave always fluctuate. There may also be a moment when each vehicle tilts in opposite directions with respect to the direction of movement of the platoon.

このような状況にあっては、単純に各車両間の動きを比較するだけでは、偶然に互いに逆方向を向いている車両が存在する場合と隊列から離脱する車両が存在する場合とを識別することができないことがある。   In such a situation, simply comparing the movements between the vehicles identifies whether there is a vehicle accidentally facing in the opposite direction and a vehicle leaving the platoon. There are times when you can't.

これに対し本実施形態では、全車両のヨー角平均値を算出し、各車両のヨー角とヨー角平均値とを比較し、ヨー角とヨー角平均値との偏差が閾値を越えた車両を隊列から離脱した車両と判定するようにしたので、離脱車両の動きが隊列走行を行う他の車両の動きと明らかに違うことを検出できる。これにより、各車両の挙動の瞬間的なばらつきやノイズ等の影響を受けることなく、隊列からの離脱車両を安定性良く且つ高精度に判定することができる。   On the other hand, in this embodiment, the yaw angle average value of all vehicles is calculated, the yaw angle of each vehicle is compared with the yaw angle average value, and the deviation between the yaw angle and the yaw angle average value exceeds the threshold value. Since it is determined that the vehicle has left the platoon, it is possible to detect that the movement of the detaching vehicle is clearly different from the movement of the other vehicles that perform the platooning. This makes it possible to determine a vehicle leaving the platoon with high stability and high accuracy without being affected by instantaneous variations in the behavior of each vehicle, noise, and the like.

また、車両のヨー角は、隊列進行方向に対する車両の傾きに相当する値であり、隊列からの車両の離脱と密接に関連する。このため、ヨー角を用いることで隊列からの離脱車両を確実に判定することができる。   Further, the yaw angle of the vehicle is a value corresponding to the inclination of the vehicle with respect to the formation direction, and is closely related to the departure of the vehicle from the formation. For this reason, by using the yaw angle, it is possible to reliably determine a vehicle that has left the platoon.

また、ヨー角平均値は単純な計算式で算出できるため、ECU4の処理を高速に実行することができる。このため、離脱車両の判定処理を短い周期で繰り返すことができ、離脱車両を遅れなく判定することができる。   Further, since the yaw angle average value can be calculated by a simple calculation formula, the processing of the ECU 4 can be executed at high speed. For this reason, the determination process of a leaving vehicle can be repeated with a short period, and a leaving vehicle can be determined without delay.

図5は、本発明に係わる離脱車両判定装置の第2実施形態において、ECU4が行う離脱車両判定処理手順の詳細を示すフローチャートである。図5のフローチャートにおいて、第1実施形態と同じ手順には同じ符号を付し、その説明を省略する。また、第2実施形態のハードウェア構成は第1実施形態と同一であり、その説明を省略する。   FIG. 5 is a flowchart showing details of a procedure for determining a departure vehicle performed by the ECU 4 in the second embodiment of the departure vehicle determination device according to the present invention. In the flowchart of FIG. 5, the same procedures as those in the first embodiment are denoted by the same reference numerals, and the description thereof is omitted. The hardware configuration of the second embodiment is the same as that of the first embodiment, and a description thereof is omitted.

第2実施形態では、他車両のヨー角を受信した(手順S103)後に、例えば受信したヨー角データのデータ数等から隊列内の車両台数(隊列車両台数)を取得する(手順S201)。   In the second embodiment, after receiving the yaw angle of another vehicle (procedure S103), the number of vehicles in the platoon (number of platoon vehicles) is acquired from the number of data of the received yaw angle data, for example (procedure S201).

隊列車両台数Nを取得すると、それが予め決められた閾値NoVよりも大きいかを判断する(手順S202)。そして、隊列車両台数Nが閾値NoVよりも大きければ手順S104に進み、以降手順S107まで第1実施形態と同じ処理を行う。隊列車両台数Nが閾値NoV以下であれば手順S203に進む。   If the number N of convoy vehicles is acquired, it will be judged whether it is larger than the predetermined threshold value NoV (procedure S202). And if the number N of convoy vehicles is larger than threshold NoV, it will progress to procedure S104 and will perform the same process as 1st Embodiment until procedure S107 after that. If the number N of vehicles in the row is equal to or less than the threshold NoV, the process proceeds to step S203.

手順S203では、各車両のヨー角中央値を算出する。そして、各車両のヨー角とヨー角中央値との差分の絶対値(ヨー角偏差)を算出し(手順S204)、下記式(2)を満足するか、つまり予め決められた閾値よりもヨー角偏差の大きい車両が存在するかを判断する(手順S205)。

Figure 2011233010

i:i番目の車両のヨー角
YMe:ヨー角中央値
θth:閾値 In step S203, the median yaw angle of each vehicle is calculated. Then, the absolute value (yaw angle deviation) of the difference between the yaw angle and the median yaw angle of each vehicle is calculated (step S204), and the following equation (2) is satisfied, that is, the yaw is larger than a predetermined threshold value. It is determined whether there is a vehicle with a large angular deviation (step S205).
Figure 2011233010

Y i : Y-th vehicle yaw angle YMe: median yaw angle θth: threshold

ここで、中央値とは、複数の測定値を大きい順に並べたときに、中央に位置する測定値を意味する。車両台数が偶数であるために測定値が偶数ある場合には、中央2つの測定値の平均値を中央値とする。以後、中央値の語は同様の意味で用いる。   Here, the median means a measured value located in the center when a plurality of measured values are arranged in descending order. When the number of vehicles is an even number and the measured value is an even number, the average value of the two center measured values is set as the median value. Hereinafter, the term “median” is used in the same meaning.

手順S205において、閾値θthよりもヨー角偏差の大きい車両が存在すれば、その車両が隊列から離脱中であると判定する。例えば、i台目車両のヨー角偏差が閾値θthよりも大きい場合は、i台目車両が隊列から離脱中であると判定する(S107)。そして、離脱車両判定処理を終了する。   In step S205, if there is a vehicle having a yaw angle deviation larger than the threshold value θth, it is determined that the vehicle is leaving the platoon. For example, when the yaw angle deviation of the i-th vehicle is larger than the threshold value θth, it is determined that the i-th vehicle is leaving the platoon (S107). Then, the leaving vehicle determination process ends.

一方、手順S205において、ヨー角偏差が閾値θthよりも大きい車両が存在しなければ、手順S102に戻る。   On the other hand, if there is no vehicle having a yaw angle deviation larger than the threshold value θth in step S205, the process returns to step S102.

以上において、ECU4の手順S201は、隊列走行する車両の台数を取得する隊列車両台数取得手段を構成する。ECU4の手順S202,S104,S203は、自車両の横方向運動に関する物理量と複数の他車両の横方向運動に関する物理量とに基づいて、隊列走行する各車両の横方向運動に関する物理量統計値(ヨー角平均値及びヨー角中央値)を算出する物理量統計値算出手段を構成する。ECU4の手順S105〜S107,S204,S205は、各車両の横方向運動に関する物理量と物理量統計値との偏差に基づいて、隊列から離脱する車両を特定する離脱車両特定手段を構成する。以上により、本実施形態の離脱車両判定装置1が構成されている。   In the above, procedure S201 of ECU4 comprises the convoy vehicle number acquisition means which acquires the number of vehicles which run in convoy. Steps S202, S104, and S203 of the ECU 4 are based on physical quantities related to the lateral movement of the host vehicle and physical quantities related to the lateral movement of a plurality of other vehicles. A physical quantity statistic value calculating means for calculating (average value and median yaw angle) is configured. Steps S <b> 105 to S <b> 107, S <b> 204, and S <b> 205 of the ECU 4 constitute a leaving vehicle specifying unit that specifies a vehicle that leaves the platoon based on the deviation between the physical quantity related to the lateral movement of each vehicle and the physical quantity statistical value. As described above, the detached vehicle determination device 1 of the present embodiment is configured.

ここで、ヨー角平均値は、隊列内にある全車両のヨー角から算出され、隊列からの離脱車両のヨー角も含む値である。また、隊列からの離脱車両のヨー角は、他の車両と比べ大きく変動すると考えられる。このため、隊列からの離脱車両のある場合には、その影響でヨー角平均値も変動する。隊列車両台数が少ない場合には、このようなヨー角平均値の変動が大きくなる。   Here, the average yaw angle value is a value calculated from the yaw angles of all the vehicles in the platoon and includes the yaw angles of vehicles leaving the platoon. Further, it is considered that the yaw angle of a vehicle leaving the platoon varies greatly compared to other vehicles. For this reason, when there is a vehicle leaving the platoon, the yaw angle average value also varies due to the influence. When the number of vehicles in the platoon is small, such fluctuation of the average yaw angle becomes large.

これに対し本実施形態では、隊列車両台数Nが閾値NoV以下であるときは、ヨー角平均値に代えてヨー角中央値を算出するようにしている。ヨー角中央値は、上述したように、隊列内の各車両のヨー角を大きい順に並べたときに、中央に位置するヨー角である。隊列からの離脱車両のヨー角は、隊列内の各車両のヨー角の中で上限または下限に近い値を示すため、ヨー角中央値には隊列からの離脱車両のヨー角は含まれないこととなる。これにより、隊列車両台数Nが少ない状況下においても、隊列からの離脱車両を安定性良く且つ高精度に判定することができる。   On the other hand, in this embodiment, when the number N of convoy vehicles is equal to or less than the threshold NoV, the yaw angle median value is calculated instead of the yaw angle average value. As described above, the median yaw angle is a yaw angle located at the center when the yaw angles of the vehicles in the platoon are arranged in descending order. The yaw angle of vehicles leaving the platoon is close to the upper or lower limit of the yaw angle of each vehicle in the platoon, so the median yaw angle should not include the yaw angle of vehicles leaving the platoon It becomes. Thereby, even in a situation where the number N of convoy vehicles is small, it is possible to determine a vehicle leaving the convoy with high stability and high accuracy.

また、ヨー角中央値は、上述したヨー角平均値同様に単純な計算式で算出できるため、ECU4の処理を高速に実行することができる。このため、ヨー角平均値に代えてヨー角中央値を算出する場合においても、離脱車両の判定処理を短い周期で繰り返すことができ、離脱車両を遅れなく判定することができる。   Moreover, since the yaw angle median value can be calculated by a simple calculation formula like the above-mentioned yaw angle average value, the processing of the ECU 4 can be executed at high speed. For this reason, also when calculating the yaw angle median value instead of the yaw angle average value, the determination process of the leaving vehicle can be repeated in a short cycle, and the leaving vehicle can be determined without delay.

図6は、本発明に係わる離脱車両判定装置の第3実施形態を示す概略構成図である。図中、第1実施形態と同じ要素には同じ符号を付し、その説明を省略する。   FIG. 6 is a schematic configuration diagram showing a third embodiment of the leaving vehicle determination device according to the present invention. In the figure, the same elements as those of the first embodiment are denoted by the same reference numerals, and the description thereof is omitted.

同図において、離脱車両判定装置30は、無線通信機2と、ヨーレートセンサ3と、操舵角センサ31と、車速センサ32と、車間距離センサ33と、無線通信機2及び各センサ3,31〜33と接続されたECU34とを備えている。   In the figure, the leaving vehicle determination device 30 includes a wireless communication device 2, a yaw rate sensor 3, a steering angle sensor 31, a vehicle speed sensor 32, an inter-vehicle distance sensor 33, a wireless communication device 2, and sensors 3, 31 to 31. 33 is connected to the ECU 34.

操舵角センサ31は、自車両のステアリング角を測定するセンサである。車速センサ32は、自車両の車速を測定するセンサである。車間距離センサ33は、自車両と先行車両との車間距離を測定するセンサである。   The steering angle sensor 31 is a sensor that measures the steering angle of the host vehicle. The vehicle speed sensor 32 is a sensor that measures the vehicle speed of the host vehicle. The inter-vehicle distance sensor 33 is a sensor that measures the inter-vehicle distance between the host vehicle and the preceding vehicle.

ECU34は、無線通信機2から他車両に送信するデータを無線通信機2に送ると共に、無線通信機2で受信したデータと各センサ3,31〜33の測定結果とに基づき所定の処理を行い、隊列からの離脱車両を判定する。   The ECU 34 sends data to be transmitted to the other vehicle from the wireless communication device 2 to the wireless communication device 2, and performs predetermined processing based on the data received by the wireless communication device 2 and the measurement results of the sensors 3, 31 to 33. , Determine the leaving vehicle from the formation.

図7は、ECU34によって実行される離脱車両判定処理手順の詳細を示すフローチャートである。   FIG. 7 is a flowchart showing the details of the departure vehicle determination processing procedure executed by the ECU 34.

まず、隊列走行が開始されると、後述する自車両のヨー角およびステアリング角積分値が初期化される(手順S301)。   First, when platooning is started, the yaw angle and steering angle integral value of the host vehicle, which will be described later, are initialized (step S301).

次に、ヨーレートセンサ3で測定されたヨーレートを積算し、自車両のヨー角を算出する。また、操舵角センサ31で測定されたステアリング角を積算し、自車両のステアリング角積分値を算出する(手順S302)。そして、無線通信機2を介し、算出した自車両のヨー角及びステアリング角積分値を他車両に送信する。また、無線通信機2を介し、他車両のヨー角及びステアリング角積分値を受信する(手順S303)。   Next, the yaw rate measured by the yaw rate sensor 3 is integrated to calculate the yaw angle of the host vehicle. Further, the steering angle measured by the steering angle sensor 31 is integrated to calculate an integrated value of the steering angle of the host vehicle (step S302). Then, the calculated yaw angle and steering angle integral value of the host vehicle are transmitted to the other vehicle via the wireless communication device 2. Further, the yaw angle and steering angle integral value of the other vehicle is received via the wireless communication device 2 (step S303).

次に、車速センサ32で測定された自車両の車速を隊列車速として取得し、車間距離センサ33で測定された自車両と先行車両との車間距離を隊列車間距離として取得する(手順S304)。そして、自車両の車速Vが予め決められた閾値Vkよりも大きいかを判断する(手順S305)。また、先行車両との車間距離Lが予め決められた閾値Lkよりも小さいかを判断する(手順S306)。   Next, the vehicle speed of the host vehicle measured by the vehicle speed sensor 32 is acquired as the fleet train speed, and the inter-vehicle distance between the host vehicle and the preceding vehicle measured by the inter-vehicle distance sensor 33 is acquired as the inter-train distance (step S304). . Then, it is determined whether the vehicle speed V of the host vehicle is greater than a predetermined threshold value Vk (step S305). Further, it is determined whether the inter-vehicle distance L with the preceding vehicle is smaller than a predetermined threshold value Lk (step S306).

手順S305において、自車両の車速Vが閾値Vkよりも大きいか、手順S306において、先行車両との車間距離Lが閾値Lkよりも小さい場合には、手順S307に進む。   If the vehicle speed V of the host vehicle is greater than the threshold value Vk in step S305, or if the inter-vehicle distance L with the preceding vehicle is smaller than the threshold value Lk in step S306, the process proceeds to step S307.

手順S307では、各車両のステアリング角積分値中央値を算出する。そして、各車両のステアリング角積分値とステアリング角積分値中央値との差分の絶対値(ステアリング角積分値偏差)を算出し(手順S308)、下記式(3)を満足するか、つまり予め決められた閾値θthよりもステアリング角積分値偏差の大きい車両が存在するかを判断する(手順S309)。

Figure 2011233010

STGi:i番目の車両のステアリング角積分値
stgMe:ステアリング角積分値中央値
θth:閾値 In step S307, the median steering angle integral value of each vehicle is calculated. Then, the absolute value (steering angle integral value deviation) of the difference between the steering angle integral value and the steering angle integral value median value of each vehicle is calculated (procedure S308), and the following equation (3) is satisfied, that is, determined in advance. It is determined whether there is a vehicle having a steering angle integral value deviation larger than the obtained threshold value θth (step S309).
Figure 2011233010

STG i : Steering angle integral value of the i-th vehicle stgMe: Steering angle integral value median value θth: Threshold value

手順S309において、閾値θthよりもステアリング角積分値偏差の大きい車両が存在すれば、その車両が隊列から離脱中であると判定する。例えば、i台目車両のステアリング角積分値偏差が閾値θthよりも大きい場合は、i台目車両が隊列から離脱中であると判定する(S107)。そして、離脱車両判定処理を終了する。   In step S309, if there is a vehicle having a steering angle integral value deviation larger than the threshold θth, it is determined that the vehicle is leaving the platoon. For example, when the steering angle integral value deviation of the i-th vehicle is larger than the threshold value θth, it is determined that the i-th vehicle is leaving the platoon (S107). Then, the leaving vehicle determination process ends.

一方、手順S309において、ヨー角偏差が閾値θthよりも大きい車両が存在しなければ、手順S302に戻る。   On the other hand, if there is no vehicle having a yaw angle deviation larger than the threshold value θth in step S309, the process returns to step S302.

手順S305において、自車両の車速Vが閾値Vk以下であるか、手順S306において、先行車両との車間距離Lが閾値Lk以上である場合には、手順S203に進み、以降手順S107まで第2実施形態の手順S203〜S107と同じ処理を行う。   In step S305, if the vehicle speed V of the host vehicle is less than or equal to the threshold value Vk, or if the inter-vehicle distance L with the preceding vehicle is greater than or equal to the threshold value Lk in step S306, the process proceeds to step S203, and then the second execution is performed until step S107. The same processing as that of steps S203 to S107 of the embodiment is performed.

なお、手順S305において、自車両の車速Vが閾値Vkよりも大きく、かつ手順S306において、先行車両との車間距離Lが閾値Lk以上である場合には、手順S307以降の処理と手順S203以降の処理とが並行して実行される。また、手順S305において、自車両の車速Vが閾値Vk以下であり、かつ手順S306において、先行車両との車間距離Lが閾値Lkよりも小さい場合にも、手順S307以降の処理と手順S203以降の処理とが並行して実行される。   In step S305, when the vehicle speed V of the host vehicle is greater than the threshold value Vk and the inter-vehicle distance L with the preceding vehicle is greater than or equal to the threshold value Lk in step S306, the processing after step S307 and the processing after step S203 are performed. Processing is executed in parallel. In step S305, when the vehicle speed V of the host vehicle is equal to or less than the threshold value Vk and the inter-vehicle distance L with the preceding vehicle is smaller than the threshold value Lk in step S306, the processing after step S307 and the processing after step S203 are also performed. Processing is executed in parallel.

以上において、ヨーレートセンサ3、操舵角センサ31及びECU34の手順S301,S302は、自車両の横方向運動に関する物理量(ヨー角及びステアリング角積分値)を取得する自車両物理量取得手段を構成する。無線通信機2及びECU34の手順S303は、自車両と共に隊列走行する複数の他車両の横方向運動に関する物理量(ヨー角及びステアリング角積分値)を取得する他車両物理量取得手段を構成する。車速センサ32、車間距離センサ33、及びECU34の手順S304は、隊列の走行環境に関する情報を取得する走行環境情報取得手段を構成する。ECU34の手順S305,S306,S307,S203は、自車両の横方向運動に関する物理量と複数の他車両の横方向運動に関する物理量とに基づいて、隊列走行する各車両の横方向運動に関する物理量統計値(ステアリング角中央値及びヨー角中央値)を算出する物理量統計値算出手段を構成する。ECU34の手順S308,S309,S204,S205,S107は、各車両の横方向運動に関する物理量と物理量統計値との偏差に基づいて、隊列から離脱する車両を特定する離脱車両特定手段を構成する。以上により、本実施形態の離脱車両判定装置30が構成されている。   In the above, the steps S301 and S302 of the yaw rate sensor 3, the steering angle sensor 31, and the ECU 34 constitute a host vehicle physical quantity acquisition unit that acquires a physical quantity (yaw angle and steering angle integral value) related to the lateral movement of the host vehicle. Step S303 of the wireless communication device 2 and the ECU 34 constitutes other vehicle physical quantity acquisition means for acquiring physical quantities (yaw angle and steering angle integral values) related to the lateral movement of a plurality of other vehicles traveling in tandem with the host vehicle. Step S304 of the vehicle speed sensor 32, the inter-vehicle distance sensor 33, and the ECU 34 constitutes a travel environment information acquisition unit that acquires information related to the travel environment of the platoon. Steps S305, S306, S307, and S203 of the ECU 34 are based on physical quantities related to the lateral movement of the host vehicle and physical quantities related to the lateral movement of a plurality of other vehicles. A physical quantity statistical value calculation means for calculating a steering angle median and a yaw angle median is configured. Steps S308, S309, S204, S205, and S107 of the ECU 34 constitute a leaving vehicle specifying unit that specifies a vehicle that leaves the platoon based on the deviation between the physical quantity related to the lateral movement of each vehicle and the physical quantity statistical value. Thus, the detached vehicle determination device 30 of the present embodiment is configured.

ここで、ヨー角変動の大きさは、車速または車間距離に左右される。つまり、車速が高くなるか、車間距離が短くなると、ステアリング操作が慎重になり、ヨー角変動が鈍くなる。   Here, the magnitude of the yaw angle fluctuation depends on the vehicle speed or the inter-vehicle distance. That is, when the vehicle speed increases or the inter-vehicle distance decreases, the steering operation becomes cautious and the yaw angle fluctuation becomes dull.

これに対し本実施形態では、自車両の車速Vが閾値Vk以下であるか、先行車両との車間距離Lが閾値Lk以上である場合には、各車両のヨー角中央値を算出する。そして、各車両のヨー角とヨー角中央値との偏差に基づいて隊列から離脱する車両を判定する。一方、自車両の車速Vが閾値Vkよりも大きいか、先行車両との車間距離Lが閾値Lkよりも小さい場合には、各車両のステアリング角積分値中央値を算出する。そして、各車両のステアリング角積分値とステアリング角積分値中央値との偏差に基づいて隊列から離脱する車両を判定する。ステアリング角積分値は、ステアリング操作に直結するため、ステアリング操作が慎重となる走行環境下においても高感度に変動する。これにより、車速の高い走行環境や、車間距離の短い走行環境においても、隊列からの離脱車両を高感度に判定することができる。   On the other hand, in this embodiment, when the vehicle speed V of the host vehicle is equal to or less than the threshold value Vk, or the inter-vehicle distance L with respect to the preceding vehicle is equal to or greater than the threshold value Lk, the median yaw angle of each vehicle is calculated. Based on the deviation between the yaw angle of each vehicle and the median value of the yaw angle, the vehicle leaving the platoon is determined. On the other hand, when the vehicle speed V of the host vehicle is larger than the threshold value Vk or the inter-vehicle distance L with the preceding vehicle is smaller than the threshold value Lk, the median steering angle integral value of each vehicle is calculated. Based on the deviation between the steering angle integral value and the steering angle integral value median value of each vehicle, a vehicle leaving the platoon is determined. Since the steering angle integral value is directly related to the steering operation, it varies with high sensitivity even in a driving environment where the steering operation is cautious. As a result, it is possible to determine a vehicle leaving the platoon with high sensitivity even in a traveling environment with a high vehicle speed or a traveling environment with a short inter-vehicle distance.

なお、ステアリング角積分値は、隊列進行方向に対する車両の傾きを代用する値であり、隊列からの車両の離脱と密接に関連する。このため、ステアリング角積分値偏差に基づく場合も、隊列からの離脱車両を確実に判定することができる。   Note that the steering angle integral value is a value that substitutes for the inclination of the vehicle with respect to the formation direction, and is closely related to the departure of the vehicle from the formation. For this reason, even when based on the steering angle integral value deviation, it is possible to reliably determine a vehicle that has left the platoon.

以上、本発明に係わる離脱車両判定装置の実施形態について幾つか説明してきたが、本発明は、上記実施形態に限定されるものではなく、以下に示すような様々な変形例が考えられる。   As mentioned above, although several embodiment of the leaving vehicle determination apparatus concerning this invention has been demonstrated, this invention is not limited to the said embodiment, The various modifications as shown below are considered.

例えば、上記各実施形態では、離脱判定に用いる物理量としてヨー角またはステアリング角積分値を例示したが、車両の横方向運動に関するものであれば他のどのような物理量を用いてもよい。例えば、車両の横方向の位置を用いても良い。横方向の位置は、GPSや加速度センサ等から取得することができる。   For example, in each of the above embodiments, the yaw angle or steering angle integral value is exemplified as the physical quantity used for the departure determination, but any other physical quantity may be used as long as it relates to the lateral movement of the vehicle. For example, the lateral position of the vehicle may be used. The lateral position can be acquired from a GPS, an acceleration sensor, or the like.

また、上記各実施形態では、離脱判定に用いる物理量統計値としてヨー角平均値、ヨー角中央値、ステアリング角積分値中央値を例示したが、自車両の横方向運動に関する物理量と複数の他車両の横方向運動に関する物理量とに基づくものであれば、他のどのような物理量統計値を用いても良い。例えば、ヨー角等の平均値の算出において、自車両との距離に応じた重み付けをしても良い。これにより、離脱判定の感度を調整することができる。また、複数の物理量測定値を大きい順に並べ、最大および最小のものを除いて平均値を算出しても良い。これにより、平均値の一層の安定性を得つつ、離脱車両の影響を十分除外することができる。   In each of the above embodiments, the average yaw angle value, the median yaw angle, and the median steering angle integrated value are exemplified as the physical quantity statistics used for the departure determination. However, the physical quantity related to the lateral movement of the host vehicle and a plurality of other vehicles Any other physical quantity statistical value may be used as long as the physical quantity is based on the physical quantity related to the lateral movement. For example, in calculating the average value such as the yaw angle, weighting may be performed according to the distance from the host vehicle. Thereby, the sensitivity of determination of separation can be adjusted. Alternatively, a plurality of physical quantity measurement values may be arranged in descending order, and the average value may be calculated except for the maximum and minimum values. Thereby, it is possible to sufficiently exclude the influence of the leaving vehicle while obtaining further stability of the average value.

また、上記第3実施形態では、走行環境に関する情報として、隊列車速(自車両の車速)、隊列車間距離(自車両と先行車両との車間距離)を例示したが、ステアリング操作に影響を与える情報であれば他のどのようなものを用いてもよい。例えば、自車両だけでなく、自車両と共に隊列走行する複数の他車両の車速および車間距離情報を取得し、隊列走行する各車両の車速平均値及び車間距離平均値を、隊列車速及び隊列車間距離として算出しても良い。さらに、周囲の明るさや、走行路の幅を用いても良い。これらの情報は、車載カメラの撮像画像などから取得することができる。   In the third embodiment, as information on the traveling environment, the train speed (vehicle speed of the own vehicle) and the distance between train cars (the distance between the own vehicle and the preceding vehicle) are exemplified, but the steering operation is affected. Any other information may be used. For example, the vehicle speed and inter-vehicle distance information of not only the own vehicle but also a plurality of other vehicles traveling in a row with the own vehicle are obtained, and the average vehicle speed value and the inter-vehicle distance average value of each vehicle traveling in the platoon are determined as the train speed and between train trains. It may be calculated as a distance. Furthermore, ambient brightness and the width of the travel path may be used. Such information can be acquired from a captured image of the in-vehicle camera.

1,30…離脱車両判定装置、2…無線通信機(他車両物理量取得手段)、3…ヨーレートセンサ(自車両物理量取得手段)、4,34…ECU(自車両物理量取得手段、他車両物理量取得手段、物理量統計値算出手段、離脱車両特定手段、隊列車両台数取得手段、走行環境情報取得手段)、31…操舵角センサ(自車両物理量取得手段)、32…車速センサ(走行環境情報取得手段)、33…車間距離センサ(走行環境情報取得手段)。   DESCRIPTION OF SYMBOLS 1,30 ... Departure vehicle determination apparatus, 2 ... Wireless communication apparatus (other vehicle physical quantity acquisition means), 3 ... Yaw rate sensor (own vehicle physical quantity acquisition means), 4, 34 ... ECU (own vehicle physical quantity acquisition means, other vehicle physical quantity acquisition) Means, physical quantity statistical value calculation means, departure vehicle specifying means, platoon number acquisition means, travel environment information acquisition means), 31 ... steering angle sensor (own vehicle physical quantity acquisition means), 32 ... vehicle speed sensor (travel environment information acquisition means) 33: Inter-vehicle distance sensor (traveling environment information acquisition means).

Claims (8)

隊列走行時に隊列から離脱する車両を判定する離脱車両判定装置において、
自車両の横方向運動に関する物理量を取得する自車両物理量取得手段と、
前記自車両と共に隊列走行する複数の他車両の横方向運動に関する物理量を取得する他車両物理量取得手段と、
前記自車両の横方向運動に関する物理量と前記複数の他車両の横方向運動に関する物理量とに基づいて、前記隊列走行する各車両の横方向運動に関する物理量統計値を算出する物理量統計値算出手段と、
前記各車両の横方向運動に関する物理量と前記物理量統計値との偏差に基づいて、前記隊列から離脱する車両を特定する離脱車両特定手段とを備えることを特徴とする離脱車両判定装置。
In a departure vehicle determination device that determines a vehicle that leaves a formation when traveling in a formation,
Own vehicle physical quantity acquisition means for acquiring a physical quantity related to the lateral movement of the own vehicle;
Other vehicle physical quantity acquisition means for acquiring a physical quantity related to lateral movement of a plurality of other vehicles traveling in tandem with the host vehicle;
A physical quantity statistic value calculating means for calculating a physical quantity statistic value related to a lateral movement of each vehicle traveling in the formation based on a physical quantity relating to a lateral movement of the own vehicle and a physical quantity relating to a lateral movement of the plurality of other vehicles;
A departure vehicle determination device comprising: a departure vehicle identification unit that identifies a vehicle leaving the platoon based on a deviation between a physical quantity relating to a lateral movement of each vehicle and the physical quantity statistical value.
前記物理量統計値算出手段は、前記各車両の横方向運動に関する物理量平均値及び物理量中央値の少なくとも一方を前記物理量統計値として算出することを特徴とする請求項1記載の離脱車両判定装置。   2. The separated vehicle determination device according to claim 1, wherein the physical quantity statistical value calculation means calculates at least one of a physical quantity average value and a physical quantity median value related to a lateral motion of each vehicle as the physical quantity statistical value. 前記隊列走行する車両の台数を取得する隊列車両台数取得手段を更に備え、
前記物理量統計値算出手段は、前記隊列走行する車両の台数に応じて、統計値の種類が異なる前記物理量統計値を算出することを特徴とする請求項1記載の離脱車両判定装置。
The vehicle further comprises a vehicle number acquisition means for acquiring the number of vehicles traveling in the row,
The said physical quantity statistical value calculation means calculates the said physical quantity statistical value from which the kind of statistical value differs according to the number of the vehicles which carry out the platoon, The leaving vehicle determination apparatus of Claim 1 characterized by the above-mentioned.
前記物理量統計値算出手段は、前記隊列走行する車両の台数が所定台数よりも多いときは、前記各車両の横方向運動に関する物理量平均値を前記物理量統計値として算出し、前記隊列走行する車両の台数が前記所定台数よりも少ないときは、前記各車両の横方向運動に関する物理量中央値を前記物理量統計値として算出することを特徴とする請求項3記載の離脱車両判定装置。   When the number of vehicles traveling in the platoon is greater than a predetermined number, the physical quantity statistic value calculating means calculates a physical quantity average value related to lateral movement of each vehicle as the physical quantity statistic value, and 4. The departure vehicle determination apparatus according to claim 3, wherein when the number of vehicles is smaller than the predetermined number, a median physical quantity related to lateral movement of each vehicle is calculated as the physical quantity statistical value. 前記自車両物理量取得手段は、前記自車両の横方向運動に関する物理量として前記自車両のヨー角及びステアリング角積分値の少なくとも一方を取得し、
前記他車両物理量取得手段は、前記他車両の横方向運動に関する物理量として前記他車両のヨー角及びステアリング角積分値の少なくとも一方を取得し、
前記物理量統計値算出手段は、前記各車両の横方向運動に関する物理量統計値として前記各車両のヨー角統計値及びステアリング角積分値統計値の少なくとも一方を算出することを特徴とする請求項1〜4のいずれか一項記載の離脱車両判定装置。
The host vehicle physical quantity acquisition means acquires at least one of a yaw angle and a steering angle integral value of the host vehicle as a physical quantity related to a lateral movement of the host vehicle,
The other vehicle physical quantity acquisition means acquires at least one of a yaw angle and a steering angle integral value of the other vehicle as a physical quantity related to a lateral movement of the other vehicle,
The physical quantity statistical value calculation means calculates at least one of a yaw angle statistical value and a steering angle integrated value statistical value of each vehicle as a physical quantity statistical value related to lateral movement of each vehicle. 5. The departure vehicle determination device according to claim 4.
前記隊列の走行環境に関する情報を取得する走行環境情報取得手段を更に備え、
前記物理量統計値算出手段は、前記走行環境に関する情報に応じて、物理量の種類が異なる前記物理量統計値を算出することを特徴とする請求項1〜4のいずれか一項記載の離脱車両判定装置。
A travel environment information acquisition means for acquiring information related to the travel environment of the platoon;
The said physical quantity statistical value calculation means calculates the said physical quantity statistical value from which the kind of physical quantity differs according to the information regarding the said driving environment, The leaving vehicle determination apparatus as described in any one of Claims 1-4 characterized by the above-mentioned. .
前記走行環境情報取得手段は、前記走行環境に関する情報として前記各車両の隊列車速を取得し、
前記物理量統計値算出手段は、前記隊列車速が所定速度よりも低いときは、前記各車両の横方向運動に関する物理量統計値として前記各車両のヨー角統計値を算出し、前記隊列車速が前記所定速度よりも高いときは、前記各車両の横方向運動に関する物理量統計値として前記各車両のステアリング角積分値統計値を算出することを特徴とする請求項6記載の離脱車両判定装置。
The travel environment information acquisition means acquires the train speed of each vehicle as information related to the travel environment,
The physical quantity statistical value calculation means calculates a yaw angle statistical value of each vehicle as a physical quantity statistical value related to lateral movement of each vehicle when the unit train speed is lower than a predetermined speed, and the unit train speed is the predetermined speed. The separated vehicle determination device according to claim 6, wherein when the speed is higher than the speed, a steering angle integral value statistic value of each vehicle is calculated as a physical quantity statistic value regarding a lateral motion of each vehicle.
前記走行環境情報取得手段は、前記走行環境に関する情報として前記各車両の隊列車間距離を取得し、
前記物理量統計値算出手段は、前記隊列車間距離が所定距離よりも長いときは、前記各車両の横方向運動に関する物理量統計値として前記各車両のヨー角統計値を算出し、前記隊列車間距離が前記所定距離よりも短いときは、前記各車両の横方向運動に関する物理量統計値として前記各車両のステアリング角積分値統計値を算出することを特徴とする請求項6記載の離脱車両判定装置。
The travel environment information acquisition means acquires the distance between the trains of each vehicle as information on the travel environment,
When the inter-train distance is longer than a predetermined distance, the physical quantity statistical value calculation means calculates a yaw angle statistical value of each vehicle as a physical quantity statistical value related to lateral movement of each vehicle, and 7. A departure vehicle determination apparatus according to claim 6, wherein when the distance is shorter than the predetermined distance, a steering angle integral value statistic value of each vehicle is calculated as a physical quantity statistic value regarding a lateral movement of each vehicle. .
JP2010103948A 2010-04-28 2010-04-28 Deviating vehicle determination device Pending JP2011233010A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2010103948A JP2011233010A (en) 2010-04-28 2010-04-28 Deviating vehicle determination device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2010103948A JP2011233010A (en) 2010-04-28 2010-04-28 Deviating vehicle determination device

Publications (1)

Publication Number Publication Date
JP2011233010A true JP2011233010A (en) 2011-11-17

Family

ID=45322259

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2010103948A Pending JP2011233010A (en) 2010-04-28 2010-04-28 Deviating vehicle determination device

Country Status (1)

Country Link
JP (1) JP2011233010A (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2017133933A (en) * 2016-01-28 2017-08-03 株式会社ゼンリンデータコム Position management system and position management method

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2017133933A (en) * 2016-01-28 2017-08-03 株式会社ゼンリンデータコム Position management system and position management method

Similar Documents

Publication Publication Date Title
US10303168B2 (en) On-vehicle control device, host vehicle position and posture specifying device, and on-vehicle display device
CN110809790B (en) Vehicle information storage method, vehicle travel control method, and vehicle information storage device
JP4962581B2 (en) Lane marking detector
US9912933B2 (en) Road surface detection device and road surface detection system
WO2014192137A1 (en) Movement trajectory prediction device, and movement trajectory prediction method
JP6538547B2 (en) Road curvature measurement device
CN109074737A (en) Safe driving assistant system, server, vehicle and program
CN111868479B (en) Vehicle operation based on vehicle measurement data processing
US20190146514A1 (en) Apparatus for autonomous driving algorithm development using daily driving data and method using the same
CN101223416A (en) Object detection device
US20050278112A1 (en) Process for predicting the course of a lane of a vehicle
WO2016098284A1 (en) Remote vehicle data collection system
JP2015138316A (en) Unusual travel point detection device and method for detecting unusual travel point
JP4670528B2 (en) Imaging device deviation detection method, imaging device deviation correction method, and imaging device
EP3330669A1 (en) Control method for travel control device, and travel control device
CN104471626A (en) Lane departure determination apparatus, lane departure warning apparatus, and vehicle control system using same
CN104937648A (en) Road environment recognition system
CN105022987B (en) The method of bias correction and diagnostic function for lane sensing sensor
JP2019066302A (en) Object estimation device
JP6115429B2 (en) Own vehicle position recognition device
JP2020003463A (en) Vehicle&#39;s self-position estimating device
CN111947669A (en) Method for using feature-based positioning maps for vehicles
CN103868516A (en) Method and device for determining location and/or type of road infrastructure facility
JP2012059058A (en) Risk estimation device and program
CN113306559A (en) Compensation for vertical road camber in road shape estimation