JP2020187709A - Control device - Google Patents
Control device Download PDFInfo
- Publication number
- JP2020187709A JP2020187709A JP2019093837A JP2019093837A JP2020187709A JP 2020187709 A JP2020187709 A JP 2020187709A JP 2019093837 A JP2019093837 A JP 2019093837A JP 2019093837 A JP2019093837 A JP 2019093837A JP 2020187709 A JP2020187709 A JP 2020187709A
- Authority
- JP
- Japan
- Prior art keywords
- safety
- area data
- control
- control output
- output
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B9/00—Safety arrangements
- G05B9/02—Safety arrangements electric
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Artificial Intelligence (AREA)
- Health & Medical Sciences (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Feedback Control In General (AREA)
- Safety Devices In Control Systems (AREA)
- Traffic Control Systems (AREA)
Abstract
Description
本発明は、制御装置に関する。 The present invention relates to a control device.
自動運転を初めとする制御の全自動化は、人為的操作を不用とし、人為的誤りに起因する事故の確率を低減し、安全性を向上させることを可能とする。自動運転においては特に推論機能により安全性が低下する状態の発生を予測してそれを回避させる、人間にたとえればいわゆる「かもしれない運転」のために、人工知能の活用が有効な面がある。 Full automation of control such as automatic driving eliminates the need for human operation, reduces the probability of accidents caused by human error, and makes it possible to improve safety. In autonomous driving, the use of artificial intelligence is effective, especially for so-called "possible driving" in which humans can predict the occurrence of a state in which safety is reduced by the inference function and avoid it. ..
しかしその一方で、そのままでは人工知能の制御による動作の安全性の保証が無く、誤った推論結果により安全性が低下する状態を発生させる、いわゆる「だろう運転」の可能性を否定できない。そこで、本発明者らは、人工知能による制御操作候補に安全検証機能を付加して、人工知能による制御の安全性を確保する技術を既に出願している(特許文献1)。 However, on the other hand, there is no guarantee of safety of operation by controlling artificial intelligence as it is, and the possibility of so-called "probable driving" that causes a state in which safety is lowered due to an erroneous inference result cannot be denied. Therefore, the present inventors have already applied for a technique for ensuring the safety of control by artificial intelligence by adding a safety verification function to the control operation candidates by artificial intelligence (Patent Document 1).
本発明者らによる先願によれば、特に実際の動作実績に基づいて、制御操作候補の安全性が確認された場合のみ、または安全性が確認された範囲に制限した場合のみ、動作を許可することにより、制御システムの動作の安全性を保証することができる。 According to the prior application by the present inventors, the operation is permitted only when the safety of the control operation candidate is confirmed based on the actual operation results, or only when the safety is limited to the confirmed range. By doing so, the safety of operation of the control system can be guaranteed.
しかしその反面、動作実績のない条件下での制御操作候補の安全性を確認することは困難である。あらゆる条件下での制御操作候補の安全性を確認することを可能とするためには、あらゆる条件下での制御システムの安全な動作実績データの収集が必要となる。したがって、データを取得するために長時間を要することになり、データ量も膨大なものとなる。 However, on the other hand, it is difficult to confirm the safety of the control operation candidates under the condition that there is no operation record. In order to be able to confirm the safety of control operation candidates under all conditions, it is necessary to collect safe operation record data of the control system under all conditions. Therefore, it takes a long time to acquire the data, and the amount of data becomes enormous.
本発明は、上記の点に鑑みてなされたものであり、その目的とするところは、動作実績のない条件下であっても制御操作候補の安全性を確保することができる制御装置を提供することである。 The present invention has been made in view of the above points, and an object of the present invention is to provide a control device capable of ensuring the safety of control operation candidates even under conditions where there is no actual operation record. That is.
上記課題を解決する本発明の制御装置は、所定の入力に基づいて制御出力を生成する知能化制御部と、前記制御出力が予め設定された安全領域データ内にあるか否かを判定する安全検証部と、前記制御出力が前記安全領域データ内にある場合には前記制御出力による制御を許可し、前記安全領域データ外にある場合には前記制御出力による制御を禁止、または、前記制御出力を前記安全領域データ内に制限して制御する出力制御部と、を備え、前記安全検証部は、前記安全領域データを制御対象の動作条件に応じて変化させることを特徴とする。 The control device of the present invention that solves the above problems includes an intelligent control unit that generates a control output based on a predetermined input, and safety that determines whether or not the control output is within preset safety area data. The verification unit allows control by the control output when the control output is within the safety area data, and prohibits control by the control output when the control output is outside the safety area data, or the control output. Is provided with an output control unit that limits and controls the data in the safety area data, and the safety verification unit is characterized in that the safety area data is changed according to the operating conditions of the control target.
本発明によれば、安全領域データを制御対象の動作条件に応じて変化させるので、特定の条件下で収集された制御装置の安全な動作実績データから、他の動作条件下での制御出力の安全制限出力を生成することができる。したがって、動作実績のない条件下であっても制御操作候補の安全性を確保することが可能となる。 According to the present invention, since the safety area data is changed according to the operating conditions of the controlled object, the control output under other operating conditions is obtained from the safe operating record data of the control device collected under specific conditions. A safety limit output can be generated. Therefore, it is possible to ensure the safety of the control operation candidate even under the condition that there is no operation record.
本発明に関連する更なる特徴は、本明細書の記述、添付図面から明らかになるものである。また、上記した以外の、課題、構成及び効果は、以下の実施形態の説明により明らかにされる。 Further features relating to the present invention will become apparent from the description herein and the accompanying drawings. In addition, problems, configurations, and effects other than those described above will be clarified by the following description of the embodiments.
以下に、本発明の実施形態について図面を用いて説明する。なお、以下の各実施形態では、本発明の制御装置を車両の自動運転制御に適用した場合を例に説明するが、これに限定されるものではなく、他の移動体に用いてもよい。 Hereinafter, embodiments of the present invention will be described with reference to the drawings. In each of the following embodiments, the case where the control device of the present invention is applied to the automatic driving control of the vehicle will be described as an example, but the present invention is not limited to this, and the control device may be used for other moving bodies.
<第1実施形態>
図1Aは、第1実施形態における制御装置のブロック図、図1Bは、動作条件によって安全領域データをスケーリング(拡大または縮小)する方法について説明する図である。
<First Embodiment>
FIG. 1A is a block diagram of the control device according to the first embodiment, and FIG. 1B is a diagram illustrating a method of scaling (enlarging or reducing) the safety region data according to operating conditions.
本実施形態の制御装置2は、不図示の操作インタフェース部に有線または無線で接続され、操作インタフェース部から入力される操作量情報に基づいて、図外の制御対象を制御するための安全制御出力50を生成する。制御装置2は、自動制御出力を生成する自動制御部20と、自動制御出力の安全性を検証する安全検証部30と、出力制御部3を構成するANDゲート40を備える。自動制御出力の安全性を検証するとは、自動制御出力が出力制御部3から図外の制御対象に入力された場合に、制御対象が安全に動作するかを判定することである。制御装置2は、安全検証部30によって安全性が確保できる場合に、自動制御部20の自動制御出力を出力し、安全性が確保できない場合には自動制御出力の出力を制限する構成を有する。
The
制御装置2は、知能化制御部である自動制御部20により深層学習または機械学習などの人工知能を導入することにより、人知を超えた制御性能を実現することが期待されている。しかし、人知を超えるがゆえに、安全に関するアカウンタビリティ(説明責任、説明性)の向上が望ましい。制御装置2は、安全検証部30によって、人工知能による人知を超えた高度な制御においても安全性を確保することができる。
The
安全検証部30は、所定の入力4と自動制御出力21とが入力され、それらの値4、21に対応する検証出力(検証結果)を出力する判定回路301を有する。安全性の確認結果である検証結果は、「OK」(安全性あり)または「NG」(安全性なし)のいずかで出力される。安全検証部30は、現在の入力4および現在の自動制御出力21に限らず、過去の値からの遷移状態を利用することもできる。過去の値からの状態遷移にも着目する場合(遷移チェック302付き)、1サンプル前(Z−1)の入力4および自動制御出力21も判定回路301Aへ入力される。
The
判定回路301は、現在の所定の入力4および現在の自動制御出力21と、1サンプル前の所定の入力4および自動制御出力21(すなわち過去の入力4および過去の自動制御出力21)とに基づいて、安全性あり(OK)または安全性なし(NG)の検証結果を出力する。
The
安全検証部30は、判定回路301の検証結果が「OK」(安全性あり)である場合、出力制御部3のANDゲート40に信号を出力して、ANDゲート40が自動制御部20の自動制御出力21を出力できるようにする。これに対し、安全検証部30は、判定回路301の検証結果が「NG」(安全性なし)である場合、ANDゲート40に信号を出力して、ANDゲート40に自動制御出力21の出力を遮断または制限させるようにする。出力制御部3は、安全検証部30の検証結果がNGの場合、自動制御出力21による制御を禁止、または、自動制御出力21を安全領域データ内に制限して制御する。制御装置2は、安全検証部30によって、自動制御部20からの自動制御出力21の安全性を監視するため、制御対象の安全な動作を保証できる。
When the verification result of the
安全検証部30は、自動制御出力21が過去に安全な制御結果を経験した範囲を安全領域データとして記憶する安全領域データベースを備えている。安全検証部30は、特定の動作条件i下で制御出力が安全な動作実績データを収集して安全な制御出力範囲である安全領域データを取得し、安全領域データベースに記憶する。そして、図1Bに示すように、特定の動作条件i下の安全領域データを動作条件に基づいてスケーリングすることによって、特定の動作条件i下の安全領域データから、特定の動作条件iとは異なる他の動作条件下でも制御出力が安全であるとされる安全領域データを生成する。
The
本実施形態の安全検証部30は、特定の動作条件i下で取得した安全領域データを動作条件でスケーリングすることにより変化させて、条件1〜条件n(nは整数)に対応する安全領域データを生成する。安全検証部30は、シミュレーションまたは実機を実際に動作させて、スケーリングにより生成された安全領域データを用いた制御出力の動作結果が安全であったかどうかを検証し、安全が確認されたデータを安全領域データとして取得する。
The
本実施形態の制御装置2は、特定の動作条件下での制御装置2の安全な動作実績データ(安全領域データ)を収集する。そして、その動作条件と、制御装置の安全な動作実績データの境界値の関係(特に、比例関係、反比例関係)を分析する。それから、その関係に基づいて、スケーリングを行うことにより、異なる動作条件下での制御装置2の安全領域データを生成する。安全領域データは、少なくとも一つ以上の次元(組み合わせる変数の数)を持ち、スケーリングは、安全領域データを特定の次元の軸において拡大縮小させること、或いは、特定の次元において係数を乗じることにより行われる。
The
本実施例によれば、特定の動作条件iについて安全領域データを取得すれば、その安全領域データを条件に応じてスケーリングすることによって、動作実績のない条件1〜条件nに対応する安全領域データを得ることができる。したがって、条件1〜条件nにおいて動作実績データを取得する必要がなく、これらの安全領域データを取得するための時間を大幅に短縮することが可能となる。
According to this embodiment, if the safety area data is acquired for a specific operating condition i, the safety area data is scaled according to the condition, so that the safety area data corresponding to the
<第2実施形態>
本実施形態は、車両の自動運転制御に際して、速度指令値と操舵角指令値の組み合わせを安全領域データとしたものであり、動作条件は、移動体である車両が走行する路面の摩擦係数である。
<Second Embodiment>
In the present embodiment, the combination of the speed command value and the steering angle command value is used as the safety region data in the automatic driving control of the vehicle, and the operating condition is the friction coefficient of the road surface on which the moving vehicle travels. ..
図2と図3は、第2実施形態の制御装置の内容を説明する図であり、図2は、速度指令値と操舵角指令値により規定される安全性確認済の安全領域データを示す図、図3は、図2に示す安全性確認済の安全領域データを摩擦係数μでスケーリングしたスケーリング後の安全領域データを示す図である。図2および図3において図示される上下の直線部分(境界A)は、操舵機構の構造で決まる最大操舵角であり、図示される右上、右下の曲線部分(境界B)は、遠心力とタイヤグリップ力で制約される領域である。 2 and 3 are diagrams for explaining the contents of the control device of the second embodiment, and FIG. 2 is a diagram showing safety-confirmed safety region data defined by a speed command value and a steering angle command value. , FIG. 3 is a diagram showing the safety region data after scaling of the safety region data whose safety has been confirmed shown in FIG. 2 by the friction coefficient μ. The upper and lower straight lines (boundary A) shown in FIGS. 2 and 3 are the maximum steering angles determined by the structure of the steering mechanism, and the upper right and lower right curved parts (boundary B) shown are centrifugal forces. This is an area constrained by tire grip.
車体の遠心力は、
F=mv^2 /R (但し、F:遠心力、m: 車体重量、v: 速度、R: 旋回半径)・・・(1)
と表され、旋回半径Rは、
R = L /(sinθ) (但し、L: ホイールベースの長さ、θ: 操舵角)・・・(2)
であるから式(2)を式(1)に代入すると、
F = m・sinθ・v^2 /L ・・・(3)
となる。
タイヤの摩擦力は、
F = mμ ・・・(4)
であるから、式(3)=式(4)とおくと、
m・sinθ・v^2 /L = mμ
となり、即ち、
v = SQRT(μ・L /( sinθ))
となる。
The centrifugal force of the car body is
F = mv ^ 2 / R (However, F: centrifugal force, m: vehicle weight, v: speed, R: turning radius) ・ ・ ・ (1)
The turning radius R is
R = L / (sin θ) (However, L: wheelbase length, θ: steering angle) ・ ・ ・ (2)
Therefore, when Eq. (2) is substituted into Eq. (1),
F = m ・ sinθ ・ v ^ 2 / L ・ ・ ・ (3)
Will be.
The frictional force of the tire is
F = mμ ・ ・ ・ (4)
Therefore, if Eq. (3) = Eq. (4),
m ・ sinθ ・ v ^ 2 / L = mμ
That is,
v = SQRT (μ ・ L / (sin θ))
Will be.
安全検証部30は、例えば路面の摩擦係数μが1.0(条件i)のときの動作実績データから安全領域データ(図2のSa)を取得し、その安全領域データを摩擦係数μまたは摩擦係数μの平方根に比例して拡大縮小(他の条件でスケーリング)することにより、路面の摩擦係数μが0.5のときの安全領域データ(図3のSa)をはじめとして、任意の路面の摩擦係数μについて安全領域データを生成することができる。
For example, the
限界となる速度vは、以下のように求められ、TTC(Time to collision)一定、すなわち停止時間一定と仮定した場合には摩擦係数μに比例し、停止距離一定と仮定した場合には摩擦係数μの平方根に比例する。 The limit velocity v is obtained as follows, and is proportional to the friction coefficient μ when the TTC (Time to collision) is constant, that is, when the stop time is constant, and the friction coefficient is when the stop distance is constant. It is proportional to the square root of μ.
まず、TTC(Time to collision)一定、すなわち停止時間一定と仮定した場合に限界となる速度vを求める。
v=at(但し、v: 速度、a: 加速度、t: 時間) ・・・(5)
であるから、時間tの間に速度vから速度0に減速するために必要な減速度は、
a = v/t
となる。ここで、tを一定と仮定すると、
v ∝ a
となる。さらに、
a ∝ μ
であるから、
v ∝ μ
となる。
First, the speed v, which is the limit when the TTC (Time to collision) is constant, that is, the stop time is assumed to be constant, is obtained.
v = at (however, v: velocity, a: acceleration, t: time) ・ ・ ・ (5)
So the deceleration required to slow down from speed v to speed 0 during time t is
a = v / t
Will be. Here, assuming that t is constant,
v ∝ a
Will be. further,
a ∝ μ
Because it is
v ∝ μ
Will be.
続いて、停止距離を一定と仮定した場合に限界となる速度を求める。
y = at^2 /2(但し、y: 距離) ・・・(6)
であるから、停止距離を一定と仮定すると、式(5)より、
t = v/a ・・・(7)
である。したがって、式(6)に式(7)を代入すると、
y = v^2 /(2a)
となる。
Then, the speed that becomes the limit when the stopping distance is assumed to be constant is obtained.
y = at ^ 2/2 (however, y: distance) ・ ・ ・ (6)
Therefore, assuming that the stopping distance is constant, from equation (5),
t = v / a ・ ・ ・ (7)
Is. Therefore, substituting Eq. (7) into Eq. (6),
y = v ^ 2 / (2a)
Will be.
ここで、yを一定と仮定すると、
v^2 ∝ a
となる。同様にして、
a ∝ μ
であるから、
v ∝ SQRT(μ)
となる。
Here, assuming that y is constant,
v ^ 2 ∝ a
Will be. Similarly,
a ∝ μ
Because it is
v ∝ SQRT (μ)
Will be.
また、大型車両においては、車重や積載量等の条件を変更することにより速度指令値と操舵角指令値の安全領域データをスケーリングすることも可能である。 Further, in a large vehicle, it is possible to scale the safety region data of the speed command value and the steering angle command value by changing the conditions such as the vehicle weight and the load capacity.
<第3実施形態>
本実施形態は、車両の制御に際して、交差点に進入してからの経過時間と操舵角指令値の組み合わせを安全領域データとしたものである。
<Third Embodiment>
In this embodiment, when controlling the vehicle, the combination of the elapsed time after entering the intersection and the steering angle command value is used as the safety region data.
図4と図5は、第3実施形態の制御装置の内容を説明する図であり、図4は、交差点の形状の特徴量についての一例を示す図、図5は、車速Voのときの安全性確認済の安全領域データを示す図である。 4 and 5 are diagrams for explaining the contents of the control device of the third embodiment, FIG. 4 is a diagram showing an example of the feature amount of the shape of the intersection, and FIG. 5 is a diagram showing safety at a vehicle speed Vo. It is a figure which shows the safety area data which confirmed sex.
本実施形態では、移動体である自車両200が交差点403を通過する場合を例に説明する。なお、本実施形態は、左側通行の場合を例に説明するが、本発明は、右側通行の場合にも同様に適用することができる。
In the present embodiment, the case where the
道路400は、図4に示すように、2本の直線路401、402がほぼ直角に交わる、いわゆる四叉路の道路形状を有している。自車両200は、一方の直線路401を直進して、交差点入り口411から交差点403に進入し、交差点403で右折して他方の直線路402を走行する経路を辿る自動運転制御がなされる。
As shown in FIG. 4, the
交差点403は、その形状の特徴量として、交差点の大きさと、曲がる回転角度で表すことができる。交差点の大きさは、交差点の入り口から奥行きの距離Dで表すことができる。交差点403は、一方の直線路401における交差点入り口411から交差点出口までの直線距離が奥行きDであり、一方の直線路401の交差点入り口411から他方の直線路402の交差点出口412までの右折角度が角度αである。
The
安全検証部30は、動作実績データから車速Voで交差点403を安全に右折することができる安全領域データを取得して安全確認済の安全領域データSaを生成する。安全領域データSaは、交差点403に進入してからの経過時間tと、交差点403を右折した際の操舵角指令値θとの組み合わせによって規定される。安全領域データSa外の領域は、走行に注意を有する注意領域Sbとなる。安全検証部30は、交差点の形状の特徴量を表す奥行きD、角度α、および、移動体の速度(車速)Vにより安全領域データSaをスケーリングする。
The
図6は、図5に示す安全性確認済の安全領域データを2倍の車速2Voでスケーリングしたスケーリング後の安全領域データを示す図、図7は、図5に示す安全性確認済の安全領域データを3倍の車速3Voでスケーリングしたスケーリング後の安全領域データを示す図である。 FIG. 6 is a diagram showing the safety region data after scaling of the safety confirmed safety region data shown in FIG. 5 at a vehicle speed of 2 Vo, and FIG. 7 is a diagram showing the safety region data after scaling shown in FIG. It is a figure which shows the safety area data after scaling by scaling the data at 3 times the vehicle speed 3Vo.
図5に示す安全性確認済の安全領域データを2倍の車速2Voでスケーリングしたスケーリング後の安全領域データSaは、図6に示すように、経過時間tを2分の1の大きさに縮小した大きさを有している。図5に示す安全性確認済の安全領域データを3倍の車速3Voでスケーリングしたスケーリング後の安全領域データは、図7に示すように、経過時間tを3分の1の大きさに縮小した大きさを有している。 As shown in FIG. 6, the safety region data Sa after scaling, which is obtained by scaling the safety region data for which safety has been confirmed shown in FIG. 5 at a vehicle speed of 2 Vo, reduces the elapsed time t to half the size as shown in FIG. Has a large size. As shown in FIG. 7, the safety area data after scaling, which is obtained by scaling the safety confirmed safety area data shown in FIG. 5 at a vehicle speed of 3 Vo, reduced the elapsed time t to one-third of the size as shown in FIG. It has a size.
移動体の速度(車速)Vについては、図5−図7に示すように、交差点403に進入してからの経過時間tが移動体の速度(車速)Vに反比例してスケーリングされる。したがって、例えば速度Voの動作実績データから安全性確認済の安全領域データを所得すれば、スケーリングによって任意の速度Vに対応する安全領域データを得ることができる。
As for the speed (vehicle speed) V of the moving body, as shown in FIGS. 5 to 7, the elapsed time t after entering the
次に、交差点の奥行きDについて考える。
車両のホイールベースをL、前輪の旋回半径をR、操舵角をθとすると、
L=R・sin θ
となる。従って操舵角θは、
θ=sin−1(L/R)
となる。
通常は、R=Dであるから、
θ=sin−1(L/D)
となる。
Next, consider the depth D of the intersection.
Assuming that the wheelbase of the vehicle is L, the turning radius of the front wheels is R, and the steering angle is θ,
L = R · sin θ
Will be. Therefore, the steering angle θ is
θ = sin -1 (L / R)
Will be.
Normally, R = D, so
θ = sin -1 (L / D)
Will be.
図8は、交差点の奥行きDoのときの安全性確認済の安全領域データを示す図、図9は、図8に示す安全性確認済の安全領域データを2倍の奥行き2Doでスケーリングしたスケーリング後の安全領域データを示す図、図10は、図8に示す安全性確認済の安全領域データを3倍の奥行き3Doでスケーリングしたスケーリング後の安全領域データを示す図である。図8に示す安全性確認済の安全領域データを2倍の奥行き2Doでスケーリングしたスケーリング後の安全領域データSaは、図9に示すように、操舵角指令値θを所定の大きさに縮小した大きさを有している。図8に示す安全性確認済の安全領域データを3倍の奥行き3Doでスケーリングしたスケーリング後の安全領域データSaは、図10に示すように、操舵角指令値θを奥行き2Doの場合よりも更に縮小した大きさを有している。 FIG. 8 is a diagram showing the safety area data for which the safety has been confirmed at the depth Do of the intersection, and FIG. 9 shows the safety area data for which the safety has been confirmed shown in FIG. 8 after scaling with a double depth of 2 Do. FIG. 10 is a diagram showing the safety area data of FIG. 10, which is a diagram showing the safety area data after scaling by scaling the safety area data of the safety confirmed shown in FIG. 8 with a depth of 3 Do. As shown in FIG. 9, the safety region data Sa after scaling, which is obtained by scaling the safety region data whose safety has been confirmed in FIG. 8 with a double depth of 2 Do, reduces the steering angle command value θ to a predetermined size as shown in FIG. It has a size. As shown in FIG. 10, the safety region data Sa after scaling, which is obtained by scaling the safety region data whose safety has been confirmed in FIG. 8 with a depth of 3 Do, has a steering angle command value θ further than that in the case of a depth of 2 Do. It has a reduced size.
交差点403の奥行きDについては、図8−図10に示すように、操舵角指令値θがsin−1(L/D)に比例してスケーリングされる。したがって、例えば奥行きDoの動作実績データから安全確認済の安全領域データを取得すれば、スケーリングによって任意の奥行きDに対応する安全領域データを得ることができる。
As for the depth D of the
次に、交差点の入り口と出口とのなす角αについて考える。
図11は、交差点の曲がる角度αが90度のときの安全性確認済の安全領域データを示す図、図12は、図11に示す安全性確認済の安全領域データを交差点の曲がる角度αが120度でスケーリングしたスケーリング後の安全領域データを示す図、図13は、図11に示す安全性確認済の安全領域データを交差点の曲がる角度αが45度でスケーリングしたスケーリング後の安全領域データを示す図、図14は、図11に示す安全性確認済の安全領域データを交差点の曲がる角度αが30度でスケーリングしたスケーリング後の安全領域データを示す図である。
Next, consider the angle α between the entrance and exit of the intersection.
FIG. 11 is a diagram showing safety-confirmed safety area data when the bending angle α of the intersection is 90 degrees, and FIG. 12 is a diagram showing safety-confirmed safety area data shown in FIG. 11 with the bending angle α of the intersection. The figure showing the safety area data after scaling scaled at 120 degrees, FIG. 13 shows the safety area data after scaling obtained by scaling the safety confirmed safety area data shown in FIG. 11 at an intersection bending angle α of 45 degrees. FIG. 14 is a diagram showing the safety area data after scaling of the safety confirmed safety area data shown in FIG. 11 by scaling the intersection bending angle α at 30 degrees.
入り口と出口のなす角αについては、図11−図14に示すように交差点に進入してからの経過時間が入り口と出口のなす角αに比例してスケーリングされる。したがって、例えば交差点の曲がる角度αが90度(α=90度)の動作実績データから安全確認済の安全領域データを取得すれば、スケーリングによって任意の角度αに対応する安全領域データを得ることができる。 As for the angle α formed by the entrance and the exit, as shown in FIGS. 11-14, the elapsed time from entering the intersection is scaled in proportion to the angle α formed by the entrance and the exit. Therefore, for example, if the safety area data for which safety has been confirmed is acquired from the operation record data in which the bending angle α of the intersection is 90 degrees (α = 90 degrees), the safety area data corresponding to an arbitrary angle α can be obtained by scaling. it can.
<第4実施形態>
図15は、図2に示す安全性確認済の安全領域データをタイヤのスライド量(アンダーステア、オーバーステア)で補正した安全領域データを示す図、図16は、図5に示す安全性確認済の安全領域データを3倍の車速3Voでスケーリングし、スケーリング後の安全領域データをタイヤのスライド量(オーバーステア、アンダーステア)で補正した安全領域データを示す図である。
<Fourth Embodiment>
FIG. 15 is a diagram showing safety region data in which the safety-confirmed safety region data shown in FIG. 2 is corrected by the amount of tire slide (understeer, oversteer), and FIG. 16 is a diagram showing safety-confirmed safety region data shown in FIG. It is a figure which shows the safety area data which scaled the safety area data at 3 times the vehicle speed 3V, and corrected the safety area data after scaling by the slide amount (oversteer, understeer) of a tire.
速度指令値と操舵角指令値により規定される安全領域データSaに、遠心力とタイヤグリップ力で制約される領域でタイヤのスライド(オーバーステア、アンダーステア)を許容する安全領域データSc、Sdも考慮して設定することができる。なお、この場合、図16に示すように、操舵角指令値の安全領域データSaもタイヤのスライド(オーバーステア、アンダーステア)を考慮して設定される。 The safety area data Sa defined by the speed command value and the steering angle command value also considers the safety area data Sc and Sd that allow tire slide (oversteer, understeer) in the area constrained by centrifugal force and tire grip force. Can be set. In this case, as shown in FIG. 16, the safety region data Sa of the steering angle command value is also set in consideration of the tire slide (oversteer, understeer).
<第5実施形態>
図17は、第5実施形態における制御装置のブロック図、図18は、安全検証部の動作の説明図である。上述の実施形態と同様の構成要素には同一の符号を付することでその詳細な説明を省略する。
<Fifth Embodiment>
FIG. 17 is a block diagram of the control device according to the fifth embodiment, and FIG. 18 is an explanatory diagram of the operation of the safety verification unit. The same components as those in the above-described embodiment are designated by the same reference numerals, and detailed description thereof will be omitted.
制御装置2Aの安全検証部30Aは、判定回路301Aと、遷移チェック302を有する。安全検証部30の判定回路301Aは、図17に示すように、現在の所定の入力4および現在の自動制御出力21と、1サンプル前の所定の入力4および自動制御出力21(すなわち過去の入力4および過去の自動制御出力21)とに基づいて、安全性あり(OK)または安全性なし(NG)の検証結果を出力する。
The
安全検証部30Aの動作は、図18に示すように、例えばCAM(Content Addressable Memory、連想記憶メモリ)等を用いて定義することができる。例えばCAMには、所定の入力4および自動制御出力21と、遷移チェック302付きの場合には過去の所定の入力4および過去の自動制御出力21との組み合わせをエントリーとして、それらに対応した検証出力(OK/NG)が予め設定されている。
As shown in FIG. 18, the operation of the
このように構成される本実施形態も第1実施形態と同様の作用効果を奏する。さらに本実施例の安全検証部30Aは、過去の入力4および過去の自動制御出力21も考慮して、自動制御出力21が安全であるか判定することができる。これにより、より効率的にかつ高い信頼性をもって安全性を検証することができる。
The present embodiment configured in this way also has the same effect as that of the first embodiment. Further, the
<第6実施形態>
図19は、第6実施形態における制御装置のブロック図、図20は、安全検証部の動作の説明図である。上述の実施形態と同様の構成要素には同一の符号を付することでその詳細な説明を省略する。
制御装置2Bは、自動制御出力21を所定の制御出力上限値と所定の制御出力下限値とで定まる所定の範囲内に収まるように出力することができる。制御装置2Bは、自動制御部20と、安全検証部30Bと、制限値選択回路41とを含む。
<Sixth Embodiment>
FIG. 19 is a block diagram of the control device according to the sixth embodiment, and FIG. 20 is an explanatory diagram of the operation of the safety verification unit. The same components as those in the above-described embodiment are designated by the same reference numerals, and detailed description thereof will be omitted.
The
安全検証部30Bの判定回路301Bは、現在の所定の入力4および現在の自動制御出力21が入力されると、それらに対応する制御出力上限および制御出力下限を出力する。安全検証部30Bは、上述の各実施形態と同様に、過去の値からの状態遷移にも着目することができる。すなわち、安全検証部30Bには、現在の入力4および現在の自動制御出力21に加えて、1サンプル前(Z−1)の過去の入力4および過去の自動制御出力21も入力される。安全検証部30Bの判定回路301Bは、それら現在および過去の情報に対応する制御出力上限および制御出力下限を出力する。
When the current
制限値選択回路41は、入力された自動制御出力21が制御出力上限と制御出力下限の間にある場合は、その自動制御出力21を安全制限出力50として出力する。制限値選択回路41は、入力された自動制御出力21が制御出力上限を上回る場合は、自動制御出力21を制御出力上限に制限した値を安全制限出力50として出力する。制限値選択回路41は、入力された自動制御出力21が制御出力下限を下回る場合は、自動制御出力21を制御出力下限に制限した値を安全制限出力50として出力する。
When the input
さらに、制限値選択回路41は、安全検証結果をステータス51として出力することもできる。安全検証結果のステータスは、例えば、「OK」「OK w/limit」「NG」の複数段階に分けられている。
Further, the limit
ステータス「OK」とは、自動制御出力21が制御出力下限と制御出力上限の範囲内にある場合である。ステータス「OK w/limit」とは、自動制御出力21が制御出力下限と制御出力上限との範囲の外に存在するが、制御出力下限と制御出力上限との間の値に補正しうる場合である。つまり、自動制御出力21を制御出力下限と制御出力上限との範囲内に補正可能な場合である。ステータス「NG」とは、自動制御出力21が制御出力下限と制御出力上限との範囲内に存在せず、制御出力下限と制御出力上限の間の範囲の値を取ることのできない場合(制御出力下限<制御出力上限が成り立たない場合)である。
The status "OK" is a case where the
図20は、本実施形態における安全検証部30Bの動作を示す。図18で述べたと同様に、安全検証部30BはCAMと等価に構成することができる。安全検証部30Bは、現在の所定の入力4と、遷移チェック付きの場合には過去の所定の入力4および過去の自動制御出力21との組み合わせが入力されると、それらに対応した制御出力上限および制御出力下限を出力する。
FIG. 20 shows the operation of the
このように構成される本実施例も第5実施形態と同様の作用効果を奏する。さらに本実施形態では、安全検証部30Bが制限出力下限および制限出力上限を出力し、制限値選択回路41は制限出力下限と制限出力上限との範囲内に収まるように自動制御出力21を安全制限出力50として出力する。さらに、本実施例の安全検証部30Bは、安全検証結果のステータスを「OK」「OK w/limit」「NG」の複数段階で出力することができる。したがって、本実施例によれば、より柔軟かつ安全に、自動制御出力21を用いて安全制限出力50を得ることができる。
This embodiment configured in this way also has the same effect as that of the fifth embodiment. Further, in the present embodiment, the
図21と図22は、図17と図19に対応する制御装置の他の実施例を説明するブロック図である。図21に示す制御装置2A’および図22に示す制御装置2B’は、図17に示す第5実施形態の制御装置2Aおよび図19に示す第6実施形態の制御装置2Bの構成において、安全検証部30A、30Bの入出力に、スケーリングのための係数を乗じる係数部100〜102を付加した構成を有する。図1に示す第1実施形態の構成のように、1つの動作実績データによる安全領域データから複数の条件の安全領域データを予め作成する方法では、データ量が膨大なものとなる。これに対し、本実施形態では、1つのデータで様々な動作条件に対応することができ、データ量を大幅に削減することができる。
21 and 22 are block diagrams illustrating another embodiment of the control device corresponding to FIGS. 17 and 19. The control device 2A'shown in FIG. 21 and the control device 2B'shown in FIG. 22 are safety-verified in the configurations of the
以上、本発明の実施形態について詳述したが、本発明は、前記の実施形態に限定されるものではなく、特許請求の範囲に記載された本発明の精神を逸脱しない範囲で、種々の設計変更を行うことができるものである。例えば、前記した実施の形態は本発明を分かりやすく説明するために詳細に説明したものであり、必ずしも説明した全ての構成を備えるものに限定されるものではない。また、ある実施形態の構成の一部を他の実施形態の構成に置き換えることが可能であり、また、ある実施形態の構成に他の実施形態の構成を加えることも可能である。さらに、各実施形態の構成の一部について、他の構成の追加・削除・置換をすることが可能である。 Although the embodiments of the present invention have been described in detail above, the present invention is not limited to the above-described embodiments, and various designs are designed without departing from the spirit of the present invention described in the claims. You can make changes. For example, the above-described embodiment has been described in detail in order to explain the present invention in an easy-to-understand manner, and is not necessarily limited to the one including all the described configurations. Further, it is possible to replace a part of the configuration of one embodiment with the configuration of another embodiment, and it is also possible to add the configuration of another embodiment to the configuration of one embodiment. Further, it is possible to add / delete / replace a part of the configuration of each embodiment with another configuration.
2、2A、2B:制御装置
3:出力制御部
4:入力
20:自動制御部(知能化制御部)
21:自動制御出力
30、30A、30B:安全検証部
40:ANDゲート
50:安全制限出力
100〜102:係数部
200:自車両
301、301A、301B:判定回路
302:遷移チェック
2, 2A, 2B: Control device 3: Output control unit 4: Input 20: Automatic control unit (intelligent control unit)
21:
Claims (10)
前記制御出力が予め設定された安全領域データ内にあるか否かを判定する安全検証部と、
前記制御出力が前記安全領域データ内にある場合には前記制御出力による制御を許可し、前記安全領域データ外にある場合には前記制御出力による制御を禁止、または、前記制御出力を前記安全領域データ内に制限して制御する出力制御部と、
を備え、
前記安全検証部は、前記安全領域データを制御対象の動作条件に応じて変化させることを特徴とする制御装置。 An intelligent control unit that generates a control output based on a predetermined input,
A safety verification unit that determines whether or not the control output is within the preset safety area data,
When the control output is in the safety area data, control by the control output is permitted, and when it is outside the safety area data, control by the control output is prohibited, or the control output is set to the safety area. An output control unit that limits and controls the data,
With
The safety verification unit is a control device characterized in that the safety area data is changed according to operating conditions of a controlled object.
前記安全検証部は、過去の入力および過去の制御出力に基づいて前記制御出力が前記安全領域データ内にあるか否かを判定することを特徴とする請求項1に記載の制御装置。 It is provided with a database that stores the range in which the control output has experienced a safe control result in the past as the safe area data.
The control device according to claim 1, wherein the safety verification unit determines whether or not the control output is within the safety area data based on a past input and a past control output.
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019093837A JP7250613B2 (en) | 2019-05-17 | 2019-05-17 | Control device |
PCT/JP2020/018069 WO2020235317A1 (en) | 2019-05-17 | 2020-04-28 | Control device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019093837A JP7250613B2 (en) | 2019-05-17 | 2019-05-17 | Control device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2020187709A true JP2020187709A (en) | 2020-11-19 |
JP7250613B2 JP7250613B2 (en) | 2023-04-03 |
Family
ID=73222830
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2019093837A Active JP7250613B2 (en) | 2019-05-17 | 2019-05-17 | Control device |
Country Status (2)
Country | Link |
---|---|
JP (1) | JP7250613B2 (en) |
WO (1) | WO2020235317A1 (en) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000338004A (en) * | 1999-05-31 | 2000-12-08 | Horiba Ltd | Travelling performance learning method for motor- vehicle drive system, motor-vehicle drive system, and recording medium to record travelling performance learning program |
JP2003098047A (en) * | 2001-09-26 | 2003-04-03 | Horiba Ltd | Automobile automatic operation system |
JP2010023657A (en) * | 2008-07-18 | 2010-02-04 | Jtekt Corp | Electric power steering device |
JP2018185746A (en) * | 2017-04-27 | 2018-11-22 | 株式会社日立製作所 | Control system and control method |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000034093A (en) * | 1998-07-21 | 2000-02-02 | Kobe Steel Ltd | Slewing type working machinery and its safety working area and setting method of rated load |
-
2019
- 2019-05-17 JP JP2019093837A patent/JP7250613B2/en active Active
-
2020
- 2020-04-28 WO PCT/JP2020/018069 patent/WO2020235317A1/en active Application Filing
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000338004A (en) * | 1999-05-31 | 2000-12-08 | Horiba Ltd | Travelling performance learning method for motor- vehicle drive system, motor-vehicle drive system, and recording medium to record travelling performance learning program |
JP2003098047A (en) * | 2001-09-26 | 2003-04-03 | Horiba Ltd | Automobile automatic operation system |
JP2010023657A (en) * | 2008-07-18 | 2010-02-04 | Jtekt Corp | Electric power steering device |
JP2018185746A (en) * | 2017-04-27 | 2018-11-22 | 株式会社日立製作所 | Control system and control method |
Also Published As
Publication number | Publication date |
---|---|
WO2020235317A1 (en) | 2020-11-26 |
JP7250613B2 (en) | 2023-04-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3588226B1 (en) | Method and arrangement for generating control commands for an autonomous road vehicle | |
Du et al. | A cooperative control framework for CAV lane change in a mixed traffic environment | |
Tehrani et al. | General behavior and motion model for automated lane change | |
CN109791051A (en) | Vehicle-mounted interface device, judgment method, program and storage medium | |
CN110297484B (en) | Unmanned control method, device, computer equipment and storage medium | |
Kamran et al. | Minimizing safety interference for safe and comfortable automated driving with distributional reinforcement learning | |
Horst et al. | Trajectory generation for an on-road autonomous vehicle | |
Hidalgo et al. | Hybrid trajectory planning approach for roundabout merging scenarios | |
Liu et al. | The robustly-safe automated driving system for enhanced active safety | |
JP2021057012A (en) | Method, device and apparatus for controlling vehicle, and storage medium | |
Bulsara et al. | Obstacle avoidance using model predictive control: An implementation and validation study using scaled vehicles | |
CN113200054B (en) | Path planning method and system for automatic driving take-over | |
WO2020235317A1 (en) | Control device | |
CN112141073A (en) | Method for controlling a vehicle | |
CN115107808A (en) | Vehicle running track planning method and device | |
CN114475656A (en) | Travel track prediction method, travel track prediction device, electronic device, and storage medium | |
US20210061303A1 (en) | Monitor assignment system and method | |
Pek et al. | Enhancing motion safety by identifying safety-critical passageways | |
Cheng et al. | A hierarchical driver model | |
Geyer | Maneuver-based vehicle guidance based on the Conduct-by-Wire principle | |
Yan et al. | Application of fuzzy control under time-varying universe in unmanned vehicles | |
Faruffini et al. | Vehicle autonomous navigation with context awareness | |
Ito | The uncertainty that the autonomous car faces and predictability analysis for evaluation | |
CN114207533A (en) | Formal verification for development and real-time application of autonomic systems | |
Yuan et al. | Scalable Game-Theoretic Decision-Making for Self-Driving Cars at Unsignalized Intersections |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20220121 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20220712 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20220826 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20221004 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20221122 |
|
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: 20230307 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20230322 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7250613 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |