JP6747141B2 - Speed control device - Google Patents
Speed control device Download PDFInfo
- Publication number
- JP6747141B2 JP6747141B2 JP2016147619A JP2016147619A JP6747141B2 JP 6747141 B2 JP6747141 B2 JP 6747141B2 JP 2016147619 A JP2016147619 A JP 2016147619A JP 2016147619 A JP2016147619 A JP 2016147619A JP 6747141 B2 JP6747141 B2 JP 6747141B2
- Authority
- JP
- Japan
- Prior art keywords
- speed
- term
- moving body
- unit
- vehicle
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L3/00—Electric devices on electrically-propelled vehicles for safety purposes; Monitoring operating variables, e.g. speed, deceleration or energy consumption
- B60L3/08—Means for preventing excessive speed of the vehicle
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L15/00—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles
- B60L15/20—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles for control of the vehicle or its driving motor to achieve a desired performance, e.g. speed, torque, programmed variation of speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L15/00—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles
- B60L15/20—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles for control of the vehicle or its driving motor to achieve a desired performance, e.g. speed, torque, programmed variation of speed
- B60L15/2009—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles for control of the vehicle or its driving motor to achieve a desired performance, e.g. speed, torque, programmed variation of speed for braking
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L3/00—Electric devices on electrically-propelled vehicles for safety purposes; Monitoring operating variables, e.g. speed, deceleration or energy consumption
- B60L3/0007—Measures or means for preventing or attenuating collisions
- B60L3/0015—Prevention of collisions
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L7/00—Electrodynamic brake systems for vehicles in general
- B60L7/10—Dynamic electric regenerative braking
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
- B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
- B60W30/09—Taking automatic action to avoid collision, e.g. braking and steering
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
- B60W30/14—Adaptive cruise control
- B60W30/143—Speed control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L2200/00—Type of vehicles
- B60L2200/34—Wheel chairs
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L2240/00—Control parameters of input or output; Target parameters
- B60L2240/10—Vehicle control parameters
- B60L2240/12—Speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L2240/00—Control parameters of input or output; Target parameters
- B60L2240/10—Vehicle control parameters
- B60L2240/14—Acceleration
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L2240/00—Control parameters of input or output; Target parameters
- B60L2240/40—Drive Train control parameters
- B60L2240/42—Drive Train control parameters related to electric machines
- B60L2240/421—Speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L2240/00—Control parameters of input or output; Target parameters
- B60L2240/80—Time limits
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L2260/00—Operating Modes
- B60L2260/20—Drive modes; Transition between modes
- B60L2260/32—Auto pilot mode
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/10—Longitudinal speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2554/00—Input parameters relating to objects
- B60W2554/40—Dynamic objects, e.g. animals, windblown objects
- B60W2554/404—Characteristics
- B60W2554/4041—Position
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/801—Lateral distance
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/804—Relative longitudinal speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2720/00—Output or target parameters relating to overall vehicle dynamics
- B60W2720/10—Longitudinal speed
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/64—Electric machine technologies in electromobility
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/72—Electric energy management in electromobility
Description
本発明の実施形態は、速度制御装置に関する。 Embodiments of the present invention relate to a speed control device.
従来、乗員に操作されることにより移動する移動体にかかる技術として、前方の移動体または後方の移動体との関係において自身の移動体の速度を決定する技術がある(例えば特許文献1、2、および3参照)。
2. Description of the Related Art Conventionally, as a technique related to a moving body that is moved by being operated by an occupant, there is a technique that determines the speed of the own moving body in relation to a moving body in front or a moving body in the rear (for example,
前方の障害物との衝突を避けるために、自身の移動体を停止することが望まれる場合がある。しかしながら、他の移動体が後方に存在する場合において自身の移動体を急停止させると、後方の移動体に後突されるリスクがある。 It may be desirable to stop its own moving body to avoid collisions with obstacles ahead. However, if another moving body is behind, and if its own moving body is suddenly stopped, there is a risk that the moving body in the rear may collide with it.
そこで、本発明の課題の一つは、後突のリスクを低減しつつ移動体を減速させることができる速度制御装置を提供することである。 Then, one of the subject of this invention is providing the speed control apparatus which can decelerate a mobile body, reducing the risk of a rear impact.
本発明の実施形態にかかる速度制御装置は、一例として、移動体の前方の第1対象物と移動体の後方の第2対象物とを、移動体に設けられた検知装置からの入力情報に基づいて検知する検知部と、検知部によって検知された第1対象物に衝突しないために移動体の減速を行う減速制御を、速度を評価する第1項とジャークを評価する第2項とを含み、第1項と第2項との重み付けの比が調整可能な評価関数に基づいて実行する減速制御部と、移動体から検知部によって検知された第2対象物までの距離が第1の距離である第1の場合、移動体から第1対象物までの距離が第1の場合における移動体から第1対象物までの距離と同一でありかつ移動体から第2対象物までの距離が第1の距離よりも長い第2の距離である第2の場合に比べて、第1項に対する第2項の重み付けが大きくなるように比を調整する、調整部と、を備えた。当該構成により、一例として、移動体から第2対象物までの距離が短い場合、移動体から第2対象物までの距離が長い場合に比べて、緩やかな制動によって移動体が減速されるので、第2対象物による後突のリスクを低減することが可能となる。 As an example, the speed control device according to the embodiment of the present invention uses the first object in front of the moving body and the second object in the back of the moving body as input information from the detection device provided in the moving body. And a deceleration control for decelerating the moving body so as not to collide with the first object detected by the detection unit, a first term for evaluating speed and a second term for evaluating jerk. Including the deceleration control unit that executes based on an evaluation function in which the weighting ratio of the first term and the second term is adjustable, and the distance from the moving body to the second object detected by the detection unit is the first In the first case of the distance, the distance from the moving body to the first object is the same as the distance from the moving body to the first object in the first case, and the distance from the moving body to the second object is An adjusting unit that adjusts the ratio so that the weighting of the second term with respect to the first term is larger than that in the second case where the second distance is longer than the first distance . With this configuration, as an example, when the distance from the moving body to the second target object is short, the moving body is decelerated by gentle braking, as compared with the case where the distance from the moving body to the second target object is long, It is possible to reduce the risk of a rear impact due to the second object.
また、本発明の実施形態にかかる速度制御装置は、一例として、移動体の前方の第1対象物と移動体の後方の第2対象物とを、移動体に設けられた検知装置からの入力情報に基づいて検知する検知部と、検知部によって検知された第1対象物に衝突しないために移動体の減速を行う減速制御を、速度を評価する第1項とジャークを評価する第2項とを含み、第1項と第2項との重み付けの比が調整可能な評価関数に基づいて実行する減速制御部と、検知部によって検知された第2対象物が移動体に近づく相対速度が第1の速度である第1の場合、第1対象物が移動体に近づく相対速度が第1の場合における第1対象物が移動体に近づく相対速度と同一でありかつ第2対象物が移動体に近づく相対速度が第1の速度よりも遅い第2の速度である第2の場合に比べて、第1項に対する第2項の重み付けが大きくなるように比を調整する、調整部と、を備えた。当該構成により、一例として、第2対象物が移動体に近づく速度が速い場合、第2対象物が移動体に近づく速度が遅い場合に比べて、緩やかな制動によって移動体が減速されるので、第2対象物による後突のリスクを低減することが可能となる。 The speed control equipment according to an embodiment of the present invention, as an example, of a moving body and the first object in front of the moving object and a second object of the rear, from the sensing device provided in the mobile The detection unit that detects based on the input information, the deceleration control that decelerates the moving body so as not to collide with the first object detected by the detection unit, the first item that evaluates the speed, and the second item that evaluates the jerk. And a relative speed at which the second object detected by the detection unit approaches the moving body, and a deceleration control unit that executes the weighting ratio of the first and second terms based on an adjustable evaluation function. Is a first speed, the relative speed at which the first object approaches the moving body is the same as the relative speed at which the first object approaches the moving body in the first case, and the second object is An adjusting unit that adjusts the ratio so that the weighting of the second term with respect to the first term is larger than in the second case where the relative speed approaching the moving body is the second speed that is slower than the first speed. Equipped with . With this configuration, as an example, when the speed at which the second object approaches the moving body is high, the moving object is decelerated by gentle braking as compared with the case where the speed at which the second object approaches the moving body is slow, It is possible to reduce the risk of a rear impact due to the second object.
また、本発明の実施形態にかかる速度制御装置は、一例として、移動体の前方の第1対象物と移動体の後方の第2対象物とを、移動体に設けられた検知装置からの入力情報に基づいて検知する検知部と、検知部によって検知された第1対象物に衝突しないために移動体の減速を行う減速制御を、速度を評価する第1項とジャークを評価する第2項とを含み、第1項と第2項との重み付けの比が調整可能な評価関数に基づいて実行する減速制御部と、調整部と、を備え、検知部は、第2対象物が移動体に注意を向けているか否かをさらに検知し、調整部は、第2対象物が移動体に注意を向けていない場合、第2対象物が移動体に注意を向けている場合に比べて、第1項に対する第2項の重み付けが大きくなるように比を調整する。当該構成により、一例として、第2対象物が移動体に注意を向けていない場合、第2対象物が移動体に注意を向けている場合に比べて、緩やかな制動によって移動体が減速されるので、第2対象物による後突のリスクを低減することが可能となる。 The speed control equipment according to an embodiment of the present invention, as an example, of a moving body and the first object in front of the moving object and a second object of the rear, from the sensing device provided in the mobile A detection unit that detects based on input information, a deceleration control that decelerates a moving object so as not to collide with the first object detected by the detection unit, a first item that evaluates speed, and a second item that evaluates jerk. A deceleration control unit that executes based on an evaluation function in which the weighting ratio of the first term and the second term is adjustable, and an adjustment unit, and the detection unit moves the second object. body further detects whether or not attention, tone-save, when the second object is not paying attention to the moving object, compared to the case where the second object is paying attention to the moving object Then, the ratio is adjusted so that the weighting of the second term with respect to the first term becomes large. With this configuration, as an example, when the second object is not paying attention to the moving body, the moving body is decelerated by gentle braking as compared with the case where the second object is paying attention to the moving body. Therefore, it is possible to reduce the risk of a rear-end collision due to the second object.
また、本発明の実施形態にかかる速度制御装置は、一例として、移動体の前方の第1対象物と移動体の後方の第2対象物とを、移動体に設けられた検知装置からの入力情報に基づいて検知する検知部と、検知部によって検知された第1対象物に衝突しないために移動体の減速を行う減速制御を、速度を評価する第1項とジャークを評価する第2項とを含み、第1項と第2項との重み付けの比が調整可能な評価関数に基づいて実行する減速制御部と、検知部によって検知された第2対象物に注意喚起を行うことができる注意喚起部と、注意喚起部によって第2対象物に注意喚起が行われない場合、注意喚起部によって第2対象物に注意喚起が行われる場合に比べて、第1項に対する第2項の重み付けが大きくなるように比を調整する、調整部と、を備えた。当該構成により、一例として、第2対象物に注意喚起を行わない場合、第2対象物に注意喚起を行う場合に比べて、緩やかな制動によって移動体が減速されるので、第2対象物による後突のリスクを低減することが可能となる。 In addition, the speed control device according to the embodiment of the present invention inputs , as an example, a first object in front of the moving body and a second object behind the moving body from a detection device provided in the moving body. A detection unit that detects based on the information, a deceleration control that decelerates the moving body so as not to collide with the first object detected by the detection unit, a first item that evaluates speed, and a second item that evaluates jerk. It is possible to call attention to the second target object detected by the deceleration control unit and the detection unit that includes, and that is executed based on the evaluation function in which the weighting ratio of the first term and the second term is adjustable. a reminder portion, if the alert to the second object by the alerting unit is not performed, as compared with the case where alerting the second object is performed by the attention drawing unit, the weighting of the second term to the first term And an adjusting unit that adjusts the ratio so as to be large. With this configuration, as an example, when the second object is not alerted, the moving body is decelerated by gentle braking as compared to when the second object is alerted. It is possible to reduce the risk of a rear impact.
<第1実施形態>
以下、本発明の第1実施形態にかかる速度制御装置を、図1および図2に示す車両1を例に挙げて説明する。図1は、第1実施形態の車両1の車室の一部が透視された状態の一例が示された斜視図である。図2は、第1実施形態の車両1の一例が示された平面図である。車両1は、乗員に操作されることにより移動する移動体の一例である。なお、本発明の各実施形態にかかる速度制御装置は、乗員に操作されることにより移動する任意の移動体に搭載することが可能である。車両1以外では、本発明の各実施形態にかかる速度制御装置は、例えば、電動車椅子またはパーソナルモビリティに搭載することが可能である。
<First Embodiment>
Hereinafter, the speed control device according to the first embodiment of the present invention will be described by taking the
本明細書においては説明の便宜上、図1における左上側および右下側をそれぞれ車両1の前方および後方とし、同じく右上側および左下側をそれぞれ車両1の右方および左方として説明する。図2においては、左側が車両1の前方に対応し、右側が車両1の後方に対応する。
In this specification, for convenience of description, the upper left side and the lower right side in FIG. 1 will be referred to as the front and the rear of the
車両1は、図1,図2に例示されるように、例えば、四輪自動車であり、左右二つの前輪7Fと、左右二つの後輪7Rとを有する。これら4つの車輪7は、いずれも転舵可能に構成されうる。また、4つの車輪7のいずれを駆動輪にするかは、種々に設定可能である。4つの車輪7のいずれかには、図1,図2には不図示の車輪速センサ9が設けられている。車輪速センサ9が検出した車輪速度は、図1,図2には不図示のECU(electronic control unit)10に送られる。車輪速センサ9による回転速度の検出値は、ECU10において、車両1の速度の検出値に変換される。
As illustrated in FIGS. 1 and 2, the
また、図1に例示されるように、車体2は、不図示の乗員が乗車する車室2aを構成している。車室2a内には、乗員としての運転者の座席2bに臨む状態で、操作装置3が設けられている。操作装置3は、乗員に操作されるものであって、乗員が車両1の進行方向の指示および車両1の速度の指示を入力するためのものである。操作装置3は、一例として、加速操作部3a、操舵部3b、変速操作部3c、および制動操作部3dを含む。加速操作部3aは、例えば、運転者の足下に位置されたアクセルペダルであり、操舵部3bは、例えば、ダッシュボード6から突出したステアリングホイールであり、変速操作部3cは、例えば、センターコンソールから突出したシフトレバーであり、制動操作部3dは、例えば、運転者の足下に位置されたブレーキペダルである。なお、加速操作部3a、操舵部3b、変速操作部3c、および制動操作部3dは、これらに限定されない。
In addition, as illustrated in FIG. 1, the
運転者が加速操作部3aの可動部を操作すると、加速操作部3aの可動部の変位量は不図示の変位センサによって検出され、検出された変位量はECU10に送られる。加速操作部3aの可動部の変位量は、ECU10によって運転者が所望する速度(以降、所望速度)に変換され、図1,図2には不図示の駆動装置8の制御に使用される。
When the driver operates the movable part of the
駆動装置8は、車両1に駆動力を与えたり車両1を減速したりするものであって、駆動源、変速機構、および制動機構を含む。駆動源は、例えば、内燃機関または電動機である。変速機構は、動力源が発生する動力を変換して車輪7に伝達する機構であり、例えば、連続可変トランスミッション(Continuously Variable Transmission、CVT)を含む。制動機構は、例えば、摩擦によって車輪速度を減速するブレーキ、または、運動エネルギーを電動機を用いて回収する回生ブレーキである。
The
運転者が操舵部3bを操作すると、操舵部3bの操作量は、不図示の舵角センサによって操舵情報として検出され、検出された操舵情報はECU10に送られる。ECU10による制御の元で、前輪7Fのタイヤ角が操舵情報に応じて転舵される。なお、後輪7Rが転舵されてもよい。
When the driver operates the
運転者が変速操作部3cを操作すると、変速操作部3cの可動部の位置は位置センサによって検出され、検出された位置はECU10に送られる。ECU10による制御の元で、駆動源から車輪7に伝達される動力を、変速操作部3cの可動部の位置に応じて変換する。
When the driver operates the gear
また、図1,図2に例示されるように、車体2には、前方検知装置4および後方検知装置5が設けられている。
Further, as illustrated in FIGS. 1 and 2, the
前方検知装置4は、車両1の前方に対象物がある場合に、その対象物の情報を被検知物情報として取得する。対象物は、車両1の走行の妨げとなり得るものであり、例えば、歩行者、自転車、自動車、静止物、転落場所、他の車両、などを含む。ここでは前方検知装置4は、一例として、4つのソナー4a〜4dによって構成され、4つのソナー4a〜4dは、車体2のフロントバンパー2cにおよそ等間隔に設置されている。ソナー4a〜4dは、ソナーセンサ、超音波探知器、または超音波ソナーとも称されうる。前方検知装置4は、車両1の前方を含む範囲に超音波を発射して、対象物からの反射波を受信することにより、前方検知装置4から対象物までの距離および対象物が存在する方角を被検知物情報として取得する。前方検知装置4は、例えば、第一所定時間毎に被検知物情報を取得する。前方検知装置4が取得した被検知物情報は、ECU10に送られる。
When there is an object in front of the
なお、前方検知装置4は、ソナー4a〜4d以外のセンサによって構成され得る。例えば、前方検知装置4は、3次元測域センサ(レーザーレンジスキャナー(3Dスキャナー))によって構成され得る。また、例えば、赤外光または可視光などを用いて周辺環境を撮像し、撮像された画像に基づいて対象物の情報を取得するカメラ、ミリ波レーダーまたはサブミリ波レーダーを用いて対象物の情報を取得するセンサ、車車間通信によって対象物の情報を取得する通信装置など、種々の装置によって前方検知装置4が構成され得る。また、上記の被検知物情報は、一例である。また、被検知物情報は上記以外の種類の情報によって構成され得る。第1実施形態では、被検知物情報から対象物の有無と対象物までの距離とが少なくとも導出可能であればよい。
The
後方検知装置5は、車両1の後方に対象物がある場合に、その対象物の情報を被検知物情報として取得する。前方検知装置4と同様に、後方検知装置5は、任意のセンサによって構成され得る。ここでは後方検知装置5は、一例として、4つのソナー5a〜5dによって構成され、4つのソナー5a〜5dは、リアバンパー2dにおよそ等間隔に設置されている。後方検知装置5は、後方検知装置5から対象物までの距離および対象物が存在する方角を被検知物情報として取得する。後方検知装置5は、例えば、第一所定時間毎に被検知物情報を取得する。後方検知装置5が取得した被検知物情報は、ECU10に出力される。
When there is an object behind the
なお、車両1が備える各種装置の構成または配置等は、一例であって、種々に設定(変更)することが可能である。
The configurations, arrangements, and the like of the various devices provided in the
図3は、第1実施形態のECU10のハードウェア構成例を示す図である。図示するように、ECU10は、演算装置11、記憶装置12、および入出力装置13を備えている。演算装置11、記憶装置12、および入出力装置13は、バス14を介して相互に接続されている。演算装置11は、コンピュータプログラムを実行するものであり、例えばCPU(Central Processing Unit)である。記憶装置12は、コンピュータプログラムを予め記憶するものである。演算装置11は、記憶装置12が記憶するコンピュータプログラムを実行することによって、後述する各機能構成部を実現する。記憶装置12は、例えば、ROM(Read Only Memory)、RAM(Random Access Memory)、フラッシュメモリ、HDD(Hard Disk Drive)、またはこれらの組み合わせによって構成され得る。入出力装置13は、ECU10が他の装置との間で情報の入出力を行うためのインタフェース装置である。入出力装置13は、操作装置3、前方検知装置4、後方検知装置5、駆動装置8、および車輪速センサ9に接続されている。
FIG. 3 is a diagram illustrating a hardware configuration example of the
図4は、第1実施形態のECU10の機能構成例を示す図である。ECU10は、機能構成部として、取得部15、駆動制御部16、および速度制限部17を備える。
FIG. 4 is a diagram showing a functional configuration example of the
なお、ECU10が備える各機能構成部(取得部15、駆動制御部16、速度制限部17)、および、速度制限部17を構成する各機能構成部(後述する)、のうちの一部または全部は、ハードウェア回路、または、ソフトウェア(コンピュータプログラム)とハードウェア回路との組み合わせによって実現され得る。
It should be noted that some or all of the functional components (the
取得部15は、操作装置3から出力された各種情報を取得するものである。取得部15は、特に、加速操作部3aの可動部の変位量を所望速度に変換する。また、取得部15は、操舵情報を取得する。取得部15は、所望速度および操舵情報を速度制限部17に入力する。取得部15は、所望速度にフィルタ、マップ、または関数を作用させるなどによって所望速度を加工してもよい。
The
速度制限部17は、車両1の前方に対象物が存在する場合に、車両1がその対象物に衝突しないように車両1を減速する制御(以降、減速制御)を実行するものである。車両1の前方に存在する、衝突防止対象の対象物を、前方対象物と表記する。
The speed limiter 17 executes control (hereinafter, deceleration control) for decelerating the
ここで、減速制御のアルゴリズムを説明する。 Here, a deceleration control algorithm will be described.
アルゴリズムは、速度を含む評価関数を最適化する最適化問題を解くことによって、減速制御のための車両1の目標速度(以降、制限速度)を求める。ここでは一例として、評価関数は、コストを示すものであり、アルゴリズムは、評価関数を最小化する速度を演算する。評価関数に含まれる速度は、実際には時刻の関数になっており、アルゴリズムは、最適化問題の解(最適解)として、評価区間における速度の時間変化を得る。以降、最適解として得られる速度の時間変化を、速度曲線と表記する。
The algorithm finds a target speed (hereinafter, speed limit) of the
アルゴリズムは、前方対象物が検知されて減速制御を開始する時点を初期時刻(t=0)とし、初期時刻から前方対象物に到達(衝突)するまでの時間である到達予測時間Tfを演算する。一例では、アルゴリズムは、t=0での車両1から前方対象物までの距離を、t=0での車両1の速度で除算することによって、Tfを演算する。アルゴリズムは、t=0からt=Tfまでの区間を評価区間に設定する。
The algorithm calculates the estimated arrival time Tf, which is the time from the initial time to the arrival (collision) of the front object, with the time point when the front object is detected and the deceleration control is started as the initial time (t=0). .. In one example, the algorithm computes Tf by dividing the distance from
評価関数は、速度を評価する項とジャークを評価する項と、を含み、かつ、速度を評価する項とジャークを評価する項との重み付けの比が調整可能に、少なくとも構成されている。 The evaluation function includes a term for evaluating speed and a term for evaluating jerk, and at least a weighting ratio of the term for evaluating speed and the term for evaluating jerk is adjustable.
一例では、評価関数は、下記の式(1)のように示されるものである。xは、速度vと加速度aとからなる状態変数であり、例えば下記の式(2)のように表記される。uはジャークである。
式(1)において、Qは、速度を評価する項の重み付け係数に該当し、Rは、ジャークを評価する項の重み付け係数に該当する。式(1)によれば、QおよびRの調整によって、速度を評価する項とジャークを評価する項との重み付けの比が調整可能である。なお、式(1)の例では、Qを含む項は、速度とともに加速度を評価する項であり、Qは、加速度を評価する項の重み付け係数としても機能する。評価関数は、加速度を評価する項を含んでいなくてもよい。また、評価関数は、加速度を評価する項を、速度を評価する項とは別の項として含んでいてもよい。また、評価関数は、加速度を評価する項を速度を評価する項とは別の項として含み、加速度を評価する項は、QおよびRと異なる重み付け係数によって重み付けがなされてもよい。また、評価関数は、速度、ジャーク、加速度の他の、任意のパラメータを評価する項を含んでいてもよい。 In Expression (1), Q corresponds to the weighting coefficient of the term for evaluating the speed, and R corresponds to the weighting coefficient of the term for evaluating the jerk. According to the equation (1), by adjusting Q and R, it is possible to adjust the weighting ratio of the term for evaluating the speed and the term for evaluating the jerk. In the example of Expression (1), the term including Q is a term that evaluates acceleration together with velocity, and Q also functions as a weighting coefficient for the term that evaluates acceleration. The evaluation function does not have to include a term for evaluating acceleration. Further, the evaluation function may include a term for evaluating acceleration as a term different from the term for evaluating velocity. Further, the evaluation function may include a term for evaluating acceleration as a term different from the term for evaluating velocity, and the term for evaluating acceleration may be weighted by a weighting coefficient different from Q and R. Further, the evaluation function may include a term for evaluating an arbitrary parameter other than velocity, jerk, acceleration.
アルゴリズムは、速度vの初期値をt=0の時点での車両1の速度v0とし、加速度aの初期値をt=0の時点での車両1の加速度a0とする初期条件と、速度vおよび加速度aの終端値(即ちt=Tfの時点での各値)を0とする終端条件と、下記の式(3)の状態方程式と、を最適化問題の拘束条件とする。
アルゴリズムは、上記の拘束条件を用いて式(1)の評価関数を最小とする最適化問題を解くことによって、t=Tfの時点で車両1が停止しているための速度曲線を得ることができる。上記の初期条件および終端条件は、車両1が前方対象物に衝突しない速度曲線を得るために設けられた拘束条件の一例である。拘束条件は、車両1が前方対象物に衝突しない速度曲線を得るためのものであればよく、拘束条件に対し、任意の条件の追加、削除、変更が可能である。
The algorithm can obtain the velocity curve for the
速度曲線の特性は、QとRとの比に応じて異なる。例えばQ:R=1:1の場合、図5に示す速度曲線が得られる。図6は、図5の速度曲線に対応する加速度の時間変化を示すグラフである。また、Q:R=10:1の場合、図7に示す速度曲線が得られる。図8は、図7の速度曲線に対応する加速度の時間変化を示すグラフである。図5〜図8に示されるように、Qに対するRの比が大きい場合、Qに対するRの比が小さい場合に比べ、加速度の時間変化が緩やかであり、緩やかな制動によって車両1を停止することができる。別の視点では、Qに対するRが小さい場合、Qに対するRが大きい場合に比べ、加速度の時間変化が急峻であり、車両1を急停止することができる。Rに対してQが大きければ大きいほど、より急激な制動が実現し、Qに対してRが大きければ大きいほど、より緩やかな制動が実現する。
The characteristics of the velocity curve differ depending on the ratio of Q and R. For example, when Q:R=1:1, the velocity curve shown in FIG. 5 is obtained. FIG. 6 is a graph showing the time change of the acceleration corresponding to the speed curve of FIG. When Q:R=10:1, the velocity curve shown in FIG. 7 is obtained. FIG. 8 is a graph showing the time change of the acceleration corresponding to the velocity curve of FIG. As shown in FIGS. 5 to 8, when the ratio of R to Q is large, the change in acceleration over time is gentler than when the ratio of R to Q is small, and the
第1実施形態では、アルゴリズムは、車両1から前方対象物までの距離(以降、前方距離)と、車両1から後方の対象物(以降、後方対象物)までの距離(以降、後方距離)と、に基づいてQとRとを演算する。
In the first embodiment, the algorithm uses a distance from the
具体的には、アルゴリズムは、他の条件(少なくとも前方距離)が同じである場合において、後方距離が短い場合、後方距離が長い場合に比べ、Qに対するRの比がより大きくなるように、QおよびRを演算する。後方対象物が例えば歩行者、自転車、自動車などのような別の移動体であって、後方対象物が車両1の近い位置を移動中である場合において、車両1が急停止すると、後方対象物は車両1の急停止に対応することができずに車両1に後突する可能性がある。第1実施形態では、後方距離が短い場合、アルゴリズムによって緩やかな制動が実現するので、後方対象物による後突のリスクを低減することができる。また、急激な制動が抑制されることによって、乗員が姿勢を崩すことを防止することができる。即ち、乗り心地が向上する。
Specifically, the algorithm is such that, under other conditions (at least the forward distance), the ratio of R to Q is larger when the backward distance is shorter than when the backward distance is long. And R are calculated. When the rear object is another moving body such as a pedestrian, a bicycle, an automobile, etc., and the rear object is moving near the
また、アルゴリズムは、他の条件(少なくとも後方距離)が同じである場合において、前方距離が短い場合、前方距離が長い場合に比べ、Qに対するRの比がより小さくなるように、QおよびRを調整する。これにより、急激な制動を実現し、その結果、車両1が前方対象物のより手前で停止することができる。即ち、前方対象物への衝突のリスクをより低減することができる。
The algorithm also sets Q and R such that the ratio of R to Q is smaller when the front distance is shorter than when the front distance is long, under the same conditions (at least the rear distance). adjust. As a result, rapid braking is realized, and as a result, the
一例では、アルゴリズムは、下記の式(4)および式(5)を用いてQおよびRを演算する。ただし、Dfrontは前方距離であり、Dbackは後方距離である。DfrontおよびDbackはそれぞれ正の実数としている。
なお、式(4)および式(5)は、前方距離と後方距離とに基づくQとRの演算方法の一例であり、QとRの演算方法はこれに限定されない。アルゴリズムは、後方距離のみに基づいてQとRとを演算してもよい。また、アルゴリズムは、Qを例えば1に固定し、Rのみを調整してもよい。また、アルゴリズムは、Rを例えば1に固定し、Qのみを調整してもよい。 Equations (4) and (5) are examples of the method of calculating Q and R based on the front distance and the rear distance, and the method of calculating Q and R is not limited to this. The algorithm may compute Q and R based only on the backward distance. Further, the algorithm may fix Q to 1 and adjust only R, for example. Further, the algorithm may fix R to 1, for example, and adjust only Q.
なお、ある時点において得られた解に従って時刻がTfに至るまで速度制御された場合、時刻がTfに至るまでに発生する外乱に対応できない。そこで、アルゴリズムは、所定の制御周期で(例えば第一所定時間毎に)最適解の更新を行い、各更新時点を常に初期時刻として減速制御を行う。アルゴリズムは、最適解の更新の際には、Tf、Q、R、拘束条件などをその都度更新し、更新された各情報を用いて最適化問題を解く。アルゴリズムは、速度曲線を刻々と更新し、最新の速度曲線が示す速度を制限速度とする。これにより、状況(第1実施形態では例えば前方距離または後方距離)が刻々と変化する場合においても、変化した状況に応じてTf、Q、R、拘束条件が更新され、それに応じて、得られる速度曲線も更新されるので、ロバストな減速制御が実現する。 When the speed is controlled until the time reaches Tf according to the solution obtained at a certain time, it is impossible to deal with the disturbance that occurs until the time reaches Tf. Therefore, the algorithm updates the optimum solution in a predetermined control cycle (for example, every first predetermined time), and performs deceleration control with each update time always as the initial time. When updating the optimum solution, the algorithm updates Tf, Q, R, constraint conditions, etc. each time, and solves the optimization problem using each updated information. The algorithm updates the speed curve every moment, and sets the speed indicated by the latest speed curve as the speed limit. As a result, even when the situation (for example, the front distance or the rear distance in the first embodiment) changes momentarily, Tf, Q, R, and the constraint condition are updated according to the changed situation, and are obtained accordingly. Since the speed curve is also updated, robust deceleration control is realized.
なお、所望速度と制限速度とで、向き情報が同じであってもよいし、異なっていてもよい。ここでは、アルゴリズムは、制限速度の大きさを演算し、制限速度の向き情報は所望速度から変更しないこととする。 The direction information may be the same or different between the desired speed and the speed limit. Here, the algorithm calculates the magnitude of the speed limit, and the direction information of the speed limit is not changed from the desired speed.
図4に説明を戻す。速度制限部17は、進路予測部171、検知部172、制御切り替え部173、および減速制御部174を備える。
Returning to FIG. The speed limiting unit 17 includes a
ここでは一例として、速度制限部17は、車両1の前方の対象物のうちの車両1の進路上の対象物に衝突しないように車両1を減速させる、として説明する。即ち、速度制限部17は、車両1の前方の対象物のうちの車両1の進路上の対象物を、前方対象物として特定する。また、速度制限部17は、車両1から前方対象物までの進路上の距離を、前方距離とする。
Here, as an example, the speed limiting unit 17 will be described as decelerating the
進路予測部171は、進路を予測するものである。進路予測部171は、取得部15によって取得された所望速度および操舵情報に基づいて、車両1の進路(予測進路)を演算する。例えば、進路予測部171は、所望速度および操舵情報から、実験またはシミュレーションなどにより予め導出された関数に基づいて、進路を演算する。なお、進路の予測方法はこれに限定されない。例えば、進路予測部171は、単に、前方真正面に直線軌跡を設定し、その直線軌跡を進路としてもよい。進路予測部171は、所望速度以外の情報に基づいて車両1の進路を演算してもよい。
The
検知部172は、前方検知装置4からの入力情報に基づいて進路上の対象物(即ち前方対象物)を検知したり、後方検知装置5からの入力情報に基づいて後方対象物を検知したりするものである。例えば、検知部172は、進路予測部171によって予測された進路と、前方検知装置4からの被検知物情報とを重ね合わせ、進路上に対象物があるか否かを判断する。進路上に対象物があると判断した場合、検知部172は、その対象物を前方対象物として検知(特定)する。また、検知部172は、後方に対象物があるか否かを後方検知装置5からの被検知物情報に基づいて判断する。後方に対象物があると判断した場合、検知部172は、その対象物を後方対象物として検知(特定)する。
The detection unit 172 detects an object on the path (that is, a front object) based on input information from the
なお、前方対象物の特定方法は、上記の方法だけに限定されない。例えば、速度制限部17が、例えば検知範囲内の最も近い対象物を前方対象物として特定するなど、進路に基づかない方法で前方対象物を特定してもよい。その場合には、進路予測部171は省略可能である。なお、前方対象物が検知される距離範囲、角度範囲は、任意に設定可能である。
The method of identifying the front object is not limited to the above method. For example, the speed limiter 17 may specify the front target object by a method that is not based on the route, such as specifying the closest target object within the detection range as the front target object. In that case, the
また、後方対象物の特定方法は、上記の方法だけに限定されない。例えば、検知部172は、後方の所定の角度範囲内に存在する対象物を、後方対象物として特定する。後方対象物が検知される距離範囲、角度範囲は、任意に設定可能である。 Further, the method of identifying the rear target object is not limited to the above method. For example, the detection unit 172 identifies a target object existing within a predetermined rear angle range as a rear target object. The distance range and the angle range in which the rear object is detected can be set arbitrarily.
制御切り替え部173は、少なくとも、所望速度に従って車両1を制御する通常制御と、上述したアルゴリズムに基づく減速制御と、の間で制御の切り替えを行うものである。ここでは、制御切り替え部173は、通常制御と、減速制御と、緊急停止制御と、の間で制御の切り替えを行うこととする。緊急停止制御は、最大の制動能力を用いて車両1を停止する制御である。切り替えのための判断基準は、特定の基準に限定されない。
The
ここでは、制御切り替え部173は、検知部172によって前方対象物が検知されていない場合、通常制御を選択する。即ち、速度制限部17は、取得部15から取得された所望速度を、そのまま駆動制御部16に入力する。
Here, the
検知部172によって前方対象物が検知された場合、制御切り替え部173は、減速制御と緊急停止制御とのうちのいずれの制御を行うかを判断する。具体的には、制御切り替え部173は、まず、前方距離を演算する。そして、制御切り替え部173は、前方距離と制動限界距離とを比較する。制動限界距離は、最大の制動能力を用いて車両1を停止する場合に必要とされる距離である。制動限界距離は、固定値として予め設定されてもよいし、速度などに応じて可変に構成されてもよい。前方距離が制動限界距離より長い場合、制御切り替え部173は、減速制御を選択する。即ち、制御切り替え部173は、減速制御部174に減速制御を実行させる。
When the detection unit 172 detects a front object, the
前方距離が制動限界距離より短い場合、制御切り替え部173は、緊急停止制御を選択する。具体的には、制御切り替え部173は、停止指示を駆動制御部16に出力する。停止指示は、最大の制動能力を用いて車両1を停止する指示である。
When the front distance is shorter than the braking limit distance, the
なお、緊急停止制御は、選択肢に含まれていなくてもよい。また、より単純に、制御切り替え部173は、制動限界距離よりも大きい判定しきい値が設定され、前方距離が判定しきい値よりも大きい場合に通常制御を選択し、前方距離が判定しきい値よりも小さい場合に減速制御を選択してもよい。判定しきい値は、固定値として予め設定されてもよいし、速度などに応じて可変に構成されてもよい。このように、通常制御から減速制御に切り替えるための条件は、任意に設定され得る。
Note that the emergency stop control may not be included in the options. Further, more simply, the
減速制御部174は、上述したアルゴリズムに従って減速制御を行うものである。減速制御部174は、速度を評価する項とジャークを評価する項と、を含み、かつ、速度を評価する項とジャークを評価する項との重み付けの比が調整可能な評価関数(ここでは一例として式(1)の評価関数)に基づいて、減速制御を行う。減速制御部174は、車輪速センサ9からの入力情報に基づいて、初期条件に設定される速度v0および加速度a0を取得する。減速制御部174は、速度を評価する項とジャークを評価する項との重み付けの比を調整する調整部175を備えている。ここでは、調整部175は、前方距離および後方距離を演算し、演算によって得られた各距離を式(4)および式(5)に適用することによって、速度を評価する項の重み付け係数Qとジャークを評価する項の重み付け係数であるRをそれぞれ演算する。減速制御部174は、調整部175によって演算されたQおよびRを評価関数に適用し、その評価関数を用いて制限速度を演算する。減速制御部174は、制限速度を逐次演算し、演算された制限速度を順次、駆動制御部16に出力する。
The deceleration control unit 174 performs deceleration control according to the algorithm described above. The deceleration control unit 174 includes an evaluation function that includes a term that evaluates speed and a term that evaluates jerk, and has an adjustable weighting ratio between the term that evaluates speed and the term that evaluates jerk (an example here). Then, the deceleration control is performed based on the evaluation function of Expression (1). The deceleration control unit 174 acquires the speed v0 and the acceleration a0 set in the initial condition based on the input information from the
なお、評価関数の最適化のための計算機的な手法としては任意の手法が採用可能である。評価関数の最適化のための計算機的な手法として、数値解析など既存の手法が採用可能であるし、今後開発される任意の手法が採用可能である。また、減速制御部174は、必ずしも「最適な」解を演算しなくてもよい。減速制御部174は、評価関数ができるだけ小さくなるような速度曲線を演算するように構成されてもよい。評価関数をどの程度小さくするかは、例えば、計算にかかる時間などを考慮して決められる。 An arbitrary method can be adopted as a computer-based method for optimizing the evaluation function. As a computer-based method for optimizing the evaluation function, an existing method such as numerical analysis can be adopted, or any method developed in the future can be adopted. Further, the deceleration control unit 174 does not necessarily have to calculate the “optimal” solution. The deceleration control unit 174 may be configured to calculate a velocity curve such that the evaluation function is as small as possible. How small the evaluation function is can be determined, for example, in consideration of the time required for calculation.
駆動制御部16は、入力された速度(所望速度または制限速度)に基づいて駆動装置8を駆動するための制御指令を演算するものである。駆動制御部16は、車両1が入力された速度で移動するように、制御指令を演算する。一例では、駆動制御部16は、車輪7の目標回転速度の大きさが、入力された速度の大きさに比例するように、制御指令を演算する。入力される速度と、制御指令との関係は、予め実験などにより実測されて導出されている。制御指令は、駆動源の駆動力を調整するものであってよいし、変速機構を制御するものであってもよいし、制動機構を制御するものであってもよいし、それらの組み合わせであってもよい。
The drive control unit 16 calculates a control command for driving the
また、駆動制御部16は、停止指示が入力されると、各車輪7を最大の制動能力で停止させるための制御指令を演算する。
Further, when the stop instruction is input, the drive control unit 16 calculates a control command for stopping each
なお、駆動制御部16は、補償制御を行ってもよいし、補償制御を行わなくてもよい。例えば、駆動制御部16は、車輪速センサ9の検出値に基づいて車両1の速度の検出値を演算し、演算された車両1の速度の検出値を制御指令の演算にフィードバックする。
The drive control unit 16 may perform the compensation control or may not perform the compensation control. For example, the drive control unit 16 calculates the detected value of the speed of the
続いて、第1実施形態の速度制御を説明する。図9は、第1実施形態の速度制御の手順の一例を示すフローチャートである。図9の処理は、所定の制御周期で(例えば第一所定時間毎に)実行される。即ち、S1からS7、S8、またはS9に至る一連の処理は、所定の制御周期でループせしめられる。 Next, the speed control of the first embodiment will be described. FIG. 9 is a flowchart showing an example of the speed control procedure of the first embodiment. The process of FIG. 9 is executed at a predetermined control cycle (for example, every first predetermined time). That is, a series of processing from S1 to S7, S8, or S9 is looped at a predetermined control cycle.
まず、進路予測部171は、取得部15から所望速度および操舵情報を受け付けて、受け付けた所望速度に基づいて進路を予測する(S1)。続いて、検知部172は、前方検知装置4および後方検知装置5から被検知物情報を受け付けて、進路予測部171によって予測された進路を受け付けて、受け付けた各情報に基づき、前方対象物および後方対象物の検知を行う(S2)。
First, the
制御切り替え部173は、検知部172によって前方対象物が検知されたか否かを判断する(S3)。検知部172によって前方対象物が検知されたと判断した場合(S3:Yes)、即ち前方対象物が存在する場合、制御切り替え部173は、前方距離を演算し、前方距離が制動限界距離よりも大きいか否かを判断する(S4)。例えば、制御切り替え部173は、進路予測部171によって予測された進路と、前方検知装置4からの被検知物情報とに基づいて前方距離を演算する。
The
制御切り替え部173によって前方距離が制動限界距離よりも大きいと判断された場合(S4:Yes)、減速制御部174は、制限速度を演算する(S5)。
When the
図10は、第1実施形態の制限速度の演算手順の一例を示すフローチャートである。 FIG. 10 is a flowchart showing an example of a speed limit calculation procedure of the first embodiment.
図10において、まず、調整部175は、前方距離および後方距離を取得する(S101)。調整部175は、取得した各距離を式(4)および式(5)に適用することによってQおよびRを演算し、演算されたQおよびRを式(1)の評価関数に設定する(S102)。 In FIG. 10, first, the adjustment unit 175 acquires the front distance and the rear distance (S101). The adjusting unit 175 calculates Q and R by applying the obtained distances to the equations (4) and (5), and sets the calculated Q and R in the evaluation function of the equation (1) (S102). ).
なお、後方対象物がなく、検知部172によって後方対象物を検知できなかった場合、一例では、調整部175は、S102の処理において、所定の大きな値を後方距離として使用する。所定の大きな値とは、例えば、後方検知装置5によって被検知物を検出できる最大距離である。
In addition, when there is no rear target object and the rear target object cannot be detected by the detection unit 172, in one example, the adjustment unit 175 uses a predetermined large value as the rear distance in the process of S102. The predetermined large value is, for example, the maximum distance at which the
減速制御部174は、現在の速度v0を取得する(S103)。例えば、減速制御部174は、車輪速センサ9による検出値を取得し、取得した各検出値から、車両1の速度を演算する。そして、減速制御部174は、演算された車両1の速度を現在の速度v0とする。減速制御部174は、前方距離および現在の速度v0に基づいて、到達予測時間Tfを演算する(S104)。減速制御部174は、現在の加速度a0を演算する(S105)。一例では、減速制御部174は、前回の制御周期にて取得した速度v0を記憶し、当該記憶している速度v0と今回の制御周期にて取得した速度v0とに基づいて現在の加速度a0を演算する。
The deceleration control unit 174 acquires the current speed v0 (S103). For example, the deceleration control unit 174 acquires the detection value of the
減速制御部174は、現在時刻を初期時刻(t=0)に設定し(S106)、t=0において速度v=v0、加速度a=a0とする初期条件を設定する(S107)。また、減速制御部174は、t=Tfにおいて速度v=0、加速度a=0とする終端条件を設定する(S108)。そして、減速制御部174は、初期条件、終端条件、および式(3)の状態方程式を拘束条件として式(1)の評価関数をt=0〜Tfの評価区間で最小化する速度曲線を演算する(S109)。減速制御部174は、演算された最新の速度曲線に基づいて制限速度を演算し(S110)、処理がリターンされる。 The deceleration control unit 174 sets the current time to the initial time (t=0) (S106), and sets the initial condition that the velocity v=v0 and the acceleration a=a0 at t=0 (S107). Further, the deceleration control unit 174 sets the termination condition that the velocity v=0 and the acceleration a=0 at t=Tf (S108). Then, the deceleration control unit 174 calculates a speed curve that minimizes the evaluation function of Expression (1) in the evaluation section of t=0 to Tf, using the initial condition, the end condition, and the state equation of Expression (3) as constraint conditions. (S109). The deceleration control unit 174 calculates the speed limit based on the calculated latest speed curve (S110), and the process is returned.
図9に説明を戻す。S5の処理によって制限速度が演算されると、制御切り替え部173は、所望速度は制限速度より大きいか否かを判断する(S6)。制御切り替え部173は、所望速度が制限速度より大きいと判断した場合(S6:Yes)、制限速度を駆動制御部16に出力し(S7)、現在の制御周期が終了する。即ち、次の制御周期で処理がS1に戻る。
Returning to FIG. When the speed limit is calculated in the process of S5, the
制御切り替え部173は、S3の処理において、検知部172によって前方対象物が検知されていないと判断された場合(S3:No)、または、S6の処理において、所望速度が制限速度より大きくないと判断した場合(S6:No)、所望速度を駆動制御部16に出力し(S8)、現在の制御周期が終了する。
In the process of S3, the
また、S4の処理において、制御切り替え部173は、前方距離が制動限界距離よりも大きくないと判断した場合(S4:No)、停止指示を駆動制御部16に出力し(S9)、現在の制御周期が終了する。
In the process of S4, when the
以上述べたように、第1実施形態によれば、ECU10は、速度を評価する項とジャークを評価する項と、を含み、かつ、速度を評価する項とジャークを評価する項との重み付けの比が調整可能な評価関数に基づいて減速制御を実行する。ECU10は、後方対象物との間の距離が短い場合、後方対象物との間の距離が長い場合に比べ、速度を評価する項に対するジャークを評価する項の重み付けが大きくなるように、速度を評価する項とジャークを評価する項との重み付けの比を調整する。これにより、後方対象物との間の距離が短い場合、緩やかな制動が実現し、その結果、後方対象物が歩行者、自転車、自動車などのような移動体であったとしても、後方対象物による後突のリスクを低減することができる。また、急激な制動が抑制されることによって、乗員が姿勢を崩すことを防止することができる。即ち、乗り心地が向上する。
As described above, according to the first embodiment, the
なお、実施形態では、取得部15および速度制限部17が扱う速度(所望速度、制限速度、速度曲線など)は、車両1の速度であるとして説明した。取得部15および速度制限部17が扱う速度は、車両1の速度に対応するものであれば、必ずしも車両1の速度でなくてもよい。取得部15および速度制限部17が扱う速度は、任意の単位で表現され得るし、車両1の速度に変換可能な任意の量で表現され得る。一例では、取得部15および速度制限部17が扱う速度は、車両1の速度と比例関係がある任意の量で表現され得る。
In the embodiment, the speeds (the desired speed, the speed limit, the speed curve, etc.) handled by the
また、実施形態では、通常制御においては、駆動制御部16に所望速度が入力される、として説明した。通常制御における制御指令は、所望速度以外の量に基づいて演算され得る。例えば、通常制御においては、加速操作部3aの可動部の変位量が駆動制御部16に入力され、駆動制御部16は、入力された変位量に応じたトルクが駆動輪に伝達されるように制御指令を演算してもよい。
Further, in the embodiment, the description has been made assuming that in the normal control, the desired speed is input to the drive control unit 16. The control command in the normal control can be calculated based on an amount other than the desired speed. For example, in the normal control, the displacement amount of the movable portion of the
<第2実施形態>
第2実施形態の速度制御装置が適用されたECU10においては、制限速度の演算において、調整部175によるQおよびRの調整方法が第1実施形態と異なる。第1実施形態と共通する構成および手順については、説明を省略する。
<Second Embodiment>
In the
第2実施形態によれば、調整部175は、前方対象物の車両1に対する相対速度(以降、前方相対速度)と、後方対象物の車両1に対する相対速度(以降、後方相対速度)と、に基づいて、QとRとの比を調整する。ここでは、各相対速度に関し、車両1に近づく方向を正の方向とする。即ち、前方相対速度は、前方対象物が車両1に近づく相対速度である。また、後方相対速度は、後方対象物が車両1に近づく相対速度である。
According to the second embodiment, the adjusting unit 175 calculates the relative speed of the front target object with respect to the vehicle 1 (hereinafter, front relative speed) and the relative speed of the rear target object with respect to the vehicle 1 (hereinafter, rear relative speed). Based on this, the ratio of Q and R is adjusted. Here, for each relative speed, the direction approaching the
具体的には、調整部175は、他の条件(少なくとも前方相対速度)が同じである場合において、後方相対速度が速い場合、後方相対速度が遅い場合に比べて、Qに対するRの比がより大きくなるように、QおよびRを演算する。これにより、後方対象物が速い速度で車両1に接近する場合、緩やかな制動によって車両1が減速されるので、後方対象物による後突のリスクを低減することができる。また、急激な制動が抑制されることによって、乗員が姿勢を崩すことを防止することができる。即ち、乗り心地が向上する。
Specifically, when the other conditions (at least the front relative speed) are the same, the adjusting unit 175 has a higher ratio of R to Q when the rear relative speed is higher than when the rear relative speed is low. Q and R are calculated so as to be large. Accordingly, when the rear target object approaches the
また、調整部175は、他の条件(少なくとも後方相対速度)が同じである場合において、前方相対速度が速い場合、前方相対速度が遅い場合に比べて、Qに対するRの比がより小さくなるように、QおよびRを演算する。これにより、前方対象物が速い速度で車両1に接近する場合、急激な制動によって車両1が減速されるので、車両1が前方対象物に衝突するリスクをより低減することができる。
In addition, when the other conditions (at least the rear relative speed) are the same, the adjusting unit 175 sets the ratio of R to Q to be smaller when the front relative speed is higher than when the front relative speed is low. Then, Q and R are calculated. As a result, when the front object approaches the
一例では、調整部175は、下記の式(6)および式(7)を用いてQおよびRを演算する。ただし、Vfrontは前方相対速度であり、Vbackは後方相対速度である。ただし、VfrontおよびVbackは正の実数とする。
なお、式(6)および式(7)は、前方相対速度と後方相対速度とに基づくQとRの演算方法の一例であり、QとRの演算方法はこれに限定されない。アルゴリズムは、後方相対速度のみに基づいてQとRとを演算してもよい。 The expressions (6) and (7) are an example of the calculation method of Q and R based on the front relative speed and the rear relative speed, and the calculation method of Q and R is not limited to this. The algorithm may calculate Q and R based only on the backward relative velocity.
図11は、第2実施形態の制限速度の演算手順の一例を示すフローチャートである。 FIG. 11 is a flowchart showing an example of a speed limit calculation procedure of the second embodiment.
図11において、まず、調整部175は、前方相対速度および後方相対速度を取得する(S201)。調整部175は、例えば、前方距離および後方距離を制御周期毎に取得し、前回の制御周期にて取得した前方距離および後方距離を記憶する。また、調整部175は、現在の速度(現在の車両1の速度)を取得する。そして、調整部175は、記憶している前回の制御周期の前方距離および後方距離と今回の制御周期にて取得した前方距離および後方距離と取得した現在の速度から、前方相対速度および後方相対速度を演算する。なお、各相対速度の取得方法は、これに限定されない。 In FIG. 11, first, the adjusting unit 175 acquires the front relative speed and the rear relative speed (S201). The adjusting unit 175 acquires, for example, the front distance and the rear distance for each control cycle, and stores the front distance and the rear distance acquired in the previous control cycle. Further, the adjusting unit 175 acquires the current speed (current speed of the vehicle 1). Then, the adjusting unit 175 determines the front relative speed and the rear relative speed from the stored front distance and rear distance of the previous control cycle, the front distance and rear distance acquired in the current control cycle, and the acquired current speed. Is calculated. The method of acquiring each relative velocity is not limited to this.
続いて、調整部175は、取得した各相対速度を式(6)および式(7)に適用することによってQおよびRを演算し、演算されたQおよびRを式(1)の評価関数に設定する(S202)。 Subsequently, the adjusting unit 175 calculates Q and R by applying the obtained relative velocities to the equations (6) and (7), and uses the calculated Q and R as the evaluation function of the equation (1). It is set (S202).
なお、後方対象物がなく、検知部172によって後方対象物が検知されなかった場合、一例では、調整部175は、S202の処理において、例えば所定の小さな値を後方距離として使用する。 In addition, when there is no rear target object and the rear target object is not detected by the detection unit 172, in one example, the adjustment unit 175 uses a predetermined small value as the rear distance in the process of S202.
その後、S203〜S210において、S103〜S110とそれぞれ同じ処理が実行され、処理がリターンされる。 Then, in S203 to S210, the same processes as S103 to S110 are executed, and the process is returned.
このように、第2実施形態によれば、ECU10は、後方対象物が車両1に近づく相対速度が速い場合、後方対象物が車両1に近づく相対速度が遅い場合に比べて、速度を評価する項に対するジャークを評価する項の重み付けが大きくなるように、速度を評価する項とジャークを評価する項との重み付けの比を調整する。これにより、後方対象物が車両1に近づく相対速度が速い場合、後方対象物が車両1に近づく相対速度が遅い場合に比べて、緩やかな制動によって移動体が減速されるので、後方対象物による後突のリスクを低減することが可能となる。さらに、急激な制動が抑制されることによって、乗員が姿勢を崩すことを防止することができる。即ち、乗り心地が向上する。
As described above, according to the second embodiment, the
<第3実施形態>
第3実施形態の速度制御装置が適用されたECU10においては、主に、検知部172の処理と、調整部175によるQおよびRの調整方法とが、第1実施形態と異なる。第1実施形態と共通する構成および手順については、説明を省略する。
<Third Embodiment>
In the
第3実施形態においては、検知部172は、後方対象物が車両1に注意を払っているか否かを検知する。後方対象物は例えば人であり、より具体的には、歩行者、自転車を操縦している人、または自動車を操縦している人である。
In the third embodiment, the detection unit 172 detects whether the rear target object is paying attention to the
後方対象物が車両1に注意を払っているか否かの判断基準は、特定の基準に限定されない。一例では、後方検知装置5は、例えば赤外光または可視光などを用いて後方を撮像するカメラを含み、当該カメラは、撮像した画像をECU10に入力する。検知部172は、撮像された画像に人が写っている場合には、画像解析により、その人が車両1に注意を払っているか否かを判断する。例えば、検知部172は、撮像された画像から人の顔を特定し、特定された顔が車両1の方を向いているか否かを判断する。検知部172は、顔が車両1の方を向いていると判断した場合には、後方対象物が車両1に注意を払っていると判断する。検知部172は、顔が車両1の方を向いていないと判断した場合には、後方対象物が車両1に注意を払っていないと判断する。
The criterion for determining whether or not the rear target object is paying attention to the
別の例では、検知部172は、後方距離または後方相対速度に基づいて後方対象物が車両1に注意を払っているか否かを判断する。例えば後方対象物が速い相対速度で車両1に接近し、後方距離が所定距離を下回っても後方対象物が速度を落とさない場合に、検知部172は、後方対象物が車両1に注意を払っていないと判断する。
In another example, the detection unit 172 determines whether the rear target object is paying attention to the
別の例では、検知部172は、後方対象物の減速度に基づいて後方対象物が車両1に注意を払っているか否かを判断する。後方対象物が車両1に注意を払っている場合、車両1が減速制御により減速すると、後方対象物は車両1の減速に気づき、速度を落とすと考えられる。一方、後方対象物が車両1に注意を払っていない場合、車両1が減速制御により減速しても、後方対象物は車両1の減速に気づかないので、速度を落とさないと考えられる。検知部172は、このような関係に基づいて、後方対象物が車両1に注意を払っているか否かを判断する。例えば、検知部172は、下記の式(8)が満たされているか否かを判定する。ただし、DECは車両1の減速度であり、DECbackは車両1の後方対象物に対する相対的な減速度である。DECbackは、例えば、後方相対速度の変化に基づいて演算される。Absは、絶対値を演算する演算子である。daは、判断のためのしきい値であり、正の実数である。daは、予め検知部172に設定されてもよいし、動的に変更可能であってもよい。
式(8)の左辺のかっこ内は、後方対象物の減速度を示している。式(8)が満たされている場合には、検知部172は、後方対象物は車両1に気づいて減速している、即ち、後方対象物は車両1に注意を払っている、と判断する。式(8)が満たされていない場合には、検知部172は、後方対象物は車両1に気づいていないのであまり減速していない、即ち、後方対象物は車両1に注意を払っていない、と判断する。
The inside of the parenthesis on the left side of Expression (8) indicates the deceleration of the rear target. When Expression (8) is satisfied, the detection unit 172 determines that the rear target object is aware of the
調整部175は、検知部172によって後方対象物が車両1に注意を払っていないと判断された場合、検知部172によって後方対象物が車両1に注意を払っていると判定した場合に比べ、Qに対するRの比がより大きくなるように、QおよびRを演算する。
When the detection unit 172 determines that the rear target object is not paying attention to the
図12は、第3実施形態の制限速度の演算手順の一例を示すフローチャートである。ここでは、該当の制御周期において、検知部172によって後方対象物が車両1に注意を払っているか否かがすでに判断されたものとする。
FIG. 12 is a flowchart showing an example of a speed limit calculation procedure according to the third embodiment. Here, it is assumed that the detection unit 172 has already determined whether or not the rear target object is paying attention to the
まず、調整部175は、検知部172による検知結果から、後方対象物は車両1に注意を払っているか否かを判断する(S301)。後方対象物は車両1に注意を払っていると判断した場合(S301:Yes)、調整部175は、QおよびRをそれぞれ決定し、決定されたQおよびRを式(1)の評価関数に設定する(S302)。S302では、調整部175は、例えば、Qに対するRの比が、予め設定された比Rate1に等しくなるように、QとRとを決定する。ただし、Rate1は、後述のRate2よりも小さい。調整部175は、後方対象物が車両1に注意を払っている場合に設定するためのQおよびRの値を予め記憶しておいてもよい。例えば、調整部175は、Qとして0.9を、Rとして0.1を設定する。
First, the adjustment unit 175 determines whether or not the rear target object is paying attention to the
後方対象物は車両1に注意を払っていないと判断した場合(S301:No)、調整部175は、QおよびRをそれぞれ決定し、決定されたQおよびRを式(1)の評価関数に設定する(S303)。S303では、調整部175は、例えば、Qに対するRの比が予め設定された比Rate2に等しくなるように、QとRとを決定する。調整部175は、後方対象物が車両1に注意を払っていない場合に設定するためのQとRの値を予め記憶しておいてもよい。例えば、調整部175は、Qとして0.1を、Rとして0.9を設定する。
When it is determined that the rear object is not paying attention to the vehicle 1 (S301: No), the adjusting unit 175 determines Q and R, respectively, and determines the determined Q and R as the evaluation function of the equation (1). Set (S303). In S303, the adjustment unit 175 determines Q and R so that the ratio of R to Q becomes equal to the preset ratio Rate2, for example. The adjustment unit 175 may store in advance the values of Q and R to be set when the rear target is not paying attention to the
S302またはS303の処理の後、S304〜S311において、S103〜S110とそれぞれ同じ処理が実行され、処理がリターンされる。 After the processing of S302 or S303, the same processing as S103 to S110 is executed in S304 to S311, and the processing is returned.
このように、第3実施形態によれば、ECU10は、後方対象物が車両1に注意を向けていない場合、後方対象物が車両1に注意を向けている場合に比べて、速度を評価する項に対するジャークを評価する項の重み付けが大きくなるように、速度を評価する項とジャークを評価する項との重み付けの比を調整する。これにより、後方対象物が車両1に注意を向けていない場合、後方対象物が車両1に注意を向けている場合に比べて、緩やかな制動によって車両1が減速されるので、後方対象物による後突のリスクを低減することが可能となる。さらに、急激な制動が抑制されることによって、乗員が姿勢を崩すことを防止することができる。即ち、乗り心地が向上する。
As described above, according to the third embodiment, the
<第4実施形態>
第4実施形態の速度制御装置が適用されたECU10においては、主に、後方対象物に注意喚起を行うことが可能な構成を有することと、調整部175によるQおよびRの調整方法とが、第1実施形態と異なる。第1実施形態と共通する構成および手順については、説明を省略する。
<Fourth Embodiment>
In the
図13は、第4実施形態のECU10の機能構成例を示す図である。第4実施形態によれば、ECU10は、音声出力装置20に接続されている。
FIG. 13 is a diagram showing a functional configuration example of the
音声出力装置20は、例えばスピーカであり、音声を出力することができる。音声出力装置20は、例えば、車体2の後ろ側に設けられている。
The
ECU10は、取得部15、駆動制御部16、および速度制限部17を備える。速度制限部17は、進路予測部171、検知部172、制御切り替え部173、減速制御部174、および注意喚起部176を備える。減速制御部174は、調整部175を備える。
The
注意喚起部176は、車両1の周囲の移動体、特に車両1の後方の移動体に注意喚起を行うための音声を、音声出力装置20に出力させる。注意喚起のための音声は、特定の音声に限定されない。例えば、「車両が通ります」など、言葉で注意喚起してもよいし、ブザー音またはクラクションで注意喚起してもよい。また、注意喚起部176による注意喚起のタイミングは、特定のタイミングに限定されない。注意喚起部176は、車両1が走行中は常に、注意喚起のための音声を音声出力装置20に出力させてもよい。注意喚起部176は、減速制御が実行中である際に、注意喚起のための音声を音声出力装置20に出力させてもよい。注意喚起部176は、減速制御を実行中であるか否かに関わらず、減速中に、注意喚起のための音声を音声出力装置20に出力させてもよい。注意喚起部176は、検知部172によって後方対象物が検知されているときに、注意喚起のための音声を音声出力装置20に出力させてもよい。注意喚起部176は、乗員による指示入力があったときに、注意喚起のための音声を音声出力装置20に出力させてもよい。
The alerting unit 176 causes the
なお、音声によって注意喚起を行う方法は、注意喚起の方法の一例である。例えば、車両1の後ろ側に尾灯が具備され、注意喚起部176は、尾灯を明滅させるなどによって後方対象物に注意喚起を促してもよい。
The method of calling attention by voice is an example of a method of calling attention. For example, a taillight may be provided on the rear side of the
調整部175は、注意喚起部176が後方対象物に注意喚起を促したか否かを判断する。注意喚起部176が後方対象物に注意喚起を行わない場合、調整部175は、注意喚起部176が後方対象物に注意喚起を行う場合に比べ、Qに対するRの比がより大きくなるように、QおよびRを演算する。 The adjusting unit 175 determines whether or not the alerting unit 176 alerts the rear target object. When the alerting unit 176 does not alert the backward target object, the adjusting unit 175 has a larger ratio of R to Q than when the alerting unit 176 alerts the backward target object. Calculate Q and R.
図14は、第4実施形態の制限速度の演算手順の一例を示すフローチャートである。 FIG. 14 is a flowchart showing an example of a speed limit calculation procedure of the fourth embodiment.
まず、調整部175は、注意喚起部176が後方対象物に注意喚起を行ったか否かを判断する(S401)。注意喚起部176が後方対象物に注意喚起を行ったと判断した場合(S401:Yes)、調整部175は、QおよびRをそれぞれ決定し、決定されたQおよびRを式(1)の評価関数に設定する(S402)。S402では、調整部175は、例えば、Qに対するRの比が、予め設定された比Rate3に等しくなるように、QとRとを決定する。ただし、Rate3は、後述のRate4よりも小さい。調整部175は、注意喚起部176が後方対象物に注意喚起を行った場合に設定するためのQおよびRの値を予め記憶しておいてもよい。例えば、調整部175は、Qとして0.9を、Rとして0.1を設定する。 First, the adjustment unit 175 determines whether or not the alerting unit 176 alerts the rear target object (S401). When the attention unit 176 determines that the rear target is alerted (S401: Yes), the adjustment unit 175 determines Q and R, respectively, and determines the determined Q and R as the evaluation function of the equation (1). (S402). In S402, the adjusting unit 175 determines Q and R so that the ratio of R to Q becomes equal to the preset ratio Rate3, for example. However, Rate3 is smaller than Rate4 described later. The adjusting unit 175 may store in advance the values of Q and R to be set when the alerting unit 176 alerts the rear target object. For example, the adjusting unit 175 sets 0.9 as Q and 0.1 as R.
注意喚起部176が後方対象物に注意喚起を行っていないと判断した場合(S401:No)、調整部175は、QおよびRをそれぞれ決定し、決定されたQおよびRを式(1)の評価関数に設定する(S403)。S403では、調整部175は、例えば、Qに対するRの比が予め設定された比Rate4に等しくなるように、QとRとを決定する。調整部175は、注意喚起部176が後方対象物に注意喚起を行っていない場合に設定するためのQとRの値を予め記憶しておいてもよい。例えば、調整部175は、Qとして0.1を、Rとして0.9を設定する。 When the alerting unit 176 determines that the backward object is not alerted (S401: No), the adjusting unit 175 determines Q and R, respectively, and determines the determined Q and R in the formula (1). The evaluation function is set (S403). In S403, the adjustment unit 175 determines Q and R such that the ratio of R to Q is equal to the preset ratio Rate4. The adjusting unit 175 may store in advance the values of Q and R to be set when the alerting unit 176 does not alert the backward target object. For example, the adjusting unit 175 sets 0.1 as Q and 0.9 as R.
S402またはS403の処理の後、S404〜S411において、S103〜S110とそれぞれ同じ処理が実行され、処理がリターンされる。 After the processing of S402 or S403, the same processing as S103 to S110 is executed in S404 to S411, and the processing is returned.
このように、第4実施形態によれば、ECU10は、後方対象物に注意喚起を行わない場合、後方対象物に注意喚起を行う場合に比べて、速度を評価する項に対するジャークを評価する項の重み付けが大きくなるように、速度を評価する項とジャークを評価する項との重み付けの比を調整する。これにより、後方対象物に注意喚起を行わない場合、後方対象物に注意喚起を行う場合に比べて、緩やかな制動によって移動体が減速されるので、後方対象物による後突のリスクを低減することが可能となる。さらに、急激な制動が抑制されることによって、乗員が姿勢を崩すことを防止することができる。即ち、乗り心地が向上する。
As described above, according to the fourth embodiment, the
また、第1実施形態〜第4実施形態では、ECU10は、少なくとも後方対象物の状態に基づいて、速度を評価する項に対するジャークを評価する項の重み付けを調整する。これによって、後方対象物が静止物でない場合であっても、その状態に基づいて急激な制動を行うか緩やかな制動を行うかが決定されるので、後方対象物による後突のリスクを低減することが可能となる。後方対象物の状態とは、第1実施形態〜第4実施形態の例では、後方距離、後方相対速度、後方対象物が車両1に注意を払っているか否か、または、後方対象物に注意喚起を行うか否か、である。後方対象物の状態は、これらに限定されない。
In addition, in the first to fourth embodiments, the
速度を評価する項に対するジャークを評価する項の重み付けを調整する方法として、第1実施形態〜第4実施形態に4つの方法を示したが、ECU10は、上記4つの方法のうちの2以上の方法を組み合わせた方法で、重み付けを調整するようにしてもよい。
Although four methods are shown in the first to fourth embodiments as a method of adjusting the weighting of the term for evaluating jerk with respect to the term for evaluating speed, the
組み合わせ方法は、任意である。一例では、ECU10は、QおよびRのそれぞれについて、2以上の方法で演算し、それぞれ和を演算する。具体的には、例えば4つの方法の組み合わせによってQおよびRが演算される場合、ECU10は、Q1、Q2、Q3、Q4、R1、R2、R3、およびR4をそれぞれ演算し、下記の式(9)および式(10)によってQおよびRを演算する。ただし、Q1およびR1は、第1実施形態の方法によって演算されるQおよびRであり、Q2およびR2は、第2実施形態の方法によって演算されるQおよびRであり、Q3およびR3は、第3実施形態の方法によって演算されるQおよびRであり、Q4およびR4は、第4実施形態の方法によって演算されるQおよびRである。Cは所定の定数である。
別の例では、ECU10は、下記の式(11)および式(12)によってQおよびRを演算する。
このように、ECU10は、QおよびRを、複数の方法の組み合わせによって演算することができる。
In this way, the
また、ECU10は、QおよびRを調整する方法を、複数の方法から選択可能に構成されてもよい。一例では、ECU10は、乗員などが複数の方法のうちの一を選択することが可能に構成され得る。別の例では、ECU10は、状況に応じて方法を自動で切り替えることが可能に構成され得る。
Further, the
以上、本発明の実施形態を例示したが、上記実施形態および変形例はあくまで一例であって、発明の範囲を限定することは意図していない。上記実施形態や変形例は、その他の様々な形態で実施されることが可能であり、発明の要旨を逸脱しない範囲で、種々の省略、置き換え、組み合わせ、変更を行うことができる。また、各実施形態や各変形例の構成や形状は、部分的に入れ替えて実施することも可能である。 Although the embodiments of the present invention have been described above, the above-described embodiments and modifications are merely examples, and are not intended to limit the scope of the invention. The above-described embodiment and modified examples can be implemented in various other forms, and various omissions, replacements, combinations, and changes can be made without departing from the spirit of the invention. Further, the configurations and shapes of the embodiments and the modified examples may be partially replaced with each other.
1…車両、2…車体、2a…車室、2b…座席、2c…フロントバンパー、2d…リアバンパー、3…操作装置、3a…加速操作部、3b…操舵部、3c…変速操作部、3d…制動操作部、4…前方検知装置、4a,4b,4c,4d,5a,5b,5c,5d…ソナー、5…後方検知装置、6…ダッシュボード、7…車輪、7F…前輪、7R…後輪、8…駆動装置、9…車輪速センサ、10…ECU、11…演算装置、12…記憶装置、13…入出力装置、14…バス、15…取得部、16…駆動制御部、17…速度制限部、20…音声出力装置、171…進路予測部、172…検知部、173…制御切り替え部、174…減速制御部、175…調整部、176…注意喚起部。
DESCRIPTION OF
Claims (4)
前記検知部によって検知された前記第1対象物に衝突しないために前記移動体の減速を行う減速制御を、速度を評価する第1項とジャークを評価する第2項とを含み、前記第1項と前記第2項との重み付けの比が調整可能な評価関数に基づいて実行する減速制御部と、
前記移動体から前記検知部によって検知された前記第2対象物までの距離が第1の距離である第1の場合、前記移動体から前記第1対象物までの距離が前記第1の場合における前記移動体から前記第1対象物までの距離と同一でありかつ前記移動体から前記第2対象物までの距離が前記第1の距離よりも長い第2の距離である第2の場合に比べて、前記第1項に対する前記第2項の重み付けが大きくなるように前記比を調整する、調整部と、
を備えた速度制御装置。 A detection unit that detects a first object in front of the moving body and a second object behind the moving body based on input information from a detection device provided in the moving body,
The deceleration control for decelerating the moving body so as not to collide with the first object detected by the detection unit includes a first term for evaluating speed and a second term for evaluating jerk, and A deceleration control unit that executes based on an evaluation function in which the weighting ratio of the term and the second term is adjustable,
In the first case where the distance from the moving body to the second object detected by the detection unit is the first distance, in the case where the distance from the moving body to the first object is the first case Compared with the second case where the distance from the moving body to the first object is the same and the distance from the moving body to the second object is a second distance longer than the first distance. An adjusting unit that adjusts the ratio so that the weighting of the second term with respect to the first term increases .
Speed control device equipped with.
前記検知部によって検知された前記第1対象物に衝突しないために前記移動体の減速を行う減速制御を、速度を評価する第1項とジャークを評価する第2項とを含み、前記第1項と前記第2項との重み付けの比が調整可能な評価関数に基づいて実行する減速制御部と、
前記検知部によって検知された前記第2対象物が前記移動体に近づく相対速度が第1の速度である第1の場合、前記第1対象物が前記移動体に近づく相対速度が前記第1の場合における前記第1対象物が前記移動体に近づく相対速度と同一でありかつ前記第2対象物が前記移動体に近づく相対速度が前記第1の速度よりも遅い第2の速度である第2の場合に比べて、前記第1項に対する前記第2項の重み付けが大きくなるように前記比を調整する、調整部と、
を備えた速度制御装置。 A detection unit that detects a first object in front of the moving body and a second object behind the moving body based on input information from a detection device provided in the moving body,
The deceleration control for decelerating the moving body so as not to collide with the first object detected by the detection unit includes a first term for evaluating speed and a second term for evaluating jerk, and A deceleration control unit that executes based on an evaluation function in which the weighting ratio of the term and the second term is adjustable,
In the first case where the relative speed at which the second object approaches the moving body detected by the detection unit is a first speed, the relative speed at which the first object approaches the moving body is the first speed. A second speed that is the same as the relative speed at which the first object approaches the moving body in the case, and the relative speed at which the second object approaches the moving body is slower than the first speed; An adjusting unit that adjusts the ratio so that the weighting of the second term with respect to the first term is larger than that in the case of
Speed control device equipped with .
前記検知部によって検知された前記第1対象物に衝突しないために前記移動体の減速を行う減速制御を、速度を評価する第1項とジャークを評価する第2項とを含み、前記第1項と前記第2項との重み付けの比が調整可能な評価関数に基づいて実行する減速制御部と、
調整部と、
を備え、
前記検知部は、前記第2対象物が前記移動体に注意を向けているか否かをさらに検知し、
前記調整部は、前記第2対象物が前記移動体に注意を向けていない場合、前記第2対象物が前記移動体に注意を向けている場合に比べて、前記第1項に対する前記第2項の重み付けが大きくなるように前記比を調整する、
速度制御装置。 A detection unit that detects a first object in front of the moving body and a second object behind the moving body based on input information from a detection device provided in the moving body,
The deceleration control for decelerating the moving body so as not to collide with the first object detected by the detection unit includes a first term for evaluating speed and a second term for evaluating jerk. A deceleration control unit that executes based on an evaluation function in which the weighting ratio of the term and the second term is adjustable,
The adjustment section,
Equipped with
The detection unit further detects whether or not the second object is paying attention to the moving body ,
Before SL adjuster, when the second object is not paying attention to the moving body, as compared with the case where the second object is paying attention to the moving object, the first for the first term Adjusting the ratio so that the weighting of the two terms becomes large,
Speed control devices.
前記検知部によって検知された前記第1対象物に衝突しないために前記移動体の減速を行う減速制御を、速度を評価する第1項とジャークを評価する第2項とを含み、前記第1項と前記第2項との重み付けの比が調整可能な評価関数に基づいて実行する減速制御部と、
前記検知部によって検知された前記第2対象物に注意喚起を行うことができる注意喚起部と、
前記注意喚起部によって前記第2対象物に注意喚起が行われない場合、前記注意喚起部によって前記第2対象物に注意喚起が行われる場合に比べて、前記第1項に対する前記第2項の重み付けが大きくなるように前記比を調整する、調整部と、
を備えた速度制御装置。 A detection unit that detects a first object in front of the moving body and a second object behind the moving body based on input information from a detection device provided in the moving body;
The deceleration control for decelerating the moving body so as not to collide with the first object detected by the detection unit includes a first term for evaluating speed and a second term for evaluating jerk, and A deceleration control unit that executes based on an evaluation function in which the weighting ratio of the term and the second term is adjustable,
An alerting unit capable of alerting the second object detected by the detecting unit;
If alerting the second object by the previous SL alerting unit is not performed, as compared with the case where attention calling is performed to the second object by the alerting unit, the second term to the first term An adjusting unit that adjusts the ratio so that the weighting of
Speed control device equipped with .
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016147619A JP6747141B2 (en) | 2016-07-27 | 2016-07-27 | Speed control device |
FR1755603A FR3054497B1 (en) | 2016-07-27 | 2017-06-20 | SPEED REGULATION DEVICE |
CN201710617479.7A CN107662606A (en) | 2016-07-27 | 2017-07-26 | Speed control unit |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016147619A JP6747141B2 (en) | 2016-07-27 | 2016-07-27 | Speed control device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2018016189A JP2018016189A (en) | 2018-02-01 |
JP6747141B2 true JP6747141B2 (en) | 2020-08-26 |
Family
ID=61000206
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2016147619A Active JP6747141B2 (en) | 2016-07-27 | 2016-07-27 | Speed control device |
Country Status (3)
Country | Link |
---|---|
JP (1) | JP6747141B2 (en) |
CN (1) | CN107662606A (en) |
FR (1) | FR3054497B1 (en) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11618439B2 (en) * | 2019-04-11 | 2023-04-04 | Phantom Auto Inc. | Automatic imposition of vehicle speed restrictions depending on road situation analysis |
US11608056B2 (en) * | 2019-12-20 | 2023-03-21 | Baidu Usa Llc | Post collision damage reduction brake system incorporating front obstacle avoidance |
CN113320521B (en) * | 2020-02-28 | 2022-10-04 | 联合汽车电子有限公司 | Speed planning method and system for hybrid vehicle |
DE102022207688A1 (en) * | 2022-07-27 | 2024-02-01 | Robert Bosch Gesellschaft mit beschränkter Haftung | Method for braking a vehicle with an electric drive motor, computing unit and computer program |
Family Cites Families (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002052952A (en) | 2000-08-11 | 2002-02-19 | Nissan Motor Co Ltd | Traveling control device for vehicle |
JP3928512B2 (en) | 2002-07-26 | 2007-06-13 | 日産自動車株式会社 | Preceding vehicle tracking control device |
JP4735516B2 (en) * | 2006-11-10 | 2011-07-27 | トヨタ自動車株式会社 | Rear collision prediction device |
JP2008273252A (en) | 2007-04-25 | 2008-11-13 | Toyota Motor Corp | Driving force controller for vehicle |
JP2008290600A (en) * | 2007-05-25 | 2008-12-04 | Nissan Diesel Motor Co Ltd | Travel control device of vehicle |
JP4321633B2 (en) * | 2007-07-12 | 2009-08-26 | 株式会社デンソー | Collision mitigation device |
JP5066478B2 (en) * | 2008-04-22 | 2012-11-07 | 富士重工業株式会社 | Vehicle driving support device |
CN102673561B (en) * | 2011-12-20 | 2015-11-18 | 河南科技大学 | A kind of rear-end collision preventing system and method |
JP5668706B2 (en) * | 2012-02-03 | 2015-02-12 | トヨタ自動車株式会社 | BRAKE CONTROL DEVICE, BRAKE CONTROL METHOD, PROGRAM, AND MEDIUM |
KR20150067848A (en) * | 2013-12-10 | 2015-06-19 | 현대모비스 주식회사 | Apparatus and method for controlling quick brake considering distance between vehicles |
CN105235681B (en) * | 2015-11-11 | 2018-06-08 | 吉林大学 | A kind of vehicle rear-end collision collision avoidance system and method based on pavement conditions |
CN105774800B (en) * | 2016-03-28 | 2018-06-26 | 清华大学 | A kind of impact-moderation method and device in hybrid vehicle queue between vehicle |
JP6461042B2 (en) * | 2016-05-18 | 2019-01-30 | トヨタ自動車株式会社 | Driving assistance device |
-
2016
- 2016-07-27 JP JP2016147619A patent/JP6747141B2/en active Active
-
2017
- 2017-06-20 FR FR1755603A patent/FR3054497B1/en active Active
- 2017-07-26 CN CN201710617479.7A patent/CN107662606A/en active Pending
Also Published As
Publication number | Publication date |
---|---|
FR3054497A1 (en) | 2018-02-02 |
CN107662606A (en) | 2018-02-06 |
FR3054497B1 (en) | 2020-09-25 |
JP2018016189A (en) | 2018-02-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6848794B2 (en) | Collision avoidance support device | |
US11427194B2 (en) | Lane change assist device | |
US20220118971A1 (en) | Lane change assist device | |
JP6859902B2 (en) | Vehicle control unit | |
US6859731B2 (en) | Collision damage reduction system | |
JP6766783B2 (en) | Vehicle control device | |
US7200481B2 (en) | Driving assist system for vehicle | |
JP6521803B2 (en) | Automatic operation control device, footrest, automatic operation control method, and operation information output method | |
JP6593607B2 (en) | Vehicle control device | |
JP6747141B2 (en) | Speed control device | |
JP5677154B2 (en) | Vehicle driving support device | |
JP2007186141A (en) | Running control device for vehicle | |
CN109572690B (en) | Vehicle control device | |
JP5772651B2 (en) | Driving assistance device | |
KR101286466B1 (en) | Adaptive cruise control apparatus and control method for the same | |
JP2011016418A (en) | Vehicle control device | |
JP2021109598A (en) | Driving support device | |
JP5939130B2 (en) | Driving assistance device | |
JP2005010893A (en) | Vehicular contact avoidance control system | |
JP2009035245A (en) | Vehicle operation supporting device | |
JP5549472B2 (en) | Vehicle control device | |
JP7347340B2 (en) | Travel control equipment and vehicles | |
JP3948398B2 (en) | VEHICLE DRIVE OPERATION ASSISTANCE DEVICE AND VEHICLE HAVING THE DEVICE | |
JP7459446B2 (en) | Driver status detection device | |
JP2023137956A (en) | Driving assistance device, driving assistance method, and program |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20190610 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20200330 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20200407 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20200529 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20200707 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20200720 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 6747141 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |