JP6747141B2 - Speed control device - Google Patents

Speed control device Download PDF

Info

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
Application number
JP2016147619A
Other languages
Japanese (ja)
Other versions
JP2018016189A (en
Inventor
博敏 落合
博敏 落合
安藤 充宏
充宏 安藤
小林 聡宏
聡宏 小林
加藤 幸裕
幸裕 加藤
昇 長嶺
昇 長嶺
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Aisin Corp
Original Assignee
Aisin Seiki Co Ltd
Aisin Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Aisin Seiki Co Ltd, Aisin Corp filed Critical Aisin Seiki Co Ltd
Priority to JP2016147619A priority Critical patent/JP6747141B2/en
Priority to FR1755603A priority patent/FR3054497B1/en
Priority to CN201710617479.7A priority patent/CN107662606A/en
Publication of JP2018016189A publication Critical patent/JP2018016189A/en
Application granted granted Critical
Publication of JP6747141B2 publication Critical patent/JP6747141B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION 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/00Electric devices on electrically-propelled vehicles for safety purposes; Monitoring operating variables, e.g. speed, deceleration or energy consumption
    • B60L3/08Means for preventing excessive speed of the vehicle
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION 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/00Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles
    • B60L15/20Methods, 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
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION 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/00Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles
    • B60L15/20Methods, 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/2009Methods, 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
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION 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/00Electric devices on electrically-propelled vehicles for safety purposes; Monitoring operating variables, e.g. speed, deceleration or energy consumption
    • B60L3/0007Measures or means for preventing or attenuating collisions
    • B60L3/0015Prevention of collisions
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION 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/00Electrodynamic brake systems for vehicles in general
    • B60L7/10Dynamic electric regenerative braking
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/09Taking automatic action to avoid collision, e.g. braking and steering
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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/14Adaptive cruise control
    • B60W30/143Speed control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION 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/00Type of vehicles
    • B60L2200/34Wheel chairs
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION 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/00Control parameters of input or output; Target parameters
    • B60L2240/10Vehicle control parameters
    • B60L2240/12Speed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION 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/00Control parameters of input or output; Target parameters
    • B60L2240/10Vehicle control parameters
    • B60L2240/14Acceleration
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION 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/00Control parameters of input or output; Target parameters
    • B60L2240/40Drive Train control parameters
    • B60L2240/42Drive Train control parameters related to electric machines
    • B60L2240/421Speed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION 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/00Control parameters of input or output; Target parameters
    • B60L2240/80Time limits
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION 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/00Operating Modes
    • B60L2260/20Drive modes; Transition between modes
    • B60L2260/32Auto pilot mode
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Input parameters relating to overall vehicle dynamics
    • B60W2520/10Longitudinal speed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Input parameters relating to objects
    • B60W2554/40Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404Characteristics
    • B60W2554/4041Position
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Input parameters relating to objects
    • B60W2554/80Spatial relation or speed relative to objects
    • B60W2554/801Lateral distance
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Input parameters relating to objects
    • B60W2554/80Spatial relation or speed relative to objects
    • B60W2554/804Relative longitudinal speed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Output or target parameters relating to overall vehicle dynamics
    • B60W2720/10Longitudinal speed
    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/60Other road transportation technologies with climate change mitigation effect
    • Y02T10/64Electric machine technologies in electromobility
    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/60Other road transportation technologies with climate change mitigation effect
    • Y02T10/72Electric 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, Patent Documents 1 and 2). , And 3).

特開2002−052952号公報JP, 2002-052952, A 特開2008−273252号公報JP, 2008-273252, A 特開2004−058801号公報JP 2004-058801 A

前方の障害物との衝突を避けるために、自身の移動体を停止することが望まれる場合がある。しかしながら、他の移動体が後方に存在する場合において自身の移動体を急停止させると、後方の移動体に後突されるリスクがある。 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実施形態の車両の車室の一部が透視された状態の一例が示された斜視図である。FIG. 1 is a perspective view showing an example of a state in which a part of a vehicle interior of a vehicle according to the first embodiment is seen through. 図2は、第1実施形態の車両の一例が示された平面図である。FIG. 2 is a plan view showing an example of the vehicle of the first embodiment. 図3は、第1実施形態のECUのハードウェア構成例を示す図である。FIG. 3 is a diagram illustrating a hardware configuration example of the ECU of the first embodiment. 図4は、第1実施形態のECUの機能構成例を示す図である。FIG. 4 is a diagram showing a functional configuration example of the ECU of the first embodiment. 図5は、Q:R=1:1の場合に第1実施形態の評価関数によって得られる速度曲線を示すグラフである。FIG. 5 is a graph showing a velocity curve obtained by the evaluation function of the first embodiment when Q:R=1:1. 図6は、Q:R=1:1の場合に第1実施形態の評価関数によって得られる速度曲線から導出される加速度変化を示すグラフである。FIG. 6 is a graph showing the acceleration change derived from the velocity curve obtained by the evaluation function of the first embodiment when Q:R=1:1. 図7は、Q:R=10:1の場合に第1実施形態の評価関数によって得られる速度曲線を示すグラフである。FIG. 7 is a graph showing a velocity curve obtained by the evaluation function of the first embodiment when Q:R=10:1. 図8は、Q:R=10:1の場合に第1実施形態の評価関数によって得られる速度曲線から導出される加速度変化を示すグラフである。FIG. 8 is a graph showing a change in acceleration derived from the velocity curve obtained by the evaluation function of the first embodiment when Q:R=10:1. 図9は、第1実施形態の速度制御の手順の一例を示すフローチャートである。FIG. 9 is a flowchart showing an example of the speed control procedure of the first embodiment. 図10は、第1実施形態の制限速度の演算手順の一例を示すフローチャートである。FIG. 10 is a flowchart showing an example of a speed limit calculation procedure of the first embodiment. 図11は、第2実施形態の制限速度の演算手順の一例を示すフローチャートである。FIG. 11 is a flowchart showing an example of a speed limit calculation procedure of the second embodiment. 図12は、第3実施形態の制限速度の演算手順の一例を示すフローチャートである。FIG. 12 is a flowchart showing an example of a speed limit calculation procedure according to the third embodiment. 図13は、第4実施形態のECUの機能構成例を示す図である。FIG. 13 is a diagram showing a functional configuration example of the ECU of the fourth embodiment. 図14は、第4実施形態の制限速度の演算手順の一例を示すフローチャートである。FIG. 14 is a flowchart showing an example of a speed limit calculation procedure of the fourth embodiment.

<第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 vehicle 1 shown in FIGS. 1 and 2 as an example. FIG. 1 is a perspective view showing an example of a state in which a part of a vehicle interior of a vehicle 1 according to the first embodiment is seen through. FIG. 2 is a plan view showing an example of the vehicle 1 of the first embodiment. The vehicle 1 is an example of a moving body that is moved by being operated by an occupant. The speed control device according to each embodiment of the present invention can be mounted on an arbitrary moving body that is moved by being operated by an occupant. In addition to the vehicle 1, the speed control device according to each embodiment of the present invention can be mounted on, for example, an electric wheelchair or a personal mobility.

本明細書においては説明の便宜上、図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 vehicle 1, respectively, and the upper right side and the lower left side will be described as the right side and the left side of the vehicle 1, respectively. In FIG. 2, the left side corresponds to the front of the vehicle 1 and the right side corresponds to the rear of the vehicle 1.

車両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 vehicle 1 is, for example, a four-wheeled vehicle and has two left and right front wheels 7F and two left and right rear wheels 7R. Each of these four wheels 7 can be configured to be steerable. Further, which of the four wheels 7 is to be the driving wheel can be set in various ways. A wheel speed sensor 9 (not shown in FIGS. 1 and 2) is provided on any of the four wheels 7. The wheel speed detected by the wheel speed sensor 9 is sent to an ECU (electronic control unit) 10 (not shown in FIGS. 1 and 2). The detected value of the rotation speed by the wheel speed sensor 9 is converted into the detected value of the speed of the vehicle 1 by the ECU 10.

また、図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 vehicle body 2 constitutes a vehicle interior 2a in which an occupant (not shown) rides. An operation device 3 is provided in the vehicle interior 2a so as to face the seat 2b of the driver as an occupant. The operation device 3 is operated by an occupant, and is used by the occupant to input an instruction of a traveling direction of the vehicle 1 and an instruction of a speed of the vehicle 1. The operation device 3 includes, for example, an acceleration operation unit 3a, a steering unit 3b, a shift operation unit 3c, and a braking operation unit 3d. The acceleration operation unit 3a is, for example, an accelerator pedal located under the driver's foot, the steering unit 3b is, for example, a steering wheel protruding from the dashboard 6, and the gear shift operation unit 3c is, for example, from a center console. The shift operation lever 3 is a protruding shift lever, and the braking operation unit 3d is, for example, a brake pedal located under the driver's foot. The acceleration operation unit 3a, the steering unit 3b, the shift operation unit 3c, and the braking operation unit 3d are not limited to these.

運転者が加速操作部3aの可動部を操作すると、加速操作部3aの可動部の変位量は不図示の変位センサによって検出され、検出された変位量はECU10に送られる。加速操作部3aの可動部の変位量は、ECU10によって運転者が所望する速度(以降、所望速度)に変換され、図1,図2には不図示の駆動装置8の制御に使用される。 When the driver operates the movable part of the acceleration operation part 3a, the displacement amount of the movable part of the acceleration operation part 3a is detected by a displacement sensor (not shown), and the detected displacement amount is sent to the ECU 10. The displacement amount of the movable part of the acceleration operation part 3a is converted by the ECU 10 into a speed desired by the driver (hereinafter, desired speed), and is used for controlling the drive device 8 not shown in FIGS.

駆動装置8は、車両1に駆動力を与えたり車両1を減速したりするものであって、駆動源、変速機構、および制動機構を含む。駆動源は、例えば、内燃機関または電動機である。変速機構は、動力源が発生する動力を変換して車輪7に伝達する機構であり、例えば、連続可変トランスミッション(Continuously Variable Transmission、CVT)を含む。制動機構は、例えば、摩擦によって車輪速度を減速するブレーキ、または、運動エネルギーを電動機を用いて回収する回生ブレーキである。 The drive device 8 applies a driving force to the vehicle 1 or decelerates the vehicle 1, and includes a drive source, a speed change mechanism, and a braking mechanism. The drive source is, for example, an internal combustion engine or an electric motor. The speed change mechanism is a mechanism that converts the power generated by the power source and transmits the power to the wheels 7, and includes, for example, a continuously variable transmission (CVT). The braking mechanism is, for example, a brake that reduces the wheel speed by friction, or a regenerative brake that recovers kinetic energy using an electric motor.

運転者が操舵部3bを操作すると、操舵部3bの操作量は、不図示の舵角センサによって操舵情報として検出され、検出された操舵情報はECU10に送られる。ECU10による制御の元で、前輪7Fのタイヤ角が操舵情報に応じて転舵される。なお、後輪7Rが転舵されてもよい。 When the driver operates the steering section 3b, the operation amount of the steering section 3b is detected as steering information by a steering angle sensor (not shown), and the detected steering information is sent to the ECU 10. Under the control of the ECU 10, the tire angle of the front wheels 7F is steered according to the steering information. The rear wheels 7R may be steered.

運転者が変速操作部3cを操作すると、変速操作部3cの可動部の位置は位置センサによって検出され、検出された位置はECU10に送られる。ECU10による制御の元で、駆動源から車輪7に伝達される動力を、変速操作部3cの可動部の位置に応じて変換する。 When the driver operates the gear shift operation unit 3c, the position of the movable portion of the gear shift operation unit 3c is detected by the position sensor, and the detected position is sent to the ECU 10. Under the control of the ECU 10, the power transmitted from the drive source to the wheels 7 is converted according to the position of the movable portion of the gear shift operation unit 3c.

また、図1,図2に例示されるように、車体2には、前方検知装置4および後方検知装置5が設けられている。 Further, as illustrated in FIGS. 1 and 2, the vehicle body 2 is provided with a front detecting device 4 and a rear detecting device 5.

前方検知装置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 vehicle 1, the front detecting device 4 acquires information about the object as detected object information. The target object may be an obstacle to the traveling of the vehicle 1, and includes, for example, a pedestrian, a bicycle, an automobile, a stationary object, a falling place, another vehicle, and the like. Here, as an example, the front detecting device 4 is configured by four sonars 4a to 4d, and the four sonars 4a to 4d are installed in the front bumper 2c of the vehicle body 2 at approximately equal intervals. The sonars 4a-4d may also be referred to as sonar sensors, ultrasonic detectors, or ultrasonic sonars. The front detecting device 4 emits an ultrasonic wave in a range including the front of the vehicle 1 and receives a reflected wave from the target object, whereby the distance from the front detecting device 4 to the target object and the direction in which the target object exists. Is acquired as the detected object information. The front detection device 4 acquires the detected object information, for example, every first predetermined time. The detected object information acquired by the front detection device 4 is sent to the ECU 10.

なお、前方検知装置4は、ソナー4a〜4d以外のセンサによって構成され得る。例えば、前方検知装置4は、3次元測域センサ(レーザーレンジスキャナー(3Dスキャナー))によって構成され得る。また、例えば、赤外光または可視光などを用いて周辺環境を撮像し、撮像された画像に基づいて対象物の情報を取得するカメラ、ミリ波レーダーまたはサブミリ波レーダーを用いて対象物の情報を取得するセンサ、車車間通信によって対象物の情報を取得する通信装置など、種々の装置によって前方検知装置4が構成され得る。また、上記の被検知物情報は、一例である。また、被検知物情報は上記以外の種類の情報によって構成され得る。第1実施形態では、被検知物情報から対象物の有無と対象物までの距離とが少なくとも導出可能であればよい。 The front detection device 4 may be configured by sensors other than the sonars 4a to 4d. For example, the front detection device 4 may be configured by a three-dimensional range sensor (laser range scanner (3D scanner)). In addition, for example, a camera that captures the surrounding environment by using infrared light or visible light, and obtains information about the target object based on the captured image, information about the target object using a millimeter-wave radar or a submillimeter-wave radar. The front detection device 4 may be configured by various devices such as a sensor for acquiring the information and a communication device for acquiring the information of the object by the inter-vehicle communication. The above-mentioned detected object information is an example. Further, the detected object information may be configured by information other than the above. In the first embodiment, it is sufficient that at least the presence/absence of the object and the distance to the object can be derived from the detected object information.

後方検知装置5は、車両1の後方に対象物がある場合に、その対象物の情報を被検知物情報として取得する。前方検知装置4と同様に、後方検知装置5は、任意のセンサによって構成され得る。ここでは後方検知装置5は、一例として、4つのソナー5a〜5dによって構成され、4つのソナー5a〜5dは、リアバンパー2dにおよそ等間隔に設置されている。後方検知装置5は、後方検知装置5から対象物までの距離および対象物が存在する方角を被検知物情報として取得する。後方検知装置5は、例えば、第一所定時間毎に被検知物情報を取得する。後方検知装置5が取得した被検知物情報は、ECU10に出力される。 When there is an object behind the vehicle 1, the rear detection device 5 acquires information about the object as detected object information. Similar to the front detecting device 4, the rear detecting device 5 may be configured by any sensor. Here, as an example, the rear detection device 5 includes four sonars 5a to 5d, and the four sonars 5a to 5d are installed on the rear bumper 2d at approximately equal intervals. The rear detection device 5 acquires the distance from the rear detection device 5 to the target object and the direction in which the target object is present as detected object information. The rear detection device 5 acquires the detected object information, for example, every first predetermined time. The detected object information acquired by the rearward detection device 5 is output to the ECU 10.

なお、車両1が備える各種装置の構成または配置等は、一例であって、種々に設定(変更)することが可能である。 The configurations, arrangements, and the like of the various devices provided in the vehicle 1 are merely examples, and can be set (changed) in various ways.

図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 ECU 10 according to the first embodiment. As illustrated, the ECU 10 includes an arithmetic unit 11, a storage unit 12, and an input/output unit 13. The arithmetic device 11, the storage device 12, and the input/output device 13 are connected to each other via a bus 14. The arithmetic unit 11 executes a computer program, and is, for example, a CPU (Central Processing Unit). The storage device 12 stores a computer program in advance. The arithmetic unit 11 implements each functional configuration unit described later by executing a computer program stored in the storage unit 12. The storage device 12 may be configured by, for example, a ROM (Read Only Memory), a RAM (Random Access Memory), a flash memory, an HDD (Hard Disk Drive), or a combination thereof. The input/output device 13 is an interface device for the ECU 10 to input/output information to/from other devices. The input/output device 13 is connected to the operating device 3, the front detecting device 4, the rear detecting device 5, the driving device 8, and the wheel speed sensor 9.

図4は、第1実施形態のECU10の機能構成例を示す図である。ECU10は、機能構成部として、取得部15、駆動制御部16、および速度制限部17を備える。 FIG. 4 is a diagram showing a functional configuration example of the ECU 10 of the first embodiment. The ECU 10 includes an acquisition unit 15, a drive control unit 16, and a speed limiting unit 17 as functional components.

なお、ECU10が備える各機能構成部(取得部15、駆動制御部16、速度制限部17)、および、速度制限部17を構成する各機能構成部(後述する)、のうちの一部または全部は、ハードウェア回路、または、ソフトウェア(コンピュータプログラム)とハードウェア回路との組み合わせによって実現され得る。 It should be noted that some or all of the functional components (the acquisition unit 15, the drive control unit 16, the speed limiting unit 17) included in the ECU 10 and the functional components (described later) configuring the speed limiting unit 17 are included. Can be realized by a hardware circuit or a combination of software (computer program) and a hardware circuit.

取得部15は、操作装置3から出力された各種情報を取得するものである。取得部15は、特に、加速操作部3aの可動部の変位量を所望速度に変換する。また、取得部15は、操舵情報を取得する。取得部15は、所望速度および操舵情報を速度制限部17に入力する。取得部15は、所望速度にフィルタ、マップ、または関数を作用させるなどによって所望速度を加工してもよい。 The acquisition unit 15 acquires various information output from the operation device 3. The acquisition unit 15 particularly converts the displacement amount of the movable portion of the acceleration operation unit 3a into a desired speed. The acquisition unit 15 also acquires steering information. The acquisition unit 15 inputs the desired speed and steering information to the speed limiting unit 17. The acquisition unit 15 may process the desired speed by applying a filter, a map, or a function to the desired speed.

速度制限部17は、車両1の前方に対象物が存在する場合に、車両1がその対象物に衝突しないように車両1を減速する制御(以降、減速制御)を実行するものである。車両1の前方に存在する、衝突防止対象の対象物を、前方対象物と表記する。 The speed limiter 17 executes control (hereinafter, deceleration control) for decelerating the vehicle 1 so that the vehicle 1 does not collide with the object when the object is present in front of the vehicle 1. An object that is present in front of the vehicle 1 and is a collision prevention target is referred to as a front object.

ここで、減速制御のアルゴリズムを説明する。 Here, a deceleration control algorithm will be described.

アルゴリズムは、速度を含む評価関数を最適化する最適化問題を解くことによって、減速制御のための車両1の目標速度(以降、制限速度)を求める。ここでは一例として、評価関数は、コストを示すものであり、アルゴリズムは、評価関数を最小化する速度を演算する。評価関数に含まれる速度は、実際には時刻の関数になっており、アルゴリズムは、最適化問題の解(最適解)として、評価区間における速度の時間変化を得る。以降、最適解として得られる速度の時間変化を、速度曲線と表記する。 The algorithm finds a target speed (hereinafter, speed limit) of the vehicle 1 for deceleration control by solving an optimization problem that optimizes an evaluation function including speed. Here, as an example, the evaluation function indicates the cost, and the algorithm calculates the speed at which the evaluation function is minimized. The speed included in the evaluation function is actually a function of time, and the algorithm obtains the time change of the speed in the evaluation section as the solution (optimal solution) of the optimization problem. Hereinafter, the time change of the speed obtained as the optimum solution will be referred to as a speed curve.

アルゴリズムは、前方対象物が検知されて減速制御を開始する時点を初期時刻(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 vehicle 1 to the forward object at t=0 by the speed of vehicle 1 at t=0. The algorithm sets the section from t=0 to t=Tf as the evaluation section.

評価関数は、速度を評価する項とジャークを評価する項と、を含み、かつ、速度を評価する項とジャークを評価する項との重み付けの比が調整可能に、少なくとも構成されている。 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はジャークである。

Figure 0006747141
Figure 0006747141
In one example, the evaluation function is represented by the following expression (1). x is a state variable composed of the velocity v and the acceleration a, and is represented by the following equation (2), for example. u is a jerk.
Figure 0006747141
Figure 0006747141

式(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)の状態方程式と、を最適化問題の拘束条件とする。

Figure 0006747141
The algorithm sets the initial value of the speed v to the speed v0 of the vehicle 1 at t=0 and the initial value of the acceleration a to the acceleration a0 of the vehicle 1 at t=0, and the speed v and A terminal condition for setting the terminal value of the acceleration a (that is, each value at the time of t=Tf) to 0 and a state equation of the following expression (3) are constraint conditions for the optimization problem.
Figure 0006747141

アルゴリズムは、上記の拘束条件を用いて式(1)の評価関数を最小とする最適化問題を解くことによって、t=Tfの時点で車両1が停止しているための速度曲線を得ることができる。上記の初期条件および終端条件は、車両1が前方対象物に衝突しない速度曲線を得るために設けられた拘束条件の一例である。拘束条件は、車両1が前方対象物に衝突しない速度曲線を得るためのものであればよく、拘束条件に対し、任意の条件の追加、削除、変更が可能である。 The algorithm can obtain the velocity curve for the vehicle 1 being stopped at the time t=Tf by solving the optimization problem that minimizes the evaluation function of the equation (1) using the above constraint condition. it can. The initial condition and the end condition described above are examples of restraint conditions provided in order to obtain a velocity curve in which the vehicle 1 does not collide with a front object. The constraint condition may be any condition for obtaining the velocity curve in which the vehicle 1 does not collide with the object in front, and any condition can be added, deleted, or changed to the constraint condition.

速度曲線の特性は、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 vehicle 1 is stopped by gentle braking. You can From another viewpoint, when R with respect to Q is small, the time change of acceleration is steeper than when R with respect to Q is large, and the vehicle 1 can be stopped suddenly. The larger Q is with respect to R, the more abrupt braking is realized, and the larger R is with respect to Q, the more gentle braking is realized.

第1実施形態では、アルゴリズムは、車両1から前方対象物までの距離(以降、前方距離)と、車両1から後方の対象物(以降、後方対象物)までの距離(以降、後方距離)と、に基づいてQとRとを演算する。 In the first embodiment, the algorithm uses a distance from the vehicle 1 to a front target object (hereinafter, front distance) and a distance from the vehicle 1 to a rear target object (hereinafter, rear target object) (hereinafter, rear distance). , And Q and R are calculated.

具体的には、アルゴリズムは、他の条件(少なくとも前方距離)が同じである場合において、後方距離が短い場合、後方距離が長い場合に比べ、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 vehicle 1, when the vehicle 1 suddenly stops, the rear object May not be able to cope with the sudden stop of the vehicle 1 and may collide with the vehicle 1 rearward. In the first embodiment, when the backward distance is short, the algorithm realizes the gentle braking, so that the risk of a rear collision due to the backward object can be reduced. Further, by suppressing the sudden braking, it is possible to prevent the occupant from losing his/her posture. That is, the riding comfort is improved.

また、アルゴリズムは、他の条件(少なくとも後方距離)が同じである場合において、前方距離が短い場合、前方距離が長い場合に比べ、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 vehicle 1 can be stopped before the object ahead. That is, it is possible to further reduce the risk of collision with a front object.

一例では、アルゴリズムは、下記の式(4)および式(5)を用いてQおよびRを演算する。ただし、Dfrontは前方距離であり、Dbackは後方距離である。DfrontおよびDbackはそれぞれ正の実数としている。

Figure 0006747141
Figure 0006747141
In one example, the algorithm computes Q and R using equations (4) and (5) below. However, Dfront is the front distance, and Dback is the rear distance. Each of Dfront and Dback is a positive real number.
Figure 0006747141
Figure 0006747141

なお、式(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 route prediction unit 171, a detection unit 172, a control switching unit 173, and a deceleration control unit 174.

ここでは一例として、速度制限部17は、車両1の前方の対象物のうちの車両1の進路上の対象物に衝突しないように車両1を減速させる、として説明する。即ち、速度制限部17は、車両1の前方の対象物のうちの車両1の進路上の対象物を、前方対象物として特定する。また、速度制限部17は、車両1から前方対象物までの進路上の距離を、前方距離とする。 Here, as an example, the speed limiting unit 17 will be described as decelerating the vehicle 1 so as not to collide with an object on the path of the vehicle 1 among the objects in front of the vehicle 1. That is, the speed limiting unit 17 specifies an object on the path of the vehicle 1 among the objects in front of the vehicle 1 as the front object. Further, the speed limiter 17 sets the distance on the route from the vehicle 1 to the front target object as the front distance.

進路予測部171は、進路を予測するものである。進路予測部171は、取得部15によって取得された所望速度および操舵情報に基づいて、車両1の進路(予測進路)を演算する。例えば、進路予測部171は、所望速度および操舵情報から、実験またはシミュレーションなどにより予め導出された関数に基づいて、進路を演算する。なお、進路の予測方法はこれに限定されない。例えば、進路予測部171は、単に、前方真正面に直線軌跡を設定し、その直線軌跡を進路としてもよい。進路予測部171は、所望速度以外の情報に基づいて車両1の進路を演算してもよい。 The route prediction unit 171 predicts a route. The route prediction unit 171 calculates the route (predicted route) of the vehicle 1 based on the desired speed and the steering information acquired by the acquisition unit 15. For example, the course prediction unit 171 calculates the course from the desired speed and the steering information based on a function derived in advance by experiments, simulations, or the like. Note that the route prediction method is not limited to this. For example, the course prediction unit 171 may simply set a straight line trajectory in front of the front and use the straight line trajectory as the course. The route prediction unit 171 may calculate the route of the vehicle 1 based on information other than the desired speed.

検知部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 front detection device 4, or detects a rear object based on input information from the rear detection device 5. To do. For example, the detection unit 172 superimposes the route predicted by the route prediction unit 171 and the detected object information from the front detection device 4, and determines whether or not there is an object on the path. When determining that there is an object on the path, the detection unit 172 detects (specifies) the object as a front object. Further, the detection unit 172 determines whether or not there is an object behind the object based on the detected object information from the rear detection device 5. When it is determined that the target object is behind, the detection unit 172 detects (specifies) the target object as the rear target object.

なお、前方対象物の特定方法は、上記の方法だけに限定されない。例えば、速度制限部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 route prediction unit 171 can be omitted. The distance range and the angle range in which the front object is detected can be set arbitrarily.

また、後方対象物の特定方法は、上記の方法だけに限定されない。例えば、検知部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 control switching unit 173 switches control between at least the normal control for controlling the vehicle 1 according to the desired speed and the deceleration control based on the above-described algorithm. Here, the control switching unit 173 switches the control among the normal control, the deceleration control, and the emergency stop control. The emergency stop control is control for stopping the vehicle 1 using the maximum braking capacity. The criterion for switching is not limited to a specific criterion.

ここでは、制御切り替え部173は、検知部172によって前方対象物が検知されていない場合、通常制御を選択する。即ち、速度制限部17は、取得部15から取得された所望速度を、そのまま駆動制御部16に入力する。 Here, the control switching unit 173 selects the normal control when the front object is not detected by the detection unit 172. That is, the speed limiting unit 17 inputs the desired speed acquired from the acquisition unit 15 to the drive control unit 16 as it is.

検知部172によって前方対象物が検知された場合、制御切り替え部173は、減速制御と緊急停止制御とのうちのいずれの制御を行うかを判断する。具体的には、制御切り替え部173は、まず、前方距離を演算する。そして、制御切り替え部173は、前方距離と制動限界距離とを比較する。制動限界距離は、最大の制動能力を用いて車両1を停止する場合に必要とされる距離である。制動限界距離は、固定値として予め設定されてもよいし、速度などに応じて可変に構成されてもよい。前方距離が制動限界距離より長い場合、制御切り替え部173は、減速制御を選択する。即ち、制御切り替え部173は、減速制御部174に減速制御を実行させる。 When the detection unit 172 detects a front object, the control switching unit 173 determines which of the deceleration control and the emergency stop control is to be performed. Specifically, the control switching unit 173 first calculates the front distance. Then, the control switching unit 173 compares the front distance with the braking limit distance. The braking limit distance is a distance required when the vehicle 1 is stopped using the maximum braking ability. The braking limit distance may be set in advance as a fixed value, or may be variably configured according to speed or the like. When the front distance is longer than the braking limit distance, the control switching unit 173 selects the deceleration control. That is, the control switching unit 173 causes the deceleration control unit 174 to execute deceleration control.

前方距離が制動限界距離より短い場合、制御切り替え部173は、緊急停止制御を選択する。具体的には、制御切り替え部173は、停止指示を駆動制御部16に出力する。停止指示は、最大の制動能力を用いて車両1を停止する指示である。 When the front distance is shorter than the braking limit distance, the control switching unit 173 selects the emergency stop control. Specifically, the control switching unit 173 outputs a stop instruction to the drive control unit 16. The stop instruction is an instruction to stop the vehicle 1 using the maximum braking ability.

なお、緊急停止制御は、選択肢に含まれていなくてもよい。また、より単純に、制御切り替え部173は、制動限界距離よりも大きい判定しきい値が設定され、前方距離が判定しきい値よりも大きい場合に通常制御を選択し、前方距離が判定しきい値よりも小さい場合に減速制御を選択してもよい。判定しきい値は、固定値として予め設定されてもよいし、速度などに応じて可変に構成されてもよい。このように、通常制御から減速制御に切り替えるための条件は、任意に設定され得る。 Note that the emergency stop control may not be included in the options. Further, more simply, the control switching unit 173 selects the normal control when the judgment threshold value larger than the braking limit distance is set and the front distance is larger than the judgment threshold value, and the front distance is judged. If it is smaller than the value, the deceleration control may be selected. The determination threshold value may be set in advance as a fixed value, or may be variably configured according to the speed or the like. In this way, the condition for switching from the normal control to the deceleration control can be set arbitrarily.

減速制御部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 wheel speed sensor 9. The deceleration control unit 174 includes an adjustment unit 175 that adjusts the weighting ratio of the term for evaluating the speed and the term for evaluating the jerk. Here, the adjusting unit 175 calculates the front distance and the rear distance, and applies the respective distances obtained by the calculation to the formula (4) and the formula (5) to obtain the weighting factor Q of the term for evaluating the speed. R, which is a weighting coefficient of the term for evaluating jerk, is calculated. The deceleration control unit 174 applies Q and R calculated by the adjustment unit 175 to the evaluation function, and calculates the speed limit using the evaluation function. The deceleration control unit 174 sequentially calculates the speed limit and sequentially outputs the calculated speed limits to the drive control unit 16.

なお、評価関数の最適化のための計算機的な手法としては任意の手法が採用可能である。評価関数の最適化のための計算機的な手法として、数値解析など既存の手法が採用可能であるし、今後開発される任意の手法が採用可能である。また、減速制御部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 drive device 8 based on the input speed (desired speed or speed limit). The drive control unit 16 calculates a control command so that the vehicle 1 moves at the input speed. In one example, the drive control unit 16 calculates the control command so that the magnitude of the target rotation speed of the wheel 7 is proportional to the magnitude of the input speed. The relationship between the input speed and the control command is measured and derived in advance by experiments or the like. The control command may be one that adjusts the driving force of the drive source, one that controls the speed change mechanism, one that controls the braking mechanism, or a combination thereof. May be.

また、駆動制御部16は、停止指示が入力されると、各車輪7を最大の制動能力で停止させるための制御指令を演算する。 Further, when the stop instruction is input, the drive control unit 16 calculates a control command for stopping each wheel 7 with the maximum braking ability.

なお、駆動制御部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 vehicle 1 based on the detected value of the wheel speed sensor 9, and feeds back the calculated detected value of the speed of the vehicle 1 to the calculation of the control command.

続いて、第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 route prediction unit 171 receives a desired speed and steering information from the acquisition unit 15 and predicts a route based on the received desired speed (S1). Subsequently, the detection unit 172 receives the detected object information from the front detection device 4 and the rear detection device 5, receives the route predicted by the route prediction unit 171, and based on each received information, detects the front object and The rear target is detected (S2).

制御切り替え部173は、検知部172によって前方対象物が検知されたか否かを判断する(S3)。検知部172によって前方対象物が検知されたと判断した場合(S3:Yes)、即ち前方対象物が存在する場合、制御切り替え部173は、前方距離を演算し、前方距離が制動限界距離よりも大きいか否かを判断する(S4)。例えば、制御切り替え部173は、進路予測部171によって予測された進路と、前方検知装置4からの被検知物情報とに基づいて前方距離を演算する。 The control switching unit 173 determines whether or not the front object is detected by the detection unit 172 (S3). When it is determined that the front object is detected by the detection unit 172 (S3: Yes), that is, when the front object is present, the control switching unit 173 calculates the front distance, and the front distance is larger than the braking limit distance. It is determined whether or not (S4). For example, the control switching unit 173 calculates the forward distance based on the route predicted by the route prediction unit 171 and the detected object information from the front detection device 4.

制御切り替え部173によって前方距離が制動限界距離よりも大きいと判断された場合(S4:Yes)、減速制御部174は、制限速度を演算する(S5)。 When the control switching unit 173 determines that the front distance is larger than the braking limit distance (S4: Yes), the deceleration control unit 174 calculates the speed limit (S5).

図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 rear detection device 5 can detect an object to be detected.

減速制御部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 wheel speed sensor 9 and calculates the speed of the vehicle 1 from the acquired detection values. Then, the deceleration control unit 174 sets the calculated speed of the vehicle 1 as the current speed v0. The deceleration control unit 174 calculates the predicted arrival time Tf based on the forward distance and the current speed v0 (S104). The deceleration control unit 174 calculates the current acceleration a0 (S105). In one example, the deceleration control unit 174 stores the speed v0 acquired in the previous control cycle, and calculates the current acceleration a0 based on the stored speed v0 and the speed v0 acquired in the current control cycle. Calculate

減速制御部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 control switching unit 173 determines whether the desired speed is higher than the speed limit (S6). When determining that the desired speed is higher than the speed limit (S6: Yes), the control switching unit 173 outputs the speed limit to the drive control unit 16 (S7), and the current control cycle ends. That is, the process returns to S1 in the next control cycle.

制御切り替え部173は、S3の処理において、検知部172によって前方対象物が検知されていないと判断された場合(S3:No)、または、S6の処理において、所望速度が制限速度より大きくないと判断した場合(S6:No)、所望速度を駆動制御部16に出力し(S8)、現在の制御周期が終了する。 In the process of S3, the control switching unit 173 determines that the detection unit 172 has not detected the front object (S3: No), or in the process of S6, the desired speed is not higher than the speed limit. If determined (S6: No), the desired speed is output to the drive control unit 16 (S8), and the current control cycle ends.

また、S4の処理において、制御切り替え部173は、前方距離が制動限界距離よりも大きくないと判断した場合(S4:No)、停止指示を駆動制御部16に出力し(S9)、現在の制御周期が終了する。 In the process of S4, when the control switching unit 173 determines that the front distance is not larger than the braking limit distance (S4: No), the control switching unit 173 outputs a stop instruction to the drive control unit 16 (S9), and the current control is performed. The cycle ends.

以上述べたように、第1実施形態によれば、ECU10は、速度を評価する項とジャークを評価する項と、を含み、かつ、速度を評価する項とジャークを評価する項との重み付けの比が調整可能な評価関数に基づいて減速制御を実行する。ECU10は、後方対象物との間の距離が短い場合、後方対象物との間の距離が長い場合に比べ、速度を評価する項に対するジャークを評価する項の重み付けが大きくなるように、速度を評価する項とジャークを評価する項との重み付けの比を調整する。これにより、後方対象物との間の距離が短い場合、緩やかな制動が実現し、その結果、後方対象物が歩行者、自転車、自動車などのような移動体であったとしても、後方対象物による後突のリスクを低減することができる。また、急激な制動が抑制されることによって、乗員が姿勢を崩すことを防止することができる。即ち、乗り心地が向上する。 As described above, according to the first embodiment, the ECU 10 includes the term for evaluating speed and the term for evaluating jerk, and the weighting of the term for evaluating speed and the term for evaluating jerk. The deceleration control is executed based on the evaluation function whose ratio can be adjusted. When the distance to the rear object is short, the ECU 10 adjusts the speed so that the term for evaluating the jerk is weighted more heavily than the term for evaluating the speed, compared to the case where the distance to the rear object is long. Adjust the weighting ratio of the term evaluated and the term evaluated jerk. As a result, when the distance to the rear object is short, gentle braking is realized, and as a result, even if the rear object is a moving body such as a pedestrian, a bicycle, or a car, the rear object is It is possible to reduce the risk of a rear-end collision. Further, by suppressing the sudden braking, it is possible to prevent the occupant from losing his/her posture. That is, the riding comfort is improved.

なお、実施形態では、取得部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 acquisition unit 15 and the speed limiter 17 are the speeds of the vehicle 1. The speed handled by the acquisition unit 15 and the speed limiting unit 17 is not necessarily the speed of the vehicle 1 as long as it corresponds to the speed of the vehicle 1. The speeds handled by the acquisition unit 15 and the speed limiter 17 can be expressed in arbitrary units, or can be expressed in arbitrary amounts that can be converted into the speed of the vehicle 1. In one example, the speed handled by the acquisition unit 15 and the speed limiting unit 17 can be expressed by an arbitrary amount that is proportional to the speed of the vehicle 1.

また、実施形態では、通常制御においては、駆動制御部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 acceleration operation unit 3a is input to the drive control unit 16, and the drive control unit 16 transmits torque according to the input displacement amount to the drive wheels. The control command may be calculated.

<第2実施形態>
第2実施形態の速度制御装置が適用されたECU10においては、制限速度の演算において、調整部175によるQおよびRの調整方法が第1実施形態と異なる。第1実施形態と共通する構成および手順については、説明を省略する。
<Second Embodiment>
In the ECU 10 to which the speed control device of the second embodiment is applied, the method of adjusting the Q and R by the adjusting unit 175 in the calculation of the speed limit is different from that of the first embodiment. Descriptions of configurations and procedures common to the first embodiment will be omitted.

第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 vehicle 1 is a positive direction. That is, the front relative speed is the relative speed at which the front target object approaches the vehicle 1. The rear relative speed is the relative speed at which the rear target object approaches the vehicle 1.

具体的には、調整部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 vehicle 1 at a high speed, the vehicle 1 is decelerated by the gentle braking, so that the risk of a rear collision due to the rear target object can be reduced. Further, by suppressing the sudden braking, it is possible to prevent the occupant from losing his/her posture. That is, the riding comfort is improved.

また、調整部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 vehicle 1 at a high speed, the vehicle 1 is decelerated by the sudden braking, so that the risk of the vehicle 1 colliding with the front object can be further reduced.

一例では、調整部175は、下記の式(6)および式(7)を用いてQおよびRを演算する。ただし、Vfrontは前方相対速度であり、Vbackは後方相対速度である。ただし、VfrontおよびVbackは正の実数とする。

Figure 0006747141
Figure 0006747141
In one example, the adjusting unit 175 calculates Q and R using the following equations (6) and (7). However, Vfront is a front relative speed and Vback is a rear relative speed. However, Vfront and Vback are positive real numbers.
Figure 0006747141
Figure 0006747141

なお、式(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 ECU 10 evaluates the speed when the relative speed of the rear target object approaching the vehicle 1 is fast, as compared with the case where the relative speed of the rear target object approaching the vehicle 1 is slow. The weighting ratio of the term for evaluating speed and the term for evaluating jerk is adjusted so that the weight of the term for evaluating jerk with respect to the term becomes large. Accordingly, when the relative speed of the rear target object approaching the vehicle 1 is high, the moving body is decelerated by gentle braking as compared with the case where the rear target object approaches the vehicle 1 at a low relative speed. It is possible to reduce the risk of a rear-end collision. Further, by suppressing the sudden braking, it is possible to prevent the occupant from losing his/her posture. That is, the riding comfort is improved.

<第3実施形態>
第3実施形態の速度制御装置が適用されたECU10においては、主に、検知部172の処理と、調整部175によるQおよびRの調整方法とが、第1実施形態と異なる。第1実施形態と共通する構成および手順については、説明を省略する。
<Third Embodiment>
In the ECU 10 to which the speed control device of the third embodiment is applied, the processing of the detection unit 172 and the method of adjusting Q and R by the adjustment unit 175 are mainly different from those of the first embodiment. Descriptions of configurations and procedures common to the first embodiment will be omitted.

第3実施形態においては、検知部172は、後方対象物が車両1に注意を払っているか否かを検知する。後方対象物は例えば人であり、より具体的には、歩行者、自転車を操縦している人、または自動車を操縦している人である。 In the third embodiment, the detection unit 172 detects whether the rear target object is paying attention to the vehicle 1. The rear object is, for example, a person, and more specifically, a pedestrian, a person driving a bicycle, or a person driving a car.

後方対象物が車両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 vehicle 1 is not limited to a specific criterion. In one example, the rear detection device 5 includes a camera that captures the rear using, for example, infrared light or visible light, and the camera inputs the captured image to the ECU 10. When a person is included in the captured image, the detection unit 172 determines whether or not the person pays attention to the vehicle 1 by image analysis. For example, the detection unit 172 identifies the face of a person from the captured image, and determines whether the identified face faces the vehicle 1. When it is determined that the face is facing the vehicle 1, the detection unit 172 determines that the rear target object is paying attention to the vehicle 1. When it is determined that the face does not face the vehicle 1, the detection unit 172 determines that the rear target object is not paying attention to the vehicle 1.

別の例では、検知部172は、後方距離または後方相対速度に基づいて後方対象物が車両1に注意を払っているか否かを判断する。例えば後方対象物が速い相対速度で車両1に接近し、後方距離が所定距離を下回っても後方対象物が速度を落とさない場合に、検知部172は、後方対象物が車両1に注意を払っていないと判断する。 In another example, the detection unit 172 determines whether the rear target object is paying attention to the vehicle 1 based on the rear distance or the rear relative speed. For example, when the rear target object approaches the vehicle 1 at a high relative speed and the rear target object does not slow down even if the rear target distance is less than a predetermined distance, the detection unit 172 causes the rear target object to pay attention to the vehicle 1. Judge not to.

別の例では、検知部172は、後方対象物の減速度に基づいて後方対象物が車両1に注意を払っているか否かを判断する。後方対象物が車両1に注意を払っている場合、車両1が減速制御により減速すると、後方対象物は車両1の減速に気づき、速度を落とすと考えられる。一方、後方対象物が車両1に注意を払っていない場合、車両1が減速制御により減速しても、後方対象物は車両1の減速に気づかないので、速度を落とさないと考えられる。検知部172は、このような関係に基づいて、後方対象物が車両1に注意を払っているか否かを判断する。例えば、検知部172は、下記の式(8)が満たされているか否かを判定する。ただし、DECは車両1の減速度であり、DECbackは車両1の後方対象物に対する相対的な減速度である。DECbackは、例えば、後方相対速度の変化に基づいて演算される。Absは、絶対値を演算する演算子である。daは、判断のためのしきい値であり、正の実数である。daは、予め検知部172に設定されてもよいし、動的に変更可能であってもよい。

Figure 0006747141
In another example, the detection unit 172 determines whether the rear target object is paying attention to the vehicle 1 based on the deceleration of the rear target object. When the rear object is paying attention to the vehicle 1, it is considered that when the vehicle 1 decelerates by the deceleration control, the rear object notices the deceleration of the vehicle 1 and slows down. On the other hand, when the rear object is not paying attention to the vehicle 1, the rear object does not notice the deceleration of the vehicle 1 even if the vehicle 1 decelerates by the deceleration control, and therefore it is considered that the vehicle 1 does not slow down. The detection unit 172 determines whether or not the rear target object is paying attention to the vehicle 1 based on such a relationship. For example, the detection unit 172 determines whether the following formula (8) is satisfied. However, DEC is the deceleration of the vehicle 1, and DECback is the deceleration relative to the rear target object of the vehicle 1. DECback is calculated, for example, based on the change in the rear relative speed. Abs is an operator that calculates an absolute value. da is a threshold for judgment and is a positive real number. da may be set in the detection unit 172 in advance, or may be dynamically changeable.
Figure 0006747141

式(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 vehicle 1 and is decelerating, that is, the rear target object is paying attention to the vehicle 1. .. When the expression (8) is not satisfied, the detection unit 172 does not decelerate much because the rear target object is not aware of the vehicle 1, that is, the rear target object does not pay attention to the vehicle 1. To judge.

調整部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 vehicle 1, the adjustment unit 175 compares the case where the detection unit 172 determines that the rear target object is paying attention to the vehicle 1, Q and R are calculated so that the ratio of R to Q is larger.

図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 vehicle 1 in the corresponding control cycle.

まず、調整部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 vehicle 1 based on the detection result of the detection unit 172 (S301). When it is determined that the rear object is paying attention to the vehicle 1 (S301: Yes), the adjusting unit 175 determines Q and R, respectively, and uses the determined Q and R as the evaluation function of the equation (1). It is set (S302). In S302, the adjustment unit 175 determines Q and R such that the ratio of R to Q is equal to the preset ratio Rate1, for example. However, Rate1 is smaller than Rate2 described later. The adjusting unit 175 may store in advance the values of Q and R to be set when the rear target is paying attention to the vehicle 1. For example, the adjusting unit 175 sets 0.9 as Q and 0.1 as R.

後方対象物は車両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 vehicle 1. For example, the adjusting unit 175 sets 0.1 as Q and 0.9 as R.

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 ECU 10 evaluates the speed when the rear object is not paying attention to the vehicle 1 as compared to when the rear object is paying attention to the vehicle 1. The weighting ratio of the term for evaluating speed and the term for evaluating jerk is adjusted so that the weight of the term for evaluating jerk with respect to the term becomes large. Accordingly, when the rear target object is not paying attention to the vehicle 1, the vehicle 1 is decelerated by gentle braking as compared with the case where the rear target object is paying attention to the vehicle 1. It is possible to reduce the risk of a rear-end collision. Further, by suppressing the sudden braking, it is possible to prevent the occupant from losing his/her posture. That is, the riding comfort is improved.

<第4実施形態>
第4実施形態の速度制御装置が適用されたECU10においては、主に、後方対象物に注意喚起を行うことが可能な構成を有することと、調整部175によるQおよびRの調整方法とが、第1実施形態と異なる。第1実施形態と共通する構成および手順については、説明を省略する。
<Fourth Embodiment>
In the ECU 10 to which the speed control device according to the fourth embodiment is applied, mainly, a configuration capable of alerting a rear target object and a method of adjusting Q and R by the adjustment unit 175 are Different from the first embodiment. Descriptions of configurations and procedures common to the first embodiment will be omitted.

図13は、第4実施形態のECU10の機能構成例を示す図である。第4実施形態によれば、ECU10は、音声出力装置20に接続されている。 FIG. 13 is a diagram showing a functional configuration example of the ECU 10 of the fourth embodiment. According to the fourth embodiment, the ECU 10 is connected to the voice output device 20.

音声出力装置20は、例えばスピーカであり、音声を出力することができる。音声出力装置20は、例えば、車体2の後ろ側に設けられている。 The audio output device 20 is, for example, a speaker and can output audio. The audio output device 20 is provided, for example, on the rear side of the vehicle body 2.

ECU10は、取得部15、駆動制御部16、および速度制限部17を備える。速度制限部17は、進路予測部171、検知部172、制御切り替え部173、減速制御部174、および注意喚起部176を備える。減速制御部174は、調整部175を備える。 The ECU 10 includes an acquisition unit 15, a drive control unit 16, and a speed limiting unit 17. The speed limiting unit 17 includes a route prediction unit 171, a detection unit 172, a control switching unit 173, a deceleration control unit 174, and a caution unit 176. The deceleration control unit 174 includes an adjustment unit 175.

注意喚起部176は、車両1の周囲の移動体、特に車両1の後方の移動体に注意喚起を行うための音声を、音声出力装置20に出力させる。注意喚起のための音声は、特定の音声に限定されない。例えば、「車両が通ります」など、言葉で注意喚起してもよいし、ブザー音またはクラクションで注意喚起してもよい。また、注意喚起部176による注意喚起のタイミングは、特定のタイミングに限定されない。注意喚起部176は、車両1が走行中は常に、注意喚起のための音声を音声出力装置20に出力させてもよい。注意喚起部176は、減速制御が実行中である際に、注意喚起のための音声を音声出力装置20に出力させてもよい。注意喚起部176は、減速制御を実行中であるか否かに関わらず、減速中に、注意喚起のための音声を音声出力装置20に出力させてもよい。注意喚起部176は、検知部172によって後方対象物が検知されているときに、注意喚起のための音声を音声出力装置20に出力させてもよい。注意喚起部176は、乗員による指示入力があったときに、注意喚起のための音声を音声出力装置20に出力させてもよい。 The alerting unit 176 causes the voice output device 20 to output a voice for alerting a moving body around the vehicle 1, particularly a moving body behind the vehicle 1. The sound for alerting is not limited to a specific sound. For example, a warning may be given by a word such as "a vehicle passes by", or a buzzer or a horn. Further, the timing of alerting by the alerting unit 176 is not limited to a specific timing. The alerting unit 176 may cause the voice output device 20 to output a voice for alerting while the vehicle 1 is traveling. The alerting unit 176 may cause the voice output device 20 to output a voice for alerting when the deceleration control is being executed. The alerting unit 176 may cause the audio output device 20 to output a voice for alerting during deceleration regardless of whether deceleration control is being performed. The alerting unit 176 may cause the voice output device 20 to output a voice for alerting when the detection unit 172 detects the rear target object. The alerting unit 176 may cause the voice output device 20 to output a voice for alerting when an instruction is input by the occupant.

なお、音声によって注意喚起を行う方法は、注意喚起の方法の一例である。例えば、車両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 vehicle 1, and the alerting unit 176 may alert the rear target object by blinking the taillight.

調整部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 ECU 10 evaluates jerk with respect to the term for evaluating the speed, as compared with the case where the rear target object is not alerted when the rear target object is not alerted. The weighting ratio of the term for evaluating the speed and the term for evaluating the jerk is adjusted so that As a result, when the rear target is not alerted, the moving body is decelerated by gentle braking as compared to when the rear target is alerted, so the risk of a rear collision due to the rear target is reduced. It becomes possible. Further, by suppressing the sudden braking, it is possible to prevent the occupant from losing his/her posture. That is, the riding comfort is improved.

また、第1実施形態〜第4実施形態では、ECU10は、少なくとも後方対象物の状態に基づいて、速度を評価する項に対するジャークを評価する項の重み付けを調整する。これによって、後方対象物が静止物でない場合であっても、その状態に基づいて急激な制動を行うか緩やかな制動を行うかが決定されるので、後方対象物による後突のリスクを低減することが可能となる。後方対象物の状態とは、第1実施形態〜第4実施形態の例では、後方距離、後方相対速度、後方対象物が車両1に注意を払っているか否か、または、後方対象物に注意喚起を行うか否か、である。後方対象物の状態は、これらに限定されない。 In addition, in the first to fourth embodiments, the ECU 10 adjusts the weighting of the term that evaluates jerk with respect to the term that evaluates speed, based on at least the state of the rear target object. As a result, even if the rear object is not a stationary object, it is determined whether to perform sudden braking or gentle braking based on the state, so that the risk of a rear collision due to the rear object is reduced. It becomes possible. In the examples of the first to fourth embodiments, the state of the rear target object means the rear distance, the rear relative speed, whether the rear target object pays attention to the vehicle 1, or the rear target object. Whether or not to call out. The state of the rear target object is not limited to these.

速度を評価する項に対するジャークを評価する項の重み付けを調整する方法として、第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 ECU 10 uses two or more of the above four methods. The weighting may be adjusted by a combination of methods.

組み合わせ方法は、任意である。一例では、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は所定の定数である。

Figure 0006747141
Figure 0006747141
The combination method is arbitrary. In one example, the ECU 10 calculates each of Q and R by two or more methods to calculate the sum. Specifically, for example, when Q and R are calculated by a combination of four methods, the ECU 10 calculates Q1, Q2, Q3, Q4, R1, R2, R3, and R4, respectively, and the following equation (9) ) And equation (10). However, Q1 and R1 are Q and R calculated by the method of the first embodiment, Q2 and R2 are Q and R calculated by the method of the second embodiment, and Q3 and R3 are Q and R calculated by the method of the third embodiment, and Q4 and R4 are Q and R calculated by the method of the fourth embodiment. C is a predetermined constant.
Figure 0006747141
Figure 0006747141

別の例では、ECU10は、下記の式(11)および式(12)によってQおよびRを演算する。

Figure 0006747141
Figure 0006747141
In another example, the ECU 10 calculates Q and R by the following equations (11) and (12).
Figure 0006747141
Figure 0006747141

このように、ECU10は、QおよびRを、複数の方法の組み合わせによって演算することができる。 In this way, the ECU 10 can calculate Q and R by combining a plurality of methods.

また、ECU10は、QおよびRを調整する方法を、複数の方法から選択可能に構成されてもよい。一例では、ECU10は、乗員などが複数の方法のうちの一を選択することが可能に構成され得る。別の例では、ECU10は、状況に応じて方法を自動で切り替えることが可能に構成され得る。 Further, the ECU 10 may be configured so that a method of adjusting Q and R can be selected from a plurality of methods. In one example, the ECU 10 may be configured to allow an occupant or the like to select one of a plurality of methods. In another example, the ECU 10 may be configured to be able to automatically switch the method depending on the situation.

以上、本発明の実施形態を例示したが、上記実施形態および変形例はあくまで一例であって、発明の範囲を限定することは意図していない。上記実施形態や変形例は、その他の様々な形態で実施されることが可能であり、発明の要旨を逸脱しない範囲で、種々の省略、置き換え、組み合わせ、変更を行うことができる。また、各実施形態や各変形例の構成や形状は、部分的に入れ替えて実施することも可能である。 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 SYMBOLS 1... Vehicle, 2... Car body, 2a... Cabin, 2b... Seat, 2c... Front bumper, 2d... Rear bumper, 3... Operating device, 3a... Accelerating operation part, 3b... Steering part, 3c... Shift operation part, 3d... Braking operation part, 4... Front detecting device, 4a, 4b, 4c, 4d, 5a, 5b, 5c, 5d... Sonar, 5... Rear detecting device, 6... Dashboard, 7... Wheel, 7F... Front wheel, 7R... Rear Wheels, 8... Drive device, 9... Wheel speed sensor, 10... ECU, 11... Arithmetic device, 12... Storage device, 13... Input/output device, 14... Bus, 15... Acquisition unit, 16... Drive control unit, 17... Speed limiter, 20... Voice output device, 171... Path prediction part, 172... Detection part, 173... Control switching part, 174... Deceleration control part, 175... Adjusting part, 176... Alerting part.

Claims (4)

移動体の前方の第1対象物と前記移動体の後方の第2対象物とを、前記移動体に設けられた検知装置からの入力情報に基づいて検知する検知部と、
前記検知部によって検知された前記第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対象物と前記移動体の後方の第2対象物とを、前記移動体に設けられた検知装置からの入力情報に基づいて検知する検知部と、
前記検知部によって検知された前記第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対象物と前記移動体の後方の第2対象物とを、前記移動体に設けられた検知装置からの入力情報に基づいて検知する検知部と、
前記検知部によって検知された前記第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対象物と前記移動体の後方の第2対象物とを、前記移動体に設けられた検知装置からの入力情報に基づいて検知する検知部と、
前記検知部によって検知された前記第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 .
JP2016147619A 2016-07-27 2016-07-27 Speed control device Active JP6747141B2 (en)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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

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