JP7805202B2 - Braking/driving force control method and braking/driving force control device - Google Patents
Braking/driving force control method and braking/driving force control deviceInfo
- Publication number
- JP7805202B2 JP7805202B2 JP2022033487A JP2022033487A JP7805202B2 JP 7805202 B2 JP7805202 B2 JP 7805202B2 JP 2022033487 A JP2022033487 A JP 2022033487A JP 2022033487 A JP2022033487 A JP 2022033487A JP 7805202 B2 JP7805202 B2 JP 7805202B2
- Authority
- JP
- Japan
- Prior art keywords
- speed
- braking
- target
- target position
- distance
- 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.)
- Active
Links
Landscapes
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Description
本発明は、制駆動力制御方法及び制駆動力制御装置に関する。 The present invention relates to a braking/driving force control method and a braking/driving force control device.
特許文献1には、自車両が停車する地点を予測し、予測した地点までの距離に応じた車速の目標値である計画速度を生成し、生成された計画速度に沿うように自車両を減速制御する技術が提案されている。 Patent Document 1 proposes a technology that predicts where the vehicle will stop, generates a planned speed, which is a target value for the vehicle speed according to the distance to the predicted point, and controls the deceleration of the vehicle so that it follows the generated planned speed.
しかしながら、自車両前方の目標位置と自車両との相対距離に応じて自車両を減速させる速度調整には、運転者によって個人差がある。このため運転者の期待する車速変化と異なる速度プロファイルで自車両を減速させると、運転者に違和感を与える虞がある。
本発明は、自車両前方の目標位置と自車両との相対距離に応じた速度プロファイルに基づいて自車両を減速させる際の運転者の違和感を軽減することを目的とする。
However, there are individual differences among drivers in the speed adjustment for decelerating the vehicle in accordance with the relative distance between the vehicle and a target position ahead of the vehicle, and therefore, if the vehicle is decelerated using a speed profile that differs from the vehicle speed change expected by the driver, the driver may feel uncomfortable.
The present invention aims to reduce the sense of discomfort felt by the driver when the host vehicle is decelerated based on a speed profile according to the relative distance between the host vehicle and a target position ahead of the host vehicle.
本発明の一態様に係る制駆動力制御方法では、自車両のアクセルペダルの操作量に応じた制駆動力を算出し、自車両の現在位置と自車両の進行方向前方の予め設定された所定の位置である目標位置との間の相対距離を算出し、目標位置までの距離に応じた車速を示す速度プロファイルであって第1減速度で減速して目標位置よりも第1距離だけ自車両に近い第1地点において所定の設定速度に達して第1地点から目標位置まで設定速度を維持する第1速度プロファイルと、相対距離と、に基づいて第1目標速度を算出し、目標位置までの距離に応じた速度プロファイルとして設定され且つ第1減速度よりも大きな第2減速度で減速して目標位置において設定速度となる第2速度プロファイルと、相対距離と、に基づいて第2目標速度を算出し、目標位置に対する自車両の相対速度を検出し、相対速度が第1目標速度以上である場合に、相対速度から第1目標速度を減算した差分を第2目標速度から第1目標速度を減算した差分で除算した割合が大きいほどより大きな補正量を算出し、アクセルペダルの操作量に応じて算出した制駆動力から補正量を減算することにより補正済制駆動力を算出し、算出された補正済制駆動力に基づいて自車両の制駆動力を制御する。 In one aspect of the present invention, a braking/driving force control method calculates braking/driving forces according to the amount of operation of the accelerator pedal of the vehicle, calculates the relative distance between the current position of the vehicle and a target position, which is a predetermined position ahead in the direction of travel of the vehicle, and calculates a first target speed based on the relative distance and a speed profile indicating the vehicle speed according to the distance to the target position, which decelerates the vehicle at a first deceleration to reach a predetermined set speed at a first point closer to the vehicle than the target position by a first distance, and maintains the set speed from the first point to the target position. The system calculates a second target speed based on the relative distance and a second speed profile in which the vehicle is decelerated at a second deceleration greater than the first deceleration to reach the set speed at the target position; detects the relative speed of the vehicle with respect to the target position; and, if the relative speed is equal to or greater than the first target speed, calculates a larger correction amount the greater the ratio of the difference obtained by subtracting the first target speed from the relative speed divided by the difference obtained by subtracting the first target speed from the second target speed; calculates corrected braking/driving forces by subtracting the correction amount from the braking/driving forces calculated in accordance with the amount of operation of the accelerator pedal; and controls the braking/driving forces of the vehicle based on the calculated corrected braking/driving forces.
本発明によれば、自車両前方の目標位置と自車両との相対距離に応じた速度プロファイルに基づいて自車両を減速させる際の運転者の違和感を軽減できる。 This invention can reduce the driver's discomfort when decelerating the vehicle based on a speed profile that corresponds to the relative distance between the vehicle and a target position ahead of the vehicle.
以下、図面を参照して、本発明の実施形態を説明する。図面の記載において、同一又は類似の部分には同一又は類似の符号を付し、重複する説明を省略する。各図面は模式的なものであり、現実のものとは異なる場合が含まれる。以下に示す実施形態は、本発明の技術的思想を具体化するための装置や方法を例示するものであって、本発明の技術的思想は、下記の実施形態に例示した装置や方法に特定するものでない。本発明の技術的思想は、特許請求の範囲に記載された技術的範囲内において、種々の変更を加えることができる。 Embodiments of the present invention will be described below with reference to the drawings. In the description of the drawings, identical or similar parts will be designated by identical or similar reference numerals, and redundant explanations will be omitted. The drawings are schematic and may differ from the actual product. The embodiments shown below exemplify devices and methods that embody the technical concept of the present invention, but the technical concept of the present invention is not limited to the devices and methods exemplified in the following embodiments. The technical concept of the present invention can be modified in various ways within the technical scope described in the claims.
(第1実施形態)
(構成)
図1を参照する。自車両1は制駆動力制御装置10を備える。制駆動力制御装置10は、駆動力指示操作子であるアクセルペダルに対する運転者による操作量に応じて自車両1に発生させる駆動トルク及び制動トルク(以下、総称して「制駆動トルク」と表記することがある)を制御する。
図2を参照して、アクセルペダルの操作量Acに応じた制駆動トルクを模式的に説明する。制駆動力制御装置10は、アクセルペダルの操作量Acが所定の閾値Ac0よりも大きいときには車両に駆動トルクを発生させ、操作量Acが所定の閾値Ac0よりも小さいときには車両に制動トルクを発生させる。このような操作量Acに応じた制駆動トルクの制御を、以下の説明において「ワンペダル制御」と表記することがある。
(First embodiment)
(composition)
Referring to Figure 1, the host vehicle 1 is equipped with a braking/driving force control device 10. The braking/driving force control device 10 controls the driving torque and braking torque (hereinafter, collectively referred to as "braking/driving torque") generated in the host vehicle 1 in accordance with the amount of driver operation of an accelerator pedal, which is a driving force indication operator.
Braking/driving torques corresponding to accelerator pedal depression amount Ac will be explained schematically with reference to Figure 2. Braking/driving force control device 10 generates driving torque on the vehicle when accelerator pedal depression amount Ac is greater than a predetermined threshold Ac0, and generates braking torque on the vehicle when accelerator pedal depression amount Ac is less than the predetermined threshold Ac0. This type of control of braking/driving torques corresponding to accelerator pedal depression amount Ac may be referred to as "one-pedal control" in the following explanation.
操作量Acが最大値(100%)であるときに駆動トルクは最大値(100%)となり、操作量Acが小さくなるほど駆動トルクが小さくなり、操作量Acが閾値Ac0に至ると駆動トルクが0となる。閾値Ac0は、例えば操作量Acの最大値の4分の1(25%)程度であってよい。操作量Acが閾値Ac0よりも小さくなると、操作量Acが小さくなるほど制動トルクが大きくなり、操作量Acが0に至ると制動トルクは所定値Td0となる。
図1を参照する。制駆動力制御装置10は、測位装置11と、地図データベース(地図DB)12と、外界センサ13と、車両センサ14と、コントローラ15と、制駆動力発生機構16を備える。
When the operation amount Ac is at its maximum value (100%), the drive torque is at its maximum value (100%), and as the operation amount Ac decreases, the drive torque decreases, and when the operation amount Ac reaches a threshold value Ac0, the drive torque becomes 0. The threshold value Ac0 may be, for example, about one-fourth (25%) of the maximum value of the operation amount Ac. When the operation amount Ac becomes smaller than the threshold value Ac0, the braking torque increases as the operation amount Ac decreases, and when the operation amount Ac reaches 0, the braking torque becomes a predetermined value Td0.
Referring to Fig. 1, the braking/driving force control device 10 includes a positioning device 11, a map database (map DB) 12, an external sensor 13, a vehicle sensor 14, a controller 15, and a braking/driving force generation mechanism 16.
測位装置11は、自車両1の現在位置を測定する。測位装置11は、例えば全地球型測位システム(GNSS)受信機を備えてよい。GNSS受信機は、例えば地球測位システム(GPS)受信機等であり、複数の航法衛星から電波を受信して自車両1の現在位置を測定する。測位装置11は、慣性航法装置であってもよい。
地図DB12は、地図情報のデータベースである。地図DB12は、例えばカーナビゲーションシステムが備える地図DBであってもよい。地図DB12は、例えば自動運転用の地図情報として好適な高精度地図データであってもよい。コントローラ15は、自車両の現在位置の周囲の状況の情報を地図DB12から取得する。例えばコントローラ15は、自車両1の進行方向の前方に存在する停止線の情報を地図DB12から取得する。
The positioning device 11 measures the current position of the vehicle 1. The positioning device 11 may include, for example, a Global Navigation System (GNSS) receiver. The GNSS receiver is, for example, a Global Positioning System (GPS) receiver, and receives radio waves from multiple navigation satellites to measure the current position of the vehicle 1. The positioning device 11 may also be an inertial navigation system.
The map DB 12 is a database of map information. The map DB 12 may be, for example, a map DB included in a car navigation system. The map DB 12 may be, for example, high-precision map data suitable as map information for autonomous driving. The controller 15 acquires information about the surrounding conditions of the current position of the host vehicle from the map DB 12. For example, the controller 15 acquires information about stop lines present ahead in the traveling direction of the host vehicle 1 from the map DB 12.
外界センサ13は、自車両1の周囲環境についての様々な情報(周囲環境情報)を検出する。外界センサ13は、自車両1の周囲に存在する物体、自車両1と物体との相対位置、自車両1と物体との距離、物体が存在する方向等の自車両1の周囲環境を検出する。外界センサ13は、検出した周囲環境の情報を周囲環境情報としてコントローラ15に出力する。
例えば外界センサ13は、自車両1に対する自車両1周囲の他車両などの移動体や静止物標の相対位置を検出する。ここで静止物標とは、例えば自車両1が走行する道路に設けられた信号機、路面上の線(車線区分線等)や、路肩の縁石、ガードレールや、自車両1が走行する道路上の停止線や静止物体(例えば障害物)である。
The external sensor 13 detects various information (ambient environment information) about the environment surrounding the vehicle 1. The external sensor 13 detects the environment surrounding the vehicle 1, such as objects present around the vehicle 1, the relative positions between the vehicle 1 and the objects, the distance between the vehicle 1 and the objects, and the direction in which the objects are present. The external sensor 13 outputs the detected information about the ambient environment to the controller 15 as ambient environment information.
For example, the external sensor 13 detects the relative positions of moving objects and stationary targets, such as other vehicles around the host vehicle 1, relative to the host vehicle 1. Here, stationary targets include, for example, traffic lights provided on the road on which the host vehicle 1 is traveling, lines on the road surface (lane markings, etc.), curbs on the shoulders of the road, guardrails, stop lines and stationary objects (for example, obstacles) on the road on which the host vehicle 1 is traveling.
外界センサ13は、例えばフルHD解像度のカラーカメラのような単眼のカメラを備えてよい。カメラは、自車両1の周囲環境の認識対象を含む画像を撮像し、その撮像画像を周囲環境情報としてコントローラ15へ出力する。
また、外界センサ13は、レーザレンジファインダ(LRF)やレーダ、LiDAR(Light Detection and Ranging)のレーザレーダなどの測距装置を備えてよい。測距装置は、例えば、自車両周囲に存在する物体との相対距離と方向により定まる相対位置を検出する。測距装置は、検出した測距データを周囲環境情報としてコントローラ15へ出力する。
The external environment sensor 13 may include a monocular camera such as a full HD color camera. The camera captures an image including a target to be recognized in the environment surrounding the vehicle 1, and outputs the captured image to the controller 15 as ambient environment information.
The external sensor 13 may also include a distance measuring device such as a laser range finder (LRF), radar, or LiDAR (Light Detection and Ranging) laser radar. The distance measuring device detects the relative position of the vehicle, which is determined by the relative distance and direction to an object present around the vehicle. The distance measuring device outputs the detected distance data to the controller 15 as surrounding environment information.
車両センサ14は、自車両1から得られる様々な情報(車両情報)を検出する。車両センサ14には、例えば、自車両1の走行速度(車速)Vを検出する車速センサ、自車両1が備える各タイヤの回転速度を検出する車輪速センサ、自車両1の3軸方向の加速度(減速度を含む)を検出する3軸加速度センサ(Gセンサ)、ステアリングホイールの操舵角を検出する操舵角センサ、操向輪の転舵角を検出する転舵角センサ、自車両1に生じる角速度を検出するジャイロセンサ、ヨーレイトを検出するヨーレイトセンサ、自車両1のアクセルペダルの操作量Acを検出するアクセルセンサと、運転者によるブレーキ操作量を検出するブレーキセンサが含まれる。 The vehicle sensors 14 detect various information (vehicle information) obtained from the host vehicle 1. The vehicle sensors 14 include, for example, a vehicle speed sensor that detects the traveling speed (vehicle speed) V of the host vehicle 1, a wheel speed sensor that detects the rotational speed of each tire equipped on the host vehicle 1, a three-axis acceleration sensor (G sensor) that detects the acceleration (including deceleration) of the host vehicle 1 in three axial directions, a steering angle sensor that detects the steering angle of the steering wheel, a turning angle sensor that detects the turning angle of the steered wheels, a gyro sensor that detects the angular velocity generated in the host vehicle 1, a yaw rate sensor that detects the yaw rate, an accelerator sensor that detects the amount of accelerator pedal operation Ac of the host vehicle 1, and a brake sensor that detects the amount of brake operation by the driver.
コントローラ15は、自車両1の制駆動力の制御を行う電子制御ユニットである。コントローラ15は、プロセッサ20と、記憶装置21等の周辺部品とを含む。プロセッサ20は、例えばCPUやMPUであってよい。記憶装置21は、半導体記憶装置や、磁気記憶装置、光学記憶装置等を備えてよい。記憶装置21は、レジスタ、キャッシュメモリ、主記憶装置として使用されるROM及びRAM等のメモリを含んでよい。以下に説明するコントローラ15の機能は、例えばプロセッサ20が、記憶装置21に格納されたコンピュータプログラムを実行することにより実現される。
なお、コントローラ15を、以下に説明する各情報処理を実行するための専用のハードウエアにより形成してもよい。例えば、コントローラ15は、汎用の半導体集積回路中に設定される機能的な論理回路を備えてもよい。例えばコントローラ15はFPGA等のPLD等を有していてもよい。
The controller 15 is an electronic control unit that controls the braking and driving force of the host vehicle 1. The controller 15 includes a processor 20 and peripheral components such as a memory device 21. The processor 20 may be, for example, a CPU or an MPU. The memory device 21 may include a semiconductor memory device, a magnetic memory device, an optical memory device, etc. The memory device 21 may include memories such as a register, a cache memory, and a ROM and RAM used as a main memory device. The functions of the controller 15 described below are realized, for example, by the processor 20 executing a computer program stored in the memory device 21.
The controller 15 may be formed of dedicated hardware for executing the various information processes described below. For example, the controller 15 may include a functional logic circuit configured in a general-purpose semiconductor integrated circuit. For example, the controller 15 may include a PLD such as an FPGA.
コントローラ15は、アクセルペダルの操作量Acに応じて自車両1の車輪に発生させる駆動トルク又は制動トルクのトルク指令値Tfを設定し、トルク指令値Tfに応じて制駆動力発生機構16を駆動して自車両1に駆動トルク又は制動トルクを発生させる。コントローラ15によるトルク指令値Tfの設定処理については後述する。
制駆動力発生機構16は自車両1の車輪に接続した駆動源であり、自車両1の車輪に駆動トルクや制動トルクを発生させる、例えば駆動用モータや内燃機関、あるいはブレーキアクチュエータである。以下、本実施形態においては一例として、制駆動力発生機構16は駆動用モータであるものとする。制駆動力発生機構16はコントローラ15からの制御信号(トルク指令値Tf)に応じて、自車両1を駆動する駆動トルク又は自車両1を制動する制動トルクを発生する。
The controller 15 sets a torque command value Tf for the driving torque or braking torque to be generated on the wheels of the vehicle 1 in accordance with the accelerator pedal operation amount Ac, and drives the braking/driving force generation mechanism 16 in accordance with the torque command value Tf to generate the driving torque or braking torque on the vehicle 1. The process of setting the torque command value Tf by the controller 15 will be described later.
The driving/braking force generating mechanism 16 is a drive source connected to the wheels of the host vehicle 1, and is, for example, a drive motor, an internal combustion engine, or a brake actuator that generates driving torque or braking torque on the wheels of the host vehicle 1. In the following, in this embodiment, as an example, the driving/braking force generating mechanism 16 is assumed to be a drive motor. The driving/braking force generating mechanism 16 generates driving torque to drive the host vehicle 1 or braking torque to brake the host vehicle 1 in response to a control signal (torque command value Tf) from the controller 15.
次に、コントローラ15によるトルク指令値の設定処理について説明する。コントローラ15は、アクセルペダルの踏込みにより加速し、アクセルペダルの踏み戻しにより減速する制御を行う所謂ワンペダル制御を実行する。
図3を参照する。コントローラ15は、外界センサ13や地図DB12によって、自車両1の進行方向の前方に存在する静止物標や移動体を検出すると、自車両1の進行方向の前方において、これらの静止物標や移動体に対する自車両1の相対速度Vrを所定の設定速度Vsとする位置である目標位置Xtrgを設定する。例えば静止物標を検出した場合には、静止物標の所定距離手前の地点を、自車両1を静止させる目標位置Xtrgとして設定する(すなわち設定速度Vsは0である)。また例えば、自車両前方に移動体を検出した場合には、移動体の速度Vfを所定の設定速度Vsに設定し、移動体の所定距離手前の地点を目標位置Xtrgとして設定する。すなわち、自車両1を静止させる位置、あるいは前方の移動体から所定距離手前の地点などの、自車両の進行方向前方の予め設定された所定の位置を目標位置Xtrgを設定する。図3は、自車両1の進行方向の前方を走行する先行車両2を移動体として検出した例を示している。
Next, a description will be given of the process of setting the torque command value by the controller 15. The controller 15 executes so-called one-pedal control, which performs control such that acceleration occurs when the accelerator pedal is depressed and deceleration occurs when the accelerator pedal is released.
See FIG. 3 . When the controller 15 detects a stationary target or a moving object ahead of the host vehicle 1 in the direction of travel using the external sensor 13 or the map DB 12, the controller 15 sets a target position Xtrg ahead of the host vehicle 1 in the direction of travel, where the relative speed Vr of the host vehicle 1 with respect to the stationary target or the moving object is set to a predetermined set speed Vs. For example, when a stationary target is detected, a point a predetermined distance before the stationary target is set as the target position Xtrg at which the host vehicle 1 is to stop (i.e., the set speed Vs is 0). Also, for example, when a moving object is detected ahead of the host vehicle, the controller 15 sets the speed Vf of the moving object to the predetermined set speed Vs, and sets a point a predetermined distance before the moving object as the target position Xtrg. That is, the target position Xtrg is set to a predetermined position ahead of the host vehicle in the direction of travel, such as a position at which the host vehicle 1 is to stop or a point a predetermined distance before the moving object ahead. FIG. 3 shows an example in which a leading vehicle 2 traveling ahead of the host vehicle 1 in the direction of travel is detected as a moving object.
コントローラ15は、自車両1の現在位置と目標位置Xtrgとの間の相対距離Xrを算出し、目標位置Xtrgまでの距離に応じた速度プロファイルP1、P2を用いて、自車両1の車速Vを制御する。
このとき、自車両1の前方の目標位置Xtrgと自車両1との相対距離Xrに応じて自車両1を減速させる速度調整には、上記のとおり運転者によって個人差がある。このため運転者の期待する車速変化と異なる速度プロファイルで自車両1を減速させると、運転者に違和感を与える虞がある。
The controller 15 calculates the relative distance Xr between the current position of the vehicle 1 and the target position Xtrg, and controls the vehicle speed V of the vehicle 1 using speed profiles P1, P2 according to the distance to the target position Xtrg.
At this time, as described above, there are individual differences among drivers in the speed adjustment for decelerating the vehicle 1 in accordance with the relative distance Xr between the target position Xtrg ahead of the vehicle 1 and the vehicle 1. For this reason, if the vehicle 1 is decelerated using a speed profile that differs from the vehicle speed change expected by the driver, the driver may feel uncomfortable.
そこでコントローラ15は、目標位置Xtrgに対する自車両1の現在の相対速度Vrを検出し、相対速度Vrが速度プロファイルを超えた差に応じた補正トルクTcを算出する。そして、アクセルペダルの操作量Acに応じて算出された基本制駆動トルクTbから補正トルクTcを減算することによりトルク指令値Tfを算出し、トルク指令値Tfに基づいて制駆動力発生機構16を駆動して自車両1の制駆動トルクを制御する。
このように、相対速度Vrが速度プロファイルを超えても直ちに相対速度Vrが速度プロファイルに沿って変化するように自車両1の車速Vを直接制御するのではなく、アクセルペダルの操作量Acに応じた基本制駆動トルクTbを、補正トルクTcで減少補正する。このため、運転者の意図であるアクセルペダルの操作量Acを自車両1の速度調整に反映することができる。この結果、第1速度プロファイルP1に基づいて自車両1を減速させる際の運転者の違和感を軽減できる。
Therefore, the controller 15 detects the current relative speed Vr of the host vehicle 1 with respect to the target position Xtrg, calculates a correction torque Tc according to the difference between the relative speed Vr and the speed profile, calculates a torque command value Tf by subtracting the correction torque Tc from the basic braking/driving torque Tb calculated according to the accelerator pedal operation amount Ac, and drives the braking/driving force generation mechanism 16 based on the torque command value Tf to control the braking/driving torque of the host vehicle 1.
In this way, even if the relative speed Vr exceeds the speed profile, the vehicle speed V of the host vehicle 1 is not directly controlled so that the relative speed Vr immediately changes in line with the speed profile, but the basic braking/driving torque Tb corresponding to the accelerator pedal operation amount Ac is reduced and corrected by the correction torque Tc. Therefore, the accelerator pedal operation amount Ac, which is the driver's intention, can be reflected in the speed adjustment of the host vehicle 1. As a result, the sense of discomfort felt by the driver when decelerating the host vehicle 1 based on the first speed profile P1 can be reduced.
例えば第1実施形態のコントローラ15は、目標位置Xtrgまでの距離に応じた車速を示す速度プロファイルとして、第1速度プロファイルP1と第2速度プロファイルP2を設定する。図2において細い実線と一点鎖線は、第1速度プロファイルP1と第2速度プロファイルP2の一例を示し、太い実線は相対速度Vrの変化の一例を示している。
第1速度プロファイルP1は、第1減速度G1で減速して目標位置Xtrgよりも第1距離D1だけ自車両1に近い第1地点Xo1において所定の設定速度Vsに達して第1地点Xo1から目標位置まで設定速度Vsを維持する。
第2速度プロファイルP2は、第1減速度G1よりも大きな第2減速度G2で減速して目標位置Xtrgにおいて設定速度Vsとなる。
第1実施形態における第1減速度G1は、例えば日常走行における比較的弱い制動時の減速度(例えば0.1G)以下の値に設定してよい。第1実施形態における第2減速度G2は、例えば日常走行における比較的強い制動時の減速度(例えば0.2G)程度の値に設定してよい。
For example, the controller 15 of the first embodiment sets a first speed profile P1 and a second speed profile P2 as speed profiles that indicate the vehicle speed according to the distance to the target position Xtrg. In Fig. 2, the thin solid line and the dashed dotted line show examples of the first speed profile P1 and the second speed profile P2, and the thick solid line shows an example of the change in the relative speed Vr.
The first speed profile P1 decelerates at a first deceleration G1, reaches a predetermined set speed Vs at a first point Xo1 that is closer to the vehicle 1 by a first distance D1 than the target position Xtrg, and maintains the set speed Vs from the first point Xo1 to the target position.
The second speed profile P2 decelerates at a second deceleration G2 that is greater than the first deceleration G1, and reaches the set speed Vs at the target position Xtrg.
The first deceleration G1 in the first embodiment may be set to a value equal to or less than the deceleration (e.g., 0.1 G) that occurs during relatively weak braking in everyday driving. The second deceleration G2 in the first embodiment may be set to a value equal to or less than the deceleration (e.g., 0.2 G) that occurs during relatively strong braking in everyday driving.
コントローラ15は、第1速度プロファイルP1と相対距離Xrとに基づいて自車両1の第1目標速度V1を算出するとともに、第2速度プロファイルP2と相対距離Xrとに基づいて自車両1の第2目標速度V2を算出する。
例えば、第1速度プロファイルP1は、相対距離Xrを変数とする第1目標速度V1の計算式として設定してよい。例えばコントローラ15は、次式(1)に基づいて第1目標速度V1を算出してよい。
For example, the first speed profile P1 may be set as a calculation formula for the first target speed V1 using the relative distance Xr as a variable. For example, the controller 15 may calculate the first target speed V1 based on the following formula (1).
上式(1)の第1速度プロファイルP1は、第1減速度G1で減速して目標位置Xtrgにおいて設定速度Vsに達する速度プロファイル(2×G1×Xr)1/2+Vsの速度を、第1オフセット速度Vo1=(2×G1×Xo1)1/2だけ低下させるとともに、下限値を設定速度Vsで制限することにより得られる。
すなわち第1速度プロファイルP1は、速度プロファイル(2×G1×Xr)1/2+Vsが、図3のプロファイル特性図の下方向に第1オフセット速度Vo1だけオフセットされ、下限値が設定速度Vsで制限されたプロファイルである。
The first speed profile P1 in the above equation (1) is obtained by reducing the speed of the speed profile (2×G1×Xr) 1/2 +Vs, which decelerates at the first deceleration G1 and reaches the set speed Vs at the target position Xtrg, by the first offset speed Vo1 = (2×G1×Xo1) 1/2 , and limiting the lower limit value to the set speed Vs.
That is, the first speed profile P1 is a profile in which the speed profile (2×G1×Xr) 1/2 +Vs is offset downward by the first offset speed Vo1 in the profile characteristic diagram of FIG. 3, and the lower limit value is limited by the set speed Vs.
また例えば、第2速度プロファイルP2も、相対距離Xrを変数とする第2目標速度V2の計算式として設定してよい。例えばコントローラ15は、次式(2)に基づいて第2目標速度V2を算出してよい。
V2=(2×G2×Xr)1/2+Vs…(2)
コントローラ15は、目標位置Xtrgに対する自車両1の現在の相対速度Vrを検出する。相対速度Vrが第1目標速度V1以上である場合に、相対速度Vrから第1目標速度V1を減算した差分を第2目標速度V2から第1目標速度V1を減算した差分で除算した割合(Vr-V1)/(V2-V1)が大きいほどより大きな補正トルクTcを算出する。相対速度Vrが第1目標速度V1未満の場合には補正トルクTcを0に設定する。
For example, the second speed profile P2 may also be set as a calculation formula for the second target speed V2 using the relative distance Xr as a variable. For example, the controller 15 may calculate the second target speed V2 based on the following formula (2).
V2=(2×G2×Xr) 1/2 +Vs…(2)
The controller 15 detects the current relative speed Vr of the vehicle 1 with respect to the target position Xtrg. When the relative speed Vr is equal to or greater than the first target speed V1, the controller 15 calculates a larger correction torque Tc as the ratio (Vr-V1)/(V2-V1) obtained by dividing the difference obtained by subtracting the first target speed V1 from the relative speed Vr by the difference obtained by subtracting the first target speed V1 from the second target speed V2 increases. When the relative speed Vr is less than the first target speed V1, the controller 15 sets the correction torque Tc to 0.
次に、第1速度プロファイルP1を、目標位置Xtrgよりも第1距離D1だけ自車両1に近い第1地点Xo1において所定の設定速度Vsに達するように設定する理由について説明する。
図4は、比較のため目標位置Xtrgにおいて所定の設定速度Vsに達するように設定された第1速度プロファイルP1を示す。
自車両1の前方の移動体(図3の例では先行車両2)の所定距離手前の地点を目標位置Xtrgとして設定した場合には、移動体の速度Vfが変動することがある。その結果、例えば移動体が減速することによって自車両1と移動体との間の相対距離がXr2からXr1へと変化し相対速度VrがVr1からVr2に変化すると、相対速度Vrが速度プロファイルP1、P2を超えることによって補正トルクTcが0から正の値に変化する。
Next, the reason why the first speed profile P1 is set so as to reach the predetermined set speed Vs at the first point Xo1, which is closer to the host vehicle 1 than the target position Xtrg by the first distance D1, will be described.
For comparison, FIG. 4 shows a first speed profile P1 that is set to reach a predetermined set speed Vs at the target position Xtrg.
When a point a predetermined distance before a moving object ahead of the host vehicle 1 (leading vehicle 2 in the example of FIG. 3 ) is set as the target position Xtrg, the speed Vf of the moving object may fluctuate. As a result, for example, when the moving object decelerates, the relative distance between the host vehicle 1 and the moving object changes from Xr2 to Xr1 and the relative speed Vr changes from Vr1 to Vr2, and the relative speed Vr exceeds the speed profiles P1 and P2, causing the correction torque Tc to change from 0 to a positive value.
補正トルクTcは割合(Vr-V1)/(V2-V1)が大きいほどより大きな値に設定される。このため、図4のような第1速度プロファイルP1を設定すると、自車両1が目標位置Xtrgのすぐ近くに近づいたときに分母の(V2-V1)が0に近くなるので補正トルクTcの変化が大きくなる。この結果、補正トルクTcで補正された自車両1の制駆動トルクが大きく変動して、運転者に違和感を与える虞がある。
また、静止物標の所定距離手前の地点を目標位置Xtrgとして設定した場合においても、自車両1が目標位置Xtrgのすぐ近くに近づいたときに、(例えばアクセルペダルの踏み込みにより)相対速度Vrが速度プロファイルP1、P2を超えると同様の現象が発生する。
The correction torque Tc is set to a larger value as the ratio (Vr-V1)/(V2-V1) increases. Therefore, if the first speed profile P1 shown in Fig. 4 is set, when the host vehicle 1 approaches very close to the target position Xtrg, the denominator (V2-V1) approaches 0, and the change in correction torque Tc becomes large. As a result, the braking/driving torque of the host vehicle 1 corrected by the correction torque Tc fluctuates greatly, which may cause the driver to feel uncomfortable.
Furthermore, even if a point a predetermined distance before the stationary target is set as the target position Xtrg, a similar phenomenon occurs when the vehicle 1 approaches very close to the target position Xtrg and the relative speed Vr exceeds the speed profiles P1 and P2 (for example, due to depression of the accelerator pedal).
このため、第1速度プロファイルP1を、目標位置Xtrgよりも第1距離D1だけ自車両1に近い第1地点Xo1において所定の設定速度Vsに達するように設定する。これにより図4に示す第1速度プロファイルP1と比べて、目標位置Xtrgのすぐ近くにおける第2目標速度V2と第1目標速度V1の差分(V2-V1)を大きくできる。このため、自車両1が目標位置Xtrgのすぐ近くに近づいたときに自車両1の制駆動トルクが大きく変動するのを抑制できる。 For this reason, the first speed profile P1 is set so that the predetermined set speed Vs is reached at a first point Xo1, which is closer to the host vehicle 1 by a first distance D1 than the target position Xtrg. This makes it possible to increase the difference (V2-V1) between the second target speed V2 and the first target speed V1 in the immediate vicinity of the target position Xtrg compared to the first speed profile P1 shown in FIG. 4. This makes it possible to suppress large fluctuations in the braking/driving torque of the host vehicle 1 when the host vehicle 1 approaches the immediate vicinity of the target position Xtrg.
なお、図3の第1速度プロファイルP1は、速度プロファイル(2×G1×Xr)1/2+Vsを図3のプロファイル特性図の下方向にオフセットすることにより得たが、右方向にオフセットすることにより第1速度プロファイルP1を得てもよい。
例えば図5(a)に示すように、速度プロファイル(2×G1×Xr)1/2+Vsを右方向に第1距離D1だけオフセットするとともに、下限値を設定速度Vsで制限することにより第1速度プロファイルP1を得てもよい。
例えばコントローラ15は、次式(3)に基づいて第1目標速度V1を算出してよい。
For example, as shown in FIG. 5A, the first velocity profile P1 may be obtained by offsetting the velocity profile (2×G1×Xr) 1/2 +Vs to the right by a first distance D1 and limiting the lower limit value by the set velocity Vs.
For example, the controller 15 may calculate the first target speed V1 based on the following equation (3).
図5(a)の第1速度プロファイルP1と図5(b)の第1速度プロファイルP1とを比較する。第1地点Xo1における図5(a)及び図5(b)の第1速度プロファイルP1の傾きをそれぞれα1及びα2とすると、傾きα2の方が傾きα1よりも小さくなる。
このため、図5(a)の第1速度プロファイルP1よりも図5(b)の第1速度プロファイルの方が、自車両1が第1地点Xo1を越えるときの第1目標速度V1の変化が小さく、補正トルクTcの変動を抑制できる。
Comparing the first speed profile P1 in Fig. 5(a) with the first speed profile P1 in Fig. 5(b), if the slopes of the first speed profile P1 in Fig. 5(a) and Fig. 5(b) at the first point Xo1 are α1 and α2, respectively, the slope α2 is smaller than the slope α1.
Therefore, the first speed profile in Figure 5(b) has a smaller change in the first target speed V1 when the vehicle 1 passes the first point Xo1 than the first speed profile P1 in Figure 5(a), and can suppress fluctuations in the correction torque Tc.
続いて、コントローラ15の機能について更に詳細に説明する。図6は、コントローラ15の機能構成の一例のブロック図である。コントローラ15は、基本制駆動トルク設定部30と、目標位置設定部31と、レートリミッタ32と、補正トルク設定部33と、減算器34を備える。
基本制駆動トルク設定部30は、アクセルペダルの操作量Acと、車速センサが検出した自車両1の車速Vと、に応じて基本制駆動トルクTbを設定する。例えば図2に示す特性線のように、アクセルペダルの操作量Acが所定の閾値Ac0よりも大きいときには、操作量Acと閾値Ac0との差分に応じて操作量Acが大きいほど大きくなる駆動トルクを基本制駆動トルクTbとして設定してよい。アクセルペダルの操作量Acが所定の閾値Ac0よりも小さいときには、操作量Acと閾値Ac0との差分に応じて操作量Acが小さいほど大きくなる制動トルクを基本制駆動トルクTbとして設定してよい。
また基本制駆動トルク設定部30は、例えば自車両1の車速Vが高いほど、基本制駆動トルクTbの傾きを大きくし、自車両1の車速Vが低いほど基本制駆動トルクTbの傾きを小さくする。
Next, a more detailed description will be given of the functions of the controller 15. Fig. 6 is a block diagram showing an example of the functional configuration of the controller 15. The controller 15 includes a basic braking/driving torque setting unit 30, a target position setting unit 31, a rate limiter 32, a correction torque setting unit 33, and a subtractor 34.
The basic braking/driving torque setting unit 30 sets the basic braking/driving torque Tb in accordance with the accelerator pedal operation amount Ac and the vehicle speed V of the host vehicle 1 detected by the vehicle speed sensor. For example, as shown in the characteristic line in Figure 2, when the accelerator pedal operation amount Ac is greater than a predetermined threshold Ac0, the basic braking/driving torque Tb may be set to a driving torque that increases as the operation amount Ac increases in accordance with the difference between the operation amount Ac and the threshold Ac0. When the accelerator pedal operation amount Ac is smaller than the predetermined threshold Ac0, the basic braking/driving torque Tb may be set to a braking torque that increases as the operation amount Ac decreases in accordance with the difference between the operation amount Ac and the threshold Ac0.
Furthermore, the basic braking/driving torque setting unit 30 increases the slope of the basic braking/driving torque Tb as the vehicle speed V of the host vehicle 1 increases, and decreases the slope of the basic braking/driving torque Tb as the vehicle speed V of the host vehicle 1 decreases.
図6を参照する。目標位置設定部31は、自車両1の進行方向の前方の静止物標や移動体に対して自車両1の相対速度Vrを設定速度Vsとする位置である目標位置Xtrgを設定する。例えば、目標位置設定部31は、地図DB12の地図情報や外界センサ13からの周囲環境情報に基づいて自車両1の進行方向の前方に存在する停止線や静止物体などの静止物標を検出する。目標位置設定部31は、静止物標の所定距離手前の地点を目標位置Xtrgとして設定する。
また、例えば、目標位置設定部31は、外界センサ13からの周囲環境情報に基づいて自車両1の進行方向の前方に存在する移動体を検出する。目標位置設定部31は、静止物標の所定距離手前の地点を目標位置Xtrgとして設定する。
目標位置設定部31は、自車両1の現在位置と目標位置Xtrgとの間の相対距離Xrと、目標位置Xtrgに対する自車両1の相対速度Vrを検出する。静止物標に対して目標位置Xtrgを設定した場合には、相対速度Vrは自車両1の現在の車速Vとなり、移動体に対して目標位置Xtrgを設定した場合には、相対速度Vrは移動体に対する自車両1の現在の相対速度となる。
6 , the target position setting unit 31 sets a target position Xtrg, which is a position where the relative speed Vr of the host vehicle 1 is set to a set speed Vs with respect to a stationary target or moving object ahead in the traveling direction of the host vehicle 1. For example, the target position setting unit 31 detects a stationary target such as a stop line or a stationary object that exists ahead in the traveling direction of the host vehicle 1 based on map information in the map DB 12 and surrounding environment information from the external sensor 13. The target position setting unit 31 sets a point a predetermined distance before the stationary target as the target position Xtrg.
Further, for example, the target position setting unit 31 detects a moving object present ahead in the traveling direction of the vehicle 1 based on the surrounding environment information from the external sensor 13. The target position setting unit 31 sets a point a predetermined distance before the stationary target as the target position Xtrg.
The target position setting unit 31 detects the relative distance Xr between the current position of the host vehicle 1 and the target position Xtrg, and the relative speed Vr of the host vehicle 1 with respect to the target position Xtrg. When the target position Xtrg is set with respect to a stationary target, the relative speed Vr is the current vehicle speed V of the host vehicle 1, and when the target position Xtrg is set with respect to a moving object, the relative speed Vr is the current relative speed of the host vehicle 1 with respect to the moving object.
レートリミッタ32は、目標位置設定部31から出力される相対距離Xrの速度変化を制限して、補正トルク設定部33に出力する。これにより、目標位置Xtrgが変化した場合にその変化速度を制限する。
補正トルク設定部33は、目標位置設定部31が検出した相対速度Vrと、レートリミッタ32により速度変化が制限された相対距離Xrとに基づいて、補正トルクTcを設定する。補正トルクTcについては後述する。
減算器34は、基本制駆動トルク設定部30が算出した基本制駆動トルクTbから補正トルクTcを減算することによりトルク指令値Tfを算出する。減算器34は、算出したトルク指令値Tfを制駆動力発生機構16へ出力する。
The rate limiter 32 limits the speed change of the relative distance Xr output from the target position setting unit 31 and outputs the result to the correction torque setting unit 33. In this way, when the target position Xtrg changes, the rate of change is limited.
The correction torque setting unit 33 sets the correction torque Tc based on the relative speed Vr detected by the target position setting unit 31 and the relative distance Xr whose speed change is limited by the rate limiter 32. The correction torque Tc will be described later.
Subtractor 34 calculates torque command value Tf by subtracting correction torque Tc from basic braking/driving torque Tb calculated by basic braking/driving torque setting unit 30. Subtractor 34 outputs the calculated torque command value Tf to braking/driving force generation mechanism 16.
図7は、第1実施形態の補正トルク設定部33の機能構成の一例のブロック図である。補正トルク設定部33は、第1目標速度算出部40aと、第2目標速度算出部40bと、第1補正部41aと、割合算出部42と、リミッタ43と、ゲイン乗算部44を備える。
第1目標速度算出部40aと第1補正部41aは、第1速度プロファイルP1と、相対距離Xrと、に基づいて自車両1の車速Vの目標値である第1目標速度V1を算出する。
このとき第1目標速度算出部40aは、次式(4)に基づいて第1目標速度V1の初期値V1bを算出する。
V1b=(2×G1×Xr)1/2+Vs…(4)
7 is a block diagram showing an example of the functional configuration of the correction torque setting unit 33 according to the first embodiment. The correction torque setting unit 33 includes a first target speed calculation unit 40a, a second target speed calculation unit 40b, a first correction unit 41a, a ratio calculation unit 42, a limiter 43, and a gain multiplication unit 44.
The first target speed calculation unit 40a and the first correction unit 41a calculate a first target speed V1, which is a target value for the vehicle speed V of the host vehicle 1, based on the first speed profile P1 and the relative distance Xr.
At this time, the first target speed calculation unit 40a calculates an initial value V1b of the first target speed V1 based on the following equation (4).
V1b=(2×G1×Xr) 1/2 +Vs…(4)
第1補正部41aは、初期値V1bから第1オフセット速度Vo1を減じた差分が設定速度Vs以上である場合に、初期値V1bから第1オフセット速度Vo1を減じることによって、第1目標速度V1=V1b-Vo1を算出する。一方で、初期値V1bから第1オフセット速度Vo1を減じた差分が設定速度Vs未満である場合は、第1目標速度V1の値を設定速度Vsに設定する。すなわち、第1目標速度V1の下限値を設定速度Vsで制限する。これにより、第1補正部41aは上式(1)の第1目標速度V1を算出する。
第2目標速度算出部40bは、上式(2)に基づいて第2目標速度V2を算出する。
When the difference obtained by subtracting the first offset speed Vo1 from the initial value V1b is equal to or greater than the set speed Vs, the first correction unit 41a subtracts the first offset speed Vo1 from the initial value V1b to calculate the first target speed V1 = V1b - Vo1. On the other hand, when the difference obtained by subtracting the first offset speed Vo1 from the initial value V1b is less than the set speed Vs, the first correction unit 41a sets the value of the first target speed V1 to the set speed Vs. In other words, the lower limit of the first target speed V1 is limited by the set speed Vs. In this way, the first correction unit 41a calculates the first target speed V1 using the above equation (1).
The second target speed calculation unit 40b calculates the second target speed V2 based on the above equation (2).
割合算出部42は、第2目標速度V2と第1目標速度V1との速度差分(V2-V1)に対する、相対速度Vrと第1目標速度V1との速度差分(Vr-V1)の割合(Vr-V1)/(V2-V1)を補正係数αとして算出する。
リミッタ43は、割合算出部42が算出した補正係数αを、下限値αmin以上且つ上限値αmax以下の範囲の値に制限する。
下限値αminは、0以上の値に設定する。これにより、相対速度Vrが第1目標速度V1以下のときに補正トルクTcの出力を停止できる。例えば下限値αminは「0」に設定してよい。
The ratio calculation unit 42 calculates the correction coefficient α as the ratio (Vr-V1)/(V2-V1) of the speed difference (Vr-V1) between the relative speed Vr and the first target speed V1 to the speed difference (V2-V1) between the second target speed V2 and the first target speed V1.
The limiter 43 limits the correction coefficient α calculated by the ratio calculation unit 42 to a value in the range of a lower limit value αmin or more and an upper limit value αmax or less.
The lower limit value αmin is set to a value equal to or greater than 0. This allows the output of the correction torque Tc to be stopped when the relative speed Vr is equal to or less than the first target speed V1. For example, the lower limit value αmin may be set to "0".
上限値αmaxは、基本制駆動トルクTbを減少補正する補正トルクTcの最大許容値に応じて適宜設定してよい。例えば上限値αmaxは「2」に設定してよい。
ゲイン乗算部44は、リミッタ43により制限された補正係数αに、調整ゲインK1を乗算して得られる積を補正トルクTcとして算出する。調整ゲインK1の値は固定でもよく、第1実施形態と同様に相対距離Xrに応じた調整ゲインK1でもよい。後述の第2実施形態~第4実施形態においても同様である。
The upper limit value αmax may be set appropriately depending on the maximum allowable value of the correction torque Tc that corrects and decreases the basic braking/driving torque Tb. For example, the upper limit value αmax may be set to "2".
The gain multiplication unit 44 multiplies the correction coefficient α limited by the limiter 43 by an adjustment gain K1 to calculate the product as the correction torque Tc. The value of the adjustment gain K1 may be fixed, or may be an adjustment gain K1 that corresponds to the relative distance Xr, as in the first embodiment. This also applies to the second to fourth embodiments described below.
このため、相対速度Vrが第1目標速度V1以下の場合には補正トルクTcの値は「0」に設定される。相対速度Vrが、第1目標速度V1より大きく且つ第2目標速度V2以下の場合には、補正トルクTcの値はK1×(Vr-V1)/(V2-V1)に設定される。相対速度Vrが、第2目標速度V2より大きい場合には、上限値K1×αmaxにより制限されるまでK1×(Vr-V1)/(V2-V1)に設定される。 For this reason, if the relative speed Vr is equal to or less than the first target speed V1, the value of the correction torque Tc is set to "0." If the relative speed Vr is greater than the first target speed V1 and equal to or less than the second target speed V2, the value of the correction torque Tc is set to K1 x (Vr - V1) / (V2 - V1). If the relative speed Vr is greater than the second target speed V2, the value of the correction torque Tc is set to K1 x (Vr - V1) / (V2 - V1) until it is limited by the upper limit value K1 x αmax.
図3からわかるように、自車両1が目標位置Xtrgに近づくほど、第2目標速度V2と第1目標速度V1との速度差分(V2-V1)が小さくなり、補正係数αが大きくなる。このため、自車両1が目標位置Xtrgに近づくほど大きな補正トルクTcで基本制駆動トルクTbを減少補正できる。
また、自車両の相対速度Vrが、第1速度プロファイルP1に基づく第1目標速度V1から第2速度プロファイルP2に基づく第2目標速度V2まで変化すると、補正係数αは「0」から「1」に変化する。
このため、相対速度Vrが第1速度プロファイルP1を超えるまでは補正トルクTcの値を「0」に設定することができる。
一方で、相対速度Vrが第1速度プロファイルP1を超えた場合には、相対速度Vrが高くなるほど補正トルクTcが増加して、相対速度Vrが第2目標速度V2に至ると補正トルクTcの値は「K1」となる。
したがって、調整ゲインK1を適宜設定することにより、相対速度Vrが第2速度プロファイルP2上の第2目標速度V2に至ったときの補正トルクTcの値を任意に設定できる。
3, the closer the host vehicle 1 is to the target position Xtrg, the smaller the speed difference (V2-V1) between the second target speed V2 and the first target speed V1 becomes, and the larger the correction coefficient α becomes. Therefore, the closer the host vehicle 1 is to the target position Xtrg, the larger the correction torque Tc becomes, and the larger the basic braking/driving torque Tb can be corrected and decreased.
Furthermore, when the relative speed Vr of the host vehicle changes from the first target speed V1 based on the first speed profile P1 to the second target speed V2 based on the second speed profile P2, the correction coefficient α changes from "0" to "1".
Therefore, the value of the correction torque Tc can be set to "0" until the relative speed Vr exceeds the first speed profile P1.
On the other hand, when the relative speed Vr exceeds the first speed profile P1, the correction torque Tc increases as the relative speed Vr increases, and when the relative speed Vr reaches the second target speed V2, the value of the correction torque Tc becomes "K1".
Therefore, by appropriately setting the adjustment gain K1, it is possible to arbitrarily set the value of the correction torque Tc when the relative speed Vr reaches the second target speed V2 on the second speed profile P2.
(動作)
図6は、第1実施形態の制駆動力制御方法の一例のフローチャートである。
ステップS1において基本制駆動トルク設定部30は、基本制駆動トルクTbを設定する。
ステップS2において目標位置設定部31は、目標位置Xtrgを設定する。
ステップS3において目標位置設定部31は、自車両1と目標位置Xtrgとの相対距離Xrを算出する。
ステップS4において補正トルク設定部33の第1目標速度算出部40aと第1補正部41aは、第1速度プロファイルP1と相対距離Xrとに基づいて第1目標速度V1を算出する。
ステップS5において補正トルク設定部33の第2目標速度算出部40bは、第2速度プロファイルP2と相対距離Xrとに基づいて第2目標速度V2を算出する。
(operation)
FIG. 6 is a flowchart of an example of the braking/driving force control method according to the first embodiment.
In step S1, the basic braking/driving torque setting unit 30 sets the basic braking/driving torque Tb.
In step S2, the target position setting unit 31 sets the target position Xtrg.
In step S3, the target position setting unit 31 calculates the relative distance Xr between the host vehicle 1 and the target position Xtrg.
In step S4, the first target speed calculation unit 40a and the first correction unit 41a of the correction torque setting unit 33 calculate a first target speed V1 based on the first speed profile P1 and the relative distance Xr.
In step S5, the second target speed calculation unit 40b of the correction torque setting unit 33 calculates a second target speed V2 based on the second speed profile P2 and the relative distance Xr.
ステップS6において目標位置設定部31は、目標位置Xtrgに対する自車両1の相対速度Vrを検出する。
ステップS7において補正トルク設定部33は、相対速度Vrと第1目標速度V1と第2目標速度V2とに基づいて補正トルクTcを算出する。
ステップS8において減算器34は、基本制駆動トルクTbから補正トルクTcを減算することによりトルク指令値Tfを算出する。
ステップS9において制駆動力発生機構16は、トルク指令値Tfに応じて、自車両1を駆動する駆動トルク又は自車両1を制動する制動トルクを発生する。その後に処理は終了する。
In step S6, the target position setting unit 31 detects the relative speed Vr of the host vehicle 1 with respect to the target position Xtrg.
In step S7, the correction torque setting unit 33 calculates the correction torque Tc based on the relative speed Vr, the first target speed V1, and the second target speed V2.
In step S8, the subtractor 34 calculates the torque command value Tf by subtracting the correction torque Tc from the basic braking/driving torque Tb.
In step S9, the braking/driving force generation mechanism 16 generates a driving torque for driving the host vehicle 1 or a braking torque for braking the host vehicle 1 in accordance with the torque command value Tf. Then, the process ends.
(第2実施形態)
図9は、第2実施形態の補正トルク設定部33の機能構成の一例のブロック図である。第2実施形態の補正トルク設定部33は、第1実施形態の補正トルク設定部33に類似する構成を有しており、同一又は類似の構成要素については同じ参照符号で示す。
第2実施形態の補正トルク設定部33は、第3目標速度算出部40cと、第2補正部41bと、切替部45と、加算器46を備える。
第3目標速度算出部40cと第2補正部41bは、目標位置Xtrgまでの距離に応じた車速を示す第3速度プロファイルP3と、相対距離Xrと、に基づいて第3目標速度V3を算出する。
第3速度プロファイルP3は、第1減速度G1よりも小さな第3減速度G3で減速して第1距離D1より長い第2距離D2だけ目標位置Xtrgよりも自車両1に近い第2地点Xo2において設定速度Vsに達して第2地点Xo2から目標位置Xtrgまで設定速度Vsを維持する。
Second Embodiment
9 is a block diagram showing an example of the functional configuration of the correction torque setting unit 33 of the second embodiment. The correction torque setting unit 33 of the second embodiment has a configuration similar to that of the correction torque setting unit 33 of the first embodiment, and the same or similar components are denoted by the same reference numerals.
The correction torque setting unit 33 of the second embodiment includes a third target speed calculation unit 40 c, a second correction unit 41 b, a switching unit 45, and an adder 46.
The third target speed calculation unit 40c and the second correction unit 41b calculate a third target speed V3 based on a third speed profile P3 indicating the vehicle speed according to the distance to the target position Xtrg and the relative distance Xr.
The third speed profile P3 decelerates at a third deceleration G3 that is smaller than the first deceleration G1, reaches the set speed Vs at a second point Xo2 that is closer to the vehicle 1 than the target position Xtrg by a second distance D2 that is longer than the first distance D1, and maintains the set speed Vs from the second point Xo2 to the target position Xtrg.
例えば、第3速度プロファイルP3は、相対距離Xrを変数とする第3目標速度V3の計算式として設定してよい。例えば第3目標速度算出部40cと第2補正部41bは、次式(5)に基づいて第3目標速度V3を算出してよい。
このため第3目標速度算出部40cは、次式(6)に基づいて第3目標速度V3の初期値V3bを算出する。
V3b=(2×G3×Xr)1/2+Vs…(6)
第2補正部41bは、初期値V3bから第2オフセット速度Vo2を減じた差分が設定速度Vs以上である場合に、初期値V3bから第2オフセット速度Vo2を減じることによって、第3目標速度V3=V3b-Vo2を算出する。一方で、初期値V3bから第2オフセット速度Vo2を減じた差分が設定速度Vs未満である場合は、第3目標速度V3の値を設定速度Vsに設定する。すなわち、第3目標速度V3の下限値を設定速度Vsで制限する。これにより、第1補正部41aは上式(5)の第3目標速度V3を算出する。
Therefore, the third target speed calculation unit 40c calculates an initial value V3b of the third target speed V3 based on the following equation (6).
V3b=(2×G3×Xr) 1/2 +Vs…(6)
When the difference obtained by subtracting the second offset speed Vo2 from the initial value V3b is equal to or greater than the set speed Vs, the second correction unit 41b subtracts the second offset speed Vo2 from the initial value V3b to calculate the third target speed V3 = V3b - Vo2. On the other hand, when the difference obtained by subtracting the second offset speed Vo2 from the initial value V3b is less than the set speed Vs, the value of the third target speed V3 is set to the set speed Vs. In other words, the lower limit of the third target speed V3 is limited by the set speed Vs. In this way, the first correction unit 41a calculates the third target speed V3 using the above equation (5).
一方で、第1目標速度算出部40aと第1補正部41aは、第1速度プロファイルP1と、相対距離Xrと、に基づいて自車両1の車速Vの目標値である第1目標速度V1を算出する。また、第2目標速度算出部40bは、第2速度プロファイルP2と、相対距離Xrと、に基づいて第2目標速度V2を算出する。
図10に、第2実施形態の第1速度プロファイルP1と、第2速度プロファイルP2と、第3速度プロファイルP3の例を示す。
第2実施形態において、第1速度プロファイルP1の減速度G1は、例えば日常走行における比較的強い制動時の減速度(例えば0.2G)程度の値に設定し、第2速度プロファイルP2の減速度G2は、例えば追突防止などの急制動時の減速度(例えば0.3G)以上の値に設定し、第3速度プロファイルP3の減速度G3は、例えば日常走行における比較的弱い制動時の減速度(例えば0.1G)以下の値に設定してよい。
On the other hand, the first target speed calculation unit 40a and the first correction unit 41a calculate a first target speed V1, which is a target value for the vehicle speed V of the host vehicle 1, based on the first speed profile P1 and the relative distance Xr. Furthermore, the second target speed calculation unit 40b calculates a second target speed V2 based on the second speed profile P2 and the relative distance Xr.
FIG. 10 shows examples of a first speed profile P1, a second speed profile P2, and a third speed profile P3 according to the second embodiment.
In the second embodiment, the deceleration G1 of the first speed profile P1 may be set to a value equivalent to the deceleration during relatively strong braking in everyday driving (e.g., 0.2 G), the deceleration G2 of the second speed profile P2 may be set to a value equivalent to or greater than the deceleration during sudden braking to prevent a rear-end collision (e.g., 0.3 G), and the deceleration G3 of the third speed profile P3 may be set to a value equivalent to or less than the deceleration during relatively weak braking in everyday driving (e.g., 0.1 G).
第2実施形態の割合算出部42は、相対速度Vrと、第1入力速度VLと、第2入力速度VHを入力として取得する。割合算出部42は、第2入力速度VHと第1入力速度VLとの速度差分(VH-VL)に対する、相対速度Vrと第1入力速度VLとの速度差分(Vr-VL)の割合(Vr-VL)/(VH-VL)を補正係数αとして算出する。
切替部45は、相対速度Vrが第1目標速度V1より大きいか否かに応じて、割合算出部42に入力される第1入力速度VLを第1目標速度V1と第3目標速度V3との間で切り替える。また相対速度Vrが第1目標速度V1より大きいか否かに応じて、割合算出部42に入力される第2入力速度VHを第2目標速度V2と第1目標速度V1との間で切り替える。
The ratio calculation unit 42 of the second embodiment receives the relative speed Vr, the first input speed VL, and the second input speed VH as inputs. The ratio calculation unit 42 calculates the correction coefficient α as (Vr-VL)/(VH-VL), which is the ratio of the speed difference (Vr-VL) between the relative speed Vr and the first input speed VL to the speed difference (VH-VL) between the second input speed VH and the first input speed VL.
The switching unit 45 switches the first input speed VL input to the ratio calculation unit 42 between the first target speed V1 and the third target speed V3 depending on whether the relative speed Vr is greater than the first target speed V1. Also, the switching unit 45 switches the second input speed VH input to the ratio calculation unit 42 between the second target speed V2 and the first target speed V1 depending on whether the relative speed Vr is greater than the first target speed V1.
具体的には、相対速度Vrが第1目標速度V1以下の場合には、切替部45は、第3目標速度V3と第1目標速度V1とをそれぞれ第1入力速度VL及び第2入力速度VHとして割合算出部42に入力する。この場合、割合算出部42は、第1目標速度V1と第3目標速度V3との速度差分(V1-V3)に対する、相対速度Vrと第3目標速度V3との速度差分(Vr-V3)の割合(Vr-V3)/(V1-V3)を補正係数αとして算出する。
相対速度Vrが第1目標速度V1より大きい場合には、切替部45は、第1目標速度V1と第2目標速度V2とをそれぞれ第1入力速度VL及び第2入力速度VHとして割合算出部42に入力する。この場合、割合算出部42は、第2目標速度V2と第1目標速度V1との速度差分(V2-V1)に対する、相対速度Vrと第1目標速度V1との速度差分(Vr-V1)の割合(Vr-V1)/(V2-V1)を補正係数αとして算出する。
Specifically, when the relative speed Vr is equal to or less than the first target speed V1, the switching unit 45 inputs the third target speed V3 and the first target speed V1 as the first input speed VL and the second input speed VH, respectively, to the ratio calculation unit 42. In this case, the ratio calculation unit 42 calculates the correction coefficient α as (Vr-V3)/(V1-V3), which is the ratio of the speed difference (Vr-V3) between the relative speed Vr and the third target speed V3 to the speed difference (V1-V3) between the first target speed V1 and the third target speed V3.
When the relative speed Vr is greater than the first target speed V1, the switching unit 45 inputs the first target speed V1 and the second target speed V2 as the first input speed VL and the second input speed VH, respectively, to the ratio calculation unit 42. In this case, the ratio calculation unit 42 calculates, as the correction coefficient α, the ratio (Vr-V1)/(V2-V1) of the speed difference (Vr-V1) between the relative speed Vr and the first target speed V1 to the speed difference (V2-V1) between the second target speed V2 and the first target speed V1.
さらに切替部45は、相対速度Vrが第1目標速度V1より大きい場合に、補正係数αをオフセットさせるオフセット値Offsetの値を「1」に設定する。相対速度Vrが第1目標速度V1以下の場合には、オフセット値Offsetの値を「0」に設定する。
第2実施形態のリミッタ43の機能は、第1実施形態のリミッタ43の機能と同様である。
加算器46は、リミッタ43により制限された補正係数αに、オフセット値Offsetを加算した和(α+Offset)をゲイン乗算部44に入力する。ゲイン乗算部44は、和(α+Offset)に、調整ゲインK1を乗算して得られる積K1×(α+Offset)を補正トルクTcとして算出する。
Furthermore, when the relative speed Vr is greater than the first target speed V1, the switching unit 45 sets the value of the offset value Offset, which offsets the correction coefficient α, to 1. When the relative speed Vr is equal to or less than the first target speed V1, the switching unit 45 sets the value of the offset value Offset to 0.
The function of the limiter 43 in the second embodiment is similar to the function of the limiter 43 in the first embodiment.
The adder 46 adds the offset value Offset to the correction coefficient α limited by the limiter 43 to obtain a sum (α+Offset), and inputs the sum to the gain multiplication unit 44. The gain multiplication unit 44 multiplies the sum (α+Offset) by the adjustment gain K1 to calculate the product K1×(α+Offset) as the correction torque Tc.
このため、相対速度Vrが第3目標速度V3以下の場合には補正トルクTcの値は「0」に設定される。相対速度Vrが、第3目標速度V3より大きく且つ第1目標速度V1以下の場合には、補正トルクTcの値はK1×(Vr-V3)/(V1-V3)に設定される。相対速度Vrが、第1目標速度V1より大きく且つ第2目標速度V2以下の場合には、補正トルクTcの値はK1×((Vr-V1)/(V2-V1)+1)に設定される。相対速度Vrが、第2目標速度V2より大きい場合には、上限値K1×(αmax+1)により制限されるまでK1×((Vr-V1)/(V2-V1)+1)に設定される。
なお、図9の構成例では、加算器46はリミッタ43の後段に設けられたが、これに代えて割合算出部42とリミッタ43との間に設けてもよい。
Therefore, when the relative speed Vr is equal to or less than the third target speed V3, the value of the correction torque Tc is set to "0." When the relative speed Vr is greater than the third target speed V3 and equal to or less than the first target speed V1, the value of the correction torque Tc is set to K1 × (Vr - V3) / (V1 - V3). When the relative speed Vr is greater than the first target speed V1 and equal to or less than the second target speed V2, the value of the correction torque Tc is set to K1 × ((Vr - V1) / (V2 - V1) + 1). When the relative speed Vr is greater than the second target speed V2, the value of the correction torque Tc is set to K1 × ((Vr - V1) / (V2 - V1) + 1) until it is limited by the upper limit value K1 × (αmax + 1).
In the configuration example of FIG. 9, the adder 46 is provided after the limiter 43, but instead, it may be provided between the ratio calculation unit 42 and the limiter 43.
図10からわかるように、自車両1が目標位置Xtrgに近づくほど、第1目標速度V1と第3目標速度V3との速度差分(V1-V3)が小さくなる。また、第2目標速度V2と第1目標速度V1との速度差分(V2-V1)が小さくなる。このため自車両1が目標位置Xtrgに近づくほど補正係数αが大きくなるので、大きな補正トルクTcで基本制駆動トルクTbを減少補正できる。
また、相対速度Vrが第3速度プロファイルP3を超えるまでは補正トルクTcの値を「0」に設定することができる。
また、調整ゲインK1を適宜設定することにより、相対速度Vrが第1速度プロファイルP1上の第1目標速度V1に至ったときの補正トルクTcを任意の値「K1」に設定できる。
10, the closer the host vehicle 1 is to the target position Xtrg, the smaller the speed difference (V1-V3) between the first target speed V1 and the third target speed V3 becomes. Also, the smaller the speed difference (V2-V1) between the second target speed V2 and the first target speed V1 becomes. Therefore, the closer the host vehicle 1 is to the target position Xtrg, the larger the correction coefficient α becomes, and the basic braking/driving torque Tb can be reduced/corrected by a large correction torque Tc.
Furthermore, the value of the correction torque Tc can be set to "0" until the relative speed Vr exceeds the third speed profile P3.
Furthermore, by appropriately setting the adjustment gain K1, the correction torque Tc when the relative speed Vr reaches the first target speed V1 on the first speed profile P1 can be set to an arbitrary value "K1."
さらに、自車両の相対速度Vrが、第1速度プロファイルP1に基づく第1目標速度V1から第2速度プロファイルP2に基づく第2目標速度V2まで変化すると、補正係数αとオフセット値Offsetとの和(α+Offset)は、「1」から「2」に変化する。
したがって、調整ゲインK1を適宜設定することにより、相対速度Vrが第2速度プロファイルP2上の第2目標速度V2に至ったときの補正トルクTcを任意の値「2×K1」に設定できる。
Furthermore, when the relative speed Vr of the vehicle changes from the first target speed V1 based on the first speed profile P1 to the second target speed V2 based on the second speed profile P2, the sum of the correction coefficient α and the offset value Offset (α + Offset) changes from "1" to "2".
Therefore, by appropriately setting the adjustment gain K1, the correction torque Tc when the relative speed Vr reaches the second target speed V2 on the second speed profile P2 can be set to an arbitrary value "2 x K1".
(第3実施形態)
図11は、第3実施形態の補正トルク設定部33の機能構成の一例のブロック図である。第3実施形態の補正トルク設定部33と第2実施形態の補正トルク設定部33との差異は、第1補正部41aが相対距離Xrや移動体の速度Vfに応じて第1距離D1を設定し、第2補正部41bが相対距離Xrや移動体の速度Vfに応じて第2距離D2を設定する点である。
(Third embodiment)
11 is a block diagram showing an example of the functional configuration of the correction torque setting unit 33 of the third embodiment. The difference between the correction torque setting unit 33 of the third embodiment and the correction torque setting unit 33 of the second embodiment is that a first correction unit 41a sets the first distance D1 in accordance with the relative distance Xr and the speed Vf of the moving body, and a second correction unit 41b sets the second distance D2 in accordance with the relative distance Xr and the speed Vf of the moving body.
図4を参照して説明したように、目標位置Xtrgにおいて所定の設定速度Vsに達するように第1速度プロファイルP1が設定されると、自車両1が目標位置Xtrgのすぐ近くに近づいたときに、割合(Vr-V1)/(V2-V1)の分母(V2-V1)が0に接近して補正トルクTcの変化が大きくなることにより、自車両1の制駆動トルクの変動が大きくなる虞がある。目標位置Xtrgにおいて所定の設定速度Vsに達するように第3速度プロファイルP3を設定した場合も同様である。
このため、第1補正部41aは、目標位置Xtrgよりも第1距離D1だけ自車両1に近い第1地点Xo1において設定速度Vsに達するように、第1速度プロファイルP1を設定している。また、第2補正部41bも、目標位置Xtrgよりも第2距離D2だけ自車両1に近い第2地点Xo2において所定の設定速度Vsに達するように、第3速度プロファイルP3を設定している。
4, if the first speed profile P1 is set so that the predetermined set speed Vs is reached at the target position Xtrg, when the host vehicle 1 approaches very close to the target position Xtrg, the denominator (V2-V1) of the ratio (Vr-V1)/(V2-V1) approaches 0, causing a large change in the correction torque Tc, which may result in large fluctuations in the braking/driving torque of the host vehicle 1. The same applies when the third speed profile P3 is set so that the predetermined set speed Vs is reached at the target position Xtrg.
Therefore, the first correction unit 41a sets the first speed profile P1 so that the set speed Vs is reached at a first point Xo1 that is closer to the host vehicle 1 than the target position Xtrg by a first distance D1. Similarly, the second correction unit 41b sets the third speed profile P3 so that the predetermined set speed Vs is reached at a second point Xo2 that is closer to the host vehicle 1 than the target position Xtrg by a second distance D2.
しかしながら、自車両1が目標位置Xtrgから十分に離れている場合(すなわち相対距離Xrが長い)場合には、補正トルクTcの変化が大きくならないため、目標位置Xtrgよりも自車両1に近い地点で設定速度Vsに達するように速度プロファイルを設定しなくてもよい。
むしろ、目標位置Xtrgよりも自車両1に近い地点で設定速度Vsに達するように速度プロファイルを設定すると、目標位置Xtrgよりも手前で自車両1の車速Vが設定速度Vsになるように制駆動トルクが補正されるため、自車両1の車速Vが不必要に早く設定速度Vsになる虞がある。例えば、設定速度Vsが0である場合には、自車両1が目標位置Xtrgの手前で静止してしまう虞がある。
そこで、第1補正部41a及び第2補正部41bは、相対距離Xrが短い場合に比べて長い場合に第1距離D1及び第2距離D2をより短くする。
However, when the vehicle 1 is sufficiently far from the target position Xtrg (i.e., the relative distance Xr is long), the change in the correction torque Tc is not large, so it is not necessary to set the speed profile so that the set speed Vs is reached at a point closer to the vehicle 1 than the target position Xtrg.
If the speed profile is set so that the set speed Vs is reached at a point closer to the target position Xtrg, the braking/driving torque is corrected so that the vehicle speed V of the vehicle 1 reaches the set speed Vs before the target position Xtrg, which may cause the vehicle speed V of the vehicle 1 to reach the set speed Vs unnecessarily early. For example, if the set speed Vs is 0, the vehicle 1 may come to a stop before the target position Xtrg.
Therefore, the first corrector 41a and the second corrector 41b make the first distance D1 and the second distance D2 shorter when the relative distance Xr is long than when it is short.
また、図4を参照して説明したように、移動体の手前の地点を目標位置Xtrgとして設定した場合には、移動体の速度Vfが変動することで相対速度Vrが速度プロファイルを超え易くなり、相対距離Xrが短い場合には制駆動トルクが大きく変動して運転者に違和感を与える虞がある。
そこで、第1補正部41a及び第2補正部41bは、移動体の速度Vfが低い場合に比べて高い場合に第1距離D1及び第2距離D2をより長くする。
Furthermore, as explained with reference to Figure 4, if a point in front of the moving body is set as the target position Xtrg, fluctuations in the moving body's speed Vf will make it easier for the relative speed Vr to exceed the speed profile, and if the relative distance Xr is short, the braking/driving torque will fluctuate significantly, which may cause the driver to feel uncomfortable.
Therefore, the first corrector 41a and the second corrector 41b make the first distance D1 and the second distance D2 longer when the speed Vf of the moving body is high than when it is low.
例えば、第1補正部41aは、次式(7)に基づいて第1オフセット速度Vo1を設定してよい。
Vo1=K2a×(2×G1×Vf×T)1/2…(7)
上式(7)によれば、速度Vfが高いほど第1オフセット速度Vo1が大きくなり、第1距離D1が長くなる。
上式(7)においてK2aは、相対距離Xrに応じて設定される相対速度感応ゲインである。
第1補正部41aは、相対距離Xrが短い場合に比べて長い場合に相対速度感応ゲインK2aをより小さくする。これにより、相対距離Xrが短い場合に比べて長い場合に第1距離D1が短くなる。
図12は、相対速度感応ゲインK2aの一例の特性を示す図である。例えば、相対距離Xrが0~d0aまでの範囲では相対速度感応ゲインK2aは1であり、相対距離Xrがd0a以上の範囲では、相対距離Xrが大きくなるほど相対速度感応ゲインK2aは減少する。これにより、相対距離Xrが長いほど第1距離D1が短くなる。
For example, the first corrector 41a may set the first offset speed Vo1 based on the following equation (7).
Vo1=K2a×(2×G1×Vf×T) 1/2 …(7)
According to the above formula (7), the higher the speed Vf, the larger the first offset speed Vo1 becomes, and the longer the first distance D1 becomes.
In the above equation (7), K2a is a relative velocity sensitive gain that is set in accordance with the relative distance Xr.
The first corrector 41a reduces the relative velocity sensitive gain K2a when the relative distance Xr is long compared to when it is short, thereby shortening the first distance D1 when the relative distance Xr is long compared to when it is short.
12 is a diagram showing an example of the characteristics of the relative velocity sensitive gain K2a. For example, when the relative distance Xr is in the range from 0 to d0a, the relative velocity sensitive gain K2a is 1. When the relative distance Xr is in the range of d0a or more, the relative velocity sensitive gain K2a decreases as the relative distance Xr increases. As a result, the first distance D1 becomes shorter as the relative distance Xr becomes longer.
一方で第2補正部41bは、次式(8)に基づいて第2オフセット速度Vo2を設定してよい。
Vo2=K2b×(2×G3×Vf×T)1/2…(8)
上式(8)によれば、速度Vfが高いほど第2オフセット速度Vo2が大きくなり、第2距離D2が長くなる。
上式(8)においてK2bは、相対距離Xrに応じて設定される相対速度感応ゲインである。相対速度感応ゲインK2bの特性は、図12を参照して説明した相対速度感応ゲインK2aと同じ、又は類似した特性であってよい。
On the other hand, the second corrector 41b may set the second offset speed Vo2 based on the following equation (8).
Vo2=K2b×(2×G3×Vf×T) 1/2 …(8)
According to the above formula (8), the higher the speed Vf, the larger the second offset speed Vo2 becomes, and the longer the second distance D2 becomes.
In the above equation (8), K2b is a relative velocity sensitive gain that is set according to the relative distance Xr. The characteristics of the relative velocity sensitive gain K2b may be the same as or similar to the characteristics of the relative velocity sensitive gain K2a described with reference to FIG.
なお、第1補正部41a及び第2補正部41bは、アクセルペダルの操作量Acに応じた基本制駆動トルクTbが補正トルクTcにより補正されている場合(すなわち、相対距離Xrが第3速度プロファイルP3を超えており補正トルクTcが0でない場合)に、上式(7)による第1オフセット速度Vo1の設定及び上式(8)による第2オフセット速度Vo2の設定を中止して第1オフセット速度Vo1及び第2オフセット速度Vo2の値を保持してもよい。
これにより、補正トルクTcに基づく補正中に第1速度プロファイルP1や第3速度プロファイルP3が変更されることによって、補正トルクTcが急変して自車両1に急な減速度が生じるのを抑制できる。
Note that when the basic braking/driving torque Tb corresponding to the accelerator pedal operation amount Ac has been corrected by the correction torque Tc (i.e., when the relative distance Xr exceeds the third speed profile P3 and the correction torque Tc is not 0), the first correction unit 41 a and the second correction unit 41 b may stop setting the first offset speed Vo1 according to the above equation (7) and the second offset speed Vo2 according to the above equation (8) and may retain the values of the first offset speed Vo1 and the second offset speed Vo2.
This makes it possible to prevent the occurrence of a sudden deceleration of the host vehicle 1 due to a sudden change in the correction torque Tc caused by changing the first speed profile P1 or the third speed profile P3 during correction based on the correction torque Tc.
なお、上記の第3実施形態は、第1~3速度プロファイルP1~P3を設定する構成において、第1補正部41aと第2補正部41bとが相対距離Xrや移動体の速度Vfに応じて第1距離D1及び第2距離D2を設定する例について説明したが、第1実施形態のように第1、2速度プロファイルP1、P3を設定する構成においても同様に、第1補正部41aが相対距離Xrや移動体の速度Vfに応じて第1距離D1を設定してもよい。 In the above third embodiment, an example was described in which, in a configuration in which the first to third speed profiles P1 to P3 are set, the first correction unit 41a and the second correction unit 41b set the first distance D1 and the second distance D2 in accordance with the relative distance Xr and the speed Vf of the moving body. However, in a configuration in which the first and second speed profiles P1 and P3 are set as in the first embodiment, the first correction unit 41a may similarly set the first distance D1 in accordance with the relative distance Xr and the speed Vf of the moving body.
(第4実施形態)
上記のとおり、自車両1の進行方向の前方の移動体の手前に目標位置Xtrgを設定した場合には、移動体との相対速度Vrが目標位置Xtrgにおいて設定速度Vsになる速度プロファイルに基づいて自車両1を減速させる。
このため、移動体が減速している場合には、目標位置Xtrgにおいて相対速度Vrを設定速度Vsにできないことがある。そこで、第4実施形態の補正トルク設定部33は、移動体が減速している場合には補正トルクTcを増加させる。
具体的には、自車両1の進行方向の前方において検出された移動体の加速度aを検出し、検出された加速度aが大きいほど補正トルクTcを減少させる。言い換えれば、負値の加速度である減速度が大きいほど補正トルクTcを増加させる。
(Fourth embodiment)
As described above, when the target position Xtrg is set in front of a moving body in the direction of travel of the vehicle 1, the vehicle 1 is decelerated based on a speed profile in which the relative speed Vr with the moving body becomes the set speed Vs at the target position Xtrg.
Therefore, when the moving body is decelerating, it may not be possible to set the relative velocity Vr to the set velocity Vs at the target position Xtrg. Therefore, the correction torque setting unit 33 of the fourth embodiment increases the correction torque Tc when the moving body is decelerating.
Specifically, the acceleration a of a moving object detected ahead in the traveling direction of the vehicle 1 is detected, and the correction torque Tc is decreased as the detected acceleration a increases. In other words, the correction torque Tc is increased as the deceleration, which is a negative acceleration, increases.
図13は、第4実施形態の補正トルク設定部33の機能構成の一例のブロック図である。第4実施形態の補正トルク設定部33は、図11を参照して説明した第3実施形態の補正トルク設定部33に類似する構成を有しており、同一の構成要素については同じ参照符号で示す。
第4実施形態の補正トルク設定部33は、加速度算出部47と、ゲイン乗算部48と、加算器49を備える。
Fig. 13 is a block diagram showing an example of the functional configuration of the correction torque setting unit 33 of the fourth embodiment. The correction torque setting unit 33 of the fourth embodiment has a configuration similar to that of the correction torque setting unit 33 of the third embodiment described with reference to Fig. 11, and the same components are denoted by the same reference numerals.
The correction torque setting unit 33 of the fourth embodiment includes an acceleration calculation unit 47 , a gain multiplication unit 48 , and an adder 49 .
加速度算出部47は、自車両の進行方向の前方に存在する移動体の所定距離手前の地点が目標位置Xtrgとして設定された場合に、相対速度Vrを微分することにより自車両1に対する移動体の相対加速度を算出する。
加速度算出部47は、移動体の速度Vfを微分して移動体の加速度を算出してもよい。以下、加速度算出部47が算出した相対加速度又は移動体の加速度を総称して「加速度a」と記載することがある。
When a point a predetermined distance in front of a moving body in the direction of travel of the vehicle is set as the target position Xtrg, the acceleration calculation unit 47 calculates the relative acceleration of the moving body with respect to the vehicle 1 by differentiating the relative velocity Vr.
The acceleration calculation unit 47 may calculate the acceleration of the moving body by differentiating the velocity Vf of the moving body. Hereinafter, the relative acceleration calculated by the acceleration calculation unit 47 or the acceleration of the moving body may be collectively referred to as "acceleration a."
ゲイン乗算部48は、加速度算出部47が算出した加速度aに、負の値の調整ゲインK3を乗算して得られる積を第2補正トルクTc2として算出する。したがって加速度aが減速度を示す場合(すなわち加速度aが0より小さい場合)に、第2補正トルクTc2は正の値を有する。
例えば調整ゲインK3は、相対距離Xrが長い場合よりも短い場合により絶対値が大きくなる負値のゲインであってよい。例えば調整ゲインK3は、相対距離Xrが短いほど絶対値が大きくなる負値のゲインであってよい。これにより、自車両1が目標位置Xtrgに近づくほど大きな第2補正トルクTc2で基本制駆動トルクTbを減少補正できる。
The gain multiplication unit 48 multiplies the acceleration a calculated by the acceleration calculation unit 47 by a negative adjustment gain K3 to calculate the product as the second correction torque Tc2. Therefore, when the acceleration a indicates deceleration (i.e., when the acceleration a is less than 0), the second correction torque Tc2 has a positive value.
For example, the adjustment gain K3 may be a negative gain whose absolute value is larger when the relative distance Xr is short than when it is long. For example, the adjustment gain K3 may be a negative gain whose absolute value is larger as the relative distance Xr is shorter. This allows the basic braking/driving torque Tb to be reduced and corrected by the second correction torque Tc2, which is larger as the host vehicle 1 approaches the target position Xtrg.
ゲイン乗算部44は、リミッタ43により制限された補正係数αとオフセット値Offsetとの和(α+Offset)に、調整ゲインK1を乗算して得られる積を第1補正トルクTc1として算出する。
加算器49は、第1補正トルクTc1と第2補正トルクTc2の和を補正トルクTcとして算出して、図4に示す減算器34に出力する。
なお、第1実施形態及び第2実施形態の補正トルク設定部33にも、同様に加速度算出部47と、ゲイン乗算部48と、加算器49を加えてもよい。
The gain multiplication unit 44 multiplies the sum (α+Offset) of the correction coefficient α limited by the limiter 43 and the offset value Offset by the adjustment gain K1, and calculates the product as the first correction torque Tc1.
The adder 49 calculates the sum of the first correction torque Tc1 and the second correction torque Tc2 as the correction torque Tc, and outputs it to the subtractor 34 shown in FIG.
Similarly, an acceleration calculation section 47, a gain multiplication section 48, and an adder 49 may be added to the correction torque setting section 33 of the first and second embodiments.
(実施形態の効果)
(1)コントローラ15は、自車両1のアクセルペダルの操作量に応じた制駆動力を算出し、自車両1の現在位置と自車両の進行方向前方の予め設定された所定の位置である目標位置との間の相対距離を算出し、目標位置までの距離に応じた車速を示す速度プロファイルであって第1減速度で減速して目標位置よりも第1距離だけ自車両1に近い第1地点において所定の設定速度に達して第1地点から目標位置まで設定速度を維持する第1速度プロファイルと、相対距離と、に基づいて第1目標速度を算出し、目標位置までの距離に応じた速度プロファイルとして設定され且つ第1減速度よりも大きな第2減速度で減速して目標位置において設定速度となる第2速度プロファイルと、相対距離と、に基づいて第2目標速度を算出し、目標位置に対する自車両1の相対速度を検出し、相対速度が第1目標速度以上である場合に、相対速度から第1目標速度を減算した差分を第2目標速度から第1目標速度を減算した差分で除算した割合が大きいほどより大きな補正量を算出し、アクセルペダルの操作量に応じて算出した制駆動力から補正量を減算することにより補正済制駆動力を算出し、算出された補正済制駆動力に基づいて自車両1の制駆動力を制御する。
これにより、第1速度プロファイルに基づいて自車両1を減速させる際の運転者の違和感を軽減できる。また、自車両1が目標位置に近づくほど大きな補正量で制駆動力を減少補正できる一方で、自車両1が目標位置のすぐ近くに近づいたときに補正トルクTcの変化が大きくなって自車両1の制駆動トルクが大きく変動するのを抑制できる。
また、相対速度が第1速度プロファイルを超えるまでは補正量の値を「0」に設定することができる。一方で、相対速度が第1速度プロファイルを超えた場合には、相対速度と第1目標速度との差分が大きくなるほど補正量を増加させて、相対速度が第2速度プロファイル上の第2目標速度に至ったときの補正量の値を任意に設定できる。
(Effects of the embodiment)
(1) The controller 15 calculates a braking/driving force according to the amount of operation of the accelerator pedal of the vehicle 1, calculates a relative distance between the current position of the vehicle 1 and a target position, which is a predetermined position set ahead in the direction of travel of the vehicle, calculates a first target speed based on the relative distance and a first speed profile indicating a vehicle speed according to the distance to the target position, the first speed profile being set as a speed profile according to the distance to the target position, the first speed profile being set as a speed profile according to the distance to the target position, the first speed profile being set as a speed profile according to the distance to the target position and A second target speed is calculated based on a second speed profile in which the vehicle is decelerated at a second deceleration greater than the first deceleration to reach a set speed at the target position, and based on the relative distance; the relative speed of the vehicle 1 with respect to the target position is detected; if the relative speed is equal to or greater than the first target speed, a larger correction amount is calculated the greater the ratio of the difference obtained by subtracting the first target speed from the relative speed divided by the difference obtained by subtracting the first target speed from the second target speed; corrected braking/driving forces are calculated by subtracting the correction amount from the braking/driving forces calculated in accordance with the amount of operation of the accelerator pedal; and the braking/driving forces of the vehicle 1 are controlled based on the calculated corrected braking/driving forces.
This reduces the sense of discomfort felt by the driver when decelerating the host vehicle 1 based on the first speed profile. Also, the closer the host vehicle 1 gets to the target position, the greater the correction amount for the braking/driving force can be reduced, while the change in correction torque Tc becomes large when the host vehicle 1 gets very close to the target position, preventing large fluctuations in the braking/driving torque of the host vehicle 1.
Furthermore, the value of the correction amount can be set to "0" until the relative velocity exceeds the first velocity profile. On the other hand, when the relative velocity exceeds the first velocity profile, the correction amount is increased as the difference between the relative velocity and the first target velocity increases, and the value of the correction amount when the relative velocity reaches the second target velocity on the second velocity profile can be set arbitrarily.
(2)コントローラ15は、目標位置までの距離に応じた車速を示す速度プロファイルであって第1減速度よりも小さな第3減速度で減速して第1距離より長い第2距離だけ目標位置よりも自車両1に近い第2地点において設定速度に達して第2地点から目標位置まで設定速度を維持する第3速度プロファイルと、相対距離と、に基づいて第3目標速度を算出し、相対速度が第3目標速度以上である場合に、相対速度から第3目標速度を減算した差分を第1目標速度から第3目標速度を減算した差分で除算した割合が大きいほどより大きな補正量を算出してもよい。
これにより、相対速度が第3速度プロファイルを超えるまでは補正量の値を「0」に設定することができる。一方で、相対速度が第3速度プロファイルを超えた場合には、相対速度と第3目標速度との差分が大きくなるほど補正量を増加させて、相対速度が第1速度プロファイル上の第1目標速度に至ったときの補正量の値を任意に設定できる。さらに、相対速度が第1速度プロファイルを超えた場合には、相対速度と第1目標速度との差分が大きくなるほど補正量を増加させて、相対速度が第2速度プロファイル上の第2目標速度に至ったときの補正量の値を任意に設定できる。
(2) The controller 15 calculates the third target speed based on the relative distance and a third speed profile indicating the vehicle speed according to the distance to the target position, in which the vehicle decelerates at a third deceleration that is smaller than the first deceleration, reaches the set speed at a second point that is closer to the target position than the vehicle 1 by a second distance that is longer than the first distance, and maintains the set speed from the second point to the target position. When the relative speed is equal to or greater than the third target speed, the controller 15 may calculate a larger correction amount as the ratio of the difference obtained by subtracting the third target speed from the relative speed divided by the difference obtained by subtracting the third target speed from the first target speed increases.
As a result, the value of the correction amount can be set to "0" until the relative velocity exceeds the third velocity profile. On the other hand, when the relative velocity exceeds the third velocity profile, the correction amount is increased as the difference between the relative velocity and the third target velocity increases, so that the value of the correction amount when the relative velocity reaches the first target velocity on the first velocity profile can be set arbitrarily. Furthermore, when the relative velocity exceeds the first velocity profile, the correction amount is increased as the difference between the relative velocity and the first target velocity increases, so that the value of the correction amount when the relative velocity reaches the second target velocity on the second velocity profile can be set arbitrarily.
(3)コントローラ15は、目標位置までの距離に応じた車速を示し且つ第1減速度で減速して目標位置において設定速度に達する速度プロファイルの速度を、第1速度だけ低下させるとともに設定速度で下限値を制限することにより、第1速度プロファイルを取得してもよい。これにより、第1減速度で減速して目標位置よりも第1距離だけ自車両1に近い第1地点において所定の設定速度に達して第1地点から目標位置まで設定速度を維持する第1速度プロファイルを設定できる。 (3) The controller 15 may acquire the first speed profile by reducing the speed of a speed profile that indicates a vehicle speed according to the distance to the target position and that decelerates at a first deceleration to reach a set speed at the target position by the first speed and limiting the lower limit to the set speed. This makes it possible to set a first speed profile that decelerates at the first deceleration to reach a predetermined set speed at a first point that is closer to the host vehicle 1 than the target position by the first distance and maintains the set speed from the first point to the target position.
(4)コントローラ15は、目標位置までの距離に応じた車速を示し且つ第3減速度で減速して目標位置において設定速度に達する速度プロファイルの速度を、第1速度よりも高い第2速度だけ低下させるとともに設定速度で下限値を制限することにより、第3速度プロファイルを取得してもよい。これにより、第3減速度で減速して第1距離より長い第2距離だけ目標位置よりも自車両1に近い第2地点において設定速度に達して第2地点から目標位置まで設定速度を維持する第3速度プロファイルを設定できる。 (4) The controller 15 may acquire a third speed profile by reducing the speed of a speed profile that indicates a vehicle speed according to the distance to the target position and that decelerates at a third deceleration to reach a set speed at the target position by a second speed that is higher than the first speed and by limiting the lower limit to the set speed. This makes it possible to set a third speed profile that decelerates at the third deceleration to reach the set speed at a second point that is closer to the target position than the host vehicle 1 by a second distance that is longer than the first distance, and maintains the set speed from the second point to the target position.
(5)コントローラ15は、相対距離が短い場合に比べて長い場合に第1距離をより短くしてもよい。これにより、自車両1が目標位置から十分に離れており、自車両1が目標位置のすぐ近くに近づいたときに生じる大きな補正量の変動の発生の虞が低い場合には、目標位置よりも手前で自車両1の車速が設定速度になるように制駆動力が制御されるのを抑制できる。
(6)コントローラ15は、補正量が0でない場合には、相対距離の変化に関わらず第1距離を保持してもよい。これにより、制駆動力の補正中に第1速度プロファイルが変更されて、自車両1に急な減速度が生じるのを抑制できる。
(5) The controller 15 may shorten the first distance when the relative distance is long compared to when the relative distance is short. This makes it possible to prevent the braking/driving force from being controlled so that the vehicle speed of the host vehicle 1 reaches the set speed before the target position when the host vehicle 1 is sufficiently far from the target position and there is a low risk of a large fluctuation in the correction amount that occurs when the host vehicle 1 approaches very close to the target position.
(6) If the correction amount is not 0, the controller 15 may maintain the first distance regardless of changes in the relative distance. This prevents the first speed profile from being changed during correction of the braking/driving force, thereby preventing sudden deceleration of the host vehicle 1.
(7)コントローラ15は、目標位置の変化速度を制限してもよい。これにより、目標位置の急な変化により制駆動力が急変するのを抑制できる。
(8)コントローラ15は、自車両1の前方の静止物標の位置の所定距離手前の地点を、自車両1を停止させる目標位置として設定してもよい。これにより、自車両1の前方の静止物標の手前に停止できるように自車両1を減速できる。
(9)コントローラ15は、自車両1の前方の移動体の位置の所定距離手前の地点を目標位置として設定してもよい。これにより、自車両1の前方の移動体の手前において自車両1と移動体との相対速度が設定速度になるように自車両1を減速できる。
(7) The controller 15 may limit the rate of change of the target position, thereby preventing a sudden change in the braking/driving force due to a sudden change in the target position.
(8) The controller 15 may set a point a predetermined distance before the position of a stationary target ahead of the host vehicle 1 as the target position for stopping the host vehicle 1. This allows the host vehicle 1 to decelerate so that the host vehicle 1 can stop before the stationary target ahead of the host vehicle 1.
(9) The controller 15 may set, as the target position, a point a predetermined distance before the position of a moving object ahead of the host vehicle 1. This allows the host vehicle 1 to decelerate before the moving object ahead of the host vehicle 1 so that the relative speed between the host vehicle 1 and the moving object becomes the set speed.
(10)コントローラ15は、自車両1の前方の移動体の位置の所定距離手前の地点を目標位置として設定し、自車両1の進行方向における移動体の速度を検出し、検出した速度が遅い場合よりも早い場合に第1距離をより長くしてもよい。これにより、自車両1の前方の移動体が移動しても相対速度が第1速度プロファイルを超えるのを抑制できるため、自車両1が目標位置のすぐ近くに近づいても大きな補正量の変動の発生を抑制できる。
(11)コントローラ15は、補正量が0でない場合には、速度の変化に関わらず第1距離を保持してもよい。これにより、制駆動力の補正中に第1速度プロファイルが変更されて、自車両1に急な減速度が生じるのを抑制できる。
(10) The controller 15 may set a point a predetermined distance before the position of a moving object ahead of the host vehicle 1 as the target position, detect the speed of the moving object in the traveling direction of the host vehicle 1, and make the first distance longer when the detected speed is faster than when the detected speed is slow. This prevents the relative speed from exceeding the first speed profile even when the moving object ahead of the host vehicle 1 moves, thereby preventing large fluctuations in the correction amount even when the host vehicle 1 approaches very close to the target position.
(11) The controller 15 may maintain the first distance regardless of changes in speed when the correction amount is not 0. This prevents the first speed profile from being changed during correction of the braking/driving force, thereby preventing sudden deceleration of the host vehicle 1.
(12)コントローラ15は、自車両1の進行方向における移動体の加速度を検出し、検出された加速度が大きいほど補正量を減少させてもよい。また、自車両1の進行方向における自車両1に対する移動体の相対加速度を検出し、検出された相対加速度が大きいほど補正量を減少させてもよい。
これにより、移動体が減速していても、移動体の手前の目標位置において自車両1と移動体との相対速度が設定速度になるように制御し易くなる。
(12) The controller 15 may detect the acceleration of the moving object in the traveling direction of the host vehicle 1, and may decrease the correction amount as the detected acceleration increases. Alternatively, the controller 15 may detect the relative acceleration of the moving object with respect to the host vehicle 1 in the traveling direction of the host vehicle 1, and may decrease the correction amount as the detected relative acceleration increases.
This makes it easier to control the relative speed between the vehicle 1 and the moving body to a set speed at a target position in front of the moving body, even if the moving body is decelerating.
1…自車両、2…先行車両、10…制駆動力制御装置、11…測位装置、12…地図データベース(地図DB)、13…外界センサ、14…車両センサ、15…コントローラ、16…制駆動力発生機構、20…プロセッサ、21…記憶装置、30…基本制駆動トルク設定部、31…目標位置設定部、32…レートリミッタ、33…補正トルク設定部、34…減算器、40a…第1目標速度算出部、40b…第2目標速度算出部、40c…第3目標速度算出部、41a…第1補正部、41b…第2補正部、42…割合算出部、43…リミッタ、44、48…ゲイン乗算部、45…切替部、46、49…加算器、47…加速度算出部 1... Vehicle, 2... Leading vehicle, 10... Braking/driving force control device, 11... Positioning device, 12... Map database (map DB), 13... External sensor, 14... Vehicle sensor, 15... Controller, 16... Braking/driving force generation mechanism, 20... Processor, 21... Storage device, 30... Basic braking/driving torque setting unit, 31... Target position setting unit, 32... Rate limiter, 33... Correction torque setting unit, 34... Subtractor, 40a... First target speed calculation unit, 40b... Second target speed calculation unit, 40c... Third target speed calculation unit, 41a... First correction unit, 41b... Second correction unit, 42... Ratio calculation unit, 43... Limiter, 44, 48... Gain multiplication unit, 45... Switching unit, 46, 49... Adder, 47... Acceleration calculation unit
Claims (14)
前記自車両の進行方向前方で前記自車両を静止させる位置、又は前記自車両の前方の移動体から所定距離手前の地点を目標位置として設定し、
前記自車両の現在位置と前記目標位置との間の相対距離を算出し、
前記目標位置までの距離に応じた車速を示す速度プロファイルであって第1減速度で減速して前記目標位置よりも第1距離だけ前記自車両に近い第1地点において所定の設定速度に達して前記第1地点から前記目標位置まで前記設定速度を維持する第1速度プロファイルと、前記相対距離と、に基づいて第1目標速度を算出し、
前記目標位置までの距離に応じた速度プロファイルとして設定され且つ前記第1減速度よりも大きな第2減速度で減速して前記目標位置において前記設定速度となる第2速度プロファイルと、前記相対距離と、に基づいて第2目標速度を算出し、
前記目標位置に対する前記自車両の相対速度を検出し、
前記相対速度が前記第1目標速度以上である場合に、前記相対速度から前記第1目標速度を減算した差分を前記第2目標速度から前記第1目標速度を減算した差分で除算した割合が大きいほどより大きな補正量を算出し、
前記アクセルペダルの操作量に応じて算出した前記制駆動力から前記補正量を減算することにより補正済制駆動力を算出し、
算出された前記補正済制駆動力に基づいて前記自車両の制駆動力を制御する、
ことを特徴とする制駆動力制御方法。 Calculating braking/driving force according to the amount of accelerator pedal operation of the vehicle;
setting a position in front of the host vehicle in a traveling direction where the host vehicle is to be stopped, or a point a predetermined distance before a moving object in front of the host vehicle, as a target position;
Calculating a relative distance between the current position of the vehicle and the target position;
calculating a first target speed based on a first speed profile indicating a vehicle speed according to a distance to the target position, the first speed profile being one in which the host vehicle decelerates at a first deceleration to reach a predetermined set speed at a first point that is closer to the host vehicle than the target position by a first distance, and the set speed being maintained from the first point to the target position, and the relative distance;
calculating a second target velocity based on the relative distance and a second velocity profile that is set as a velocity profile according to the distance to the target position and that decelerates at a second deceleration that is greater than the first deceleration to reach the set velocity at the target position;
Detecting a relative velocity of the host vehicle with respect to the target position;
when the relative speed is equal to or greater than the first target speed, the larger the ratio of the difference obtained by subtracting the first target speed from the relative speed divided by the difference obtained by subtracting the first target speed from the second target speed, the larger the correction amount calculated;
calculating corrected braking/driving forces by subtracting the correction amount from the braking/driving forces calculated in accordance with the accelerator pedal depression amount;
controlling the braking/driving force of the host vehicle based on the calculated corrected braking/driving force;
A braking/driving force control method characterized by the above.
前記相対速度が前記第3目標速度以上である場合に、前記相対速度から前記第3目標速度を減算した差分を前記第1目標速度から前記第3目標速度を減算した差分で除算した割合が大きいほどより大きな補正量を算出する、
ことを特徴とする請求項1に記載の制駆動力制御方法。 calculating a third target speed based on the relative distance and a third speed profile indicating a vehicle speed according to a distance to the target position, the third speed profile being one in which the host vehicle decelerates at a third deceleration smaller than the first deceleration, reaches the set speed at a second point closer to the host vehicle than the target position by a second distance longer than the first distance, and maintains the set speed from the second point to the target position;
When the relative speed is equal to or greater than the third target speed, the larger the ratio of the difference obtained by subtracting the third target speed from the relative speed divided by the difference obtained by subtracting the third target speed from the first target speed, the larger the correction amount calculated.
2. The braking/driving force control method according to claim 1.
前記自車両の進行方向における前記移動体の速度を検出し、
検出した前記速度が低い場合よりも高い場合に前記第1距離をより長くすることを特徴とする請求項1~7のいずれか一項に記載の制駆動力制御方法。 setting a moving position that is a point a predetermined distance before the position of the moving body ahead of the host vehicle as the target position;
Detecting the speed of the moving object in the traveling direction of the host vehicle;
8. The braking/driving force control method according to claim 1, wherein the first distance is made longer when the detected speed is high than when the detected speed is low.
検出された前記加速度が大きいほど前記補正量を減少させる、
ことを特徴とする請求項9~11のいずれか一項に記載の制駆動力制御方法。 detecting an acceleration of the moving object in a traveling direction of the host vehicle;
The greater the detected acceleration, the smaller the correction amount.
12. The braking/driving force control method according to claim 9, wherein the braking/driving force control method is a braking/driving force control method.
検出された前記相対加速度が大きいほど前記補正量を減少させる、
ことを特徴とする請求項9~12のいずれか一項に記載の制駆動力制御方法。 Detecting a relative acceleration of the moving object with respect to the host vehicle in a traveling direction of the host vehicle;
The larger the detected relative acceleration is, the smaller the correction amount is.
13. The braking/driving force control method according to claim 9, wherein the braking/driving force control method is a braking/driving force control method.
自車両の制駆動力を発生させる制駆動力発生機構と、
前記アクセルペダルの操作量に応じた制駆動力を算出し、前記自車両の進行方向前方で前記自車両を静止させる位置、又は前記自車両の前方の移動体から所定距離手前の地点を目標位置として設定し、前記自車両の現在位置と前記目標位置との間の相対距離を算出し、前記目標位置までの距離に応じた車速を示す速度プロファイルであって第1減速度で減速して前記目標位置よりも第1距離だけ前記自車両に近い第1地点において所定の設定速度に達して前記第1地点から前記目標位置まで前記設定速度を維持する第1速度プロファイルと、前記相対距離と、に基づいて第1目標速度を算出し、前記目標位置までの距離に応じた速度プロファイルとして設定され且つ前記第1減速度よりも大きな第2減速度で減速して前記目標位置において前記設定速度となる第2速度プロファイルと、前記相対距離と、に基づいて第2目標速度を算出し、前記目標位置に対する前記自車両の相対速度を検出し、前記相対速度が前記第1目標速度以上である場合に、前記相対速度から前記第1目標速度を減算した差分を前記第2目標速度から前記第1目標速度を減算した差分で除算した割合が大きいほどより大きな補正量を算出し、前記アクセルペダルの操作量に応じて算出した前記制駆動力から前記補正量を減算することにより補正済制駆動力を算出し、算出された前記補正済制駆動力に基づいて前記制駆動力発生機構を制御するコントローラと、
を備えることを特徴とする制駆動力制御装置。 Accelerator pedal and
a braking/driving force generation mechanism that generates braking/driving forces for the host vehicle;
a braking/driving force corresponding to an operation amount of the accelerator pedal is calculated; a position ahead of the host vehicle in a traveling direction where the host vehicle is to be stopped, or a point a predetermined distance before a moving object ahead of the host vehicle, is set as a target position; a relative distance between the current position of the host vehicle and the target position is calculated; a first speed profile indicating a vehicle speed according to a distance to the target position, the first speed profile being a first speed profile that decelerates the host vehicle at a first deceleration to reach a predetermined set speed at a first point that is a first distance closer to the host vehicle than the target position, and the set speed is maintained from the first point to the target position; and a first target speed is calculated based on the relative distance; and the first target speed is set as a speed profile according to the distance to the target position; a controller that calculates a second target speed based on the relative distance and a second speed profile in which the host vehicle is decelerated at a second deceleration greater than the first deceleration to reach the set speed at the target position, detects the relative speed of the host vehicle with respect to the target position, and, when the relative speed is equal to or greater than the first target speed, calculates a larger correction amount the greater the ratio of a difference obtained by subtracting the first target speed from the relative speed divided by the difference obtained by subtracting the first target speed from the second target speed, calculates corrected braking/driving forces by subtracting the correction amount from the braking/driving forces calculated in accordance with the amount of operation of the accelerator pedal, and controls the braking/driving force generation mechanism based on the calculated corrected braking/driving forces;
A braking/driving force control device comprising:
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2022033487A JP7805202B2 (en) | 2022-03-04 | 2022-03-04 | Braking/driving force control method and braking/driving force control device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2022033487A JP7805202B2 (en) | 2022-03-04 | 2022-03-04 | Braking/driving force control method and braking/driving force control device |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2023128844A JP2023128844A (en) | 2023-09-14 |
| JP7805202B2 true JP7805202B2 (en) | 2026-01-23 |
Family
ID=87972422
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2022033487A Active JP7805202B2 (en) | 2022-03-04 | 2022-03-04 | Braking/driving force control method and braking/driving force control device |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP7805202B2 (en) |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20190168722A1 (en) | 2017-12-01 | 2019-06-06 | Lucas Automotive Gmbh | Brake control system and brake control method for determining a braking correction value for emergency braking operations |
| JP2020059367A (en) | 2018-10-09 | 2020-04-16 | トヨタ自動車株式会社 | Control device of vehicle |
| JP2021041851A (en) | 2019-09-12 | 2021-03-18 | 日産自動車株式会社 | Driving support method and driving support device |
| JP2021077012A (en) | 2019-11-07 | 2021-05-20 | トヨタ自動車株式会社 | Driving support device |
-
2022
- 2022-03-04 JP JP2022033487A patent/JP7805202B2/en active Active
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20190168722A1 (en) | 2017-12-01 | 2019-06-06 | Lucas Automotive Gmbh | Brake control system and brake control method for determining a braking correction value for emergency braking operations |
| JP2020059367A (en) | 2018-10-09 | 2020-04-16 | トヨタ自動車株式会社 | Control device of vehicle |
| JP2021041851A (en) | 2019-09-12 | 2021-03-18 | 日産自動車株式会社 | Driving support method and driving support device |
| JP2021077012A (en) | 2019-11-07 | 2021-05-20 | トヨタ自動車株式会社 | Driving support device |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2023128844A (en) | 2023-09-14 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US11396294B2 (en) | Driving control apparatus for vehicle | |
| US11433898B2 (en) | Driving control apparatus for vehicle | |
| JP5127917B2 (en) | Vehicle control device | |
| US9352747B2 (en) | Vehicle travel control system | |
| CN114179795B (en) | System and method for predicting collision risk in lane changes | |
| WO2016110729A1 (en) | Target vehicle speed generation device and drive control device | |
| US10353391B2 (en) | Travel control device | |
| US11634140B2 (en) | Vehicle control method and vehicle control device | |
| JP2019119298A (en) | Vehicular control device | |
| JP3197114B2 (en) | Travel control device for vehicles | |
| JP7805202B2 (en) | Braking/driving force control method and braking/driving force control device | |
| JP7802502B2 (en) | Braking/driving force control method and braking/driving force control device | |
| JP4055721B2 (en) | VEHICLE DRIVE OPERATION ASSISTANCE DEVICE AND VEHICLE WITH VEHICLE DRIVE OPERATION ASSISTANCE DEVICE | |
| JP7351076B2 (en) | Electric vehicle control method and electric vehicle control device | |
| JP7786055B2 (en) | Driving force control method and driving force control device | |
| JPH0717298A (en) | Vehicle running control device | |
| JP4576922B2 (en) | Vehicle travel control device | |
| US11987243B2 (en) | Vehicle, program and notification method | |
| CN115195712B (en) | Vehicle collision avoidance assistance device | |
| JP2023138401A5 (en) | ||
| JP2023151394A (en) | Vehicle control method and vehicle control device | |
| JP7803196B2 (en) | Vehicle control method and vehicle control device | |
| US12157477B2 (en) | Vehicle control system and vehicle control method | |
| JP7696798B2 (en) | Operation control method and operation control device | |
| US12466423B2 (en) | Information processing device |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20241108 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20250701 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20250630 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20250924 |
|
| TRDD | Decision of grant or rejection written | ||
| A711 | Notification of change in applicant |
Free format text: JAPANESE INTERMEDIATE CODE: A711 Effective date: 20250929 |
|
| RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20250930 |
|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20251216 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20260113 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 7805202 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |