JP2019038474A - Automatic steering system - Google Patents

Automatic steering system Download PDF

Info

Publication number
JP2019038474A
JP2019038474A JP2017163636A JP2017163636A JP2019038474A JP 2019038474 A JP2019038474 A JP 2019038474A JP 2017163636 A JP2017163636 A JP 2017163636A JP 2017163636 A JP2017163636 A JP 2017163636A JP 2019038474 A JP2019038474 A JP 2019038474A
Authority
JP
Japan
Prior art keywords
lane
vehicle
steering
shape
information
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2017163636A
Other languages
Japanese (ja)
Other versions
JP6898645B2 (en
Inventor
徳昭 田口
Noriaki Taguchi
徳昭 田口
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.)
Subaru Corp
Original Assignee
Subaru 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 Subaru Corp filed Critical Subaru Corp
Priority to JP2017163636A priority Critical patent/JP6898645B2/en
Publication of JP2019038474A publication Critical patent/JP2019038474A/en
Application granted granted Critical
Publication of JP6898645B2 publication Critical patent/JP6898645B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Steering Control In Accordance With Driving Conditions (AREA)
  • Traffic Control Systems (AREA)

Abstract

To provide an automatic steering system which can be converted into a manual operation without disturbing behavior of a vehicle at abnormal end time of automatic steering.SOLUTION: An automatic steering system comprising a steering control device which controls a steering gear, and a steering support device which performs such automatic steering as to control the steering control device and travels a vehicle along a target course shape. The steering control device comprises: a storage part which stores traffic lane shape information calculated from map information; an abnormality diagnosis part which detects occurrence of a failure such that input of a control signal from the steering support device is interrupted; and a future course shape changeover part which determines whether a traffic lane change operation is continued or not based on the traffic lane shape information when the failure occurs during the traffic lane change operation of the vehicle.SELECTED DRAWING: Figure 1

Description

本発明は、車両の操舵制御装置を制御する自動操舵システムに関する。   The present invention relates to an automatic steering system that controls a steering control device of a vehicle.

例えば特開2002−175597号公報に開示されているように、車両前方の道路の形状等の車両の周囲の環境を認識する外部環境認識装置を備え、当該装置の認識結果に基づいて車両の自動運転を行う走行制御システムが知られている。   For example, as disclosed in Japanese Patent Application Laid-Open No. 2002-175597, an external environment recognition device that recognizes the environment around the vehicle, such as the shape of a road ahead of the vehicle, is provided, and the vehicle is automatically operated based on the recognition result of the device. A traveling control system that performs driving is known.

特開2002−175597号公報JP 2002-175597 A

自動運転が可能な車両において、例えば外部環境認識装置の故障やケーブルの断線等により自動運転に関わる装置に障害が発生した場合、自動運転の制御が即時に異常終了する。車両の運転者が警告音等により自動運転の異常終了を認識して手動運転を開始するまでの間は、車両の操舵が行われないため、この期間中に車両の挙動が乱れてしまう場合がある。   In a vehicle capable of automatic driving, if a failure occurs in a device related to automatic driving due to, for example, a failure of an external environment recognition device or a cable disconnection, the control of automatic driving abnormally ends immediately. Until the driver of the vehicle recognizes the abnormal end of automatic driving by a warning sound or the like and starts manual driving, the vehicle is not steered, so the behavior of the vehicle may be disturbed during this period. is there.

本発明は前述した問題を解決するものであり、自動運転の異常終了時において車両の挙動を乱さずに手動運転に移行することのできる自動操舵システムを提供することを目的とする。   The present invention solves the above-described problems, and an object thereof is to provide an automatic steering system capable of shifting to manual driving without disturbing the behavior of the vehicle at the time of abnormal termination of automatic driving.

本発明の一態様の自動操舵システムは、車両の舵角を変更するアクチュエータを備える操舵装置を制御する操舵制御装置と、前記車両の外部環境情報および地図情報の少なくとも一方から目標進路形状を算出し、当該目標進路形状および前記車両の挙動を検出する状態量検出装置から出力される状態量に基づき前記操舵制御装置を制御し、前記車両を前記目標進路形状に沿って走行させる自動操舵を行う操舵支援装置と、を備える自動操舵システムであって、前記操舵制御装置および前記操舵支援装置のいずれか一方は、前記外部環境情報および前記地図情報の少なくとも一方に基づいて、現在から所定の時間後までに前記車両が走行すると予測される距離内における、前記車両が走行中の自車線および前記自車線に隣接する1つまたは2つの隣接車線の形状および属性を示す車線形状情報を算出する車線形状算出部を備え、前記操舵制御装置は、現在から所定の時間後までの前記目標進路形状である将来進路形状と、前記状態量と、前記車線形状情報と、を記憶する記憶部と、前記操舵支援装置からの制御信号の入力が途絶する障害の発生を検出する異常診断部と、前記自動操舵時において、前記車両が前記自車線から前記隣接車線への車線変更動作中に前記障害が発生した場合に、前記車線形状情報に基づいて前記車線変更動作を継続するか否かを判定し、前記車線変更動作を継続しないと判定した場合には前記自車線の前記車線形状情報に基づいて前記記憶部に記憶されている前記将来進路形状を書き換える将来進路形状切替部と、前記自動操舵時において前記障害が発生した場合には、前記記憶部に記憶されている前記将来進路形状に沿って前記車両が走行するように前記操舵装置を制御する指示値演算部と、を備える。   An automatic steering system according to an aspect of the present invention calculates a target course shape from at least one of a steering control device that controls a steering device including an actuator that changes a steering angle of a vehicle, and external environment information and map information of the vehicle. The steering control device is controlled on the basis of the target course shape and the state quantity output from the state quantity detection device for detecting the behavior of the vehicle, and the steering is performed to automatically run the vehicle along the target course shape. An automatic steering system comprising: a support device, wherein either one of the steering control device and the steering support device is based on at least one of the external environment information and the map information until a predetermined time later The vehicle lane in which the vehicle is traveling and one or two adjacent to the vehicle lane within a distance predicted to travel the vehicle. A lane shape calculation unit that calculates lane shape information indicating the shape and attribute of an adjacent lane, and the steering control device includes a future route shape that is the target route shape from a present time to a predetermined time later, the state quantity, A storage unit that stores the lane shape information, an abnormality diagnosis unit that detects the occurrence of a failure in which the input of a control signal from the steering assist device is interrupted, and the vehicle is in the own lane during the automatic steering. When the obstacle occurs during the lane change operation from the vehicle to the adjacent lane, it is determined whether to continue the lane change operation based on the lane shape information, and it is determined not to continue the lane change operation In this case, the future route shape switching unit for rewriting the future route shape stored in the storage unit based on the lane shape information of the own lane, and the obstacle occurs during the automatic steering. Case, and an instruction value calculating unit said vehicle along said future path shape stored in the storage unit to control the steering device so that the vehicle travels.

本発明によれば、自動運転の異常終了時において車両の挙動を乱さずに手動運転に移行することのできる自動操舵システムを提供することができる。   ADVANTAGE OF THE INVENTION According to this invention, the automatic steering system which can transfer to manual driving | operation without disturbing the behavior of a vehicle at the time of the abnormal end of automatic driving | operation can be provided.

自動操舵システムの構成を示すブロック図である。It is a block diagram which shows the structure of an automatic steering system. 車線変更継続判定処理のフローチャートである。It is a flowchart of a lane change continuation determination process. 操舵制御装置の動作を示すフローチャートである。It is a flowchart which shows operation | movement of a steering control apparatus. ネットワーク異常状態発生時における指示値演算部による、第3操舵指示値の算出方法の概要を示す図である。It is a figure which shows the outline | summary of the calculation method of the 3rd steering instruction value by the instruction value calculating part at the time of network abnormal state generation | occurrence | production. 操舵指示異常状態発生時における指示値演算部による、第2操舵指示値の算出方法の概要を示す図である。It is a figure which shows the outline | summary of the calculation method of the 2nd steering instruction value by the instruction value calculating part at the time of steering instruction abnormal state generation | occurrence | production.

以下に、本発明の好ましい形態について図面を参照して説明する。なお、以下の説明に用いる各図においては、各構成要素を図面上で認識可能な程度の大きさとするため、構成要素毎に縮尺を異ならせてあるものであり、本発明は、これらの図に記載された構成要素の数量、構成要素の形状、構成要素の大きさの比率、及び各構成要素の相対的な位置関係のみに限定されるものではない。   Hereinafter, preferred embodiments of the present invention will be described with reference to the drawings. In the drawings used for the following description, the scale of each component is made different in order to make each component recognizable on the drawing. It is not limited only to the quantity of the component described in (1), the shape of the component, the ratio of the size of the component, and the relative positional relationship of each component.

図1に示す本実施形態の自動操舵システム100は、車両に搭載され、当該車両が備える操舵装置1の動作を制御する装置である。操舵装置1は、例えば電動アクチュエータを備え、電動アクチュエータの出力により車両の舵角を変更する電動パワーステアリング装置である。自動操舵システム100は、操舵装置1を制御することにより、車両の自動運転機能および運転支援機能における自動操舵を実行する。   An automatic steering system 100 according to the present embodiment shown in FIG. 1 is a device that is mounted on a vehicle and controls the operation of the steering device 1 provided in the vehicle. The steering device 1 is an electric power steering device that includes an electric actuator, for example, and changes the steering angle of the vehicle by the output of the electric actuator. The automatic steering system 100 executes the automatic steering in the automatic driving function and the driving support function of the vehicle by controlling the steering device 1.

自動操舵システム100は、操舵支援装置10、および操舵制御装置20を備える。また、車両は、操舵装置1、車外通信装置2、状態量検出装置3、報知部4および通信ネットワーク5を備える。   The automatic steering system 100 includes a steering assist device 10 and a steering control device 20. The vehicle also includes a steering device 1, an outside vehicle communication device 2, a state quantity detection device 3, a notification unit 4, and a communication network 5.

本実施形態では一例として、操舵支援装置10、操舵制御装置20、車外通信装置2および状態量検出装置3は、通信ネットワーク5に接続されており、当該通信ネットワーク5を介して互いにデータ通信を行う。   In the present embodiment, as an example, the steering assist device 10, the steering control device 20, the vehicle exterior communication device 2, and the state quantity detection device 3 are connected to the communication network 5 and perform data communication with each other via the communication network 5. .

車外通信装置2は、無線通信装置を備え、車両の外部の通信装置との間で情報の送受信を行う。車外通信装置2は、通信エリア内に存在する他車両と直接的に通信を行う、いわゆる車車間通信を行う。また、車外通信装置2は、通信エリア内に存在する無線基地局との通信を行う、いわゆる路車間通信も行う形態であってもよい。車外通信装置2は、通信エリア内に存在する他車両の位置および速度の情報や、車両が走行中である道路における車線規制の情報等を受信する。なお、車両は、車外通信装置2を備えていなくてもよい。   The out-of-vehicle communication device 2 includes a wireless communication device and transmits / receives information to / from a communication device outside the vehicle. The out-of-vehicle communication device 2 performs so-called inter-vehicle communication that directly communicates with other vehicles existing in the communication area. Moreover, the form which performs what is called road-to-vehicle communication which communicates with the wireless base station which exists in a communication area may be sufficient as the external vehicle communication apparatus 2. FIG. The out-of-vehicle communication device 2 receives information on the position and speed of other vehicles existing in the communication area, information on lane restrictions on the road on which the vehicle is traveling, and the like. Note that the vehicle may not include the out-of-vehicle communication device 2.

車外通信装置2から出力される状態量の情報は、通信ネットワーク5を経由して操舵支援装置10に入力される。なお、車外通信装置2と操舵支援装置10との間の通信は、通信ネットワーク5を用いずに専用の通信ケーブルを用いて行われてもよい。   Information on the state quantity output from the external communication device 2 is input to the steering assist device 10 via the communication network 5. Note that communication between the vehicle exterior communication device 2 and the steering assist device 10 may be performed using a dedicated communication cable without using the communication network 5.

状態量検出装置3は、車両の状態量を検出する複数のセンサからなる。車両の状態量には、車両の速度である車速V、車両の前後方向の加速度α、車両のヨー方向の角速度であるヨーレートYawr、および操舵装置1の舵角が少なくとも含まれる。すなわち、状態量検出装置3は、車速センサ、加速度センサ、ヨーレートセンサおよび舵角センサを少なくとも含む。これらのセンサは公知の技術であるため、詳細な説明は省略する。なお、車両の前後方向の加速度αは、車速Vから算出可能であるため、状態量検出装置3は、加速度センサを備えていなくともよい。   The state quantity detection device 3 includes a plurality of sensors that detect the state quantity of the vehicle. The vehicle state quantity includes at least a vehicle speed V that is the speed of the vehicle, an acceleration α in the longitudinal direction of the vehicle, a yaw rate Yawr that is an angular velocity in the yaw direction of the vehicle, and a steering angle of the steering device 1. That is, the state quantity detection device 3 includes at least a vehicle speed sensor, an acceleration sensor, a yaw rate sensor, and a steering angle sensor. Since these sensors are well-known techniques, detailed description is omitted. Note that since the acceleration α in the longitudinal direction of the vehicle can be calculated from the vehicle speed V, the state quantity detection device 3 may not include an acceleration sensor.

状態量検出装置3から出力される状態量の情報は、通信ネットワーク5を経由して操舵支援装置10および操舵制御装置20に入力される。なお、状態量検出装置3と操舵支援装置10および操舵制御装置20との間の通信は、通信ネットワーク5を用いずに専用の通信ケーブルを用いて行われてもよい。   Information on the state quantity output from the state quantity detection device 3 is input to the steering assist device 10 and the steering control device 20 via the communication network 5. Communication between the state quantity detection device 3 and the steering assist device 10 and the steering control device 20 may be performed using a dedicated communication cable without using the communication network 5.

報知部4は、例えば画像や文字を表示する表示装置、光を発する発光装置、音を発するスピーカ、振動を発するバイブレータ、またはこれらの組み合わせ等、を含み、自動操舵システム100から運転者に対して情報を出力する。   The notification unit 4 includes, for example, a display device that displays images and characters, a light emitting device that emits light, a speaker that emits sound, a vibrator that emits vibration, or a combination thereof, and the like from the automatic steering system 100 to the driver. Output information.

操舵支援装置10は、地図情報認識装置11、外部環境認識装置12、および自動操舵指示値演算部13を備える。   The steering assist device 10 includes a map information recognition device 11, an external environment recognition device 12, and an automatic steering instruction value calculation unit 13.

地図情報認識装置11は、衛星測位システム(GNSS)、慣性航法装置および路車間通信の少なくとも一つを用いて車両の現在位置(緯度、経度)を検出する測位装置11aと、地図情報を記憶する地図情報記憶部11bと、を備える。   The map information recognition device 11 stores map information and a positioning device 11a that detects the current position (latitude, longitude) of the vehicle using at least one of a satellite positioning system (GNSS), an inertial navigation device, and road-to-vehicle communication. A map information storage unit 11b.

地図情報認識装置11は、測位装置11aにより検出された車両の現在位置と、地図情報記憶部11bが記憶している地図情報と、に基づいて、車両前方の走行路の形状を認識する。   The map information recognition device 11 recognizes the shape of the traveling road ahead of the vehicle based on the current position of the vehicle detected by the positioning device 11a and the map information stored in the map information storage unit 11b.

地図情報には、道路の曲率、縦断面勾配、他の道路との交差の様子等の道路の形状を示す情報が含まれる。また、地図情報には、道路が有する車線の属性を示す情報も含まれる。車線の属性とは、例えば、本線、前記本線に進入する進入路、前記本線から退出する退出路、等の情報である。また、車線の属性には、走行車線および追い越し車線の情報も含まれる。なお、道路の属性の情報は、後述する外部環境認識装置12によって判定される形態であってもよい。   The map information includes information indicating the shape of the road such as the curvature of the road, the gradient of the longitudinal section, and the state of intersection with another road. The map information includes information indicating the lane attributes of the road. The lane attributes are, for example, information such as a main line, an approach road that enters the main line, and an exit path that leaves the main line. The lane attributes also include information on the traveling lane and the overtaking lane. The road attribute information may be determined by the external environment recognition device 12 described later.

外部環境認識装置12は、車両の外部環境を認識するカメラやセンサからの情報と車外通信装置2からの情報とに基づいて車両前方の道路の形状や、道路上および道路の周囲に存在する物体の位置を認識し、これらの情報を外部環境情報として出力する。   The external environment recognition device 12 is based on information from cameras and sensors for recognizing the external environment of the vehicle and information from the external communication device 2 and the shape of the road ahead of the vehicle and objects existing on and around the road. Is recognized, and this information is output as external environment information.

外部環境認識装置12は、例えば車両前方を視野内に収めるステレオカメラを備え、ステレオカメラによって撮像された画像に既知の画像処理等を施すことによって、車両前方の環境を認識する。外部環境認識装置12は、路面上に設けられた線状標示や路面上の他車両、歩行者等を認識する。線状標示とは、車線を示すために車線の左右の境界に沿って路面上に形成された線状や破線状の道路標示である。また、外部環境認識装置12は、カメラの他にレーダ装置を備え、車両の側方や後方を走行中の他車両の車両に対する相対位置と相対速度を検出する。   The external environment recognition device 12 includes, for example, a stereo camera that keeps the front of the vehicle within the field of view, and recognizes the environment ahead of the vehicle by performing known image processing or the like on the image captured by the stereo camera. The external environment recognition device 12 recognizes linear markings provided on the road surface, other vehicles on the road surface, pedestrians, and the like. A linear marking is a linear or dashed road marking formed on a road surface along the left and right boundaries of a lane to indicate a lane. The external environment recognition device 12 includes a radar device in addition to the camera, and detects a relative position and a relative speed of the other vehicle traveling on the side or rear of the vehicle with respect to the vehicle.

すなわち、外部環境情報には、車外通信装置2からの情報およびステレオカメラやレーダ装置により検出された情報の少なくとも一方に基づいて算出された、車両の周囲を走行する1つまたは複数の他車両の、車両に対する相対位置および相対速度の情報である近接車両情報が含まれる。外部環境認識装置12は、近接車両情報を後述する操舵制御装置20に出力する。   That is, the external environment information includes one or more other vehicles traveling around the vehicle, calculated based on at least one of information from the external communication device 2 and information detected by the stereo camera or the radar device. , Proximity vehicle information that is information on the relative position and relative speed with respect to the vehicle is included. The external environment recognition device 12 outputs the proximity vehicle information to the steering control device 20 described later.

自動操舵指示値演算部13は、CPU、ROM、RAM、入出力装置等がバスに接続されたコンピュータより構成されている。自動操舵指示値演算部13は、地図情報認識装置11から出力される地図情報および外部環境認識装置12により認識される外部環境情報の少なくとも一方に基づいて、車両を走行させる走行路の形状である目標進路形状を算出する。   The automatic steering instruction value calculation unit 13 is composed of a computer having a CPU, ROM, RAM, input / output device and the like connected to a bus. The automatic steering instruction value calculation unit 13 has a shape of a travel path on which the vehicle travels based on at least one of map information output from the map information recognition device 11 and external environment information recognized by the external environment recognition device 12. A target course shape is calculated.

また、自動操舵指示値演算部13は、車両の自動操舵時において、地図情報認識装置11または外部環境認識装置12により認識される目標進路形状に対する状態量(ヨー角度偏差や横位置偏差等)と、状態量検出装置3により検出される状態量に基づいて、目標進路形状に沿って車両を走行させるために操舵装置1に出力する制御データである第1操舵指示値を算出する。第1操舵指示値は、車両が目標進路形状に沿って走行するように、操舵装置1が実行すべき操舵の目標値となる情報である。第1操舵指示値は、本実施形態では一例として、操舵装置1が変更すべき目標舵角の値である。なお、第1操舵指示値は、操舵装置1が備える電動アクチュエータが発生すべき操舵トルクの値等であってもよい。   In addition, the automatic steering instruction value calculation unit 13 is configured to calculate a state quantity (yaw angle deviation, lateral position deviation, etc.) with respect to a target course shape recognized by the map information recognition device 11 or the external environment recognition device 12 during automatic steering of the vehicle. Based on the state quantity detected by the state quantity detection device 3, a first steering instruction value, which is control data output to the steering device 1 in order to drive the vehicle along the target course shape, is calculated. The first steering instruction value is information that becomes a target value of steering that the steering device 1 should execute so that the vehicle travels along the target course shape. In the present embodiment, the first steering instruction value is, for example, a target steering angle value that the steering device 1 should change. The first steering instruction value may be a value of a steering torque that should be generated by the electric actuator provided in the steering device 1.

自動操舵指示値演算部13から出力された第1操舵指示値は、後述する操舵制御装置20に入力される。   The first steering instruction value output from the automatic steering instruction value calculation unit 13 is input to the steering control device 20 described later.

また、自動操舵指示値演算部13は、地図情報および外部環境情報の少なくとも一方に基づいて、現在から所定時間後であるA秒後までに車両を走行させる目標進路形状である将来進路形状の情報を算出する。所定の時間Aは、例えば5秒程度である。自動操舵指示値演算部13は、将来進路形状の情報を、後述する操舵制御装置20に出力する。なお、将来進路形状の算出は、後述する操舵制御装置20において行われてもよい。   In addition, the automatic steering instruction value calculation unit 13 is based on at least one of the map information and the external environment information, and information on a future course shape that is a target course shape that causes the vehicle to travel by A seconds after a predetermined time from the present time. Is calculated. The predetermined time A is, for example, about 5 seconds. The automatic steering instruction value calculation unit 13 outputs information on the future course shape to the steering control device 20 described later. The calculation of the future course shape may be performed by the steering control device 20 described later.

車線形状算出部14は、外部環境情報および地図情報の少なくとも一方に基づいて、現在から所定時間であるA秒後までに車両が走行すると予測される距離内における、車両が走行中の自車線および当該自車線に隣接する1つまたは2つの隣接車線の形状および属性を示す車線形状情報を算出する。隣接車線には、分岐路や退出路も含まれる。すなわち、車線形状情報は、現在から5秒程度の間に走行する可能性のある全ての車線の形状および属性の情報である。なお、車線形状情報は、車両が走行中の道路の全ての車線の形状および属性の情報を含んでいてもよい。車線形状算出部14は、車線形状情報を、後述する操舵制御装置20に出力する。   The lane shape calculation unit 14 is based on at least one of the external environment information and the map information, and the vehicle lane in which the vehicle is traveling within the distance that the vehicle is expected to travel within a predetermined time A seconds after the present time. Lane shape information indicating the shape and attributes of one or two adjacent lanes adjacent to the host lane is calculated. Adjacent lanes include branch roads and exit roads. That is, the lane shape information is information on the shapes and attributes of all lanes that may travel within about 5 seconds from the present time. The lane shape information may include information on the shapes and attributes of all lanes on the road on which the vehicle is traveling. The lane shape calculation unit 14 outputs lane shape information to the steering control device 20 described later.

操舵制御装置20は、CPU、ROM、RAM、入出力装置等がバスに接続されたコンピュータより構成されている。操舵制御装置20は、記憶部21、異常診断部23、将来進路形状切替部24、指示値演算部25および切替部26を備える。また、操舵制御装置20は、操舵装置1に電気的に接続されている。操舵制御装置20が備えるこれらの構成は、個々の機能を実行する別個のハードウェアとして実装されていてもよいし、所定のプログラムをCPUが実行することによって個々の機能が達成されるようにソフトウェア的に実装されていてもよい。   The steering control device 20 is composed of a computer having a CPU, ROM, RAM, input / output device and the like connected to a bus. The steering control device 20 includes a storage unit 21, an abnormality diagnosis unit 23, a future course shape switching unit 24, an instruction value calculation unit 25, and a switching unit 26. Further, the steering control device 20 is electrically connected to the steering device 1. These components included in the steering control device 20 may be implemented as separate hardware that executes individual functions, or software such that individual functions are achieved by the CPU executing a predetermined program. May be implemented.

記憶部21は、最新の将来進路形状、車線形状情報、近接車両情報および状態量を記憶する。状態量とは、状態量検出装置3から出力された最新の状態量のデータのことである。記憶部21が記憶する車両の状態量には、車両の速度である車速V、車両の前後方向の加速度α、車両のヨー方向の角速度であるヨーレートYawr、および操舵装置1の舵角、が少なくとも含まれる。   The storage unit 21 stores the latest future course shape, lane shape information, proximity vehicle information, and state quantities. The state quantity is the latest state quantity data output from the state quantity detection device 3. The vehicle state quantity stored in the storage unit 21 includes at least a vehicle speed V that is the speed of the vehicle, an acceleration α in the longitudinal direction of the vehicle, a yaw rate Yawr that is an angular velocity in the yaw direction of the vehicle, and the steering angle of the steering device 1. included.

記憶部21が記憶する将来進路形状、車線形状情報、近接車両情報および状態量は、所定の周期で常に更新される。よって、記憶部21が記憶する将来進路形状、車線形状情報、近接車両情報および状態量は、常に最新の値となる。なお、将来進路形状、車線形状情報、近接車両情報および状態量のそれぞれの更新周期は同一であってもよいし異なっていてもよい。   The future course shape, lane shape information, proximity vehicle information, and state quantity stored in the storage unit 21 are constantly updated at a predetermined cycle. Therefore, the future course shape, lane shape information, proximity vehicle information, and state quantity stored in the storage unit 21 are always the latest values. In addition, each update period of future course shape, lane shape information, proximity vehicle information, and state quantity may be the same, and may differ.

異常診断部23は、自動操舵時において、通信ネットワーク5が故障している通信ネットワーク異常状態の発生の検出と、自動操舵時において、操舵支援装置10が故障している操舵指示異常状態の発生の検出と、を行う。   The abnormality diagnosis unit 23 detects the occurrence of a communication network abnormality state in which the communication network 5 has failed during automatic steering, and the occurrence of a steering instruction abnormality state in which the steering assist device 10 has failed during automatic steering. And detection.

ネットワーク異常状態は、通信ネットワーク5を介したデータ通信が不可能な状態である。操舵指示異常状態は、操舵支援装置10から自らの動作に障害が発生していることを示す情報が出力されている状態か、もしくは通信ネットワーク5は正常に動作しているにもかかわらず操舵支援装置10とのデータ通信ができない状態である。   The network abnormal state is a state in which data communication via the communication network 5 is impossible. The steering instruction abnormal state is a state in which information indicating that a failure has occurred in its own operation is output from the steering assist device 10, or the steering assist is performed even though the communication network 5 is operating normally. In this state, data communication with the device 10 is not possible.

すなわち、ネットワーク異常状態である場合には、操舵制御装置20は、操舵支援装置10から出力される第1操舵指示値、将来進路形状および車線形状情報の受信と、状態量検出装置3から出力される状態量の情報の受信が不可能となる。また、操舵指示異常状態である場合には、操舵制御装置20は、操舵支援装置10から出力される第1操舵指示値、将来進路形状および車線形状情報の受信の情報の受信が不可能であるが、状態量検出装置3から出力される状態量の情報の受信が可能である。   That is, in a network abnormal state, the steering control device 20 receives the first steering instruction value, the future course shape information, and the lane shape information output from the steering assist device 10 and is output from the state quantity detection device 3. It becomes impossible to receive information on the state quantity. Further, when the steering instruction is abnormal, the steering control device 20 cannot receive the first steering instruction value, the future course shape, and the lane shape information received from the steering assist device 10. However, it is possible to receive state quantity information output from the state quantity detection device 3.

将来進路形状切替部24は、自動操舵時において、車両が自車線から隣接車線への車線変更動作中にネットワーク異常状態または操舵指示異常状態の障害が発生した場合に、記憶部21に記憶されている車線形状情報に基づいて車線変更動作を継続するか否かを判定する。そして、将来進路形状切替部24は、車線変更動作を継続しないと判定した場合には自車線の車線形状情報に基づいて記憶部21に記憶されている将来進路形状を書き換える。   The future course shape switching unit 24 is stored in the storage unit 21 when a fault of a network abnormal state or a steering instruction abnormal state occurs during a lane change operation from the own lane to the adjacent lane during automatic steering. It is determined whether or not to continue the lane change operation based on the existing lane shape information. If it is determined that the lane change operation is not continued, the future course shape switching unit 24 rewrites the future course shape stored in the storage unit 21 based on the lane shape information of the own lane.

自車線から隣接車線への車線変更動作中とは、車両が車線変更を開始した時点から、車両の全ての車輪が隣接車線内に入るまでの期間である。この車線変更動作中において、ネットワーク異常状態または操舵指示異常状態の障害が発生していない場合には、記憶部21に記憶されている将来進路形状は、操舵支援装置10によって算出されたものであり、隣接車線内に向かう形状になっている。   The lane change operation from the own lane to the adjacent lane is a period from when the vehicle starts changing lanes until all the wheels of the vehicle enter the adjacent lane. During the lane change operation, when no failure in the network abnormal state or the steering instruction abnormal state has occurred, the future course shape stored in the storage unit 21 is calculated by the steering assist device 10. The shape is directed toward the adjacent lane.

そして、車線変更動作中において、ネットワーク異常状態または操舵指示異常状態の障害が発生した場合には、将来進路形状切替部24は、車両が自車線内を走行するように、記憶部21に記憶されている将来進路形状を書き換える。   In the event that a network abnormal state or steering instruction abnormal state failure occurs during the lane change operation, the future course shape switching unit 24 is stored in the storage unit 21 so that the vehicle travels in the own lane. Rewrite the future course shape.

また、本実施形態の将来進路形状切替部24は、記憶部21に記憶されている車線形状情報に加えて、記憶部21に記憶されている近接車両情報に基づいて車線変更動作を継続するか否かを判定する。   In addition to the lane shape information stored in the storage unit 21, the future course shape switching unit 24 of the present embodiment continues the lane change operation based on the proximity vehicle information stored in the storage unit 21. Determine whether or not.

図2に、将来進路形状切替部24が実行する車線変更継続判定処理のフローチャートを示す。車線変更継続判定処理では、まずステップS500において、車両が車線変更動作中であるか否かを判定する。   FIG. 2 shows a flowchart of the lane change continuation determination process executed by the future course shape switching unit 24. In the lane change continuation determination process, first, in step S500, it is determined whether or not the vehicle is in a lane change operation.

ステップS500において、車両が車線変更動作中ではないと判定した場合には、将来進路形状切替部24は車線変更継続判定処理を終了する。一方、ステップS500において、車両が車線変更動作中であると判定した場合には、将来進路形状切替部24はステップS510に移行する。   If it is determined in step S500 that the vehicle is not in a lane change operation, the future course shape switching unit 24 ends the lane change continuation determination process. On the other hand, if it is determined in step S500 that the vehicle is in a lane change operation, the future course shape switching unit 24 proceeds to step S510.

ステップS510において、将来進路形状切替部24は、記憶部21に記憶されている車線形状情報に基づいて、車両の前方で自車線が消滅するか否かを判定する。車両の前方とは、車線形状情報の範囲内のことであり、すなわち現在から所定時間であるA秒後までに車両が走行すると予測される距離内のことである。   In step S <b> 510, the future course shape switching unit 24 determines whether the own lane disappears in front of the vehicle based on the lane shape information stored in the storage unit 21. The front of the vehicle is within the range of the lane shape information, that is, within the distance where the vehicle is predicted to travel from the present to A seconds after the predetermined time.

自車線の消滅は、車両が走行している道路の車線数が減少する場合や、自車線が本線に進入する進入路である場合に起こる。前述のように、車線形状情報には、自車線および隣接車線の形状および属性が含まれていることから、将来進路形状切替部24は、車線形状情報に基づいて自車線の消滅の有無を判定できる。   The disappearance of the own lane occurs when the number of lanes on the road on which the vehicle is traveling decreases or when the own lane is an approach road that enters the main line. As described above, since the lane shape information includes the shape and attributes of the own lane and the adjacent lane, the future course shape switching unit 24 determines whether or not the own lane has disappeared based on the lane shape information. it can.

ステップS510において車両の前方で自車線が消滅すると判定した場合には、将来進路形状切替部24は、ステップS580に移行する。ステップS580では、将来進路形状切替部24は、車線変更動作を継続すると判定し、車線変更継続判定処理を終了する。ステップS580が実行された場合、記憶部21に記憶されている将来進路形状は、操舵支援装置10によって算出されたものであり、隣接車線内に向かう形状になっている。   If it is determined in step S510 that the own lane will disappear in front of the vehicle, the future course shape switching unit 24 proceeds to step S580. In step S580, the future course shape switching unit 24 determines to continue the lane change operation and ends the lane change continuation determination process. When step S580 is executed, the future course shape stored in the storage unit 21 is calculated by the steering assist device 10 and is shaped toward the adjacent lane.

一方、ステップS510において車両の前方で自車線が消滅しないと判定した場合には、将来進路形状切替部24は、ステップS520に移行する。   On the other hand, if it is determined in step S510 that the own lane does not disappear in front of the vehicle, the future course shape switching unit 24 proceeds to step S520.

ステップS520では、将来進路形状切替部24は、記憶部21に記憶されている車線形状情報に基づいて、車線変更先となる隣接車線が退出路または分岐路であるか否かを判定する。   In step S520, the future course shape switching unit 24 determines whether the adjacent lane as the lane change destination is an exit route or a branch route based on the lane shape information stored in the storage unit 21.

ステップS520において車線変更先となる隣接車線が退出路または分岐路であると判定した場合には、将来進路形状切替部24は、ステップS580に移行する。前述のように、ステップS580では、将来進路形状切替部24は、車線変更動作を継続すると判定し、車線変更継続判定処理を終了する。   If it is determined in step S520 that the adjacent lane to be the lane change destination is a leaving road or a branch road, the future course shape switching unit 24 proceeds to step S580. As described above, in step S580, the future course shape switching unit 24 determines to continue the lane change operation, and ends the lane change continuation determination process.

一方、ステップS520において車線変更先となる隣接車線が退出路または分岐路ではないと判定した場合には、将来進路形状切替部24は、ステップS530に移行する。   On the other hand, if it is determined in step S520 that the adjacent lane that is the lane change destination is not an exit road or a branch road, the future course shape switching unit 24 proceeds to step S530.

ステップS530では、将来進路形状切替部24は、記憶部21に記憶されている車線形状情報に基づいて、実行中の車線変更動作は追い越し車線から走行車線への車線変更であるか否かを判定する。   In step S530, the future course shape switching unit 24 determines, based on the lane shape information stored in the storage unit 21, whether the lane change operation being performed is a lane change from an overtaking lane to a traveling lane. To do.

ステップS530において、実行中の車線変更動作は追い越し車線から走行車線への車線変更であると判定した場合には、将来進路形状切替部24は、ステップS580に移行する。前述のように、ステップS580では、将来進路形状切替部24は、車線変更動作を継続すると判定し、車線変更継続判定処理を終了する。   If it is determined in step S530 that the lane change operation being performed is a lane change from the overtaking lane to the traveling lane, the future course shape switching unit 24 proceeds to step S580. As described above, in step S580, the future course shape switching unit 24 determines to continue the lane change operation, and ends the lane change continuation determination process.

一方、ステップS530において、実行中の車線変更動作は追い越し車線から走行車線への車線変更ではないと判定した場合には、将来進路形状切替部24は、ステップS540に移行する。   On the other hand, if it is determined in step S530 that the lane change operation being performed is not a lane change from the overtaking lane to the traveling lane, the future course shape switching unit 24 proceeds to step S540.

ステップS540では、将来進路形状切替部24は、記憶部21に記憶されている車線形状情報に基づいて、実行中の車線変更動作は走行車線からから追い越し車線への車線変更であるか否かを判定する。   In step S540, based on the lane shape information stored in the storage unit 21, the future course shape switching unit 24 determines whether or not the lane change operation being performed is a lane change from the traveling lane to the overtaking lane. judge.

ステップS540において、実行中の車線変更動作は追い越し車線から走行車線への車線変更であると判定した場合には、将来進路形状切替部24は、ステップS600に移行する。ステップS600では、将来進路形状切替部24は、車線変更動作を中断すると判定する。そして、ステップS610において、将来進路形状切替部24は、記憶部21に記憶されている将来進路形状を、車両が自車線に戻るように車線形状情報に基づいて書き換え、車線変更継続判定処理を終了する。   If it is determined in step S540 that the lane change operation being performed is a lane change from the overtaking lane to the traveling lane, the future course shape switching unit 24 proceeds to step S600. In step S600, the future course shape switching unit 24 determines to interrupt the lane change operation. In step S610, the future course shape switching unit 24 rewrites the future course shape stored in the storage unit 21 based on the lane shape information so that the vehicle returns to the own lane, and ends the lane change continuation determination process. To do.

一方、ステップS540において、実行中の車線変更動作は走行車線から追い越し車線への車線変更ではないと判定した場合には、将来進路形状切替部24は、ステップS550に移行する。   On the other hand, if it is determined in step S540 that the lane change operation being performed is not a lane change from the traveling lane to the overtaking lane, the future course shape switching unit 24 proceeds to step S550.

ステップS550では、将来進路形状切替部24は、記憶部21に記憶されている近接車両情報に基づいて、車線変更先となる隣接車線に他車両が存在しているか否かを判定する。   In step S550, the future course shape switching unit 24 determines whether there is another vehicle in the adjacent lane to be the lane change destination based on the proximity vehicle information stored in the storage unit 21.

ステップS550において、車線変更先となる隣接車線に他車両が存在していないと判定した場合には、将来進路形状切替部24は、ステップS580に移行する。前述のように、ステップS580では、将来進路形状切替部24は、車線変更動作を継続すると判定し、車線変更継続判定処理を終了する。   If it is determined in step S550 that there is no other vehicle in the adjacent lane that is the lane change destination, the future course shape switching unit 24 proceeds to step S580. As described above, in step S580, the future course shape switching unit 24 determines to continue the lane change operation, and ends the lane change continuation determination process.

一方、ステップS550において、車線変更先となる隣接車線に他車両が存在していると判定した場合には、将来進路形状切替部24は、ステップS560に移行する。   On the other hand, if it is determined in step S550 that there is another vehicle in the adjacent lane that is the lane change destination, the future course shape switching unit 24 proceeds to step S560.

ステップS560では、将来進路形状切替部24は、記憶部21に記憶されている近接車両情報、および記憶部21に記憶されている車両の車速Vおよび加速度αの値に基づき、車線変更先となる隣接車線を走行中の他車両との衝突予測時間TTCを算出する。衝突予測時間TTCは、車両が記憶部21に記憶されている車両の車速Vおよび加速度αを維持して隣接車線に移り、かつ当該隣接車線を走行している他車両が記憶部21に記憶されている速度を維持した場合において、両者が接触するまでに要する時間である。   In step S560, the future course shape switching unit 24 becomes a lane change destination based on the proximity vehicle information stored in the storage unit 21 and the vehicle speed V and acceleration α values stored in the storage unit 21. A collision prediction time TTC with another vehicle traveling in the adjacent lane is calculated. The collision prediction time TTC is stored in the storage unit 21 while the vehicle moves to the adjacent lane while maintaining the vehicle speed V and acceleration α of the vehicle stored in the storage unit 21 and travels in the adjacent lane. This is the time required for the two to come into contact with each other when the speed is maintained.

次に、ステップS570において、将来進路形状切替部24は、全ての他車両に対する衝突予測時間TTCが所定の閾値ds以上であるか否かを判定する。   Next, in step S570, the future course shape switching unit 24 determines whether or not the predicted collision time TTC for all other vehicles is equal to or greater than a predetermined threshold value ds.

ステップS570において全ての他車両に対する衝突予測時間TTCが所定の閾値ds以上であると判定した場合には、将来進路形状切替部24は、ステップS580に移行する。前述のように、ステップS580では、将来進路形状切替部24は、車線変更動作を継続すると判定し、車線変更継続判定処理を終了する。   If it is determined in step S570 that the predicted collision time TTC for all other vehicles is equal to or greater than the predetermined threshold value ds, the future course shape switching unit 24 proceeds to step S580. As described above, in step S580, the future course shape switching unit 24 determines to continue the lane change operation, and ends the lane change continuation determination process.

一方、ステップS570において衝突予測時間TTCが所定の閾値ds未満の他車両が存在すると判定した場合には、将来進路形状切替部24は、ステップS600に移行する。ステップS600では、将来進路形状切替部24は、車線変更動作を中断すると判定する。そして、ステップS610において、将来進路形状切替部24は、記憶部21に記憶されている将来進路形状を、車両が自車線に戻るように車線形状情報に基づいて書き換え、車線変更継続判定処理を終了する。   On the other hand, if it is determined in step S570 that there is another vehicle with a predicted collision time TTC less than the predetermined threshold value ds, the future course shape switching unit 24 proceeds to step S600. In step S600, the future course shape switching unit 24 determines to interrupt the lane change operation. In step S610, the future course shape switching unit 24 rewrites the future course shape stored in the storage unit 21 based on the lane shape information so that the vehicle returns to the own lane, and ends the lane change continuation determination process. To do.

指示値演算部25は、車両の自動操舵時において、異常診断部23によりネットワーク異常状態または操舵指示異常状態であることが検出されている場合に、記憶部21に記憶されている将来進路形状に沿って車両を走行させるために操舵装置1に出力する指示値を算出する。   The instruction value calculation unit 25 displays the future course shape stored in the storage unit 21 when the abnormality diagnosis unit 23 detects that the network abnormality state or the steering instruction abnormality state is detected during automatic steering of the vehicle. An instruction value to be output to the steering device 1 for driving the vehicle along the vehicle is calculated.

詳細には、指示値演算部25は、自動操舵時において、操舵指示異常状態である場合には、状態量検出装置3から入力される状態量および記憶部21に記憶されている将来進路形状に基づいて、将来進路形状に沿って車両を走行させるために操舵装置1に出力する第2操舵指示値を算出する。   Specifically, the instruction value calculation unit 25 determines the state quantity input from the state quantity detection device 3 and the future course shape stored in the storage unit 21 when the steering instruction is abnormal during automatic steering. Based on this, a second steering instruction value to be output to the steering device 1 in order to drive the vehicle along the future course shape is calculated.

また、指示値演算部25は、自動操舵時において、ネットワーク異常状態である場合には、記憶部21に記憶されている最新の状態量および将来進路形状に基づいて、将来進路形状に沿って前記車両を走行させるために操舵装置1に出力する第3操舵指示値を算出する。   In addition, the instruction value calculation unit 25, in the case of a network abnormal state at the time of automatic steering, based on the latest state quantity and the future route shape stored in the storage unit 21, along the future route shape. A third steering instruction value that is output to the steering device 1 to drive the vehicle is calculated.

切替部26は、自動操舵時において、ネットワーク異常状態または操舵指示異常状態ではない場合には、操舵支援装置10から出力される第1操舵指示値に基づいて操舵装置1を制御し、操舵指示異常状態である場合には、指示値演算部25から出力される第2操舵指示値に基づいて操舵装置1を制御し、ネットワーク異常状態である場合には、指示値演算部25から出力される第3操舵指示値に基づいて操舵装置1を制御する。   The switching unit 26 controls the steering device 1 based on the first steering instruction value output from the steering assist device 10 when the automatic steering is not in the network abnormal state or the steering instruction abnormal state, and the steering instruction abnormality is detected. When the state is in the state, the steering device 1 is controlled based on the second steering instruction value output from the instruction value calculation unit 25, and when the network is in an abnormal state, the second value output from the instruction value calculation unit 25 is controlled. 3. Steering device 1 is controlled based on the steering instruction value.

すなわち、自動操舵システム100は、操舵支援装置10、状態量検出装置3および通信ネットワーク5の動作が正常である場合には、操舵支援装置10が算出する第1操舵指示値に基づいて車両の自動操舵を行う。   That is, when the operations of the steering assist device 10, the state quantity detection device 3, and the communication network 5 are normal, the automatic steering system 100 automatically detects the vehicle based on the first steering instruction value calculated by the steering assist device 10. Steer.

また、自動操舵システム100は、車両の自動操舵時において、操舵支援装置10に障害が発生し、通信ネットワーク5および状態量検出装置3の動作は正常である操舵指示異常状態となった場合には、操舵制御装置20が備える指示値演算部25が算出する第2操舵指示値に基づいて車両の自動操舵を行う。   Further, the automatic steering system 100 is in a case where a failure occurs in the steering assist device 10 during automatic steering of the vehicle, and the operation of the communication network 5 and the state quantity detection device 3 is in a normal steering instruction abnormal state. The vehicle is automatically steered based on the second steering instruction value calculated by the instruction value calculation unit 25 provided in the steering control device 20.

また、自動操舵システム100は、車両の自動操舵時において、通信ネットワーク5に障害が発生した場合であるネットワーク異常状態では、操舵制御装置20が備える指示値演算部25が算出する第3操舵指示値に基づいて車両の自動操舵を行う。   In addition, the automatic steering system 100 is configured such that the third steering instruction value calculated by the instruction value calculation unit 25 included in the steering control device 20 in a network abnormal state in which a failure occurs in the communication network 5 during automatic steering of the vehicle. Based on this, the vehicle is automatically steered.

次に、操舵制御装置20の自動操舵に関する動作について図3に示すフローチャートを参照して説明する。操舵制御装置20は、図3に示す処理を車両の走行時に実行する。   Next, an operation related to automatic steering of the steering control device 20 will be described with reference to a flowchart shown in FIG. The steering control device 20 executes the process shown in FIG. 3 when the vehicle is traveling.

操舵制御装置20は、まずステップS100において、車両の運転者による、自動操舵を開始する指示操作が入力されるまで待機する。操舵制御装置20は、運転者による自動操舵を開始する指示操作が入力されたと判定した場合に、ステップS110以降の処理を開始する。   First, in step S100, the steering control device 20 stands by until an instruction operation for starting automatic steering is input by the driver of the vehicle. When the steering control device 20 determines that an instruction operation for starting automatic steering by the driver has been input, the steering control device 20 starts processing from step S110.

以下の説明では、時間を変数tで表し、現在時刻をt=0であるとする。また、車両の速度である車速を時間の経過とともに変化する変数V(t)とし、車両の前後方向の加速度を時間の経過とともに変化する変数α(t)とし、車両のヨー方向の角速度であるヨーレートを時間の経過とともに変化する変数Yawr(t)とする。また、目標進路形状に対する車両位置の車幅方向のずれ量である横位置偏差を、時間の経過とともに変化する変数ErrX(t)とし、目標進路形状に対する車両の向きのヨー方向のずれ量であるヨー角度偏差を、時間の経過とともに変化する変数ErrYaw(t)とする。   In the following description, it is assumed that time is represented by a variable t and the current time is t = 0. The vehicle speed, which is the speed of the vehicle, is a variable V (t) that changes with time, and the acceleration in the longitudinal direction of the vehicle is a variable α (t) that changes with time. Let the yaw rate be a variable Yawr (t) that changes over time. Further, a lateral position deviation, which is a deviation amount in the vehicle width direction of the vehicle position with respect to the target route shape, is defined as a variable ErrX (t) that changes with time, and is a deviation amount in the yaw direction of the vehicle direction with respect to the target route shape. The yaw angle deviation is defined as a variable ErrYaw (t) that changes over time.

ステップS110では、操舵制御装置20は、記憶部21による、将来進路形状、車線形状情報、近接車両情報および状態量の記憶と当該記憶内容の更新を開始する。前述のように、将来進路形状は、現在から所定時間後であるA秒後まで車両を走行させるための目標進路形状である。また、車線形状情報は、現在から所定時間であるA秒後までに車両が走行すると予測される距離内における、車両が走行中の自車線および当該自車線に隣接する1つまたは2つの隣接車線の形状および属性を示す情報である。   In step S110, the steering control device 20 starts storing the future course shape, the lane shape information, the proximity vehicle information, and the state quantity by the storage unit 21, and updating the stored contents. As described above, the future course shape is a target course shape for causing the vehicle to travel from the present to A seconds after a predetermined time. In addition, the lane shape information includes the own lane in which the vehicle is traveling and one or two adjacent lanes adjacent to the own lane within a distance that the vehicle is predicted to travel within a predetermined time A seconds after the present time. It is the information which shows the shape and attribute of.

また、近接車両情報は、車両の周囲を走行する1つまたは複数の他車両の、車両に対する相対位置および相対速度の情報である。また、状態量は、車両の速度である車速V(0)、車両の前後方向の加速度α(0)、車両のヨー方向の角速度であるヨーレートYawr(0)、および操舵装置1の舵角を少なくとも含む。   The proximity vehicle information is information on a relative position and a relative speed of one or more other vehicles traveling around the vehicle with respect to the vehicle. The state quantity includes a vehicle speed V (0) that is the speed of the vehicle, a longitudinal acceleration α (0) of the vehicle, a yaw rate Yawr (0) that is an angular speed of the vehicle in the yaw direction, and the steering angle of the steering device 1. Including at least.

本実施形態では一例として、記憶部21は、状態量として、さらに目標進路形状に対する現在の車両のずれを表す横位置偏差ErrX(0)およびヨー角度偏差ErrYaw(0)を記憶する。位置偏差ErrX(0)およびヨー角度偏差ErrYaw(0)は、操舵支援装置10において算出される値であり、操舵制御装置20に入力される。記憶部21が記憶する情報は、車両が走行中であれば常に変化するため、正常状態である場合には常に更新され続ける。   In the present embodiment, as an example, the storage unit 21 further stores, as state quantities, a lateral position deviation ErrX (0) and a yaw angle deviation ErrYaw (0) representing the current vehicle deviation from the target course shape. The position deviation ErrX (0) and the yaw angle deviation ErrYaw (0) are values calculated by the steering assist device 10 and are input to the steering control device 20. Since the information stored in the storage unit 21 always changes when the vehicle is running, it is constantly updated when the vehicle is in a normal state.

次に、ステップS120において、操舵制御装置20は、操舵支援装置10が備える自動操舵指示値演算部13が算出する第1操舵指示値に基づき操舵装置1を制御する自動操舵を開始する。操舵支援装置10による自動操舵の制御は、公知の技術と同様であるため詳細な説明は省略する。概略的には、操舵支援装置10の自動操舵指示値演算部13は、地図情報認識装置11および外部認識装置12による最新の認識結果に基づいて目標進路形状を決定し、地図情報認識装置11および外部認識装置12により認識される目標進路形状に対する自車両のヨー角度偏差および横位置偏差等の情報と、車両の状態量と、に基づくフィードフォワード制御およびフィードバック制御により、第1操舵指示値を算出する。   Next, in step S <b> 120, the steering control device 20 starts automatic steering for controlling the steering device 1 based on the first steering instruction value calculated by the automatic steering instruction value calculator 13 included in the steering assist device 10. Since the control of automatic steering by the steering assist device 10 is the same as that of a known technique, a detailed description thereof is omitted. Schematically, the automatic steering instruction value calculation unit 13 of the steering assist device 10 determines the target course shape based on the latest recognition results by the map information recognition device 11 and the external recognition device 12, and the map information recognition device 11 and The first steering instruction value is calculated by feedforward control and feedback control based on information such as the yaw angle deviation and lateral position deviation of the host vehicle with respect to the target course shape recognized by the external recognition device 12 and the state quantity of the vehicle. To do.

第1操舵指示値に基づく自動操舵を開始した後は、操舵制御装置20は、正常状態であれば、運転者による自動操舵を終了する指示操作が入力されるまで自動操舵を継続する(ステップS150のYES)。   After starting the automatic steering based on the first steering instruction value, if the steering control device 20 is in a normal state, the steering control device 20 continues the automatic steering until an instruction operation for ending the automatic steering by the driver is input (step S150). YES)

そして、操舵制御装置20は、自動操舵の実行中において、異常検出部23によりネットワーク異常状態であることが検出された場合(ステップS130のYES)には、ステップS200へ移行する。   If the abnormality detection unit 23 detects that the network is abnormal during execution of automatic steering (YES in step S130), the steering control device 20 proceeds to step S200.

ステップS200では、操舵制御装置20は、将来進路形状切替部24による車線変更継続判定処理を実行する。車線変更継続判定処理は、図2を参照して前述した通りである。   In step S <b> 200, the steering control device 20 executes a lane change continuation determination process by the future course shape switching unit 24. The lane change continuation determination process is as described above with reference to FIG.

次に、ステップS210において、操舵制御装置20は、障害が発生し、自動操舵をA秒後に終了することを報知部4を介して運転者に知らせる。そしてステップS220では、操舵制御装置20は、指示値演算部25が算出する第3操舵指示値に基づいて操舵装置1を制御する自動操舵を、ネットワーク異常状態の発生検出からA秒間だけ継続する。   Next, in step S210, the steering control device 20 notifies the driver via the notification unit 4 that a failure has occurred and automatic steering is to be terminated after A seconds. In step S220, the steering control device 20 continues the automatic steering for controlling the steering device 1 based on the third steering instruction value calculated by the instruction value calculation unit 25 for A seconds from the detection of the occurrence of the network abnormal state.

指示値演算部25による、第3操舵指示値の算出方法の概要を図4に示す。以下では、時刻t=T1においてネットワーク異常状態が発生したものとし、時刻T1からの経過時間をδTとする。   An outline of a method for calculating the third steering instruction value by the instruction value calculation unit 25 is shown in FIG. In the following, it is assumed that a network abnormal state has occurred at time t = T1, and the elapsed time from time T1 is δT.

ネットワーク異常状態は操舵指示装置10および状態量検出装置3の双方と操舵制御装置20との間の通信が途絶した状態であることから、ネットワーク異常状態の発生後は、記憶部21に記憶されている将来進路形状、横位置偏差ErrX(t)およびヨー角度偏差ErrYaw(t)の値と、車両の状態量が更新されなくなる。したがって、ネットワーク異常状態の発生後は、記憶部21には、時刻T1における将来進路形状と、時刻T1における横位置偏差ErrX(T1)およびヨー角度偏差ErrYaw(T1)と、時刻T1における状態量が記憶されている。時刻T1における状態量は、車速V(T1)、加速度α(T1)およびヨーレートYawr(0)である。図4における破線の矩形枠で囲んだ値は、記憶部21に記憶されている値である。   Since the network abnormal state is a state where communication between both the steering instruction device 10 and the state quantity detection device 3 and the steering control device 20 is interrupted, the network abnormal state is stored in the storage unit 21 after the occurrence of the network abnormal state. The future course shape, the lateral position deviation ErrX (t), the yaw angle deviation ErrYaw (t), and the vehicle state quantity are not updated. Therefore, after the occurrence of the network abnormal state, the storage unit 21 stores the future course shape at the time T1, the lateral position deviation ErrX (T1) and the yaw angle deviation ErrYaw (T1) at the time T1, and the state quantities at the time T1. It is remembered. The state quantities at time T1 are vehicle speed V (T1), acceleration α (T1), and yaw rate Yawr (0). A value surrounded by a broken-line rectangular frame in FIG. 4 is a value stored in the storage unit 21.

ネットワーク異常状態の発生時には、指示値演算部25は、ネットワーク異常状態の発生時(t=T1)に記憶部21に記憶した将来進路形状および車両の状態量と、ネットワーク異常状態の発生からの経過時間δtと、に基づいて、目標進路の曲率Ce(0)を推定する。具体的には、指示値演算部25は、ネットワーク異常状態の発生時の車速V(T1)および加速度α(T1)と、経過時間δtとに基づいて、車両の現在の車速Ve(0)を推定する。そして、現在から過去δt秒間の推定車速Ve(0)の積分値から走行距離を算出し、記憶している将来進路形状上における車両の現在位置を推定し、この現在位置と将来進路形状から目標進路の曲率Ce(0)を推定する。   At the time of occurrence of the network abnormal state, the instruction value calculator 25 stores the future course shape and the vehicle state quantity stored in the storage unit 21 at the time of occurrence of the network abnormal state (t = T1), and the progress from the occurrence of the network abnormal state. Based on the time δt, the curvature Ce (0) of the target course is estimated. Specifically, the instruction value calculation unit 25 calculates the current vehicle speed Ve (0) of the vehicle based on the vehicle speed V (T1) and acceleration α (T1) at the time of occurrence of the network abnormal state and the elapsed time δt. presume. Then, the travel distance is calculated from the integrated value of the estimated vehicle speed Ve (0) for the past δt seconds from the present time, the current position of the vehicle on the stored future course shape is estimated, and the target position is determined from this current position and the future course shape. The path curvature Ce (0) is estimated.

そして、指示値演算部25は、目標ヨーレート算出部において、現在の推定車速Ve(0)と目標進路の推定曲率Ce(0)に基づき、車両のヨー角度を目標進路に沿ったヨー角度に変更させるために必要な目標ヨーレートを算出する。目標ヨーレートは、現在の推定車速Ve(0)と目標進路の推定曲率Ce(0)により算出される値である。   Then, the instruction value calculation unit 25 changes the yaw angle of the vehicle to the yaw angle along the target route based on the current estimated vehicle speed Ve (0) and the estimated curvature Ce (0) of the target route in the target yaw rate calculation unit. The target yaw rate required for the calculation is calculated. The target yaw rate is a value calculated from the current estimated vehicle speed Ve (0) and the estimated curvature Ce (0) of the target course.

また、指示値演算部25は、ネットワーク異常状態の発生時(t=T1)において目標進路に対する現在の車両の車幅方向のずれである横位置偏差ErrX(T1)や目標進路に対する現在の車両のヨー方向の角度ずれであるヨー角度偏差ErrYaw(T1)が所定の値を超えていた場合には、車両を将来進路上に復帰させるために必要な修正ヨーレートを、修正ヨーレート算出部において、横位置偏差ErrX(T1)およびヨー角度偏差ErrYaw(T1)を用いて算出する。すなわち、修正ヨーレートは、例えば、路面のカントや横風等の外乱に起因する車両の目標進路からのずれを補償するためのものである。   In addition, the instruction value calculation unit 25 performs the lateral position deviation ErrX (T1), which is a deviation in the vehicle width direction of the current vehicle with respect to the target route when the network abnormal state occurs (t = T1), and the current vehicle with respect to the target route. When the yaw angle deviation ErrYaw (T1), which is an angle deviation in the yaw direction, exceeds a predetermined value, the corrected yaw rate calculation unit calculates the corrected yaw rate necessary for returning the vehicle to the future course in the lateral position. Calculation is performed using the deviation ErrX (T1) and the yaw angle deviation ErrYaw (T1). That is, the corrected yaw rate is for compensating for a deviation from the target course of the vehicle due to, for example, a disturbance such as a cant on the road surface or a crosswind.

そして、指示値演算部25は、目標ヨーレートおよび修正ヨーレートを加算し、この結果に基づいて、第1目標舵角算出部において第1目標舵角を算出する。なお、第1目標舵角の算出には、あらかじめ設定された車両の運動特性と実際の車両の運動特性とのずれを補正するための舵角補正ゲインが加味される。   Then, the instruction value calculation unit 25 adds the target yaw rate and the corrected yaw rate, and based on this result, the first target rudder angle calculation unit calculates the first target rudder angle. The calculation of the first target rudder angle includes a rudder angle correction gain for correcting a deviation between a preset vehicle motion characteristic and an actual vehicle motion characteristic.

そして、指示値演算部25は、第1目標舵角を第3操舵指示値として出力する。すなわち、ネットワーク異常状態の発生時において自動操舵に用いられる第3操舵指示値は、記憶部21に記憶された将来進路形状と車両の状態量の情報に基づき操舵装置1をフィードフォワード制御するための第1目標舵角の成分のみを含む。第3操舵指示値には、操舵装置1をフィードバック制御するための成分が含まれていない。   Then, the instruction value calculation unit 25 outputs the first target steering angle as the third steering instruction value. That is, the third steering instruction value used for automatic steering when a network abnormal state occurs is used for feedforward control of the steering device 1 based on information on the future course shape and the vehicle state quantity stored in the storage unit 21. Only the component of the first target rudder angle is included. The third steering instruction value does not include a component for feedback control of the steering device 1.

ネットワーク異常状態の発生時において記憶部21に記憶されている将来進路形状の情報は、所定の時間(A秒間)内のものであるため、ネットワーク異常状態の発生からA秒後に、指示値演算部25は第3操舵指示値の算出を終了する。   Since the information of the future course shape stored in the storage unit 21 at the time of occurrence of the network abnormal state is within a predetermined time (A seconds), the instruction value calculation unit is A seconds after the occurrence of the network abnormal state. 25 ends the calculation of the third steering instruction value.

図3のフローチャートに戻り、操舵制御装置20は、自動操舵の実行中において、異常検出部23により操舵指示異常状態であることが検出された場合(ステップS140のYES)には、ステップS300へ移行する。   Returning to the flowchart of FIG. 3, the steering control device 20 proceeds to step S300 when the abnormality detection unit 23 detects that the steering instruction is abnormal during execution of automatic steering (YES in step S140). To do.

ステップS300では、操舵制御装置20は、将来進路形状切替部24による車線変更継続判定処理を実行する。車線変更継続判定処理は、図2を参照して前述した通りである。   In step S300, the steering control device 20 executes a lane change continuation determination process by the future course shape switching unit 24. The lane change continuation determination process is as described above with reference to FIG.

次に、ステップS310において、操舵制御装置20は、障害が発生し、自動操舵をA秒後に終了することを報知部4を介して運転者に知らせる。そしてステップS320では、操舵制御装置20は、指示値演算部25が算出する第2操舵指示値に基づいて操舵装置1を制御する自動操舵を、ネットワーク異常状態の発生検出からA秒間だけ継続する。   Next, in step S310, the steering control device 20 notifies the driver via the notification unit 4 that a failure has occurred and automatic steering is to be terminated after A seconds. In step S320, the steering control device 20 continues the automatic steering for controlling the steering device 1 based on the second steering instruction value calculated by the instruction value calculation unit 25 for A seconds from the detection of the occurrence of the network abnormal state.

指示値演算部25による、第2操舵指示値の算出方法の概要を図5に示す。以下では、時刻t=T1において操舵指示異常状態が発生したものとし、時刻T1からの経過時間をδTとする。   FIG. 5 shows an outline of a method for calculating the second steering instruction value by the instruction value calculation unit 25. In the following, it is assumed that the steering instruction abnormal state has occurred at time t = T1, and the elapsed time from time T1 is δT.

操舵指示異常状態は操舵支援装置10と操舵制御装置20との間の通信が途絶した状態であることから、操舵指示異常状態の発生後は、記憶部21に記憶されている将来進路形状と、横位置偏差ErrX(t)およびヨー角度偏差ErrYaw(t)の値が更新されなくなる。したがって、操舵指示異常状態の発生後は、記憶部21には、時刻T1における将来進路形状と、時刻T1における横位置偏差ErrX(T1)およびヨー角度偏差ErrYaw(T1)が記憶されている。図5における破線の矩形枠で囲んだ値は、記憶部21に記憶されている値である。   Since the steering instruction abnormal state is a state in which the communication between the steering assist device 10 and the steering control device 20 is interrupted, the future course shape stored in the storage unit 21 after the occurrence of the steering instruction abnormal state, The values of the lateral position deviation ErrX (t) and the yaw angle deviation ErrYaw (t) are not updated. Therefore, after the occurrence of the steering instruction abnormal state, the storage unit 21 stores the future course shape at time T1, the lateral position deviation ErrX (T1) and the yaw angle deviation ErrYaw (T1) at time T1. A value surrounded by a broken-line rectangular frame in FIG. 5 is a value stored in the storage unit 21.

操舵指示異常状態の発生時には、指示値演算部25は、操舵指示異常状態の発生時(t=T1)に記憶部21に記憶した将来進路形状と、操舵指示異常状態の発生からの経過時間δtと、現在の車速V(0)と、に基づいて、目標進路の曲率Ce(0)を推定する。具体的には、指示値演算部25は、現在から過去δt秒間の車速の積分値から走行距離を算出し、記憶している将来進路形状上における車両の現在位置を推定し、この現在位置と将来進路形状から目標進路の曲率Ce(0)を推定する。   When the steering instruction abnormal state occurs, the instruction value calculation unit 25 stores the future course shape stored in the storage unit 21 when the steering instruction abnormal state occurs (t = T1) and the elapsed time δt from the occurrence of the steering instruction abnormal state. And the curvature Ce (0) of the target course is estimated based on the current vehicle speed V (0). Specifically, the instruction value calculation unit 25 calculates the travel distance from the integrated value of the vehicle speed for the past δt seconds from the current time, estimates the current position of the vehicle on the stored future course shape, The curvature Ce (0) of the target course is estimated from the future course shape.

そして、指示値演算部25は、目標ヨーレート算出部において、現在の車速V(0)と目標進路の推定曲率Ce(0)に基づき、車両のヨー角度を目標進路に沿ったヨー角度に変更させるために必要な目標ヨーレートを算出する。目標ヨーレートは、現在の車速V(0)と目標進路の推定曲率Ce(0)により算出される値である。   Then, the instruction value calculation unit 25 causes the target yaw rate calculation unit to change the yaw angle of the vehicle to the yaw angle along the target route based on the current vehicle speed V (0) and the estimated curvature Ce (0) of the target route. The target yaw rate necessary for this is calculated. The target yaw rate is a value calculated from the current vehicle speed V (0) and the estimated curvature Ce (0) of the target course.

また、指示値演算部25は、操舵指示異常状態の発生時(t=T1)において目標進路に対する現在の車両の車幅方向のずれである横位置偏差ErrX(T1)や目標進路に対する現在の車両のヨー方向の角度ずれであるヨー角度偏差ErrYaw(T1)が所定の値を超えていた場合には、車両を将来進路上に復帰させるために必要な修正ヨーレートを、修正ヨーレート算出部において、横位置偏差ErrX(T1)およびヨー角度偏差ErrYaw(T1)を用いて算出する。すなわち、修正ヨーレートは、例えば、路面のカントや横風等の外乱に起因する車両の目標進路からのずれを補償するためのものである。   In addition, the instruction value calculation unit 25 performs the lateral position deviation ErrX (T1), which is a deviation in the vehicle width direction of the current vehicle with respect to the target route when the steering instruction abnormal state occurs (t = T1), and the current vehicle with respect to the target route. When the yaw angle deviation ErrYaw (T1), which is the angle deviation in the yaw direction, exceeds a predetermined value, the corrected yaw rate calculation unit calculates the corrected yaw rate necessary for returning the vehicle to the future course. The position deviation ErrX (T1) and the yaw angle deviation ErrYaw (T1) are used for calculation. That is, the corrected yaw rate is for compensating for a deviation from the target course of the vehicle due to, for example, a disturbance such as a cant on the road surface or a crosswind.

そして、指示値演算部25は、目標ヨーレートおよび修正ヨーレートを加算し、この結果に基づいて、第1目標舵角算出部において第1目標舵角を算出する。なお、第1目標舵角の算出には、あらかじめ設定された車両の運動特性と実際の車両の運動特性とのずれを補正するための舵角補正ゲインが加味される。   Then, the instruction value calculation unit 25 adds the target yaw rate and the corrected yaw rate, and based on this result, the first target rudder angle calculation unit calculates the first target rudder angle. The calculation of the first target rudder angle includes a rudder angle correction gain for correcting a deviation between a preset vehicle motion characteristic and an actual vehicle motion characteristic.

また、指示値演算部25は、目標ヨーレートおよび修正ヨーレートを加算した値と、現在の車両の状態量であるヨーレートYawr(0)とに基づき、第2目標舵角算出部において、車両のヨー角度を目標進路に沿ったヨー角度となるようにフィードバック制御する第2目標舵角を算出する。   Further, the instruction value calculation unit 25 uses the yaw rate yaw angle of the vehicle in the second target rudder angle calculation unit based on the value obtained by adding the target yaw rate and the corrected yaw rate and the yaw rate Yawr (0) that is the current vehicle state quantity. A second target rudder angle is calculated for feedback control so that the yaw angle along the target path becomes a yaw angle.

指示値演算部25は、第1目標舵角および第2目標舵角を加算した値を第2操舵指示値として出力する。すなわち、操舵指示異常状態の発生時において自動操舵に用いられる第2操舵指示値は、記憶部21に記憶された将来進路形状と現在の車速V(0)に基づき操舵装置1をフィードフォワード制御するための第1目標舵角の成分と、現在の車両のヨーレートYawr(0)の値に基づき操舵装置1をフィードバック制御するための第2目標舵角の成分と、を含む。   The instruction value calculation unit 25 outputs a value obtained by adding the first target steering angle and the second target steering angle as a second steering instruction value. In other words, the second steering instruction value used for automatic steering when the steering instruction abnormal state occurs performs feedforward control of the steering device 1 based on the future course shape stored in the storage unit 21 and the current vehicle speed V (0). And a second target rudder angle component for feedback control of the steering device 1 based on the current yaw rate Yawr (0) value of the vehicle.

操舵指示異常状態の発生時において記憶部21に記憶されている将来進路形状の情報は、所定の時間(A秒間)内のものであるため、操舵指示異常状態の発生からA秒後に、指示値演算部25は第2操舵指示値の算出を終了する。   Since the information on the future course shape stored in the storage unit 21 at the time of occurrence of the steering instruction abnormal state is within a predetermined time (A seconds), the instruction value is A seconds after the occurrence of the steering instruction abnormal state. The calculation unit 25 ends the calculation of the second steering instruction value.

以上に説明したように、本実施形態の操舵制御装置20は、自動操舵時において、現在から所定の時間後の将来までに車両が走行する道路の形状に応じた将来進路形状と、車両の車速等の状態量を記憶部21に記憶する。   As described above, the steering control device 20 according to the present embodiment, during automatic steering, determines the future course shape according to the shape of the road on which the vehicle travels from the present to the future after a predetermined time, and the vehicle speed. Etc. are stored in the storage unit 21.

そして、地図情報認識装置11および外部認識装置12を備える操舵支援装置10と、操舵装置1を制御する操舵制御装置20との間の通信が途絶する操舵指示異常状態が発生した場合には、操舵制御装置20は、記憶している将来進路形状と、状態量検出装置3によりリアルタイムで検出される車速およびヨーレートの情報に基づいて操舵装置1を制御し、所定の期間だけ自動操舵を継続する。この場合、車両の状態量の変化に応じて車両の位置の推定と、舵角のフィードバック制御の実行が可能であるため、自動操舵システム100は、記憶している将来進路形状に沿って所定の期間だけ正確に車両を走行させることができる。   When a steering instruction abnormal state occurs in which communication between the steering support device 10 including the map information recognition device 11 and the external recognition device 12 and the steering control device 20 that controls the steering device 1 is interrupted, steering is performed. The control device 20 controls the steering device 1 based on the stored future course shape and vehicle speed and yaw rate information detected in real time by the state quantity detection device 3, and continues automatic steering only for a predetermined period. In this case, since the estimation of the position of the vehicle and the feedback control of the steering angle can be executed in accordance with the change in the state quantity of the vehicle, the automatic steering system 100 performs a predetermined operation along the stored future course shape. The vehicle can be accurately driven only during the period.

また、本実施形態の操舵制御装置20は、操舵支援装置10および状態量検出装置3の双方と、操舵制御装置20との間の通信が途絶する通信ネットワーク異常状態が発生した場合においても、記憶している最新の将来進路形状および状態量に基づいて、操舵装置1を制御し、所定の期間だけ車両を将来進路形状に沿って走行させる自動操舵を継続することができる。   In addition, the steering control device 20 according to the present embodiment stores the memory even when a communication network abnormal state occurs in which communication between both the steering assist device 10 and the state quantity detection device 3 and the steering control device 20 is interrupted. The steering device 1 can be controlled based on the latest future course shape and state quantity, and the automatic steering can be continued so that the vehicle travels along the future course shape for a predetermined period.

よって、本実施形態の自動操舵システム100によれば、通信ネットワーク5に障害が発生した後や操舵支援装置10に障害が発生した後にも、所定の時間(A秒間)中は車両を将来進路形状に沿って走行させる自動操舵を継続することができる。   Therefore, according to the automatic steering system 100 of the present embodiment, after a failure occurs in the communication network 5 or after a failure occurs in the steering assist device 10, the vehicle is kept in the future course shape for a predetermined time (A seconds). It is possible to continue the automatic steering that travels along the road.

そして、本実施形態の自動操舵システム100によれば、障害発生後の将来進路形状に沿った自動操舵の実行期間中に、運転者による手動運転に移行させることができるため、自動操舵が異常終了する場合における車両の挙動の乱れを防止することができる。   According to the automatic steering system 100 of the present embodiment, the automatic steering is abnormally terminated because the automatic steering can be shifted to the manual driving by the driver during the execution period of the automatic steering along the future course shape after the occurrence of the failure. In this case, it is possible to prevent the disturbance of the behavior of the vehicle.

また、本実施形態の自動操舵システム100は、通信ネットワーク5に障害が発生した時点や操舵支援装置10に障害が発生した時点において、車両が車線変更動作中である場合には、図2を参照して説明したように、記憶部21に記憶されている車線形状情報および近接車両情報に基づいて、車線変更動作を継続するか否かを判定する。   In addition, the automatic steering system 100 according to the present embodiment refers to FIG. 2 when the vehicle is in a lane change operation when a failure occurs in the communication network 5 or when a failure occurs in the steering assist device 10. As described above, based on the lane shape information and the proximity vehicle information stored in the storage unit 21, it is determined whether or not to continue the lane change operation.

そして、本実施形態の自動操舵システム100では、車線変更動作を継続しないと判定した場合には、ステップS610に示すように、記憶部21に記憶されている将来進路形状を、自車線に戻る形状のものに書き換える。この場合、障害の発生後の所定の期間(A秒間)中の自動操舵において、車両は車線変更動作を中断して自車線に戻るように走行する。また、本実施形態の自動操舵システム100では、車線変更動作を継続すると判定した場合には、障害の発生後の所定の期間(A秒間)中の自動操舵において、車両は車線変更動作を実行して隣接車線へ移るように走行する。   And in the automatic steering system 100 of this embodiment, when it determines with not continuing lane change operation | movement, as shown to step S610, the future course shape memorize | stored in the memory | storage part 21 returns to the own lane. Rewrite to something. In this case, in the automatic steering during a predetermined period (A second) after the occurrence of the failure, the vehicle travels so as to return to the own lane by interrupting the lane change operation. In the automatic steering system 100 of this embodiment, when it is determined that the lane change operation is to be continued, the vehicle executes the lane change operation in the automatic steering during a predetermined period (A second) after the occurrence of the failure. And move to the adjacent lane.

より具体的に説明すると、車線数の減少や、自車線が本線に進入する進入路である場合のように、自車線が消滅する場合には、自動操舵システム100は障害の発生後の自動操舵において車線変更動作を継続する(ステップS510のYES)。自車線が消滅する場合において車線変更動作を自動的に中断してしまうと、手動運転に移行した場合において、運転者が急な舵角変更操作を行わなければならなくなるが、本実施形態の自動操舵システム100ではこのような急な舵角変更操作を防止できる。   More specifically, when the own lane disappears, such as when the number of lanes decreases or the own lane is an approach road that enters the main line, the automatic steering system 100 performs the automatic steering after the occurrence of the obstacle. In step S510, the lane change operation is continued (YES in step S510). If the lane change operation is automatically interrupted when the own lane disappears, the driver must perform a sudden steering angle change operation when shifting to manual operation. The steering system 100 can prevent such a sudden steering angle changing operation.

また、車線変更先となる隣接車線が退出路または分岐路である場合には、自動操舵システム100は障害の発生後の自動操舵において車線変更動作を継続する(ステップS520のYES)。車線変更先となる隣接車線が退出路または分岐路である場合において、車線変更動作を自動的に中断してしまうと、自動操舵による進行方向と運転者の意図する進行方向とが異なるものになってしまう。この場合、手動運転に移行した場合において、運転者が急な舵角変更操作を行わなければならなくなるが、本実施形態の自動操舵システム100ではこのような急な舵角変更操作を防止できる。   Further, when the adjacent lane as the lane change destination is a leaving road or a branch road, the automatic steering system 100 continues the lane change operation in the automatic steering after the occurrence of the obstacle (YES in step S520). If the lane change operation is automatically interrupted when the adjacent lane that is the lane change destination is an exit or branch road, the direction of travel by automatic steering and the direction of travel intended by the driver will be different. End up. In this case, when shifting to manual driving, the driver has to perform a sudden steering angle changing operation. However, the automatic steering system 100 of the present embodiment can prevent such a sudden steering angle changing operation.

また、追い越し車線から走行車線への車線変更である場合には、自動操舵システム100は障害の発生後の自動操舵において車線変更動作を継続する(ステップS530のYES)。追い越し車線から走行車線への車線変更は一般的に減速動作を伴う。このため、追い越し車線から走行車線への車線変更を中断してしまうと、車両は追い越し車線において減速してしまう可能性があり、追い越し車線を後方において走行中である他車両に追突される可能性がある。本実施形態の自動操舵システム100では追い越し車線から走行車線への車線変更を中断しないため、このような追突の可能性を無くすことができる。   When the lane change is from the overtaking lane to the traveling lane, the automatic steering system 100 continues the lane change operation in the automatic steering after the occurrence of the obstacle (YES in step S530). A lane change from an overtaking lane to a driving lane generally involves a deceleration operation. For this reason, if the lane change from the overtaking lane to the driving lane is interrupted, the vehicle may decelerate in the overtaking lane, and the vehicle may collide with another vehicle traveling behind the overtaking lane. There is. In the automatic steering system 100 of the present embodiment, the lane change from the overtaking lane to the traveling lane is not interrupted, and thus the possibility of such a rear-end collision can be eliminated.

また、走行車線から追い越しへの車線変更である場合には、自動操舵システム100は障害の発生後の自動操舵において車線変更動作を中断して自車線に戻る(ステップS540のYES)。一般に、追い越し車線には、走行車線よりも高速な他車両が走行している。また、走行車線から追い越し車線への車線変更は一般的に加速動作を伴うが、障害の発生後の自動操舵では、この加速が行われない場合がある。このため、走行車線から追い越し車線への車線変更を実行してしまうと、追い越し車線を後方において走行中である他車両に追突される可能性がある。本実施形態の自動操舵システム100では走行車線から追い越し車線への車線変更を中断して走行車線に戻るため、このような追突の可能性を無くすことができる。   Further, when the lane change from the traveling lane to the overtaking is made, the automatic steering system 100 interrupts the lane change operation and returns to the own lane in the automatic steering after the occurrence of the obstacle (YES in step S540). In general, other vehicles are traveling in the overtaking lane at a higher speed than the traveling lane. Further, a lane change from a traveling lane to an overtaking lane generally involves an acceleration operation, but this acceleration may not be performed in automatic steering after the occurrence of an obstacle. For this reason, if the lane change from the traveling lane to the overtaking lane is executed, the vehicle may collide with another vehicle traveling behind the overtaking lane. In the automatic steering system 100 of the present embodiment, the lane change from the traveling lane to the overtaking lane is interrupted and returned to the traveling lane, so that the possibility of such a rear-end collision can be eliminated.

また、車線変更先の隣接車線に衝突予測時間TTCが所定の閾値ds未満である他車両が走行している場合には、自動操舵システム100は障害の発生後の自動操舵において車線変更動作を中断して自車線に戻る(ステップS570のNO)。このような本実施形態によれば、障害の発生後の自動操舵における他車両との衝突の可能性を無くすことができる。   Further, when another vehicle having a collision prediction time TTC less than a predetermined threshold value ds is traveling in the adjacent lane to which the lane is changed, the automatic steering system 100 interrupts the lane changing operation in the automatic steering after the occurrence of the obstacle. Then, return to the own lane (NO in step S570). According to this embodiment, the possibility of a collision with another vehicle in automatic steering after the occurrence of a failure can be eliminated.

以上に説明したように、本実施形態の自動操舵システム100によれば、障害発生時において車両が車線変更動作中である場合においても、安全に運転者による手動運転に移行することができるため、自動操舵が異常終了する場合における車両の挙動の乱れを防止することができる。   As described above, according to the automatic steering system 100 of the present embodiment, even when the vehicle is in a lane change operation when a failure occurs, it is possible to safely shift to manual driving by the driver, It is possible to prevent disturbance of the behavior of the vehicle when automatic steering ends abnormally.

本発明は、上述した実施形態に限られるものではなく、請求の範囲及び明細書全体から読み取れる発明の要旨或いは思想に反しない範囲で適宜変更可能であり、そのような変更を伴う自動操舵システムもまた本発明の技術的範囲に含まれるものである。   The present invention is not limited to the above-described embodiment, and can be appropriately changed without departing from the gist or concept of the invention that can be read from the claims and the entire specification. An automatic steering system with such a change is also applicable. Moreover, it is included in the technical scope of the present invention.

1 操舵装置、
2 車外通信装置、
3 状態量検出装置、
4 報知部、
5 通信ネットワーク、
10 操舵支援装置、
11 道路情報認識装置、
11a 即位装置、
11b 地図情報記憶部、
11c 車外通信装置、
12 外部環境認識装置、
13 自動操舵指示値演算部、
14 車線形状算出部、
20 操舵制御装置、
21 記憶部、
23 異常診断部、
24 将来進路形状切替部、
25 指示値演算部、
26 切替部、
100 自動操舵システム。
1 Steering device,
2 External communication device,
3 state quantity detection device,
4 Notification Department,
5 communication network,
10 steering assist device,
11 Road information recognition device,
11a coronation device,
11b Map information storage unit,
11c External communication device,
12 External environment recognition device,
13 Automatic steering instruction value calculation unit,
14 Lane shape calculation unit,
20 steering control device,
21 storage unit,
23 abnormality diagnosis department,
24 Future course shape switching part,
25 indicated value calculation section,
26 switching section,
100 Automatic steering system.

Claims (3)

車両の舵角を変更するアクチュエータを備える操舵装置を制御する操舵制御装置と、
前記車両の外部環境情報および地図情報の少なくとも一方から目標進路形状を算出し、当該目標進路形状および前記車両の挙動を検出する状態量検出装置から出力される状態量に基づき前記操舵制御装置を制御し、前記車両を前記目標進路形状に沿って走行させる自動操舵を行う操舵支援装置と、
を備える自動操舵システムであって、
前記操舵制御装置および前記操舵支援装置のいずれか一方は、前記外部環境情報および前記地図情報の少なくとも一方に基づいて、現在から所定の時間後までに前記車両が走行すると予測される距離内における、前記車両が走行中の自車線および前記自車線に隣接する1つまたは2つの隣接車線の形状および属性を示す車線形状情報を算出する車線形状算出部を備え、
前記操舵制御装置は、
現在から所定の時間後までの前記目標進路形状である将来進路形状と、前記状態量と、前記車線形状情報と、を記憶する記憶部と、
前記操舵支援装置からの制御信号の入力が途絶する障害の発生を検出する異常診断部と、
前記自動操舵時において、前記車両が前記自車線から前記隣接車線への車線変更動作中に前記障害が発生した場合に、前記車線形状情報に基づいて前記車線変更動作を継続するか否かを判定し、前記車線変更動作を継続しないと判定した場合には前記自車線の前記車線形状情報に基づいて前記記憶部に記憶されている前記将来進路形状を書き換える将来進路形状切替部と、
前記自動操舵時において前記障害が発生した場合には、前記記憶部に記憶されている前記将来進路形状に沿って前記車両が走行するように前記操舵装置を制御する指示値演算部と、
を備えることを特徴とする自動操舵システム。
A steering control device for controlling a steering device including an actuator for changing a steering angle of the vehicle;
A target course shape is calculated from at least one of the external environment information and map information of the vehicle, and the steering control device is controlled based on the target course shape and a state quantity output from a state quantity detection device that detects the behavior of the vehicle. A steering assist device that performs automatic steering for causing the vehicle to travel along the target course shape;
An automatic steering system comprising:
Either one of the steering control device and the steering assist device is based on at least one of the external environment information and the map information, within a distance where the vehicle is predicted to travel by a predetermined time from the present time, A lane shape calculation unit that calculates lane shape information indicating the shape and attributes of the own lane in which the vehicle is traveling and one or two adjacent lanes adjacent to the lane;
The steering control device includes:
A storage unit that stores a future course shape that is the target course shape from the present to a predetermined time later, the state quantity, and the lane shape information;
An abnormality diagnosing unit for detecting the occurrence of a failure in which input of a control signal from the steering assist device is interrupted;
During the automatic steering, when the obstacle occurs during the lane change operation from the own lane to the adjacent lane, it is determined whether to continue the lane change operation based on the lane shape information. A future course shape switching unit that rewrites the future course shape stored in the storage unit based on the lane shape information of the own lane when it is determined that the lane change operation is not continued;
An instruction value calculation unit for controlling the steering device so that the vehicle travels along the future course shape stored in the storage unit when the failure occurs during the automatic steering;
An automatic steering system comprising:
前記記憶部は、前記外部環境情報および前記車両が備える車外通信装置により受信された情報の少なくとも一方に基づいて算出される、前記自車線および前記隣接車線を走行中の他車両の前記車両に対する相対位置および相対速度を示す近接車両情報を記憶し、
前記将来進路形状切替部は、前記車両が前記自車線から前記隣接車線への前記車線変更動作中に前記障害が発生した場合に、前記車線形状情報および前記近接車両情報に基づいて、前記車線変更動作を継続するか否かを判定する
ことを特徴とする請求項1に記載の自動操舵システム。
The storage unit is calculated based on at least one of the external environment information and information received by an external communication device included in the vehicle, and is relative to the vehicle of another vehicle traveling in the own lane and the adjacent lane. Memorize the proximity vehicle information indicating the position and relative speed,
The future course shape switching unit is configured to change the lane based on the lane shape information and the adjacent vehicle information when the obstacle occurs during the lane change operation from the own lane to the adjacent lane. 2. The automatic steering system according to claim 1, wherein it is determined whether or not to continue the operation.
前記将来進路形状切替部は、前記近接車両情報に基づいて、前記車線変更動作の対象となる前記隣接車線を走行中の前記他車両との衝突予測時間を算出し、前記衝突予測時間が所定の閾値未満である場合に、前記車線変更動作を継続しないと判定する
ことを特徴とする請求項2に記載の自動操舵システム。
The future course shape switching unit calculates a collision prediction time with the other vehicle traveling in the adjacent lane that is a target of the lane change operation based on the proximity vehicle information, and the collision prediction time is a predetermined value. The automatic steering system according to claim 2, wherein it is determined that the lane change operation is not continued when it is less than a threshold value.
JP2017163636A 2017-08-28 2017-08-28 Automatic steering system Active JP6898645B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2017163636A JP6898645B2 (en) 2017-08-28 2017-08-28 Automatic steering system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017163636A JP6898645B2 (en) 2017-08-28 2017-08-28 Automatic steering system

Publications (2)

Publication Number Publication Date
JP2019038474A true JP2019038474A (en) 2019-03-14
JP6898645B2 JP6898645B2 (en) 2021-07-07

Family

ID=65725237

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017163636A Active JP6898645B2 (en) 2017-08-28 2017-08-28 Automatic steering system

Country Status (1)

Country Link
JP (1) JP6898645B2 (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPWO2021140614A1 (en) * 2020-01-09 2021-07-15
CN113525411A (en) * 2020-03-31 2021-10-22 本田技研工业株式会社 Mobile object control device, mobile object control method, and storage medium
JP2022037936A (en) * 2020-11-25 2022-03-09 阿波羅智聯(北京)科技有限公司 Method and apparatus of presenting information for vehicle, electronic device, storage medium and computer program product

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1031799A (en) * 1996-07-15 1998-02-03 Toyota Motor Corp Automatic traveling controller
JP2016084038A (en) * 2014-10-27 2016-05-19 富士重工業株式会社 Vehicle traveling control device
JP2016126360A (en) * 2014-12-26 2016-07-11 日立オートモティブシステムズ株式会社 Vehicle control system
WO2017010264A1 (en) * 2015-07-10 2017-01-19 本田技研工業株式会社 Vehicle control device, vehicle control method, and vehicle control program

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1031799A (en) * 1996-07-15 1998-02-03 Toyota Motor Corp Automatic traveling controller
JP2016084038A (en) * 2014-10-27 2016-05-19 富士重工業株式会社 Vehicle traveling control device
JP2016126360A (en) * 2014-12-26 2016-07-11 日立オートモティブシステムズ株式会社 Vehicle control system
WO2017010264A1 (en) * 2015-07-10 2017-01-19 本田技研工業株式会社 Vehicle control device, vehicle control method, and vehicle control program

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPWO2021140614A1 (en) * 2020-01-09 2021-07-15
WO2021140614A1 (en) * 2020-01-09 2021-07-15 三菱電機株式会社 Driving assistance device and driving assistance method
CN113525411A (en) * 2020-03-31 2021-10-22 本田技研工业株式会社 Mobile object control device, mobile object control method, and storage medium
JP2022037936A (en) * 2020-11-25 2022-03-09 阿波羅智聯(北京)科技有限公司 Method and apparatus of presenting information for vehicle, electronic device, storage medium and computer program product

Also Published As

Publication number Publication date
JP6898645B2 (en) 2021-07-07

Similar Documents

Publication Publication Date Title
CN110050301B (en) Vehicle control device
CN107128366B (en) System and method for following path by the lane that bend provides correction to towing vehicle
CN111226267B (en) Driving control method and driving control device for driving support vehicle
JP6575492B2 (en) Automated driving system
KR101907332B1 (en) A target vehicle speed generating device and a running control device
US11318935B2 (en) Driving assist system
JP6647681B2 (en) Vehicle control device
KR20190045308A (en) A vehicle judging method, a traveling path correcting method, a vehicle judging device, and a traveling path correcting device
US10501116B2 (en) Automatic steering control device
JP2018112989A (en) Driving assist device and driving assist method
JP2009070254A (en) Vehicle risk estimation device
JP6898645B2 (en) Automatic steering system
KR20220023528A (en) Apparatus and method for controlling platooning information of vehicle
US20210061356A1 (en) Vehicle control device
JP2019144689A (en) Vehicle control device
EP3626570B1 (en) Driving assistance method and driving assistance apparatus
WO2020148561A1 (en) Driving assistance method and driving assistance device
JP7304875B2 (en) AUTOMATIC OPERATION CONTROL METHOD AND AUTOMATIC OPERATION CONTROL SYSTEM
JP2012212271A (en) Driving support device
JP2009252032A (en) Vehicular collision avoidance support apparatus
JP6955398B2 (en) Control driving force control device and automatic steering system
JP6325365B2 (en) Steering support control device
JP6330868B2 (en) Vehicle control device
JP7374722B2 (en) Driving support method and driving support device
JP7471150B2 (en) Driving support method and driving support device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20200722

RD02 Notification of acceptance of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7422

Effective date: 20200722

TRDD Decision of grant or rejection written
A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20210427

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20210511

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210604

R150 Certificate of patent or registration of utility model

Ref document number: 6898645

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150