JP2019043351A - Motion control device of movable body, computer program, motion control method of movable body, and controller - Google Patents

Motion control device of movable body, computer program, motion control method of movable body, and controller Download PDF

Info

Publication number
JP2019043351A
JP2019043351A JP2017168561A JP2017168561A JP2019043351A JP 2019043351 A JP2019043351 A JP 2019043351A JP 2017168561 A JP2017168561 A JP 2017168561A JP 2017168561 A JP2017168561 A JP 2017168561A JP 2019043351 A JP2019043351 A JP 2019043351A
Authority
JP
Japan
Prior art keywords
control
controller
acceleration
vehicle
component device
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2017168561A
Other languages
Japanese (ja)
Other versions
JP7178774B2 (en
Inventor
絢也 高橋
Junya Takahashi
絢也 高橋
児島 隆生
Takao Kojima
隆生 児島
今村 政道
Masamichi Imamura
政道 今村
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.)
Hitachi Astemo Ltd
Original Assignee
Hitachi Automotive Systems Ltd
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 Hitachi Automotive Systems Ltd filed Critical Hitachi Automotive Systems Ltd
Priority to JP2017168561A priority Critical patent/JP7178774B2/en
Priority to PCT/JP2018/015891 priority patent/WO2019044025A1/en
Publication of JP2019043351A publication Critical patent/JP2019043351A/en
Application granted granted Critical
Publication of JP7178774B2 publication Critical patent/JP7178774B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60TVEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T8/00Arrangements for adjusting wheel-braking force to meet varying vehicular or ground-surface conditions, e.g. limiting or varying distribution of braking force
    • B60T8/17Using electrical or electronic regulation means to control braking
    • B60T8/1755Brake regulation specially adapted to control the stability of the vehicle, e.g. taking into account yaw rate or transverse acceleration in a curve
    • 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
    • B60W30/02Control of vehicle driving stability
    • 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
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/02Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
    • 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
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/10Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
    • B60W40/107Longitudinal acceleration
    • 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
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/10Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
    • B60W40/109Lateral acceleration
    • 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
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/10Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
    • B60W40/114Yaw movement
    • 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
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W50/02Ensuring safety in case of control system failures, e.g. by diagnosing, circumventing or fixing failures
    • B60W50/035Bringing the control units into a predefined state, e.g. giving priority to particular actuators
    • 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
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W50/06Improving the dynamic response of the control system, e.g. improving the speed of regulation or avoiding hunting or overshoot

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Human Computer Interaction (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Regulating Braking Force (AREA)

Abstract

To reduce delay in communication between a controller of a component involved in a motion of a vehicle and the component, and prevent operability and stability of the vehicle from being impaired.SOLUTION: A motion control device 1 of a vehicle having at least an acceleration/deceleration actuator 100 and an acceleration/deceleration actuator 200 involved in a motion of the vehicle includes a longitudinal acceleration controller 10 for controlling the acceleration/deceleration actuator 100 and a longitudinal acceleration controller 20 for controlling the acceleration/deceleration actuator 200. The longitudinal acceleration controller 10 has a control algorithm for controlling a motion of the vehicle by G-vectoring control, and the longitudinal acceleration controller 20 has the same control algorithm by G-vectoring control as the algorithm of the longitudinal acceleration controller 10.SELECTED DRAWING: Figure 5

Description

本発明は、移動体の運動制御装置、コンピュータプログラム、移動体の運動制御方法、および制御器に関する。   The present invention relates to a motion control device for a moving body, a computer program, a motion control method for a moving body, and a controller.

特許文献1〜3には、移動体(車両)の運動制御装置が開示されている。
特許文献1〜3に開示されている運動制御装置では、G−ベクタリング制御(G−vectoring control:以下、GVCと表記することがある)やダイレクトヨーモーメント制御(Direct Yaw−moment Control:以下、ヨーモーメント制御又はDYCと表記することがある)により、車両の運動に関与する構成装置(アクチュエータ)を制御し、車両の操縦性や安定性を向上させている。
Patent Literatures 1 to 3 disclose motion control devices for mobile bodies (vehicles).
In motion control devices disclosed in Patent Documents 1 to 3, G-vectoring control (hereinafter sometimes referred to as GVC) and direct yaw moment control (Direct following): The yaw moment control or DYC may be used to control components (actuators) involved in the motion of the vehicle to improve the maneuverability and stability of the vehicle.

特開2010−260544号公報JP, 2010-260544, A 特開2011−73534号公報JP, 2011-73534, A 特開2014−69766号公報JP, 2014-69766, A

しかしながら、この種の運動制御装置では、GVC等を行う上位の制御器と、車両の運動に関与する構成装置(アクチュエータ)とが、CAN(Controller Area Network)等の通信手段を介して接続され、これらの間で通信が行われる構成が考えられる。   However, in this type of motion control device, a host controller performing GVC and the like and a component device (actuator) involved in the motion of the vehicle are connected via communication means such as CAN (Controller Area Network), A configuration in which communication is performed between these can be considered.

この場合、前述した運動制御装置では、上位の制御器と構成装置(アクチュエータ)とは、CANを介して通信が行われている分、通信遅れが生じてしまう。よって、上位の制御器のGVC等による制御が遅れてしまい、車両の運転者に違和感を与えるという問題がある。   In this case, in the above-described motion control device, communication between the upper controller and the component device (actuator) causes a communication delay as much as communication is performed via the CAN. Therefore, control by the GVC or the like of the upper controller is delayed, causing a problem of giving a sense of discomfort to the driver of the vehicle.

さらに、前述した運動制御装置では、GVC等に必要な車両のセンサ情報を正常に取得できない場合、上位の制御器において、GVC等を実施できない。この結果、これらの制御が急に実施されなくなることにより、車両の操縦性や安定性を損なうという問題がある。   Furthermore, in the above-described motion control device, when sensor information of a vehicle necessary for GVC or the like can not be acquired normally, GVC or the like can not be performed in the upper controller. As a result, there is a problem that the controllability and stability of the vehicle are impaired by the sudden elimination of these controls.

したがって本発明は、上記課題に鑑みてなされたもので、車両の運動に関与する構成装置の制御器と、当該構成装置との間の通信遅れを低減すると共に、車両の操作性や安定性を損なわないようにすることを目的とする。   Therefore, the present invention has been made in view of the above problems, and reduces the delay in communication between the controller of the component device involved in the motion of the vehicle and the component device, and also improves the operability and stability of the vehicle. The purpose is to prevent damage.

上記課題を解決するため、移動体の運動に関与する少なくとも第1の構成装置と第2の構成装置とを有する移動体の運動制御装置であって、第1の構成装置を制御する第1の制御器と、第2の構成装置を制御する第2の制御器と、を有し、第1の制御器は、移動体の運動を所定の手順で制御する制御アルゴリズムを有し、第2の制御器は、第1の制御器と同じ制御アルゴリズムを有する移動体の運動制御装置とした。   In order to solve the above-mentioned problems, a motion control device for a mobile body, which has at least a first component device and a second component device involved in the motion of the mobile object, the first component device being controlled A controller, and a second controller for controlling the second component device, the first controller having a control algorithm for controlling the movement of the mobile body in a predetermined procedure; The controller was a motion control device of a mobile having the same control algorithm as the first controller.

本発明によれば、車両の運動に関与する構成装置の制御器と、当該構成装置との間の通信遅れを低減すると共に、車両の操作性や安定性を損なわないようにすることができる。   According to the present invention, it is possible to reduce communication delay between the controller of the component device involved in the motion of the vehicle and the component device, and to prevent the operability and stability of the vehicle from being impaired.

G−Vectoring制御を適用した車両の左コーナー進入から脱出までの様子を示す図である。It is a figure which shows the mode from the left corner approach of the vehicle to which G-Vectoring control is applied to escape. 図1のような走行をした場合の操舵角、横加速度、横加加速度、前後加速度指令、四輪の制動力・駆動力について時刻暦波形として示した図である。FIG. 2 is a diagram showing a steering angle, lateral acceleration, lateral jerk, longitudinal acceleration command, braking force / driving force of four wheels as a time-calendar waveform when traveling as shown in FIG. 1. G−Vectoring制御により減速度を制御した際における、レーンチェンジに対する効果を示す図である。It is a figure which shows the effect with respect to a lane change at the time of controlling deceleration by G-Vectoring control. G−Vectoring制御による前後加速度指令値とMoment Plus制御によるヨーモーメント指令値を示した図である。It is the figure which showed the yaw moment command value by the longitudinal acceleration command value by G-Vectoring control, and Moment Plus control. 実施の形態にかかる運動制御装置を説明する機能ブロック図である。It is a functional block diagram explaining a motion control device concerning an embodiment. 運動制御装置の動作を説明する図である。It is a figure explaining operation of a movement control device. 第2の実施の形態にかかる運動制御装置を説明する機能ブロック図である。It is a functional block diagram explaining the movement control device concerning a 2nd embodiment. 第2の実施の形態の指令値演算部で実行される処理のフローチャートである。It is a flowchart of the process performed by the command value calculating part of 2nd Embodiment. 第3の実施の形態にかかる運動制御装置を説明する機能ブロック図である。It is a functional block diagram explaining a motion control device concerning a 3rd embodiment. 第3の実施の形態にかかる運動制御装置の動作を説明する図である。It is a figure explaining operation | movement of the movement control apparatus concerning 3rd Embodiment. 第4の実施の形態にかかる運動制御装置を説明する機能ブロック図である。It is a functional block diagram explaining the movement control device concerning a 4th embodiment. 第4の実施の形態の指令値演算部で実行される処理のフローチャートである。It is a flowchart of the process performed by the command value calculating part of 4th Embodiment.

以下、本発明の実施の形態にかかる移動体の運動制御装置を説明するに先立ち、本発明の理解が容易になるように、横運動に連係した前後運動制御(G−Vectoring制御)及びヨーモーメント制御(Moment Plus制御)の概要を説明する。   Hereinafter, prior to describing the motion control device for a mobile according to the embodiment of the present invention, longitudinal motion control (G-Vectoring control) linked to lateral motion and yaw moment so as to facilitate understanding of the present invention. An outline of control (Moment Plus control) will be described.

以下の説明において、車両の重心点を原点とし、車両の前後方向をx方向、それに直角な方向(車両の横(左右)方向)をy方向とした場合、x方向の加速度を前後加速度、y方向の加速度を横加速度とする。前後加速度は、車両前方向を正とする。すわなち、車両が前方向に対して進行している際、その速度を増加させる前後加速度を正とする。横加速度は、車両が前方向に対して進行している際、左回り(反時計回り)の旋回時に発生する横加速度を正とし、右回り(時計回り)の旋回時に発生する横加速度を負とする。   In the following description, assuming that the center of gravity of the vehicle is the origin, the longitudinal direction of the vehicle is the x direction, and the direction perpendicular thereto (the lateral (left and right) direction of the vehicle) is the y direction. Let the acceleration in the direction be the lateral acceleration. The longitudinal acceleration is positive in the forward direction of the vehicle. That is, when the vehicle travels in the forward direction, the longitudinal acceleration that increases its speed is positive. Lateral acceleration is defined as positive for lateral acceleration generated when turning counterclockwise (counterclockwise) while negative for lateral acceleration generated when turning clockwise (clockwise). I assume.

また、車両の左回りの旋回半径を正とし、その逆数を車両の走行曲率とする。同様に、目標軌道に関して、車両の左回りの旋回半径を正とし、その逆数を目標軌道曲率とする。また、車両の左回り(反時計回り)方向の操舵角を正とする。   Further, the turning radius of the vehicle in the counterclockwise direction is positive, and the reciprocal thereof is the traveling curvature of the vehicle. Similarly, regarding the target track, the turning radius of the vehicle counterclockwise is positive, and the reciprocal thereof is the target track curvature. Also, the steering angle in the counterclockwise direction of the vehicle is positive.

[横運動に連係した前後運動制御:G−Vectoring制御]
G−Vectoring制御は、ハンドル操作による車両の横運動に連係して自動的に加減速することにより、前輪と後輪の間に荷重移動を発生させて車両の操縦性と安定性の向上を図る方法である。下記数式1に示すように、加減速指令値(前後加速度指令値Gxc)は、基本的に横加加速度Gy_dotにゲインCxyを掛け、一次遅れを付与した値で表すことができる。

Figure 2019043351
[Longitudinal motion control linked to lateral motion: G-Vectoring control]
In G-Vectoring control, load movement is generated between the front and rear wheels by automatically accelerating and decelerating in conjunction with the lateral movement of the vehicle by the steering wheel operation to improve the maneuverability and stability of the vehicle. It is a method. As shown in Formula 1 below, the acceleration / deceleration command value (longitudinal acceleration command value G xc ) can be basically expressed by a value obtained by multiplying the lateral additive acceleration G y_dot by the gain C xy and giving a first-order delay.
Figure 2019043351

この数式1において、G:車両横加速度、Gy_dot:車両横加加速度、Cxy:ゲイン、T:一次遅れ時定数、s:ラプラス演算子、Gx_DC:横運動に連係しない加減速度指令である。G−Vectoringにより、エキスパートドライバの横と前後運動の連係制御ストラテジの一部を模擬することができ、車両の操縦性・安定性の向上が実現できることが確認されている。 In this formula 1, G y: vehicle lateral acceleration, G y_dot: vehicle lateral jerk, C xy: gain, T: first-order lag time constant, s: Laplace operator, G x_DC: is acceleration command which is not linked to the lateral motion . It has been confirmed that G-Vectoring can simulate part of the joint control strategy of the horizontal and longitudinal motion of the expert driver, and can improve the maneuverability and stability of the vehicle.

x_DCは、横運動に連係していない減速度成分(オフセット)であり、前方にコーナーがある場合の予見的な減速、あるいは区間速度指令がある場合に必要となる項である。sgn(シグナム)項は、右コーナーと左コーナーの両方に対して上記の動作が得られるように設けた項である。具体的には、操舵開始のターンイン時に減速し、定常旋回になると(横加加速度がゼロとなるので)減速を停止し、操舵戻し開始のコーナー脱出時に加速する動作が実現できる。 G x — DC is a deceleration component (offset) which is not linked to the lateral movement, and is a term which is necessary when there is a predictive deceleration when there is a corner ahead or an interval velocity command. The sgn (signum) term is a term provided to obtain the above operation for both the right corner and the left corner. Specifically, it is possible to realize an operation of decelerating at the turn-in at the start of steering and stopping the deceleration when steady turning (when lateral acceleration becomes zero) and accelerating at the time of departure from the corner of steering return.

前述した数式1に従って車両を制御した場合、横軸に車両の前後加速度、縦軸に車両の横加速度をとるダイアグラムにおいて前後加速度と横加速度の合成加速度(Gと表記)を表記すると、時間の経過とともに曲線的な遷移をする(Vectoring)。したがって本制御手法は、「G−Vectoring制御」と呼ばれている。   When the vehicle is controlled according to Equation 1 described above, when the combined acceleration (denoted as G) of the longitudinal acceleration and the lateral acceleration is represented in the diagram in which the longitudinal axis of the vehicle is on the horizontal axis and the lateral acceleration of the vehicle is on the vertical axis Make a curved transition with it (Vectoring). Therefore, this control method is called "G-Vectoring control".

図1は、G−Vectoring制御を適用した具体的な走行例を説明する図である。ここでは、コーナーへの進入と脱出をともなう一般的な走行シーンを想定している。図1に示す走行軌道は、直進路A、過渡区間B、定常旋回区間C、過渡区間D、直進区間Eを含む。図1において、ドライバは加減速操作をしないものとする。   FIG. 1 is a diagram for explaining a specific traveling example to which G-Vectoring control is applied. Here, we assume a general driving scene with entry and exit to a corner. The traveling track shown in FIG. 1 includes a straight path A, a transition section B, a steady turning section C, a transition section D, and a straight section E. In FIG. 1, the driver does not perform the acceleration / deceleration operation.

図2は、操舵角、横加速度、横加加速度、数式1を用いて計算した前後加速度指令、四輪の制動力・駆動力について時刻暦波形として示した図である。
後で詳細に説明するが、車両では、前外輪と前内輪、後外輪と後内輪は、左右(内外)それぞれ同じ値となるように制動力・駆動力が配分されている。制駆動力とは各輪の車両前後方向に発生する力の総称である。制動力は車両を減速する向きの力であり、駆動力は車両を加速する向きの力と定義する。図1と図2においては、車両左旋回時に発生する横加速度Gを正とし、車両前方進行方向の前後加速度Gを正としている。また各車輪に発生する力は、駆動力を正、制動力を負としている。
FIG. 2 is a diagram showing a steering angle, lateral acceleration, lateral jerk, longitudinal acceleration command calculated using Formula 1, braking force / driving force of four wheels as a time-calendar waveform.
As will be described in detail later, in the vehicle, the braking force and the driving force are distributed so that the front outer ring and the front inner ring, and the rear outer ring and the rear inner ring have the same values on the left and right (inner and outer). The braking / driving force is a generic term for the force generated in the vehicle longitudinal direction of each wheel. The braking force is a direction force to decelerate the vehicle, and the driving force is defined as a direction force to accelerate the vehicle. 1 and FIG. 2 is a lateral acceleration G y generated when the vehicle turns left is positive, longitudinal acceleration G x in front of the vehicle traveling direction as a positive. The force generated on each wheel is positive for the driving force and negative for the braking force.

まず直進路区間Aから車両がコーナーに進入する。過渡区間B(点1〜点3)においては、ドライバが徐々に操舵を切り増すにしたがって、車両の横加速度Gが増加していく。横加加速度Gy_dotは、点2近辺の横加速度が増加している間、正の値をとることになる(横加速度増加が終了する3の時点ではゼロに戻る)。このとき数式1より、車両には横加速度Gの増加にともなって減速指令が発生する(Gxcは負)。これにともない、前外、前内、後外、後内の各輪に対して、略同じ大きさの制動力(マイナス符号)が加わることになる。 First, a vehicle enters a corner from straight road section A. In the transient period B (point 1 to point 3), according to the driver increases gradually turning the steering wheel, the lateral acceleration G y of the vehicle increases. The lateral jerk Gy_dot takes a positive value while the lateral acceleration in the vicinity of the point 2 is increasing (returns to zero at time 3 when the lateral acceleration increase ends). From Equation 1 this time, a deceleration instruction with an increase of the lateral acceleration G y is generated on the vehicle (G xc is negative). Along with this, braking force (minus sign) of substantially the same magnitude is applied to each of the front, outside, front inside, back outside, and rear inside wheels.

車両が定常旋回区間C(点3〜点5)に入ると、ドライバは操舵の切り増しを止め、操舵角を一定に保つ。このとき、横加加速度Gy_dotは0となるので、前後加速度指令値Gxcは0となる。よって、各車輪の制動力・駆動力もゼロとなる。 When the vehicle enters the steady turn section C (point 3 to point 5), the driver stops turning the steering and keeps the steering angle constant. At this time, since the lateral jerk G Y_dot becomes 0, longitudinal acceleration command value G xc is 0. Therefore, the braking force and driving force of each wheel also become zero.

過渡区間D(点5〜7)では、ドライバの操舵の切り戻し操作によって車両の横加速度Gが減少していく。このとき車両の横加加速度Gy_dotは負であり、式1より車両には正の前後加速度指令値Gxc(加速指令)が発生する。これにともない、前外、前内、後外、後内の各輪に対して、略同じ大きさの駆動力(プラス符号)が加わることになる。 In transient interval D (point 5-7), the lateral acceleration G y of the vehicle decreases by the returning operation of the steering of the driver. At this time, the lateral additional acceleration Gy_dot of the vehicle is negative, and according to Equation 1, a positive longitudinal acceleration command value Gxc (acceleration command) is generated in the vehicle. Along with this, approximately the same magnitude of driving force (plus sign) is applied to each of the front, outside, front inside, back outside, and rear inside wheels.

直進区間Eにおいては、横加加速度Gが0となり横加加速度Gy_dotもゼロとなるので、加減速制御は実施されない。 In the straight traveling section E, since the lateral acceleration G y is 0 and the lateral acceleration G y_dot is also 0, acceleration / deceleration control is not performed.

以上のように、車両は操舵開始のターンイン時(点1)からクリッピングポイント(点3)にかけて減速し、定常円旋回中(点3〜点5)には減速を止め、操舵切戻し開始時(点5)からコーナー脱出時(点7)には加速する。このように、車両にG−Vectoring制御を適用すれば、ドライバは旋回のための操舵をするだけで、横運動に連係した加減速運動を実現することができる。   As described above, the vehicle decelerates from the turn-in (point 1) at the start of steering to the clipping point (point 3), stops decelerating during steady circular turning (points 3 to 5), and starts steering reverse From point (5) it accelerates at the time of corner exit (point 7). As described above, if G-Vectoring control is applied to the vehicle, the driver can realize acceleration / deceleration movement linked to the lateral movement only by steering for turning.

前後加速度を横軸、横加速度を縦軸にとり、図1〜図2において車両に発生している加速度様態をダイアグラム(“g−g”ダイヤグラム)に表すと、滑らかな曲線状(円を描くよう)に遷移する特徴的な運動になる。実施の形態にかかる加減速指令は、このダイアグラムにおいて、時間の経過とともに曲線的な遷移をするように生成される。この曲線状の遷移は、左コーナーについては図1に示すように時計回りの遷移となり、右コーナーについてはこれをG軸について反転した遷移経路となり、その遷移方向は半時計回りとなる。このように遷移することにより、前後加速度により車両に発生するピッチング運動と、横加速度により発生するロール運動が好適に連係し、ロールレイトとピッチレイトのピーク値が低減される。 Taking the longitudinal acceleration on the horizontal axis and the lateral acceleration on the vertical axis, and expressing the mode of acceleration occurring in the vehicle in FIGS. 1 and 2 in a diagram (“g-g” diagram), a smooth curve (circled It becomes a characteristic movement to transition to). The acceleration / deceleration command according to the embodiment is generated to make a curved transition with the passage of time in this diagram. The curved transition for the left corner becomes transition clockwise as shown in FIG. 1, will transition path which was reversed for G x-axis for the right corner, the transition direction is counter clockwise. By making such a transition, the pitching motion generated in the vehicle by the longitudinal acceleration and the roll motion generated by the lateral acceleration are suitably linked, and the peak values of the roll rate and the pitch rate are reduced.

この制御は、前述した数式1に示すとおり、一次遅れ項と左右の運動に対する符号関数を省略して考えると、車両横加加速度にゲインCxyを掛け合わせた値を前後加速度指令としている。したがってゲインCxyを大きくすることにより、横加加速度が同一であっても、減速度あるいは加速度を大きくすることができる。 In this control, as shown in Formula 1 described above, when the first-order lag term and the sign function for the left and right motion are omitted, the value obtained by multiplying the vehicle lateral acceleration by the gain C xy is used as the longitudinal acceleration command. Therefore, by increasing the gain C xy , it is possible to increase the deceleration or acceleration even if the lateral jerk is the same.

図3は、G−Vectoring制御により減速度を制御した際における、レーンチェンジに対する効果を示す図である。図3において、30m離してパイロンAとパイロンBを置き、車両はパイロンAの左側をすり抜けてパイロンBの右側に移動するレーンチェンジンジを実施したものとする。この場合の操舵角、前後加速度、横加速度、車両速度について、従来の横滑り防止装置(Electronic Stability Control:ESC)のみを実施した場合(ESC Only)と、G−Vectoring制御とESCの複合制御を実施した場合(GVC+ESC)とを比較する。   FIG. 3 is a diagram showing an effect on lane change when deceleration is controlled by G-Vectoring control. In FIG. 3, pylons A and pylons B are placed 30 m apart, and the vehicle is assumed to have carried out a lane change in which the vehicle passes through the left side of pylon A and moves to the right side of pylon B. In this case, when only the conventional anti-slip device (Electronic Stability Control: ESC) is implemented (ESC Only) for the steering angle, longitudinal acceleration, lateral acceleration, and vehicle speed, combined control of G-Vectoring control and ESC is performed. If (GVC + ESC) is compared.

ESCのみ実施した場合は、ステアリングを急激に戻している0.75秒から1秒近辺で、横滑り状態を検知して安定化モーメントを加えている(減速度の発生)。これに対してG−Vectoring制御とESCの連係制御においては、操舵を開始した瞬間から減速度が働き、操舵開始から0.5秒で速度が10km/hも低下している。   When only the ESC is performed, a side slip is detected and a stabilization moment is added (generation of deceleration) around 0.75 to 1 second when the steering is suddenly returned. On the other hand, in the G-Vectoring control and the coordinated control of the ESC, the deceleration works from the moment when the steering is started, and the speed is reduced by 10 km / h in 0.5 seconds from the start of the steering.

これにより、操舵角も少なくロールレイトとピッチレイトが大幅に低減され、安全にレーンチェンジができていることがわかる。このようにG−Vectoring制御を適用すると、操舵により障害物回避をする際の回避性能を大幅に向上できる。   As a result, it is understood that the steering angle is small, the roll rate and the pitch rate are significantly reduced, and the lane change can be made safely. By applying the G-Vectoring control in this manner, it is possible to greatly improve the avoidance performance when avoiding an obstacle by steering.

[G−Vectoringに基づくダイレクトヨーモーメント制御:Moment Plus(M+)]
M+制御は、上述のG−Vectoring制御の加減速によるヨー運動の促進もしくは安定化と同様の効果を、車両の左右車輪に発生する制駆動力差により与え、ヨー運動の促進もしくは安定性を向上させることを図る方法である。具体的な目標ヨーモーメントMz_GVCは、下記数式2で表せる。数式2において、Cmnは比例係数、Tmnは一次遅れ時定数である。

Figure 2019043351
[Direct yaw moment control based on G-Vectoring: Moment Plus (M +)]
The M + control gives the same effect as acceleration or deceleration of the yaw motion by the acceleration / deceleration of the G-Vectoring control described above, by the difference in braking / driving force generated on the left and right wheels of the vehicle, and promotes yaw motion It is a way to make it happen. A specific target yaw moment M z — G VC can be expressed by the following equation 2. In Equation 2, C mn is a proportional coefficient, and T mn is a first-order lag time constant.
Figure 2019043351

図4は、横加速度の増減、G−Vectoring制御の前後加速度指令値Gxc、M+制御による目標ヨーモーメントMz_GVCの関係を示す図である。なお本式により得られる目標ヨーモーメントMz_GVCは、その値が正の場合、車両に発生している旋回を促進する方向にヨーモーメントを付与し、負の場合、旋回を抑制する方向にヨーモーメントを付与するものとする。図4においては、旋回初期(区間B)に正のヨーモーメント(本図の旋回においては左回り方向)、旋回終了前(区間D)に負のヨーモーメント(本図の旋回においては右回り方向)となっている。 FIG. 4 is a diagram showing the relationship between increase / decrease of lateral acceleration, longitudinal acceleration command value G xc of G-Vectoring control, and target yaw moment M z — G VC by M + control. When the value is positive, the target yaw moment M z _GVC obtained by this formula applies a yaw moment in the direction promoting the turning generated in the vehicle, and when the value is negative the yaw moment in the direction suppressing the turning Shall be granted. In FIG. 4, a positive yaw moment (counterclockwise in the case of turning in the figure) and a negative yaw moment (clockwise in the case of turning in the figure) before the end of the turn (section D) ).

横加速度が増加する区間Bにおいては、G−Vectoring制御は負の前後加速度指令値(すなわち車両を減速する)を生成し、荷重移動にともなう車両前後輪の横力差により、旋回開始後のヨー運動を促進する。これに対しM+制御は、車両左右輪の制駆動力差(図4では車両左側輪にのみ制動力を発生)により、重心回りにヨーモーメントを直接発生させて、ヨー運動を促進する。   In the section B where the lateral acceleration increases, G-Vectoring control generates a negative longitudinal acceleration command value (that is, decelerates the vehicle), and the yaw force after the start of turning due to the lateral force difference of the vehicle front and rear wheels accompanying the load movement. Promote exercise. On the other hand, in the M + control, a yaw moment is directly generated around the center of gravity by the braking / driving force difference between the left and right wheels of the vehicle (in FIG. 4, only the left wheel of the vehicle generates a braking force) to promote yaw motion.

横運動が一定となる定常旋回区間Cにおいては、G−Vectoring制御とM+制御ともに指令値はゼロとなる。横加速度が減少する区間Dにおいては、G−Vectoring制御は正の前後加速度指令値(すなわち車両を加速する)を生成し、荷重移動にともなう車両前後輪の横力差により、旋回開始後のヨー運動を安定化する。これに対しM+制御は、車両左右輪の制駆動力差(図4では車両右側輪にのみ制動力を発生させる)により、重心回りにヨーモーメントを直接発生させて、ヨー運動を安定化する。   In the steady-state turning section C in which the lateral movement is constant, the command value is zero in both G-Vectoring control and M + control. In section D where lateral acceleration decreases, G-Vectoring control generates a positive longitudinal acceleration command value (that is, accelerates the vehicle), and the lateral force difference between the vehicle front and rear wheels accompanying load movement causes yaw after turning to start. Stabilize your movement. On the other hand, the M + control stabilizes the yawing motion by directly generating a yaw moment around the center of gravity by the braking / driving force difference between the left and right wheels of the vehicle (in FIG. 4, the braking force is generated only at the right wheel of the vehicle).

このようにG−Vectoring制御とM+制御いずれも、横加速度の絶対値が増加する区間ではヨー運動を促進し、横加速度の絶対値が減少する区間ではヨー運動を安定化するように、それぞれ前後加速度指令値またはヨーモーメント指令値を生成する。   Thus, both G-Vectoring control and M + control promote yaw motion in the section where the absolute value of lateral acceleration increases, and stabilize the yaw motion in the section where the absolute value of lateral acceleration decreases. An acceleration command value or a yaw moment command value is generated.

[運動制御装置]
次に、本発明の実施の形態にかかる移動体の運動制御装置を説明する。
以下の説明では、運動制御装置を、移動体の一例として車両300(図3参照)の運動制御装置1に適用した場合を例示して説明する。
図5は、実施の形態にかかる運動制御装置1の全体構成を説明する機能ブロック図である。
[Motor control device]
Next, a motion control device for a mobile according to an embodiment of the present invention will be described.
In the following description, the case where a motion control apparatus is applied to the motion control apparatus 1 of the vehicle 300 (refer FIG. 3) as an example of a mobile body is illustrated and demonstrated.
FIG. 5 is a functional block diagram for explaining the overall configuration of the motion control device 1 according to the embodiment.

図5に示すように、車両300の運動制御装置1は、加減速アクチュエータ100を制御する前後加速度制御器10と、加減速アクチュエータ200を制御する前後加速度制御器20とを有している。   As shown in FIG. 5, the motion control device 1 of the vehicle 300 has a longitudinal acceleration controller 10 that controls the acceleration / deceleration actuator 100 and a longitudinal acceleration controller 20 that controls the acceleration / deceleration actuator 200.

ここで、加減速アクチュエータ100、200は、車両300の移動方向の加減速に関与するアクチュエータ(車両の構成装置)である。
加減速アクチュエータ100、200は、それぞれ異なる方式でタイヤと路面との間に発生する駆動力又は制動力を制御することにより、車両300の移動方向に発生する加速度を制御できるものであれば、任意のアクチュエータを採用することができる。
Here, the acceleration / deceleration actuators 100 and 200 are actuators (components of the vehicle) involved in acceleration / deceleration in the moving direction of the vehicle 300.
The acceleration / deceleration actuators 100 and 200 are arbitrary as long as they can control the acceleration generated in the moving direction of the vehicle 300 by controlling the driving force or the braking force generated between the tire and the road surface by different methods. Actuators can be employed.

加減速アクチュエータ100、200の一例として、以下の(A)〜(E)が挙げられる。
(A)エンジン出力の調整を行う吸排気バルブ。
(B)車両300の減速・停止を行うブレーキシステム。
(C)車両300が、PHV(Plug−in Hybrid Vehicle)やEV(Electric Vehicle)などの電動輸送機器である場合の動力源として使用されるモータ。
(D)車両300の変速機が動力を各車輪に伝達する際の前後輪の変速比を互いに変えることにより、車両300の前後加速度を制御する変速機構。
(E)オルタネータの負荷制御により、車両300の前後加速度を制御する機構。
Examples of the acceleration / deceleration actuators 100 and 200 include the following (A) to (E).
(A) Intake and exhaust valves that adjust engine output.
(B) A brake system that decelerates and stops the vehicle 300.
(C) A motor used as a motive power source when the vehicle 300 is an electric transportation device such as a PHV (Plug-in Hybrid Vehicle) or an EV (Electric Vehicle).
(D) A transmission mechanism that controls the longitudinal acceleration of the vehicle 300 by mutually changing the gear ratios of the front and rear wheels when the transmission of the vehicle 300 transmits power to the wheels.
(E) A mechanism for controlling the longitudinal acceleration of the vehicle 300 by load control of the alternator.

実施の形態では、加減速アクチュエータ100が、電動輸送機器の動力源として使用されるモータである場合を例示して説明する。加減速アクチュエータ100がモータである場合、車両300の前後加速度を変化させる応答性が早く、細かな制御(微調整)を行うことができる。
また、加減速アクチュエータ200が、加減速アクチュエータ100とは異なる方式で車両300の運動を制動させるブレーキシステムである場合を例示して説明する。加減速アクチュエータ200がブレーキシステムである場合、車両300の前後加速度を変化させる応答性が遅い反面、大きく変える(制動する)ような制御を行うことができる。
In the embodiment, the case where the acceleration / deceleration actuator 100 is a motor used as a power source of a motorized transportation device will be described as an example. When the acceleration / deceleration actuator 100 is a motor, the response for changing the longitudinal acceleration of the vehicle 300 can be quick, and fine control (fine adjustment) can be performed.
The case where the acceleration / deceleration actuator 200 is a brake system that brakes the motion of the vehicle 300 by a method different from the acceleration / deceleration actuator 100 will be described as an example. When the acceleration / deceleration actuator 200 is a brake system, it is possible to perform control such as changing (braking) largely, although the response to change the longitudinal acceleration of the vehicle 300 is slow.

[前後加速度制御器10]
前後加速度制御器10は、基本制御演算部11と、GVC制御部12と、指令値演算部13と、送信部14と、を有している。
Longitudinal Acceleration Controller 10
The longitudinal acceleration controller 10 includes a basic control calculation unit 11, a GVC control unit 12, a command value calculation unit 13, and a transmission unit 14.

基本制御演算部11は、加減速アクチュエータ100を制御するための基本制御指令値CA1の演算を行う。この基本制御演算部11には、アクチュエータ制御用情報50と、車両運動情報51とが入力されており、基本制御演算部11は、アクチュエータ制御用情報50と車両運動情報51とに基づいて、加減速アクチュエータ100を制御するための基本制御指令値CA1の演算を行う。   The basic control calculation unit 11 calculates a basic control command value CA1 for controlling the acceleration / deceleration actuator 100. The actuator control information 50 and the vehicle motion information 51 are input to the basic control calculation unit 11, and the basic control calculation unit 11 adds the information based on the actuator control information 50 and the vehicle motion information 51. The basic control command value CA1 for controlling the deceleration actuator 100 is calculated.

ここで、アクチュエータ制御用情報50は、加減速アクチュエータ100の制御に直接的に必要な情報であり、車両300に設けられたセンサから異なるアクチュエータを制御する制御器間で情報伝達をすることを目的とした通信手段であるCAN60を介さずに直接入力される。   Here, the actuator control information 50 is information directly necessary for control of the acceleration / deceleration actuator 100, and the purpose is to transmit information between controllers controlling different actuators from sensors provided in the vehicle 300. Directly through the communication means CAN 60.

例えば、加減速アクチュエータ100が吸排気バルブである場合、吸排気バルブのバルブタイミングを制御するための情報であり、加減速アクチュエータ100がブレーキシステムである場合、ブレーキの油圧を制御するための情報であり、加減速アクチュエータ100がモータである場合、モータトルクを制御するための情報である。これらの情報は、車両に設けられた各種センサにより取得される。   For example, when the acceleration / deceleration actuator 100 is an intake / exhaust valve, it is information for controlling the valve timing of the intake / exhaust valve, and when the acceleration / deceleration actuator 100 is a brake system, information for controlling the hydraulic pressure of the brake. If the acceleration / deceleration actuator 100 is a motor, it is information for controlling the motor torque. These pieces of information are acquired by various sensors provided in the vehicle.

実施の形態では、加減速アクチュエータ100はモータであるので、アクチュエータ制御用情報50はモータトルクを制御するための情報(モータトルク制御情報)であり、このモータトルク制御情報が、前記CAN60を介さずに基本制御演算部11に直接入力される。   In the embodiment, since the acceleration / deceleration actuator 100 is a motor, the actuator control information 50 is information (motor torque control information) for controlling motor torque, and this motor torque control information does not go through the CAN 60. Directly to the basic control calculation unit 11.

車両運動情報51は、車両300に設けられた各種センサのセンサ情報であり、アクチュエータ制御用情報50以外の情報である。このセンサ情報は、車両300のCAN60を介して、基本制御演算部11、後述するGVC制御部12及び指令値演算部13に入力される。
この車両運動情報51の一例として、エンジントルク、エンジン回転数、モータ回転数、車速、加速度、ステア角、車両周囲の障害物の有無などのセンサ情報が挙げられる。
The vehicle motion information 51 is sensor information of various sensors provided in the vehicle 300, and is information other than the actuator control information 50. The sensor information is input to the basic control calculation unit 11, the GVC control unit 12 described later, and the command value calculation unit 13 via the CAN 60 of the vehicle 300.
Examples of the vehicle motion information 51 include sensor information such as engine torque, engine speed, motor speed, vehicle speed, acceleration, steering angle, presence or absence of an obstacle around the vehicle, and the like.

よって、実施の形態では、基本制御演算部11は、モータトルク制御情報(アクチュエータ制御用情報50)と、モータ回転数(車両運動情報51)とに基づいて、モータトルクを発生させるための電力量(基本制御指令値CA1)の演算を行う。   Therefore, in the embodiment, the basic control operation unit 11 generates the motor torque based on the motor torque control information (the actuator control information 50) and the motor rotation speed (the vehicle motion information 51). Calculation of (basic control command value CA1) is performed.

GVC制御部12は、車両300の移動方向における加速度を制御するためのGVC指令値CB1の演算を行う。このGVC制御部12には、前述した車両運動情報51が入力されるようになっており、GVC制御部12は、この車両運動情報51に基づいて車両300の移動方向における前後加速度(加減速アクチュエータ100)をGVCにより制御するためGVC指令値CB1の演算を行う。   The GVC control unit 12 calculates a GVC command value CB1 for controlling the acceleration in the moving direction of the vehicle 300. The vehicle motion information 51 described above is input to the GVC control unit 12, and the GVC control unit 12 determines the longitudinal acceleration (acceleration / deceleration actuator in the moving direction of the vehicle 300 based on the vehicle motion information 51). In order to control 100) by GVC, the GVC command value CB1 is calculated.

GVC制御部12には、GVCの制御アルゴリズムを有する制御プログラム121が記憶されている。GVC制御部12は、この制御プログラム121を実行することで、GVCの制御アルゴリズムに基づいて車両300の前後加速度をGVCにより制御するためのGVC指令値CB1の演算を行う。   The GVC control unit 12 stores a control program 121 having a GVC control algorithm. The GVC control unit 12 executes the control program 121 to calculate the GVC command value CB1 for controlling the longitudinal acceleration of the vehicle 300 by the GVC based on the GVC control algorithm.

実施の形態におけるGVC制御部12では、車両300の前後加速度G2を、GVC指令値CB1となるように制御するために、加減速アクチュエータ100を介入させるか否かの判定基準となる下側の介入閾値(下側介入閾値K11)と、下側介入閾値K11よりも上側の介入閾値(上側介入閾値K12)とが設定されている。GVC制御部12は、GVC指令値CB1が下側介入閾値K11の値よりも小さくなった場合、又は上側介入閾値K12の値よりも大きくなった場合、車両300の前後加速度G2を、GVC指令値CB1となるようにアクチュエータ100を制御する(図6の下図参照)。なお、特に区別しない場合、下側介入閾値K11と上側介入閾値K12とを合わせて介入閾値K1と表記する。
なお、下側介入閾値11の絶対値と上側介入閾値12の絶対値とは、必ずしも同じ大きさである必要はないが、同じ大きさであってもよい。両者を異なる値とした場合、加速側と減速側の制御介入タイミングを変更でき、より走行シーンにあった加減速制御が可能となる。
In the GVC control unit 12 according to the embodiment, a lower intervention serving as a determination criterion of whether or not to interpose the acceleration / deceleration actuator 100 in order to control the longitudinal acceleration G2 of the vehicle 300 to the GVC command value CB1. A threshold (lower intervention threshold K11) and an intervention threshold above the lower intervention threshold K11 (upper intervention threshold K12) are set. When the GVC command value CB1 becomes smaller than the value of the lower intervention threshold K11 or becomes larger than the value of the upper intervention threshold K12, the GVC control unit 12 sets the longitudinal acceleration G2 of the vehicle 300 to the GVC command value. The actuator 100 is controlled to be CB1 (see the lower diagram in FIG. 6). Note that the lower intervention threshold K11 and the upper intervention threshold K12 are collectively referred to as an intervention threshold K1 unless otherwise specified.
The absolute value of the lower intervention threshold 11 and the absolute value of the upper intervention threshold 12 do not necessarily have the same magnitude, but may have the same magnitude. When the values are different from each other, the control intervention timings on the acceleration side and the deceleration side can be changed, and acceleration / deceleration control according to the traveling scene can be performed.

前述した基本制御演算部11で演算された基本制御指令値CA1と、GVC制御部12で演算されたGVC指令値CB1と、車両運動情報51とは、指令値演算部13に入力される。   The basic control command value CA1 calculated by the basic control calculation unit 11 described above, the GVC command value CB1 calculated by the GVC control unit 12, and the vehicle motion information 51 are input to the command value calculation unit 13.

指令値演算部13は、基本制御演算部11から入力された基本制御指令値CA1と、GVC制御部12から入力されたGVC指令値CB1と、車両運動情報51とを合成して、加減速アクチュエータ100を制御するためのアクチュエータ指令値CC1の演算を行う。   The command value calculation unit 13 combines the basic control command value CA1 input from the basic control calculation unit 11, the GVC command value CB1 input from the GVC control unit 12, and the vehicle motion information 51 to obtain an acceleration / deceleration actuator. The actuator command value CC1 for controlling 100 is calculated.

指令値演算部13で演算されたアクチュエータ指令値CC1は、送信部14に出力され、この送信部14から加減速アクチュエータ100に送信される。   The actuator command value CC1 calculated by the command value calculation unit 13 is output to the transmission unit 14, and is transmitted from the transmission unit 14 to the acceleration / deceleration actuator 100.

この結果、加減速アクチュエータ100は、受信したアクチュエータ指令値CC1に基づいて駆動され、車両300の前後加速度G2は、この加減速アクチュエータ100の駆動により制御される。
実施の形態では、前後加速度制御器10でのGVCにより、モータ(加減速アクチュエータ100)の出力が調整され、このモータの出力に応じて車両300の前後加速度G2が制御される。
As a result, the acceleration / deceleration actuator 100 is driven based on the received actuator command value CC1, and the longitudinal acceleration G2 of the vehicle 300 is controlled by the drive of the acceleration / deceleration actuator 100.
In the embodiment, the output of the motor (acceleration / deceleration actuator 100) is adjusted by GVC in the longitudinal acceleration controller 10, and the longitudinal acceleration G2 of the vehicle 300 is controlled according to the output of the motor.

[前後加速度制御器20]
次に、前後加速度制御器20を説明する。
Longitudinal Acceleration Controller 20
Next, the longitudinal acceleration controller 20 will be described.

前後加速度制御器20は、基本制御演算部21と、GVC制御部22と、指令値演算部23と、送信部24と、を有している。
これら基本制御演算部21、GVC制御部22、指令値演算部23、送信部24は、それぞれ前述した前後加速度制御器10における基本制御演算部11、GVC制御部12、指令値演算部13、送信部14と同様の機能を有しているので、必要に応じて説明する。
The longitudinal acceleration controller 20 includes a basic control calculation unit 21, a GVC control unit 22, a command value calculation unit 23, and a transmission unit 24.
The basic control calculation unit 21, the GVC control unit 22, the command value calculation unit 23, and the transmission unit 24 are the basic control calculation unit 11, the GVC control unit 12, the command value calculation unit 13, and the transmission in the longitudinal acceleration controller 10 described above, respectively. Since it has the same function as the unit 14, it will be described as needed.

基本制御演算部21には、前述した車両運動情報51が、前記CAN60を介して入力されていると共に、アクチュエータ制御用情報52が前記CAN60を介さずに直接入力されている。基本制御演算部21は、入力された車両運動情報51と、アクチュエータ制御用情報52とに基づいて、加減速アクチュエータ200を制御するための基本制御指令値DA1の演算を行う。   While the vehicle motion information 51 described above is input to the basic control calculation unit 21 via the CAN 60, the actuator control information 52 is directly input without the CAN 60. Basic control calculation unit 21 calculates basic control command value DA1 for controlling acceleration / deceleration actuator 200 based on input vehicle motion information 51 and actuator control information 52.

ここで、アクチュエータ制御用情報52は、加減速アクチュエータ200の制御に直接的に必要な情報であり、車両300に設けられたセンサから前記CAN60を介さずに直接入力される。   Here, the actuator control information 52 is information directly necessary for control of the acceleration / deceleration actuator 200, and is directly input from a sensor provided in the vehicle 300 without passing through the CAN 60.

例えば、加減速アクチュエータ200が吸排気バルブである場合、吸排気バルブのバルブタイミングを制御するための情報であり、加減速アクチュエータ200がブレーキシステムである場合、ブレーキの油圧を制御するための情報であり、加減速アクチュエータ200がモータである場合、モータトルクを制御するための情報である。これらの情報は、車両に設けられた各種センサにより取得される。   For example, when the acceleration / deceleration actuator 200 is an intake / exhaust valve, it is information for controlling the valve timing of the intake / exhaust valve, and when the acceleration / deceleration actuator 200 is a brake system, information for controlling the hydraulic pressure of the brake. If the acceleration / deceleration actuator 200 is a motor, it is information for controlling the motor torque. These pieces of information are acquired by various sensors provided in the vehicle.

実施の形態では、加減速アクチュエータ200はブレーキシステムであるので、アクチュエータ制御用情報52は、ブレーキの油圧を制御するための情報(油圧制御情報)であり、この油圧制御情報が、基本制御演算部21に直接入力される。   In the embodiment, since the acceleration / deceleration actuator 200 is a brake system, the actuator control information 52 is information (hydraulic control information) for controlling the hydraulic pressure of the brake, and this hydraulic control information is a basic control calculation unit It is directly input to 21.

よって、実施の形態では、基本制御演算部21は、現在のブレーキの油圧制御情報(アクチュエータ制御用情報50)と、車速(車両運動情報51)とに基づいて、ブレーキシステムの制御のための油圧(基本制御指令値DA1)の演算を行う。   Therefore, in the embodiment, the basic control calculation unit 21 is a hydraulic pressure for controlling the brake system based on the hydraulic pressure control information (actuator control information 50) of the current brake and the vehicle speed (vehicle motion information 51). Calculation of (basic control command value DA1) is performed.

GVC制御部22には、車両運動情報51が入力されるようになっており、GVC制御部22は、この車両運動情報51に基づいて車両300の前後加速度G2をGVCにより制御するためのGVC指令値DB1の演算を行う。   The vehicle motion information 51 is input to the GVC control unit 22, and the GVC control unit 22 is configured to control the longitudinal acceleration G2 of the vehicle 300 based on the vehicle motion information 51 by using the GVC command. Calculate the value DB1.

GVC制御部22には、前述したGVC制御部12と共通のGVCの制御アルゴリズムを有する制御プログラム121が記憶されている。GVC制御部22では、この制御プログラム121を実行することで、車両300の前後加速度G2を制御アルゴリズムに基づいて制御するためのGVC指令値DB1の演算を行う。   The GVC control unit 22 stores a control program 121 having a GVC control algorithm common to that of the GVC control unit 12 described above. The GVC control unit 22 executes the control program 121 to calculate the GVC command value DB1 for controlling the longitudinal acceleration G2 of the vehicle 300 based on the control algorithm.

実施の形態におけるGVC制御部22では、車両300の前後加速度G2を、GVC指令値DB1となるように制御するために加減速アクチュエータ200を介入させるか否かの判定基準となる下側の介入閾値(下側介入閾値K21)と、下側介入閾値K21よりも上側の介入閾値(上側介入閾値K22)とが設定されている。GVC制御部22は、GVC指令値DB1が下側介入閾値K21の値よりも小さくなった場合、又は上側介入閾値K22の値よりも大きくなった場合、車両300の前後加速度G2を、GVC指令値DB1となるように加減速アクチュエータ100を制御する(図6の下図参照)。なお、特に区別しない場合、下側介入閾値K21と上側介入閾値K22とを合わせて介入閾値K2と表記する。
なお、下側介入閾値21の絶対値と上側介入閾値22の絶対値とは、必ずしも同じ大きさである必要はないが、同じ大きさであってもよい。両者を異なる値とした場合、加速側と減速側の制御介入タイミングを変更でき、より走行シーンにあった加減速制御が可能となる。
In the GVC control unit 22 according to the embodiment, the lower intervention threshold serving as a determination reference of whether or not to interpose the acceleration / deceleration actuator 200 to control the longitudinal acceleration G2 of the vehicle 300 to become the GVC command value DB1. (Lower intervention threshold K21) and an upper intervention threshold (upper intervention threshold K22) than the lower intervention threshold K21 are set. When the GVC command value DB1 becomes smaller than the value of the lower intervention threshold K21 or becomes larger than the value of the upper intervention threshold K22, the GVC control unit 22 sets the longitudinal acceleration G2 of the vehicle 300 to the GVC command value. The acceleration / deceleration actuator 100 is controlled to be DB1 (see the lower diagram in FIG. 6). Note that the lower intervention threshold K21 and the upper intervention threshold K22 are collectively referred to as an intervention threshold K2 unless otherwise specified.
Note that the absolute value of the lower intervention threshold 21 and the absolute value of the upper intervention threshold 22 do not necessarily have the same magnitude, but may have the same magnitude. When the values are different from each other, the control intervention timings on the acceleration side and the deceleration side can be changed, and acceleration / deceleration control according to the traveling scene can be performed.

前述した基本制御演算部21での演算結果である基本制御指令値DA1と、GVC制御部22での演算結果であるGVC指令値DB1と、車両運動情報51は、指令値演算部23に入力される。   The basic control command value DA1, which is the calculation result in the basic control calculation unit 21 described above, the GVC command value DB1, which is the calculation result in the GVC control unit 22, and the vehicle motion information 51 are input to the command value calculation unit 23. Ru.

指令値演算部23は、基本制御演算部21から入力された基本制御指令値DA1と、GVC制御部22から入力されたGVC指令値DB1と、車両運動情報51とを合成して、加減速アクチュエータ200を制御するためのアクチュエータ指令値DC1の演算を行う。   The command value calculation unit 23 combines the basic control command value DA1 input from the basic control calculation unit 21, the GVC command value DB1 input from the GVC control unit 22, and the vehicle motion information 51 to obtain an acceleration / deceleration actuator. An actuator command value DC1 for controlling 200 is calculated.

指令値演算部23で演算されたアクチュエータ指令値DC1は、送信部24に出力され、この送信部24から加減速アクチュエータ200に送信される。   The actuator command value DC1 calculated by the command value calculation unit 23 is output to the transmission unit 24, and is transmitted from the transmission unit 24 to the acceleration / deceleration actuator 200.

この結果、加減速アクチュエータ200は、受信したアクチュエータ指令値DC1に基づいて駆動され、車両300の前後加速度G2は、この加減速アクチュエータ200の駆動により制御される。
実施の形態では、前後加速度制御器20でのGVCにより、ブレーキ(加減速アクチュエータ200)の制動力(油圧)が制御され、このブレーキの制動力(油圧)に応じて車両300の前後加速度G2が制御される。
As a result, the acceleration / deceleration actuator 200 is driven based on the received actuator command value DC1, and the longitudinal acceleration G2 of the vehicle 300 is controlled by the drive of the acceleration / deceleration actuator 200.
In the embodiment, the braking force (hydraulic pressure) of the brake (acceleration / deceleration actuator 200) is controlled by the GVC in the longitudinal acceleration controller 20, and the longitudinal acceleration G2 of the vehicle 300 is controlled according to the braking force (hydraulic pressure) of the brake. It is controlled.

[運動制御装置1の動作]
図6は、運動制御装置1の動作を説明する図である。
図6の上図は、横軸に時間をとり、縦軸に車両300の横加速度G1をとったものであり、図6の下図は、横軸に時間をとり、縦軸に車両300の前後加速度G2をとったものである。
[Operation of motion control device 1]
FIG. 6 is a diagram for explaining the operation of the motion control device 1.
The upper diagram in FIG. 6 has time on the horizontal axis and the lateral acceleration G1 of the vehicle 300 on the vertical axis, and the lower diagram in FIG. 6 has time on the horizontal axis and the front and rear of the vehicle 300 on the vertical axis. The acceleration G2 is taken.

実施の形態では、図6に示すように、時間t1〜t4では、車両300が緩やかなカーブを曲がる場合の車両300の横加速度G1を示しており、時間t5〜t9では、車両300が障害物回避のような車線変更をした場合の車両300の横加速度G1を示している。   In the embodiment, as shown in FIG. 6, at time t1 to t4, the lateral acceleration G1 of the vehicle 300 when the vehicle 300 bends a gentle curve is shown, and at time t5 to t9, the vehicle 300 is an obstacle. The lateral acceleration G1 of the vehicle 300 in the case of lane change such as avoidance is shown.

図6に示すように、時間t1〜t2は、車両300のカーブへの進入時(図1の点1〜点3)であり、車両300の横加速度G1が徐々に増加する(図6の上図参照)のに応じて、車両300の前後加速後G2(GVC指令値CB1、DB1)を減少させている(図6の下図参照)。   As shown in FIG. 6, time t1 to t2 is when the vehicle 300 enters the curve (point 1 to point 3 in FIG. 1), and the lateral acceleration G1 of the vehicle 300 gradually G2 (GVC command values CB1, DB1) after longitudinal acceleration of the vehicle 300 is decreased according to (see FIG. 6) (see the lower diagram of FIG. 6).

時間t2〜t3は、車両300がカーブを曲がっている時の状態(図1の点3〜点5)であり、車両300の横加速度G1は、ほぼ一定の値となるため(図6の上図参照)、車両300の前後加速度G2(GVC指令値CB1、DB1)は、ほぼ0(ゼロ)となる。   Times t2 to t3 are states when the vehicle 300 is bending a curve (points 3 to 5 in FIG. 1), and the lateral acceleration G1 of the vehicle 300 has a substantially constant value (the upper part of FIG. 6 The longitudinal acceleration G2 (GVC command values CB1, DB1) of the vehicle 300 is substantially zero (see FIG. 6).

時間t3〜t4は、車両300がカーブから抜け出る時(図1の点5〜点7)の状態であり、車両300の横加速度G1が減少する(図6の上図参照)のに応じて、車両300の前後加速度G2(GVC指令値CB1、DB1)を増加させている(図6の下図参照)。   Times t3 to t4 are states when the vehicle 300 gets out of the curve (points 5 to 7 in FIG. 1), and the lateral acceleration G1 of the vehicle 300 decreases (see the upper diagram in FIG. 6). The longitudinal acceleration G2 (GVC command values CB1, DB1) of the vehicle 300 is increased (see the lower diagram in FIG. 6).

ここで、図6に示すように、時間t1〜t2では、GVC指令値CB1(図6の一点鎖線)が、下側介入閾値K11よりも小さくなるため、前後加速度制御器10は、車両300の前後加速度G2を、GVC指令値CB1となるようにアクチュエータ100を駆動する(図6の実線)。   Here, as shown in FIG. 6, at time t1 to t2, the GVC command value CB1 (one-dot chain line in FIG. 6) becomes smaller than the lower intervention threshold K11. The actuator 100 is driven to set the longitudinal acceleration G2 to the GVC command value CB1 (solid line in FIG. 6).

また、時間t3〜t4では、GVC指令値CB1(図6の一点鎖線)が、上側介入閾値K12よりも大きくなるため、前後加速度制御器10は、車両300の前後加速度G2を、GVC指令値CB1となるようにアクチュエータ100を駆動する(図6の実線)。   Further, at time t3 to t4, the GVC command value CB1 (one-dot chain line in FIG. 6) becomes larger than the upper intervention threshold K12, so the longitudinal acceleration controller 10 determines the longitudinal acceleration G2 of the vehicle 300 as the GVC command value CB1. The actuator 100 is driven so as to be (solid line in FIG. 6).

なお、時間t1〜t5では、GVC指令値DB1が、下側介入閾値K21よりも小さくならず、また上側介入閾値K22よりも大きくならないので、前後加速度制御器20によるアクチュエータ200の駆動は行わない。   During times t1 to t5, the GVC command value DB1 does not become smaller than the lower intervention threshold K21 and does not become larger than the upper intervention threshold K22, so the actuator 200 is not driven by the longitudinal acceleration controller 20.

次に、図6に示すように、時間t5〜t6では、車両300の横加速度G1が急激に増加する(図6の上図参照)のに応じて、車両300の前後加速度G2(GVC指令値CB1、DB1)を大きく減少させている(図6の下図参照)。   Next, as shown in FIG. 6, in time t5 to t6, the longitudinal acceleration G2 (GVC command value) of the vehicle 300 is responsive to the lateral acceleration G1 of the vehicle 300 increasing sharply (see the upper diagram of FIG. 6). CB1 and DB1) are greatly reduced (see the bottom of FIG. 6).

時間t6〜t7では、車両300の横加速度G1が、急激に減少する(図6の下図参照)のに応じて、車両300の前後加速度G2(GVC指令値CB1、DB1)を増加させている(図6の下図参照)。   From time t6 to time t7, the longitudinal acceleration G2 (GVC command values CB1, DB1) of the vehicle 300 is increased according to the lateral acceleration G1 of the vehicle 300 decreasing rapidly (see the lower diagram in FIG. 6) See the figure below in Figure 6).

時間t7〜t8では、車両300の横加速度G1が、時間t5〜t6の場合と反対側(マイナス側)に急激に増加する(図6の上図参照)のに応じて、車両300の前後加速度G2(GVC指令値CB1、DB1)を大きく減少させている(図6の下図参照)。   From time t7 to t8, the longitudinal acceleration G1 of the vehicle 300 sharply increases in the opposite side (minus side) to the time t5 to t6 (see the upper diagram in FIG. 6), the longitudinal acceleration of the vehicle 300 G2 (GVC command values CB1, DB1) is greatly reduced (see the lower diagram in FIG. 6).

最後に、時間t8〜t9では、車両300の横加速度G1が、急激に増加して0(ゼロ)に戻る(図6の上図参照)のに応じて、車両300の前後加速度G2(GVC指令値CB1、DB1)を増加させている(図2の下図参照)。   Finally, at times t8 to t9, the longitudinal acceleration G2 (GVC command) of the vehicle 300 is responsive to the lateral acceleration G1 of the vehicle 300 rapidly increasing and returning to 0 (see the upper diagram in FIG. 6). The values CB1, DB1) are increased (see the bottom of FIG. 2).

ここで、図6に示すように、時間t5〜t6及びt7〜t8では、GVC指令値DB1(図6の破線)が、下側介入閾値K21よりも小さくなるため、前後加速度制御器20は、車両300の前後加速度G2を、GVC指令値DB1となるようにアクチュエータ200を駆動する(図6の実線)。   Here, as shown in FIG. 6, at time t5 to t6 and t7 to t8, since the GVC command value DB1 (broken line in FIG. 6) becomes smaller than the lower intervention threshold K21, the longitudinal acceleration controller 20 The actuator 200 is driven so that the longitudinal acceleration G2 of the vehicle 300 becomes the GVC command value DB1 (solid line in FIG. 6).

時間t6〜t7及びt8〜t9では、アクチュエータ200はブレーキシステム(制動装置)であるため、このアクチュエータ200により車両300の前後加速度G2を、GVC指令値DB1となるように増加させることはできない。そのため、車両300の前後加速後G2は、モータであるアクチュエータ100の駆動により増加することになる。しかし、アクチュエータ100では、車両300の前後加速度G2をある一定の加速度よりも大きく増加させることができない。その結果、実施の形態では、車両300の前後加速度G2の増加がアクチュエータ100(モータ)に起因する一定の加速度で頭打ちになっている(図6の下図参照)。   At times t6 to t7 and t8 to t9, since the actuator 200 is a brake system (braking device), the longitudinal acceleration G2 of the vehicle 300 can not be increased to the GVC command value DB1 by the actuator 200. Therefore, after acceleration in the longitudinal direction G2 of the vehicle 300 is increased by driving the actuator 100, which is a motor. However, actuator 100 can not increase longitudinal acceleration G2 of vehicle 300 more than a certain acceleration. As a result, in the embodiment, the increase in the longitudinal acceleration G2 of the vehicle 300 is stopped at a constant acceleration caused by the actuator 100 (motor) (see the lower diagram in FIG. 6).

なお、時間t5〜t6及びt7〜t8では、車両300の前後加速度G2(GVC指令値CB1)が下側介入閾値K11よりも小さくなるため、前後加速度G2は、前後加速度制御器10によっても制御される。しかし、実施の形態では、前後加速度制御器10で制御される加減速アクチュエータ100はモータであり、大きな駆動力又は制動力を発生させることはできないが、GVC指令値DB1が介入閾値K2よりも大きい領域では、前後加速度制御器20の加減速アクチュエータ200の制御により車両300の前後加速度G2が制御可能となる。   In time t5 to t6 and t7 to t8, since the longitudinal acceleration G2 (GVC command value CB1) of the vehicle 300 becomes smaller than the lower intervention threshold K11, the longitudinal acceleration G2 is also controlled by the longitudinal acceleration controller 10. Ru. However, in the embodiment, the acceleration / deceleration actuator 100 controlled by the longitudinal acceleration controller 10 is a motor and can not generate a large driving force or braking force, but the GVC command value DB1 is larger than the intervention threshold K2 In the region, the longitudinal acceleration G2 of the vehicle 300 can be controlled by the control of the acceleration / deceleration actuator 200 of the longitudinal acceleration controller 20.

このように、運動制御装置1では、駆動力又は制動力の異なる加減速アクチュエータ100、200を、同じ制御アルゴリズムに基づいて駆動する前後加速度制御器10、20を有しており、この前後加速度制御器10は、車両300の前後加速度G2が、所定の介入閾値よりも大きく(又は小さく)なった場合、応答性が早く、駆動力又は制動力の小さい加減速アクチュエータ100を、GVCの制御アルゴリズムに基づいて駆動する。   As described above, the motion control device 1 includes the longitudinal acceleration controllers 10 and 20 that drive the acceleration / deceleration actuators 100 and 200 having different driving forces or braking forces based on the same control algorithm. When the longitudinal acceleration G2 of the vehicle 300 becomes larger (or smaller) than the predetermined intervention threshold, the controller 10 uses the acceleration / deceleration actuator 100 with quick response or small driving force or braking force as the GVC control algorithm. Drive based.

また、前後加速度制御器20は、車両300の前後加速度G2が、所定の介入閾値よりも大きく(又は小さく)なった場合、応答性が遅いが、駆動力又は制動力の大きい加減速アクチュエータ200を、前後加速度制御器100と同一の制御アルゴリズムに基づいて駆動する。   In addition, the longitudinal acceleration controller 20 has a slow response when the longitudinal acceleration G2 of the vehicle 300 becomes larger (or smaller) than the predetermined intervention threshold, but the acceleration / deceleration actuator 200 having a large driving force or braking force is used. , Drive based on the same control algorithm as the longitudinal acceleration controller 100.

運動制御装置1は、前述したようにGVCを行うことで、車両300の運動制御を適切に行うことができる。   The motion control device 1 can appropriately perform motion control of the vehicle 300 by performing GVC as described above.

以上説明した通り、実施の形態では、
(1)車両300(移動体)の運動に関与する少なくとも加減速アクチュエータ100(第1の構成装置)と加減速アクチュエータ200(第2の構成装置)とを有する車両300の運動制御装置1であって、加減速アクチュエータ100を制御する前後加速度制御器10(第1の制御器)と、加減速アクチュエータ200を制御する前後加速度制御器20(第2の制御器)と、を有し、前後加速度制御器10は、車両300の運動を所定の手順でGVCを実現する制御アルゴリズムを有し、前後加速度制御器20は、前後加速度制御器10と同じ制御アルゴリズムを有する構成とした。
As described above, in the embodiment,
(1) A motion control device 1 of a vehicle 300 having at least an acceleration / deceleration actuator 100 (first component device) and an acceleration / deceleration actuator 200 (second component device) involved in the motion of the vehicle 300 (moving object). Longitudinal acceleration controller 20 (first controller) for controlling the acceleration / deceleration actuator 100, and a longitudinal acceleration controller 20 (second controller) for controlling the acceleration / deceleration actuator 200, The controller 10 has a control algorithm for realizing the GVC of the motion of the vehicle 300 in a predetermined procedure, and the longitudinal acceleration controller 20 has the same control algorithm as the longitudinal acceleration controller 10.

上位の制御器のみが、加減速アクチュエータのGVCを行うための制御アルゴリズム(制御プログラム)を有している場合、上位の制御器と加減速アクチュエータとは、CANで接続されている場合、通信遅れが生じてしまう。
このように構成すると、前後加速度制御器10、20の各々が、GVCを行うための共通の制御アルゴリズム(制御プログラム121)を有しているので、前後加速度制御器10、20は、CANを介さずに直接加減速アクチュエータ100、200を制御できるので、通信遅れの影響を少なくすることができる。
When only the upper controller has a control algorithm (control program) for performing GVC of the acceleration / deceleration actuator, the communication delay when the upper controller and the acceleration / deceleration actuator are connected by CAN Will occur.
In this configuration, since each of the longitudinal acceleration controllers 10 and 20 has a common control algorithm (control program 121) for performing GVC, the longitudinal acceleration controllers 10 and 20 are connected via CAN. Since the acceleration / deceleration actuators 100 and 200 can be controlled directly, the influence of communication delay can be reduced.

また、前後加速度制御器10、20の各々がGVCのための共通の制御アルゴリズムを有しているので、何れか一方の前後加速度制御器10、20が故障や、GVCを行えない状況になっても、他方の前後加速度制御器10、20ではGVCを行える。よって、全くGVCを行えない場合と比べて、運転者の操作の違和感を少なくすると共に、運転の安定性を向上させることができる。   Also, since each of the longitudinal acceleration controllers 10, 20 has a common control algorithm for GVC, one of the longitudinal acceleration controllers 10, 20 is in a situation where it fails or can not perform GVC. The other longitudinal acceleration controllers 10 and 20 can also perform GVC. Therefore, compared with the case where GVC can not be performed at all, it is possible to reduce the discomfort of the driver's operation and to improve the driving stability.

(2)加減速アクチュエータ100は、車両300の移動方向の速度または加速度を制御する装置であり、前後加速度制御器10は、制御アルゴリズムに基づく加減速アクチュエータ100の制御により、車両300の移動方向の速度または加速度を制御すると共に、加減速アクチュエータ200は、車両300の移動方向の速度または加速度を制御する装置であり、前後加速度制御器20は、前後加速度制御器10と共通の制御アルゴリズムに基づく加減速アクチュエータ200の制御により、車両300の移動方向の速度または加速度を制御する構成とした。 (2) The acceleration / deceleration actuator 100 is a device for controlling the velocity or acceleration in the movement direction of the vehicle 300, and the longitudinal acceleration controller 10 controls the acceleration / deceleration actuator 100 based on the control algorithm to control the movement direction of the vehicle 300. The acceleration / deceleration actuator 200 is a device for controlling the velocity or acceleration in the moving direction of the vehicle 300 while controlling the velocity or acceleration, and the longitudinal acceleration controller 20 is based on a control algorithm common to the longitudinal acceleration controller 10. By controlling the deceleration actuator 200, the speed or acceleration in the moving direction of the vehicle 300 is controlled.

このように構成すると、前後加速度制御器10、20は、共通の制御アルゴリズムに基づいて車両300の移動方向の速度又は加速度を確実に制御することができる。   According to this configuration, the longitudinal acceleration controllers 10 and 20 can reliably control the speed or acceleration in the moving direction of the vehicle 300 based on the common control algorithm.

(3)前後加速度制御器10は、GVC指令値CB1が介入閾値K1(第1閾値)よりも大きく(又は小さく)なった場合、GVCの制御アルゴリズムに基づく車両300の移動方向の速度または加速度の制御を実施すると共に、前後加速度制御器20は、GVC指令値DB1が介入閾値K1と異なる介入閾値K2(第2閾値)よりも大きく(又は小さく)以上となった場合、前後加速度制御器10と共通の制御アルゴリズムに基づく車両300の移動方向の速度または加速度の制御を実施する構成とした。 (3) When the GVC command value CB1 becomes larger (or smaller) than the intervention threshold value K1 (first threshold value), the longitudinal acceleration controller 10 determines the speed or acceleration of the moving direction of the vehicle 300 based on the GVC control algorithm. While performing the control, when the GVC command value DB1 becomes greater than (or smaller than) the intervention threshold K2 (second threshold) different from the intervention threshold K1 while performing the control, the longitudinal acceleration controller 10 Control of the velocity or acceleration in the moving direction of the vehicle 300 based on the common control algorithm is performed.

このように構成すると、前後加速度制御器10、20の各々は、加減速アクチュエータ100、200が車両300の運動に介入する介入閾値を異ならせているので、車両300の様々な運転シーンに対応させて、加減速アクチュエータ100、200の制御を適切に行うことができる。   In this configuration, each of the longitudinal acceleration controllers 10 and 20 has different intervention threshold values for the acceleration / deceleration actuators 100 and 200 to intervene in the motion of the vehicle 300, so that they correspond to various driving scenes of the vehicle 300. Thus, the control of the acceleration / deceleration actuators 100 and 200 can be appropriately performed.

(4)制御アルゴリズムは、車両300の横加速度G1の単位時間当たりの変化が大きくなるほど、車両300の前後方向の加速度G2の絶対値が大きくなるように制御する構成とした。 (4) The control algorithm is configured to control so that the absolute value of the acceleration G2 in the front-rear direction of the vehicle 300 increases as the change per unit time of the lateral acceleration G1 of the vehicle 300 increases.

このように、制御アルゴリズムとして、G−ベクタリング制御のアルゴリズムを好適に採用することができる。   Thus, as a control algorithm, an algorithm of G-vectoring control can be suitably adopted.

<第2の実施の形態>
次に、第2の実施の形態にかかる運動制御装置1Aを説明する。
図7は、第2の実施の形態にかかる運動制御装置1Aを説明する機能ブロック図である。
Second Embodiment
Next, a motion control device 1A according to a second embodiment will be described.
FIG. 7 is a functional block diagram for explaining a motion control device 1A according to the second embodiment.

第2の実施の形態にかかる運動制御装置1Aでは、前後加速度制御器10A、20Aとは異なる他の制御器30から、前後加速度制御器10A、20Aを制御するための調整情報53、54が、前後加速度制御器10A、20Aに対して入力されている点が、前述した実施の形態と異なる。実施の形態では、他の制御器30は、前後加速度制御器10A、20Aの上位の制御器である。
以下、前述した実施の形態と同一の構成については同一の番号を付し、必要に応じて説明する。
In the motion control device 1A according to the second embodiment, adjustment information 53, 54 for controlling the longitudinal acceleration controllers 10A, 20A is from another controller 30 different from the longitudinal acceleration controllers 10A, 20A, The points input to the longitudinal acceleration controllers 10A and 20A are different from the embodiment described above. In the embodiment, the other controller 30 is an upper controller of the longitudinal acceleration controllers 10A and 20A.
Hereinafter, the same components as those of the embodiment described above are denoted by the same reference numerals, and will be described as necessary.

運動制御装置1Aは、前後加速度制御器10Aと、前後加速度制御器20Aとを有している。   The motion control device 1A has a longitudinal acceleration controller 10A and a longitudinal acceleration controller 20A.

前後加速度制御器10Aの指令値演算部13Aには、外部機器との通信部(図示せず)が設けられており、指令値演算部13Aは、この通信部を介して他の制御器30と接続されている。   The command value calculation unit 13A of the longitudinal acceleration controller 10A is provided with a communication unit (not shown) with an external device, and the command value calculation unit 13A communicates with the other controller 30 via this communication unit. It is connected.

また、前後加速度制御器20Aの指令値演算部23Aには、外部機器との通信部(図示せず)が設けられており、指令値演算部23Aは、この通信部を介して他の制御器30と接続されている。   In addition, the command value calculation unit 23A of the longitudinal acceleration controller 20A is provided with a communication unit (not shown) with an external device, and the command value calculation unit 23A is connected to another controller via this communication unit. Connected with 30.

他の制御器30は、前後加速度制御器10A、20Aとは異なる制御器であり、一例として、車両300の運動制御用のECU(Electronic Control Unit)を適用することができる。   The other controller 30 is a controller different from the longitudinal acceleration controllers 10A and 20A, and as an example, an ECU (Electronic Control Unit) for motion control of the vehicle 300 can be applied.

実施の形態では、制御器30は、前後加速度制御器10A、20Aの上位コントローラであり、この制御器30には、車両300に設けられた各種センサ(図示せず)からのセンサ情報や前後加速度制御器10A、20Aの正常/異常情報などが、CAN60を介して入力されると共に、車両300が自動運転車両の場合には、予め設定された運転ルート情報が、CAN60を介して入力される。   In the embodiment, the controller 30 is a host controller of the longitudinal acceleration controllers 10A and 20A, and in this controller 30, sensor information and longitudinal acceleration from various sensors (not shown) provided in the vehicle 300 are obtained. The normal / abnormal information of the controllers 10A, 20A, etc. is input via the CAN 60, and when the vehicle 300 is an automatically driven vehicle, preset driving route information is input via the CAN 60.

制御器30では、これらの情報に基づいて調整情報53、54を演算すると共に、この調整情報53、54を、前後加速度制御器10A、20Aにそれぞれ送信する。   The controller 30 calculates the adjustment information 53, 54 based on the information, and transmits the adjustment information 53, 54 to the longitudinal acceleration controllers 10A, 20A, respectively.

ここで、調整情報53、54は、指令値演算部13A、23Aで演算されるアクチュエータ指令値CC1、DC1のゲイン、フィルタ時定数、介入閾値K1、K2、介入条件などの情報である。
例えば、制御器30は、車両300の各種センサ情報などに基づいて、介入閾値K1、K2を調整するための調整情報53、54を演算して、指令値演算部13Aに送信する。そして、指令値演算部13Aでは、送信された調整情報53、54に基づいて、加減速アクチュエータ100、200が運動制御に介入する介入閾値K1、K2を調整する。
そして、前後加速度制御器10A、20Aは、制御器30によって調整された後の介入閾値K1、K2に基づいて、加減速アクチュエータ100、200を駆動し、車両300の前後加速度G2の制御を行うようになっている。
Here, the adjustment information 53, 54 is information such as the actuator command values CC1, DC1 gain calculated by the command value calculators 13A, 23A, filter time constants, intervention thresholds K1, K2, intervention conditions, and the like.
For example, the controller 30 calculates adjustment information 53, 54 for adjusting the intervention threshold values K1, K2 based on various sensor information of the vehicle 300 and the like, and transmits the adjustment information 53, 54 to the command value calculation unit 13A. Then, in the command value calculation unit 13A, the intervention threshold values K1 and K2 at which the acceleration / deceleration actuators 100 and 200 intervene in motion control are adjusted based on the transmitted adjustment information 53 and 54.
The longitudinal acceleration controllers 10A and 20A drive the acceleration / deceleration actuators 100 and 200 based on the intervention threshold values K1 and K2 adjusted by the controller 30, and control the longitudinal acceleration G2 of the vehicle 300. It has become.

これにより、上位のコントローラである制御器30に基づいて、車両300の現在の運動状況に基づく運動制御をより適切に行うことができる。   Thereby, motion control based on the current motion situation of the vehicle 300 can be more appropriately performed based on the controller 30, which is the upper controller.

また、例えば、制御器30は、前後加速度制御器10A又は前後加速度制御器20Aの正常/異常情報に基づいて、アクチュエータ指令値CC1、DC1のゲインやフィルタ時定数、介入閾値K1、K2や介入条件を調整するようにしてもよい。このようにすると、正常に動作している前後加速度制御器10A又は前後加速度制御器20Aにより、加減速アクチュエータ100、200を駆動することができ、車両300の前後加速度G2の制御を適切に行うことができる。   Also, for example, the controller 30 determines the gain and filter time constant of the actuator command value CC1 and DC1, the intervention threshold K1 and K2, and the intervention condition based on the normality / abnormality information of the longitudinal acceleration controller 10A or the longitudinal acceleration controller 20A. May be adjusted. In this way, the acceleration / deceleration actuators 100 and 200 can be driven by the longitudinal acceleration controller 10A or the longitudinal acceleration controller 20A operating normally, so that the longitudinal acceleration G2 of the vehicle 300 can be appropriately controlled. Can.

よって、制御器30では、異常のあった前後加速度制御器10A又は前後加速度制御器20Aによる加減速アクチュエータ100、200のGVCは行わず、他の正常な前後加速度制御器10A又は前後加速度制御器20AによるGVCを行うための介入閾値K1、K2や介入条件などを調整する。その結果、運動制御装置1Aでは、一方の加減速アクチュエータ100、200を適切に駆動できなくても、他方の加減速アクチュエータ100、200のみで車両300の運動制御を行うことができ、運転者の操作の違和感を少なくすることができる。   Therefore, the controller 30 does not perform GVC of the acceleration / deceleration actuators 100 and 200 by the anteroposterior acceleration controller 10A or the anteroposterior acceleration controller 20A having abnormality, and the other normal longitudinal acceleration controller 10A or the anteroposterior acceleration controller 20A Adjust the intervention threshold values K1 and K2 and intervention conditions for performing GVC according to. As a result, in the motion control device 1A, even if one of the acceleration / deceleration actuators 100, 200 can not be properly driven, motion control of the vehicle 300 can be performed only by the other acceleration / deceleration actuators 100, 200. The discomfort of the operation can be reduced.

[指令値演算部での処理]
次に、第2の実施の形態にかかる運動制御装置1Aの指令値演算部13A(又は指令値演算部23A)で実行される処理を説明する。
図8は、第2の実施の形態の指令値演算部13A(又は指令値演算部23A)で実行される処理のフローチャートである。
[Processing in command value calculation unit]
Next, a process performed by the command value calculator 13A (or the command value calculator 23A) of the motion control device 1A according to the second embodiment will be described.
FIG. 8 is a flowchart of processing executed by the command value calculator 13A (or the command value calculator 23A) according to the second embodiment.

ステップS101において、指令値演算部13A(23A)は、入力信号の受信処理を行う。   In step S101, the command value calculation unit 13A (23A) performs an input signal reception process.

ここで、実施の形態では、入力信号は、車両運動情報51、アクチュエータ制御用情報50、52、GVC制御部12(又はGVC制御部22)から入力されたGVC指令値CB1(又はGVC指令値DB1)、調整情報53(又は調整情報54)である。   Here, in the embodiment, the input signal is vehicle motion information 51, information 50, 52 for actuator control, GVC command value CB1 (or GVC command value DB1) input from GVC control unit 12 (or GVC control unit 22). , Adjustment information 53 (or adjustment information 54).

実施の形態では、調整情報53(又は調整情報54)は、加減速アクチュエータ100、200による前後加速度G2の制御を実施するか否かを決める介入閾値K1(K2)であり、下側介入閾値K11(K21)と上側介入閾値K12(K22)とが、指令値演算部13A(23A)に入力される。   In the embodiment, the adjustment information 53 (or the adjustment information 54) is the intervention threshold K1 (K2) that determines whether to control the longitudinal acceleration G2 by the acceleration / deceleration actuators 100 and 200, and the lower intervention threshold K11 The command value calculation unit 13A (23A) receives (K21) and the upper intervention threshold K12 (K22).

ステップS102において、指令値演算部13A(23A)は、ステップS101で入力された調整情報53(54)を正常に受信したか否かを判定する。指令値演算部13A(23A)は、調整情報53(54)を正常に受信したと判定した場合(ステップS102:Yes)、ステップS103に進む。   In step S102, the command value calculation unit 13A (23A) determines whether the adjustment information 53 (54) input in step S101 has been received normally. If the command value calculation unit 13A (23A) determines that the adjustment information 53 (54) has been received normally (step S102: Yes), the process proceeds to step S103.

ステップS103において、指令値演算部13A(23A)は、介入情報K1である調整情報53(54)に基づいて、アクチュエータ制御基本指令値CC11(DC11)の演算を行う。指令値演算部13A(23A)におけるアクチュエータ制御基本指令値CC11(DC11)の演算は、次の数式3、数式4を用いて行われる。

Figure 2019043351
Figure 2019043351
In step S103, the command value calculation unit 13A (23A) calculates the actuator control basic command value CC11 (DC11) based on the adjustment information 53 (54) which is the intervention information K1. The calculation of the actuator control basic command value CC11 (DC11) in the command value calculation unit 13A (23A) is performed using Formula 3 and Formula 4 below.
Figure 2019043351
Figure 2019043351

ステップS104において、指令値演算部13A(23A)は、ステップS103で演算したアクチュエータ制御基本指令値CC11(DC11)と、車両運動情報51と、アクチュエータ制御用情報50、52とに基づいて、加減速アクチュエータ100(200)のアクチュエータ指令値CC1(DC1)を演算する。   In step S104, the command value calculation unit 13A (23A) performs acceleration / deceleration based on the actuator control basic command value CC11 (DC11) calculated in step S103, the vehicle motion information 51, and the actuator control information 50, 52. The actuator command value CC1 (DC1) of the actuator 100 (200) is calculated.

ステップS105において、指令値演算部13A(23A)は、ステップS104で演算したアクチュエータ指令値CC1(DC11)を、送信部14(24)に送信して処理を終了する。   In step S105, the command value calculation unit 13A (23A) transmits the actuator command value CC1 (DC11) calculated in step S104 to the transmission unit 14 (24), and ends the process.

ここで、ステップS102において、指令値演算部13A(23A)は、調整情報53を正常に受信していない(異常)と判定した場合(ステップS102:No)、ステップS106に進む。
調整情報53を正常に受信していない場合とは、調整情報53を送信する制御器30の故障、制御器30との通信エラー等により、調整情報53を正常に受信できていない状態である。この調整情報53を正常に受信したか否かの判断は、チェックサムによる検出や、他の状態監視制御器(図示せず)による検出などの方法を用いて行うことができる。
Here, in step S102, when the command value calculation unit 13A (23A) determines that the adjustment information 53 is not properly received (abnormal) (step S102: No), the process proceeds to step S106.
The case where the adjustment information 53 is not received normally means that the adjustment information 53 can not be received normally due to a failure of the controller 30 transmitting the adjustment information 53, a communication error with the controller 30, or the like. The determination as to whether the adjustment information 53 has been received normally can be made using a method such as detection using a checksum or detection using another state monitoring controller (not shown).

そして、ステップS106において、指令値演算部13A(23A)は、予め設定された介入閾値を用いて、アクチュエータ制御基本指令値CC11の演算を行い、ステップS104に進み、ステップS104において、ステップS106で演算されたアクチュエータ制御基本指令値CC11(DC11)と、車両運動情報51と、アクチュエータ制御用情報50、52とに基づいて、加減速アクチュエータ100(200)をGVCによる制御をするためのアクチュエータ指令値CC1(DC1)を演算する。   Then, in step S106, the command value calculation unit 13A (23A) calculates the actuator control basic command value CC11 using a preset intervention threshold value, proceeds to step S104, and in step S104, calculates in step S106. Actuator command value CC1 for controlling the acceleration / deceleration actuator 100 (200) by GVC based on the determined actuator control basic command value CC11 (DC11), vehicle motion information 51, and actuator control information 50, 52 Calculate (DC1).

前述した運動制御装置1Aでは、上位(他)の制御器30から、調整情報53、54(ゲイン、フィルタ時定数、介入閾値K1、K2、介入条件など)が入力されるようになっており、この調整情報53、54に基づいて加減速アクチュエータ100、200を駆動することで、車両300の運動制御を適切に行うことができる。   In the above-described motion control device 1A, adjustment information 53 and 54 (gain, filter time constant, intervention threshold K1, K2, intervention condition, etc.) are input from the upper (other) controller 30, By driving the acceleration / deceleration actuators 100 and 200 based on the adjustment information 53 and 54, motion control of the vehicle 300 can be appropriately performed.

また、上位(他)の制御器30から、調整情報53、54を送信するようにしたので、上位の制御器30により、調整情報53、54(介入閾値K1、K2、介入条件など)を、車両300の運動状況や周囲の障害物の有無などに応じて変えることができる。そのため、制御器30が、車両300周辺の障害物や将来の走行ルート(走行シーン)を各センサから取得できる場合、制御器30では、調整情報53(54)を、周辺の障害物や走行ルート(走行シーン)に応じて変えることで、車両300の運動制御をより適切に実施できる。   Further, since the adjustment information 53, 54 is transmitted from the upper (other) controller 30, the upper controller 30 adjusts the adjustment information 53, 54 (the intervention threshold K1, K2, the intervention condition, etc.) It can be changed according to the movement status of the vehicle 300, the presence or absence of an obstacle around the vehicle, and the like. Therefore, when the controller 30 can acquire an obstacle around the vehicle 300 and a future travel route (travel scene) from each sensor, the controller 30 adjusts the adjustment information 53 (54) to the obstacle or travel route in the vicinity. By changing according to (traveling scene), motion control of the vehicle 300 can be implemented more appropriately.

その結果、例えば、車両300の通常走行時と比較して、障害物を操舵で回避する走行シーンにおいて、減速(制動)を生じさせる加減速アクチュエータ(例えば、ブレーキ)に送信するアクチュエータ指令値CC1(DC1)のゲインを高く設定し、操舵開始時に大きく減速させることで、通常走行時の減速感を抑えながら、緊急時の回避性能を高めることができる。   As a result, for example, in the traveling scene in which the obstacle is avoided by steering as compared with the normal traveling of the vehicle 300, the actuator command value CC1 (for example, brake) to be decelerated (braking) By setting the gain of DC1) high and greatly decelerating at the start of steering, it is possible to enhance the avoidance performance in an emergency while suppressing the feeling of deceleration during normal driving.

また、上位(他)の制御器30から、調整情報53、54を送信するようにしたので、例えば、下位の前後加速度制御器10A、20Aの何れかにおいて、制御プログラム121(GVCの制御アルゴリズム)に基づく車両300の運動制御を実施することができない状態となった場合でも、調整情報53、54により、運動制御を実施できる前後加速度制御器10A、20Aのゲイン、フィルタ時定数、介入閾値K1、K2などを調整して、車両300の運動制御を適切に実施することができる。   Further, since the adjustment information 53, 54 is transmitted from the upper (other) controller 30, for example, the control program 121 (GVC control algorithm) in any of the lower order longitudinal acceleration controllers 10A, 20A. Even when the motion control of the vehicle 300 based on the above can not be performed, the gains of the longitudinal acceleration controllers 10A and 20A, the filter time constant, and the intervention threshold K1, which can perform the motion control by the adjustment information 53 and 54, Motion control of the vehicle 300 can be appropriately implemented by adjusting K2 and the like.

なお、前述した実施の形態では、上位(他)の制御器30が、調整情報53、54を前後加速度制御器10A、20Aに送信する場合を例示して説明したが、これに限定されるものではない。
例えば、一方の前後加速度制御器10A、20Aで調整情報53、54を生成し、他方の前後加速度制御器10A、20Aに調整情報53、54を送信する構成としてもよい。
Although the upper (other) controller 30 transmits the adjustment information 53, 54 to the longitudinal acceleration controllers 10A, 20A in the embodiment described above, the present invention is limited thereto. is not.
For example, the adjustment information 53, 54 may be generated by one longitudinal acceleration controller 10A, 20A, and the adjustment information 53, 54 may be transmitted to the other longitudinal acceleration controller 10A, 20A.

このように構成すると、例えば、どちらか一方の前後加速度制御器10A、20Aが、加減速アクチュエータ100、200の制御上の制約(例えば、加減速アクチュエータの連続動作による温度上昇、モータである場合のバッテリの充電状態など)により、加減速アクチュエータ100、200のGVCによる制御を適切に行えない場合、一方の前後加速度制御器10A、20AによるGVCによる制御を行えない分、他の前後加速度制御器10A、20Aの介入閾値K1、K2や介入条件を変えることにより、GVCによる制御を補填して適切に行うことができる。よって、運転者の操作の違和感をより少なくすることができる。   With such a configuration, for example, when one of the longitudinal acceleration controllers 10A and 20A is a restriction on control of the acceleration / deceleration actuators 100 and 200 (for example, temperature rise by continuous operation of the acceleration / deceleration actuator, motor If the GVC control of the acceleration / deceleration actuators 100 and 200 can not be properly performed due to the charging state of the battery, etc., the other longitudinal acceleration controller 10A can not be controlled by the GVC by one longitudinal acceleration controller 10A or 20A. By changing the intervention threshold values K1 and K2 of 20 A, and the intervention conditions, control by GVC can be compensated and appropriately performed. Thus, the driver's discomfort in the operation can be further reduced.

また、一方の前後加速度制御器10A、20Aが、直接他方の前後加速度制御器10A、20Aに調整情報53、54を送信するのではなく、一方の前後加速度制御器10A、20Aの状態に関する情報を、他方の前後加速度制御器10A、20Aの介入条件などを変更するトリガとする構成でもよい。
例えば、一方の前後加速度制御器10A、20Aが、加減速アクチュエータ100、200の駆動を行うことが困難であるという情報を、他方の前後加速度制御器10A、20Aで検出するようにし、当該情報を検出した他方の前後加速度制御器10A、20Aが、当該情報に基づいて、介入条件などを変更するように調整情報53、54を生成する構成してもよい。
In addition, instead of transmitting the adjustment information 53, 54 directly to the other longitudinal acceleration controller 10A, 20A, the longitudinal acceleration controller 10A, 20A on the other side directly provides information on the state of the longitudinal acceleration controller 10A, 20A on one side. Alternatively, the intervention condition of the other longitudinal acceleration controller 10A or 20A may be changed as a trigger.
For example, information that one longitudinal acceleration controller 10A or 20A has difficulty in driving the acceleration / deceleration actuator 100 or 200 is detected by the other longitudinal acceleration controller 10A or 20A, and the information is detected. The other longitudinal acceleration controller 10A, 20A detected may be configured to generate the adjustment information 53, 54 so as to change the intervention condition or the like based on the information.

このように構成すると、上位(他)の制御器30が、前後加速度制御器10A、20Aに対して調整情報53、54を送信する場合と比べて、前後加速度制御器10A、20Aが直接調整情報53、54を生成するので、この調整情報53、54により、走行シーンに応じた車両の運動制御を行いつつ、調整情報53、54を送信する際の通信時間の遅れを低減することができる。また、仮に一方の前後加速度制御器10A、20Aが故障した場合でも、他の前後加速度制御器10A、20Aにより運動制御の補填をすることができる。   In this configuration, the longitudinal acceleration controllers 10A and 20A can directly adjust the adjustment information as compared with the case where the upper (other) controller 30 transmits the adjustment information 53 and 54 to the longitudinal acceleration controllers 10A and 20A. Since 53 and 54 are generated, it is possible to reduce a delay of communication time when transmitting the adjustment information 53 and 54 while performing motion control of the vehicle according to the traveling scene by the adjustment information 53 and 54. Even if one of the longitudinal acceleration controllers 10A and 20A fails, the motion control can be compensated by the other longitudinal acceleration controllers 10A and 20A.

以上説明した通り、実施の形態では、
(5)前後加速度制御器10と前後加速度制御器20とは異なる、上位の制御器30(第3の制御器)をさらに有し、上位の制御器30は、車両300の運動状態又は周囲状況に基づいて、介入閾値K1、K2の設定および変更を実施する構成とした。
As described above, in the embodiment,
(5) The superordinate controller 30 (third controller) different from the longitudinal acceleration controller 10 and the longitudinal acceleration controller 20 is further included, and the superordinate controller 30 indicates the motion state or the surrounding condition of the vehicle 300. Setting and changing the intervention threshold values K1 and K2 based on

このように構成すると、上位の制御器30が、車両300の各種センサ情報を取得できる場合、上位の制御器30は、各種センサ情報に基づいて調整情報53を演算することができる。その結果、前後加速度制御器10、20では、上位の制御器30から送信された調整情報53に基づいて、車両300の運転状況や周囲状況を勘案した上で、加減速アクチュエータ100、200が車両300の運転に介入する介入閾値K1、K2を適切に設定、変更することができる。   When configured in this manner, if the higher-level controller 30 can acquire the various sensor information of the vehicle 300, the higher-level controller 30 can calculate the adjustment information 53 based on the various sensor information. As a result, in the longitudinal acceleration controllers 10 and 20, based on the adjustment information 53 transmitted from the higher level controller 30, the acceleration / deceleration actuators 100 and 200 are the vehicles after considering the driving situation and the surrounding situation of the vehicle 300. Intervention thresholds K1 and K2 to intervene in 300 driving can be set and changed appropriately.

(6)また、前後加速度制御器10、20は、調整情報53に基づいて、加減速アクチュエータ100、200の介入閾値K1,K2、介入条件の少なくとも何れか一つを変更する構成とした。 (6) Further, the longitudinal acceleration controllers 10 and 20 are configured to change at least one of the intervention threshold values K1 and K2 of the acceleration / deceleration actuators 100 and 200 and the intervention condition based on the adjustment information 53.

このように構成すると、前後加速度制御器10、20は、車両300の運転状況や運転シーンに応じて、介入閾値K1、K2を設定、変更することができ、車両300の加減速のGVCによる制御をより適切に行うことができる。   According to this configuration, the longitudinal acceleration controllers 10 and 20 can set and change the intervention threshold values K1 and K2 according to the driving situation and driving scene of the vehicle 300, and control by acceleration and deceleration of the vehicle 300 by GVC Can be done more properly.

(7)また、車両300の運動に関与する少なくとも加減速アクチュエータ100と200とを有する車両300の運動制御方法であって、加減速アクチュエータ100または加減速アクチュエータ200の駆動条件を調整するための調整情報53を正常に受信したか否かを判定する受信判定ステップ(ステップS102)と、調整情報53を正常に受信したと判定した場合(ステップS102:Yes)、調整情報53に基づいて加減速アクチュエータ100又は加減速アクチュエータ200を駆動するためのアクチュエータ指令値CC1又はアクチュエータ指令値DC1を同一の制御アルゴリズムにより演算する演算ステップ(ステップS104)と、を有する構成とした。 (7) A motion control method of a vehicle 300 having at least the acceleration / deceleration actuators 100 and 200 involved in the motion of the vehicle 300, the adjustment for adjusting the drive condition of the acceleration / deceleration actuator 100 or the acceleration / deceleration actuator 200. A reception determination step (step S102) for determining whether the information 53 is normally received, and an acceleration / deceleration actuator based on the adjustment information 53 when it is determined that the adjustment information 53 is normally received (step S102: Yes) 100 or an operation step (step S104) for calculating the actuator command value CC1 or actuator command value DC1 for driving the acceleration / deceleration actuator 200 according to the same control algorithm.

このように構成すると、前後加速度制御器10、20は、上位の制御器30から運動状況や周囲状況に基づいて演算された調整情報53を取得することができる。よって、前後加速度制御器10、20は、調整情報53に基づく車両300の前後加速度のGVCによる制御を適切に行うことができる。   According to this configuration, the longitudinal acceleration controllers 10 and 20 can acquire the adjustment information 53 calculated based on the exercise status and the surrounding status from the upper controller 30. Therefore, the longitudinal acceleration controllers 10 and 20 can appropriately control the longitudinal acceleration of the vehicle 300 based on the adjustment information 53 using GVC.

(8)また、演算ステップ(ステップS102)は、調整情報53を正常に受信していないと判定した場合(ステップS102:No)、予め設定された事前調整情報(介入閾値)に基づいて、加減速アクチュエータ100又は加減速アクチュエータ200を駆動するためのアクチュエータ指令値CC1又はアクチュエータ指令値DC1を同一の制御アルゴリズムにより演算する構成とした。 (8) Further, when it is determined that the adjustment information 53 has not been received normally (step S102: No), the calculation step (step S102) is performed based on the preset advance adjustment information (intervention threshold). The actuator command value CC1 or the actuator command value DC1 for driving the deceleration actuator 100 or the acceleration / deceleration actuator 200 is calculated by the same control algorithm.

このように構成すると、上位の制御器30において、調整情報53を正常に演算できない状況にある場合や、上位の制御器30との通信エラーなどにより調整情報53を取得できない場合でも、前後加速度制御器10、20は、予め設定された調整情報に基づいて加減速アクチュエータ100、200のGVCによる制御を適切に行うことができる。   With such a configuration, the longitudinal acceleration control can be performed even when the higher-level controller 30 can not calculate the adjustment information 53 normally or when the adjustment information 53 can not be obtained due to a communication error with the upper-layer controller 30 or the like. The units 10 and 20 can appropriately perform control by the GVC of the acceleration / deceleration actuators 100 and 200 based on preset adjustment information.

なお、前述した実施の形態では、加減速アクチュエータ100、200の駆動により、車両300の前後加速度を制御することで、車両300の運動制御を行う場合を例示して説明したが、これに限定するものでない。例えば、加減速アクチュエータの代わりに、DYC(Direct Yaw−moment Control)アクチュエータを用いて車両300の運動制御を行ってもよい。   In the embodiment described above, the motion control of the vehicle 300 is performed by controlling the longitudinal acceleration of the vehicle 300 by driving the acceleration / deceleration actuators 100 and 200. However, the present invention is not limited to this. It is not a thing. For example, motion control of the vehicle 300 may be performed using a direct yaw-moment control (DYC) actuator instead of the acceleration / deceleration actuator.

<第3の実施の形態>
次に、DYCアクチュエータを用いて車両300の運動制御を行う運動制御装置1Bを説明する。
図9は、第3の実施の形態にかかる運動制御装置1Bを説明する機能ブロック図である。
図10は、第3の実施の形態にかかる運動制御装置1Bの動作を説明する図である。
Third Embodiment
Next, a motion control device 1B that performs motion control of the vehicle 300 using a DYC actuator will be described.
FIG. 9 is a functional block diagram for explaining a motion control device 1B according to the third embodiment.
FIG. 10 is a diagram for explaining the operation of the motion control device 1B according to the third embodiment.

第3の実施の形態にかかる運動制御装置1Bでは、DYC(Direct Yaw−moment Control)制御器70、80により、DYCアクチュエータ400、500を制御する点が、前述した実施の形態で、前後加速度制御器10(10A)、20(20A)により加減速アクチュエータ100、200を制御する場合と異なる。
以下、前述した実施の形態と同一の構成については同一の番号を付し、必要に応じて説明する。
In the motion control device 1B according to the third embodiment, the longitudinal acceleration control is performed in the above-described embodiment in that the DYC actuators 400 and 500 are controlled by the DYC (Direct Yaw-moment Control) controllers 70 and 80. The case is different from the case where the acceleration / deceleration actuators 100 and 200 are controlled by the units 10 (10A) and 20 (20A).
Hereinafter, the same components as those of the embodiment described above are denoted by the same reference numerals, and will be described as necessary.

運動制御装置1Bは、DYC制御器70と、DYC制御器80とを有しており、このDYC制御器70により、DYCアクチュエータ400をヨーモーメント制御するようになっており、DYC制御器80により、DYCアクチュエータ500をヨーモーメント制御するようになっている。   The motion control device 1B includes a DYC controller 70 and a DYC controller 80. The DYC controller 70 controls the yaw moment of the DYC actuator 400. The DYC controller 80 The yaw moment control of the DYC actuator 500 is performed.

DYCアクチュエータ400、500は、それぞれ異なる方式で、車両300のタイヤと路面との間に発生する駆動力又は制動力を制御することにより、車両300の左右輪で異なる駆動力又は制動力を発生させ、車両300に作用するヨーモーメントM(図3参照)を制御できるものであれば、それぞれ任意のものを用いることができる。   The DYC actuators 400 and 500 generate different driving forces or braking forces at the left and right wheels of the vehicle 300 by controlling the driving force or braking force generated between the tire of the vehicle 300 and the road surface in different ways. As long as the yaw moment M (see FIG. 3) acting on the vehicle 300 can be controlled, any arbitrary one can be used.

DYCアクチュエータ400、500の一例として、以下の(F)、(G)、(H)が挙げられる。
(F)トルクベクタリングアクチュエータにより、動力源(例えば、エンジンやモータ)により発生した駆動トルクの左右輪への配分量を制御することでタイヤに作用する駆動トルク又は制動トルクを制御する装置。
(G)左右輪をモータで独立に駆動又は制動させる装置(インホイールモータ)、それぞれ独立にモータに流れる電流を制御することで、それぞれのタイヤに作用する制動トルク又は駆動トルクを制御する装置。
(H)左右輪のブレーキディスクにブレーキパッドを押し付けることにより、左右輪に作用する制動力をそれぞれ独立に制御する装置。
Examples of the DYC actuators 400 and 500 include the following (F), (G) and (H).
(F) A device that controls the drive torque or braking torque acting on the tire by controlling the distribution amount of drive torque generated by a power source (for example, an engine or motor) to the left and right wheels by a torque vectoring actuator.
(G) A device for independently driving or braking left and right wheels with a motor (in-wheel motor), a device for controlling braking torque or driving torque acting on each tire by controlling the current flowing to the motor independently.
(H) A device for independently controlling the braking forces acting on the left and right wheels by pressing the brake pads against the brake disks of the left and right wheels.

なお、実施の形態では、DYCアクチュエータ400が、電動輸送機器の動力源として使用されるモータである場合を例示して説明する。DYCアクチュエータ400がモータである場合、制御の応答性が早く、また車両300のヨーモーメントを小さく変えるような細かな制御(微調整)を行うことができる。   In the embodiment, the case where the DYC actuator 400 is a motor used as a power source of a motorized transportation device will be described as an example. When the DYC actuator 400 is a motor, the control response is quick, and fine control (fine adjustment) can be performed to change the yaw moment of the vehicle 300 to a small value.

また、実施の形態では、DYCアクチュエータ500は、車両300を制動させるためのブレーキシステムである場合を例示して説明する。DYCアクチュエータ500がブレーキシステムである場合、ブレーキシステムは油圧制御のため応答性が遅い反面、車両300のヨーモーメントMを大きく変える(制動する)ような制御を行うことができる。   In the embodiment, the DYC actuator 500 will be described by exemplifying a case where it is a brake system for braking the vehicle 300. When the DYC actuator 500 is a brake system, the brake system is slow in response due to hydraulic pressure control, but on the other hand, can perform control such as greatly changing (braking) the yaw moment M of the vehicle 300.

DYC制御器70は、基本制御演算部71と、DYC制御部72と、指令値演算部73と、送信部74とを有している。   The DYC controller 70 includes a basic control calculation unit 71, a DYC control unit 72, a command value calculation unit 73, and a transmission unit 74.

基本制御演算部71は、アクチュエータ制御用情報50Aと、車両運動情報51Aとに基づいて、DYCアクチュエータ400(例えば、モータ)のモータトルクを発生させるための制御指令値EA1の演算を行う。   Basic control calculation unit 71 calculates control command value EA1 for generating motor torque of DYC actuator 400 (for example, motor) based on actuator control information 50A and vehicle motion information 51A.

DYC制御部72は、車両300のヨーモーメントMをDYCにより制御するためのDYC指令値EB1の演算を行う。このDYC制御部72には、車両運動情報51Aが入力されており、DYC制御部72は、この車両運動情報51Aに基づいて車両300のヨーモーメントMを制御するためのDYC指令値EB1の演算を行う。   The DYC control unit 72 calculates a DYC command value EB1 for controlling the yaw moment M of the vehicle 300 by DYC. The vehicle motion information 51A is input to the DYC control unit 72, and the DYC control unit 72 calculates the DYC command value EB1 for controlling the yaw moment M of the vehicle 300 based on the vehicle motion information 51A. Do.

DYC制御部72には、Moment Plus(以下、M+とも表記する)の制御アルゴリズムを有する制御プログラム721が記憶されている。DYC制御部72は、この制御プログラムを実行することで、車両300のヨーモーメントMを制御アルゴリズムに基づいて制御するためのDYC指令値EB1の演算を行う。   The DYC control unit 72 stores a control program 721 having a control algorithm of Moment Plus (hereinafter also referred to as M +). The DYC control unit 72 executes this control program to calculate the DYC command value EB1 for controlling the yaw moment M of the vehicle 300 based on the control algorithm.

ここで、実施の形態では、M+による制御は、前述したGVCに基づくダイレクトヨーモーメント制御(DYC)である。
M+による制御は、GVCの加減速による車両300のヨー運動の促進、若しくは安定化と同様の効果を、車両300の左右輪に発生する制動力又は駆動力の差により与え、ヨー運動の促進若しくは安定化を向上させることを図る方法である。
Here, in the embodiment, the control by M + is the direct yaw moment control (DYC) based on GVC described above.
The control by M + provides the same effect as acceleration or deceleration of the vehicle 300 by acceleration or deceleration of the GVC, by providing a difference between the braking force or the driving force generated on the left and right wheels of the vehicle 300 to promote yaw motion or It is a method to improve stabilization.

前述した基本制御演算部71で演算した制御指令値EA1と、DYC制御部72で演算したDYC指令値EB1と、車両運動情報51Aとは、指令値演算部73に入力される。   The control command value EA1 calculated by the basic control calculation unit 71 described above, the DYC command value EB1 calculated by the DYC control unit 72, and the vehicle motion information 51A are input to the command value calculation unit 73.

指令値演算部73は、基本制御演算部71から入力された制御指令値EA1と、DYC制御部72から入力されたDYC指令値EB1と、車両運動情報51Aとを合成して、DYCアクチュエータ400を制御するためのDYCアクチュエータ指令値EC1の演算を行う。   The command value calculation unit 73 combines the control command value EA1 input from the basic control calculation unit 71, the DYC command value EB1 input from the DYC control unit 72, and the vehicle motion information 51A, and obtains the DYC actuator 400. A DYC actuator command value EC1 for control is calculated.

図10に示すように、DYC制御部72では、車両300の前後加速度G2を、DYC指令値EB1となるように制御するためにDYCアクチュエータ400を介入させるか否かの判定基準となる下側の介入閾値(下側介入閾値K31)と、下側介入閾値K31よりも上側の介入閾値(上側介入閾値K32)とが設定されている。DYC制御部72は、DYC指令値EB1が下側介入閾値K31の値よりも小さくなった場合、又は上側介入閾値K32の値よりも大きくなった場合、車両300のヨーモーメントMを、DYC指令値EB1となるようにアクチュエータ400を制御する。なお、下側介入閾値K31と上側介入閾値K32とを合わせて介入閾値K3と表記する。
なお、下側介入閾値31の絶対値と上側介入閾値32の絶対値とは、必ずしも同じ大きさである必要はないが、同じ大きさであってもよい。両者を異なる値とした場合、旋回促進側と安定側の制御介入タイミングを変更でき、より走行シーンにあった加減速制御が可能となる。またアクチュエータのばらつきによる左回りと右回りのヨーモーメント違いが発生する場合の補償も可能となる。
As shown in FIG. 10, the DYC control unit 72 determines the lower side of the determination criterion as to whether or not to intervene the DYC actuator 400 to control the longitudinal acceleration G2 of the vehicle 300 to the DYC command value EB1. An intervention threshold (lower intervention threshold K31) and an intervention threshold above the lower intervention threshold K31 (upper intervention threshold K32) are set. When the DYC command value EB1 becomes smaller than the value of the lower intervention threshold K31 or becomes larger than the value of the upper intervention threshold K32, the DYC control unit 72 sets the yaw moment M of the vehicle 300 to the DYC command value. The actuator 400 is controlled to become EB1. The lower intervention threshold K31 and the upper intervention threshold K32 are collectively referred to as an intervention threshold K3.
The absolute value of the lower intervention threshold 31 and the absolute value of the upper intervention threshold 32 do not necessarily have the same magnitude, but may have the same magnitude. When the values are different from each other, the control intervention timings of the turning promotion side and the stabilization side can be changed, and acceleration / deceleration control more suited to the traveling scene becomes possible. In addition, it is also possible to compensate for the occurrence of a difference in counterclockwise and clockwise yaw moment due to the variation of the actuator.

指令値演算部73で演算されたDYCアクチュエータ指令値EC1は、送信部74に出力され、この送信部74からDYCアクチュエータ400に送信される。   The DYC actuator command value EC1 calculated by the command value calculation unit 73 is output to the transmission unit 74, and transmitted from the transmission unit 74 to the DYC actuator 400.

この結果、DYCアクチュエータ400は、受信したDYCアクチュエータ指令値EC1に基づいて駆動し、このDYCアクチュエータ400の駆動により、車両300のヨーモーメントMが制御される。   As a result, the DYC actuator 400 is driven based on the received DYC actuator command value EC1, and the yaw moment M of the vehicle 300 is controlled by the driving of the DYC actuator 400.

なお、DYC制御器80のDYC制御部82にも、DYC制御器72と共通のM+の制御アルゴリズムを有する制御プログラム721が記憶されている。DYC制御部82では、この制御プログラム721を実行することで、車両300のヨーモーメントMを制御アルゴリズムに基づいて制御するための演算を行う。   A control program 721 having an M + control algorithm common to the DYC controller 72 is also stored in the DYC controller 82 of the DYC controller 80. The DYC control unit 82 executes the control program 721 to perform calculations for controlling the yaw moment M of the vehicle 300 based on a control algorithm.

実施の形態では、図10に示すように、DYC制御部82では、車両300のヨーモーメントM2を、DYC指令値FB1となるように制御するためにDYCアクチュエータ500を介入させるか否かの判定基準となる下側の介入閾値(下側介入閾値K41)と、下側介入閾値K41よりも上側の介入閾値(上側介入閾値K42)とが設定されている。DYC制御部82は、DYC指令値FB1が下側介入閾値K41の値よりも小さくなった場合、又は上側介入閾値K42の値よりも大きくなった場合、車両300のヨーモーメントMを、DYC指令値FB1となるようにDYCアクチュエータ500を制御する。なお、下側介入閾値K41と上側介入閾値K42とを合わせて介入閾値K4と表記する。
なお、下側介入閾値41の絶対値と上側介入閾値42の絶対値とは、必ずしも同じ大きさである必要はないが、同じ大きさであってもよい。両者を異なる値とした場合、旋回促進側と安定側の制御介入タイミングを変更でき、より走行シーンにあった加減速制御が可能となる。またアクチュエータのばらつきによる左回りと右回りのヨーモーメント違いが発生する場合の補償も可能となる。
In the embodiment, as shown in FIG. 10, the DYC control unit 82 determines whether to cause the DYC actuator 500 to intervene to control the yaw moment M2 of the vehicle 300 to become the DYC command value FB1. The lower intervention threshold (lower intervention threshold K41) and the upper intervention threshold (upper intervention threshold K42) than the lower intervention threshold K41 are set. When the DYC command value FB1 becomes smaller than the value of the lower intervention threshold K41 or becomes larger than the value of the upper intervention threshold K42, the DYC control unit 82 sets the yaw moment M of the vehicle 300 to the DYC command value. The DYC actuator 500 is controlled to become FB1. The lower intervention threshold K41 and the upper intervention threshold K42 are collectively referred to as an intervention threshold K4.
The absolute value of the lower intervention threshold 41 and the absolute value of the upper intervention threshold 42 do not necessarily have the same magnitude, but may have the same magnitude. When the values are different from each other, the control intervention timings of the turning promotion side and the stabilization side can be changed, and acceleration / deceleration control more suited to the traveling scene becomes possible. In addition, it is also possible to compensate for the occurrence of a difference in counterclockwise and clockwise yaw moment due to the variation of the actuator.

[運動制御装置1Bの動作]
次に、車両300の運動(ヨーモーメントM)を、運動制御装置1Bによりヨーモーメント制御する場合の一例を説明する。
図10は、運動制御装置1Bの動作を説明する図である。
図10の上図は、横軸に時間をとり、縦軸に車両300の横加速度G1をとったものであり、図10の下図は、横軸に時間をとり、縦軸に車両300のヨーモーメントMをとったものである。
[Operation of motion control device 1B]
Next, an example in the case of controlling the motion (yaw moment M) of the vehicle 300 by the motion control device 1B will be described.
FIG. 10 is a diagram for explaining the operation of the motion control device 1B.
In the upper diagram of FIG. 10, the horizontal axis represents time, and the vertical axis represents the lateral acceleration G1 of the vehicle 300. In the lower diagram of FIG. 10, the horizontal axis represents time, and the vertical axis represents the yaw of the vehicle 300. The moment M is taken.

図10の上図に示すように、車両300の横加速度G1の発生状況は、前述した実施の形態で説明した場合と同じである(図6参照)。   As shown in the upper drawing of FIG. 10, the generation state of the lateral acceleration G1 of the vehicle 300 is the same as that described in the above embodiment (see FIG. 6).

図10の下図に示すように、車両300のヨーモーメントMは、車両300がカーブから直線へ抜け出す際(時間t3〜t4の間)に小さなマイナス方向のヨーモーメントMが車両300に作用する。また、車両300が、カーブを曲がっている時(時間t6〜t7の間)に大きなマイナス方向のヨーモーメントMが車両300に作用すると共に、時間t8〜t9の間では、大きなプラス方向のヨーモーメントMが車両300に作用している。   As shown in the lower part of FIG. 10, a small negative yaw moment M acts on the vehicle 300 when the vehicle 300 gets out of a curve straight (between times t3 and t4) as shown in the lower part of FIG. Also, when the vehicle 300 bends a curve (between times t6 and t7), a large negative direction yaw moment M acts on the vehicle 300, and between times t8 and t9, a large positive direction yaw moment M is acting on the vehicle 300.

運動制御装置1Bでは、DYC制御器70によりDYCアクチュエータ400が駆動され、このDYCアクチュエータ400の駆動により、下側介入閾値K31より小さい領域(例えば、時間t3〜t4)又は、上側介入閾値K32よりも大きい領域では、車両300のヨーモーメントMが、DYC指令値EB1となるように制御される。   In the motion control device 1B, the DYC actuator 400 is driven by the DYC controller 70, and driving the DYC actuator 400 causes the region smaller than the lower intervention threshold K31 (for example, time t3 to t4) or the upper intervention threshold K32 In a large area, the yaw moment M of the vehicle 300 is controlled to be the DYC command value EB1.

また、運動制御装置1Bでは、DYC制御器80によりDYCアクチュエータ500が駆動され、このDYCアクチュエータ500の駆動により、下側介入閾値K41より小さい領域(例えば、時間t6〜t7)又は、上側介入閾値K42よりも大きい領域(例えば、時間t8〜t9)では、車両300のヨーモーメントMが、DYC指令値FB1となるように制御される。   Further, in the motion control device 1B, the DYC actuator 500 is driven by the DYC controller 80, and driving the DYC actuator 500 causes the region smaller than the lower intervention threshold K41 (for example, time t6 to t7) or the upper intervention threshold K42. In a larger area (for example, time t8 to t9), the yaw moment M of the vehicle 300 is controlled to be the DYC command value FB1.

このように、運動制御装置1Bでは、異なる2つのDYC制御器70及びDYC制御器80を設けたことにより、ヨーモーメントを冗長化(多重化)することができ、一方のDYC制御部70、80が何らかの理由でヨーモーメント制御を行うことができない状態であっても、他のDYC制御器70、80でそれを補填することにより、車両300の運動を確実に行うことができ、運転者の運転に対する違和感を抑えると共に、運転の安定性を向上させることができる。   As described above, in the motion control device 1B, by providing two different DYC controllers 70 and 80, the yaw moment can be made redundant (multiplexed), and one DYC control unit 70, 80 can be used. Even if the yaw moment control can not be performed for some reason, by compensating it with the other DYC controllers 70, 80, the motion of the vehicle 300 can be reliably performed, and the driver's driving can be performed. While suppressing the discomfort to the driver, the stability of driving can be improved.

以上説明した通り、実施の形態では、
(9)DYCアクチュエータ400(第1の構成装置)は、車両300に作用する鉛直軸回りのヨーモーメントMを制御する装置であり、DYC制御器70は、制御アルゴリズムに基づくDYCアクチュエータ400の制御により、車両300に作用するヨーモーメントMを制御すると共に、DYCアクチュエータ500(第2の構成装置)は、車両300に作用する鉛直軸回りのヨーモーメントMを制御する装置であり、DYC制御器80は、制御アルゴリズムに基づくDYCアクチュエータ500の制御により、車両300に作用するヨーモーメントMを制御する構成とした。
As described above, in the embodiment,
(9) The DYC actuator 400 (first component device) is a device that controls the yaw moment M about the vertical axis acting on the vehicle 300, and the DYC controller 70 controls the DYC actuator 400 based on a control algorithm. The DYC actuator 500 (second component device) is a device that controls the yaw moment M about the vertical axis that acts on the vehicle 300, and the DYC controller 80 controls the yaw moment M that acts on the vehicle 300. The yaw moment M acting on the vehicle 300 is controlled by the control of the DYC actuator 500 based on the control algorithm.

例えば、上位の制御器のみが、DYCアクチュエータの制御を行うための制御アルゴリズム(制御プログラム)を有している場合、上位の制御器とDYCアクチュエータとは、何らかの通信手段(例えば、CAN)で接続されているため、通信遅れが生じ、その結果、制御の介入タイミングの遅れ等が運転者の違和感を引き起こす要因となることがある。
このように構成すると、DYC制御器70、80の各々が、ヨーモーメント制御を行うための共通の制御アルゴリズム(制御プログラム721)を有しているので、DYC制御器70、80は、通信手段(例えば、CAN)を介さずに直接DYCアクチュエータ400、500を制御できる、通信遅れの影響を少なくすることができる。
For example, when only the upper controller has a control algorithm (control program) for controlling the DYC actuator, the upper controller and the DYC actuator are connected by some communication means (for example, CAN) Because of this, communication delays may occur, and as a result, delays in control intervention timing may cause the driver to feel uncomfortable.
In this configuration, each of the DYC controllers 70, 80 has a common control algorithm (control program 721) for performing yaw moment control, so the DYC controllers 70, 80 communicate with each other For example, the influence of communication delay can be reduced by directly controlling the DYC actuators 400, 500 without intervention of CAN.

また、DYC制御器70、80の各々が共通の制御アルゴリズムを有しているので、何れか一方のDYC制御器70、80が故障や、DYCによる制御を行えない状況になっても、他方のDYC制御器70、80ではDYCによる制御が行える。よって、全くDYCによる制御を行えない場合と比べて、運転者の操作の違和感を少なくすると共に、運転の安定性を向上させることができる。   Also, since each of the DYC controllers 70, 80 has a common control algorithm, even if one of the DYC controllers 70, 80 fails or can not be controlled by the DYC, the other becomes The DYC controllers 70 and 80 can perform DYC control. Therefore, compared with the case where control by DYC can not be performed at all, it is possible to reduce the discomfort of the driver's operation and to improve the stability of the driving.

(10)DYC制御器70は、DYC指令値EB1が、介入閾値K3(第3閾値)の絶対値よりも大きい場合、制御アルゴリズムに基づく車両300に作用するヨーモーメントMの制御を実施すると共に、DYC制御器80は、DYC指令値FB1が、介入閾値K3と異なる介入閾値K4(第4閾値)の絶対値よりも大きい場合、制御アルゴリズムに基づく車両300に作用するヨーモーメントMの制御を実施する構成とした。 (10) The DYC controller 70 controls the yaw moment M acting on the vehicle 300 based on the control algorithm when the DYC command value EB1 is larger than the absolute value of the intervention threshold K3 (third threshold). The DYC controller 80 controls the yaw moment M acting on the vehicle 300 based on the control algorithm when the DYC command value FB1 is larger than the absolute value of the intervention threshold K4 (fourth threshold) different from the intervention threshold K3. It was composition.

このように構成すると、DYC制御器70、80の各々は、DYCアクチュエータ400、500が車両300の運動に介入する介入閾値を異ならせているので、車両300の様々な運転シーンに対応させて、DYCアクチュエータ400、500の制御を適切に行うことができる。   In this configuration, each of the DYC controllers 70, 80 has different intervention thresholds with which the DYC actuators 400, 500 intervene in the motion of the vehicle 300, so that they correspond to various driving scenes of the vehicle 300, Control of the DYC actuators 400 and 500 can be appropriately performed.

(11)制御アルゴリズムは、車両300の横加速度G1の単位時間当たりの変化が大きくなるほど、車両300のヨーモーメントMの絶対値が大きくなるように制御する構成とした。 (11) The control algorithm is configured to control so that the absolute value of the yaw moment M of the vehicle 300 becomes larger as the change per unit time of the lateral acceleration G1 of the vehicle 300 becomes larger.

このように、制御アルゴリズムとして、DYC(Direct Yaw−moment Control)のアルゴリズムを好適に採用することができる。   Thus, an algorithm of DYC (Direct Yaw-moment Control) can be suitably adopted as a control algorithm.

<第4の実施の形態>
次に、第4の実施の形態にかかる運動制御装置1Cを説明する。
図11は、第4の実施の形態にかかる運動制御装置1Cを説明するブロック図である。
Fourth Embodiment
Next, a motion control device 1C according to a fourth embodiment will be described.
FIG. 11 is a block diagram for explaining a motion control device 1C according to the fourth embodiment.

第4の実施の形態にかかる運動制御装置1Cでは、第2の実施の形態にかかる運動制御装置1Aと同様に、他の制御器30Aから、DYC制御器70A、80Aを制御するための調整情報53A、54Aが、DYC制御器70A、80Aに対して入力されている点が、前述した実施の形態と異なる。
以下、前述した実施の形態と同一の構成については同一の番号を付し、必要に応じて説明する。
Similar to the motion control device 1A according to the second embodiment, in the motion control device 1C according to the fourth embodiment, adjustment information for controlling the DYC controllers 70A and 80A from the other controller 30A. The point that 53A, 54A are input to the DYC controller 70A, 80A differs from the embodiment described above.
Hereinafter, the same components as those of the embodiment described above are denoted by the same reference numerals, and will be described as necessary.

[運動制御装置1C]
図11に示すように、第4の実施の形態にかかる運動制御装置1Cでは、第2の実施の形態と同様に、ゲイン、フィルタ閾値、介入閾値、介入条件などの情報である調整情報53A、54Aが、それぞれ、DYC制御器70Aの指令値演算部73A、DYC制御器80Aの指令値演算部83Aに入力されており、この調整情報53A、54Aに基づいて、DYC制御器70Aの介入閾値K3やDYC制御器80Aの介入閾値K4などが調整される。
[Motor control device 1C]
As shown in FIG. 11, in the motion control apparatus 1C according to the fourth embodiment, adjustment information 53A which is information such as gain, filter threshold, intervention threshold, intervention condition, etc. as in the second embodiment. 54A are respectively input to the command value calculation unit 73A of the DYC controller 70A and the command value calculation unit 83A of the DYC controller 80A, and based on the adjustment information 53A and 54A, the intervention threshold value K3 of the DYC controller 70A. And the intervention threshold K4 of the DYC controller 80A, etc. are adjusted.

[指令値演算部での処理]
次に、第4の実施の形態にかかる運動制御装置1Cの指令値演算部73A(又は指令値演算部83A)で実行される処理を説明する。
図12は、第4の実施の形態の指令値演算部73A(又は指令値演算部83A)で実行される処理のフローチャートである。
[Processing in command value calculation unit]
Next, processing executed by the command value calculator 73A (or the command value calculator 83A) of the motion control device 1C according to the fourth embodiment will be described.
FIG. 12 is a flowchart of processing executed by the command value calculation unit 73A (or the command value calculation unit 83A) according to the fourth embodiment.

ステップS201において、指令値演算部73A(83A)は、入力信号の受信処理を行う。   In step S201, the command value calculation unit 73A (83A) performs an input signal reception process.

ここで、実施の形態では、入力信号は、車両運動情報51、アクチュエータ制御用情報50、52、DYC制御部72(又はDYC制御部82)から入力されたDYC指令値EB1(又はDYC指令値FB1)、調整情報53A(又は調整情報54A)である。   Here, in the embodiment, the input signals are vehicle motion information 51, information 50, 52 for actuator control, DYC command value EB1 (or DYC command value FB1) input from DYC control unit 72 (or DYC control unit 82). , Adjustment information 53A (or adjustment information 54A).

調整情報53(54)は、DYCアクチュエータ400、500による車両300のヨーモーメントMの制御を実施するか否かを決める介入閾値K3(又は介入閾値K4)であり、下側介入閾値K31(又は下側介入閾値K41)と上側介入閾値K32(又は上側介入閾値K42)とが、指令値演算部73A(83A)に入力される。   The adjustment information 53 (54) is an intervention threshold K3 (or intervention threshold K4) that determines whether to control the yaw moment M of the vehicle 300 by the DYC actuator 400, 500, and the lower intervention threshold K31 (or lower). The side intervention threshold K41) and the upper intervention threshold K32 (or the upper intervention threshold K42) are input to the command value calculation unit 73A (83A).

ステップS202において、指令値演算部73A(83A)は、ステップS201で入力された調整情報53A(54A)を正常に受信したか否かを判定する。指令値演算部73A(83A)は、調整情報53A(54A)を正常に受信したと判定した場合(ステップS202:Yes)、ステップS203に進む。   In step S202, the command value calculation unit 73A (83A) determines whether the adjustment information 53A (54A) input in step S201 has been received normally. If the command value computing unit 73A (83A) determines that the adjustment information 53A (54A) has been received normally (step S202: Yes), the process proceeds to step S203.

ステップS203において、指令値演算部73A(83A)は、調整情報53A(54A)に基づいて、DYC制御基本指令値EC11(FC11)の演算を行う。指令値演算部73A(83A)におけるDYC制御基本指令値EC11(FC11)の演算は、次の数式5、数式6を用いて行われる。

Figure 2019043351
Figure 2019043351
In step S203, the command value calculation unit 73A (83A) calculates the DYC control basic command value EC11 (FC11) based on the adjustment information 53A (54A). The calculation of the DYC control basic command value EC11 (FC11) in the command value calculation unit 73A (83A) is performed using the following Formula 5 and Formula 6.
Figure 2019043351
Figure 2019043351

ステップS204において、指令値演算部73A(83A)は、ステップS203で演算したDYC制御基本指令値EC11(FC11)と、車両運動情報51Aと、アクチュエータ制御用情報50A、52Aとに基づいて、DYCアクチュエータ400(500)のDYCアクチュエータ指令値EC1(FC1)を演算する。   In step S204, the command value calculation unit 73A (83A) calculates the DYC actuator based on the DYC control basic command value EC11 (FC11) calculated in step S203, the vehicle motion information 51A, and the actuator control information 50A and 52A. A DYC actuator command value EC1 (FC1) of 400 (500) is calculated.

ステップS205において、指令値演算部73A(83A)は、ステップS204で演算したDYCアクチュエータ指令値EC1(FC1)を、送信部74(84)に送信して処理を終了する。   In step S205, the command value calculation unit 73A (83A) transmits the DYC actuator command value EC1 (FC1) calculated in step S204 to the transmission unit 74 (84), and ends the processing.

ここで、ステップS202において、指令値演算部73A(83A)は、調整情報53Aを正常に受信していない(異常)と判定した場合(ステップS202:No)、ステップS206に進む。
調整情報53Aを正常に受信していない場合とは、調整情報53Aを送信する制御器30Aの故障や、制御器30Aとの通信エラー等により、調整情報53Aを正常に受信できていない状態である。この調整情報53Aを正常に受信したか否かの判断は、チェックサムによる検出や、他の状態監視制御器(図示せず)による検出などの方法を用いて行うことができる。
Here, when it is determined in step S202 that the command value computing unit 73A (83A) does not receive the adjustment information 53A normally (abnormality) (step S202: No), the process proceeds to step S206.
The case where the adjustment information 53A is not received normally means that the adjustment information 53A can not be received normally due to a failure of the controller 30A transmitting the adjustment information 53A, a communication error with the controller 30A, or the like. . The determination as to whether the adjustment information 53A has been received normally can be made using a method such as detection with a checksum or detection with another condition monitoring controller (not shown).

そして、ステップS206において、指令値演算部73A(83A)は、予め設定された介入閾値を用いて、DYCアクチュエータ制御基本指令値EC11(FC11)の演算を行い、ステップS204に進み、ステップS204において、ステップS206で演算されたアクチュエータ制御基本指令値EC11(FC11)と、車両運動情報51Aと、アクチュエータ制御用情報50A、52Aとに基づいて、DYCアクチュエータ400(500)のアクチュエータ指令値EC1(FC1)を演算する。   Then, in step S206, the command value calculation unit 73A (83A) calculates the DYC actuator control basic command value EC11 (FC11) using the intervention threshold set in advance, proceeds to step S204, and proceeds to step S204. The actuator command value EC1 (FC1) of the DYC actuator 400 (500) is calculated based on the actuator control basic command value EC11 (FC11) calculated in step S206, the vehicle motion information 51A, and the actuator control information 50A, 52A. Calculate

前述した運動制御装置1Cでは、上位(他)の制御器30Aから、調整情報53A、54A(ゲイン、フィルタ時定数、介入閾値K3、K4、介入条件など)が入力されるようになっており、この調整情報53A、54Aに基づいてDYCアクチュエータ400、500を駆動することで、車両300の運動制御を適切に行うことができる。   In the above-described motion control device 1C, adjustment information 53A, 54A (gain, filter time constant, intervention threshold K3, K4, intervention condition, etc.) is input from the upper (other) controller 30A, By driving the DYC actuators 400 and 500 based on the adjustment information 53A and 54A, motion control of the vehicle 300 can be appropriately performed.

また、上位(他)の制御器30Aから、調整情報53A、54Aを送信するようにしたので、上位の制御器30Aにより、調整情報53A、54A(介入閾値K3、K4、介入条件など)を変えることができる。そのため、制御器30Aが、車両300周辺の障害物や将来の走行ルート(走行シーン)を取得できる場合、制御器30では、調整情報53A(54A)を、周辺の障害物や走行ルート(走行シーン)に応じて変えることで、車両300の運動制御をより適切に実施できる。   Further, since the adjustment information 53A, 54A is transmitted from the upper (other) controller 30A, the upper controller 30A changes the adjustment information 53A, 54A (intervention thresholds K3, K4, intervention condition, etc.) be able to. Therefore, when the controller 30A can acquire an obstacle around the vehicle 300 and a future travel route (travel scene), the controller 30 adjusts the adjustment information 53A (54A) to the obstacle or travel route (travel scene (travel scene) The motion control of the vehicle 300 can be implemented more appropriately by changing in accordance with.

その結果、例えば、車両300の通常走行時と比較して、障害物を操舵で回避する走行シーンにおいて、減速(制動)を生じさせる加減速アクチュエータ(例えば、ブレーキ)に送信するDYCアクチュエータ指令値EC1(FC1)のゲインを高く設定し、操舵開始時に大きく減速させることで、通所走行時の減速感を抑えながら、緊急時の回避性能を高めることができる。   As a result, for example, DYC actuator command value EC1 to be transmitted to an acceleration / deceleration actuator (for example, a brake) which causes deceleration (braking) in a traveling scene in which an obstacle is avoided by steering as compared with that during normal traveling of vehicle 300. By setting the gain of (FC1) high and causing a large deceleration at the start of steering, it is possible to enhance the avoidance performance in an emergency while suppressing the sense of deceleration during regular driving.

また、上位(他)の制御器30Aから、調整情報53A、54Aを送信するようにしたので、例えば、下位のDYC制御器70A、80Aの何れかにおいて、制御プログラム721(DYCの制御アルゴリズム)に基づく車両300の運動制御を実施することができない状態となった場合でも、調整情報53A、54Aにより、運動制御を実施できるDYC制御器70A,80Aを選択すると共に、ゲイン、フィルタ時定数、介入閾値K3、K4などを調整して、車両300の運動制御を適切に実施することができる。   Further, since the adjustment information 53A and 54A are transmitted from the upper (other) controller 30A, for example, in any of the lower DYC controllers 70A and 80A, the control program 721 (DYC control algorithm) Even when motion control of the vehicle 300 based on the above can not be performed, the DYC controller 70A, 80A capable of performing motion control is selected by the adjustment information 53A, 54A, and the gain, filter time constant, intervention threshold Motion control of the vehicle 300 can be appropriately implemented by adjusting K3, K4, and the like.

なお、前述した実施の形態では、上位(他)の制御器30Aが、調整情報53A、54AをDYC制御器70A、80Aに送信する場合を例示して説明したが、これに限定されるものではない。
例えば、一方のDYC制御器70A,80Aで調整情報53A、54Aを生成し、他方のDYC制御器70A、80Aに調整情報53A、54Aを送信する構成としてもよい。
Although the upper (other) controller 30A transmits the adjustment information 53A, 54A to the DYC controller 70A, 80A in the above-described embodiment, the present invention is not limited to this. Absent.
For example, the adjustment information 53A, 54A may be generated by one DYC controller 70A, 80A, and the adjustment information 53A, 54A may be transmitted to the other DYC controller 70A, 80A.

このように構成すると、例えば、どちらか一方のDYC制御器70A、80Aが、DYCアクチュエータ400、500の制御上の制約(例えば、DYCアクチュエータの連続動作による温度上昇、モータである場合のバッテリの充電状態など)により、DYCアクチュエータ400、500の制御を適切に行えない場合、当該DYC制御器70A、80Aによる制御を行えない分、他方のDYC制御器70A、80Aで補填するように、他のDYC制御器70A、80Aによる介入条件などを変更することができる。   In this configuration, for example, when one of the DYC controllers 70A, 80A is restricted in controlling the DYC actuators 400, 500 (for example, temperature increase due to continuous operation of the DYC actuator, charging of the battery in the case of a motor) If the DYC actuators 400 and 500 can not be properly controlled depending on the conditions, etc., the other DYC controllers 70A and 80A can not perform control, and the other DYC controller 70A or 80A compensates for the other DYC. Intervention conditions and the like by the controllers 70A and 80A can be changed.

また、一方のDYC制御器70A、80Aが、直接他方のDYC制御器70A、80Aに調整情報53、54を送信するのではなく、一方のDYC制御器70A、80Aの状態に関する情報を、他方のDYC制御器70A、80Aの介入条件などを変更するトリガとする構成でもよい。
例えば、一方のDYC制御器70A、80Aが、DYCアクチュエータ400、500の駆動を行うことが困難であるという情報を、他方のDYC制御器70A、80Aで検出するようにし、当該情報を検出した他方のDYC制御器70A、80Aが、当該情報に基づいて、介入条件などを変更するように調整情報53A、54Aを生成する構成してもよい。
Also, one DYC controller 70A, 80A does not directly transmit adjustment information 53, 54 to the other DYC controller 70A, 80A, but information on the state of one DYC controller 70A, 80A, the other It may be configured as a trigger for changing the intervention condition of the DYC controller 70A, 80A and the like.
For example, the information that one DYC controller 70A, 80A has difficulty in driving the DYC actuator 400, 500 is detected by the other DYC controller 70A, 80A, and the other information is detected. The DYC controllers 70A and 80A may generate the adjustment information 53A and 54A based on the information to change the intervention condition and the like.

このように構成すると、上位(他)の制御器30Aが、DYC制御器70A、80Aに対して調整情報53A、54Aを送信する場合と比べて、DYC制御器70A、80Aが直接調整情報53A、54Aを生成するので、この調整情報53A、54Aにより、走行シーンに応じた車両の運動制御を行いつつ、調整情報53A、54Aを送信する際の通信時間の遅れを低減することができる。また、仮に一方のDYC制御器70A、80Aが故障した場合でも、他のDYC制御器70A、80Aにより運動制御の補填をすることができる。   When configured in this manner, the DYC controller 70A, 80A directly adjusts the adjustment information 53A, as compared to the case where the upper (other) controller 30A transmits the adjustment information 53A, 54A to the DYC controller 70A, 80A. Since 54A is generated, it is possible to reduce the delay of communication time when transmitting the adjustment information 53A, 54A while performing the motion control of the vehicle according to the traveling scene by the adjustment information 53A, 54A. Also, even if one DYC controller 70A, 80A fails, motion control can be compensated by the other DYC controller 70A, 80A.

以上説明した通り、実施の形態では、
(12)DYC制御器70AとDYC制御器80Aとは異なる、上位の制御器30A(第3の制御器)をさらに有し、上位の制御器30Aは、車両300の運動状態又は周囲状況に基づいて、介入閾値K3、K4の設定および変更を実施する構成とした。
As described above, in the embodiment,
(12) The DYC controller 70A and the DYC controller 80A further include an upper controller 30A (third controller), and the upper controller 30A is based on the motion state or the surrounding condition of the vehicle 300. Thus, the setting and changing of the intervention threshold values K3 and K4 are performed.

このように構成すると、上位の制御器30Aが、車両300の各種センサ情報を取得できる場合、上位の制御器30Aは、各種センサ情報に基づいて調整情報53Aを演算することができる。その結果、DYC制御器70A、80Aでは、上位の制御器30Aから送信された調整情報53Aに基づいて、車両300の運転状況や周囲状況を勘案した上で、DYCアクチュエータ400、500が車両300の運転に介入する介入閾値K3、K4を適切に設定、変更することができる。   With such a configuration, when the host controller 30A can acquire various sensor information of the vehicle 300, the host controller 30A can calculate the adjustment information 53A based on the various sensor information. As a result, in the DYC controllers 70A and 80A, the DYC actuators 400 and 500 correspond to the vehicle 300 in consideration of the driving condition and the surrounding condition of the vehicle 300 based on the adjustment information 53A transmitted from the upper controller 30A. The intervention threshold values K3 and K4 to intervene in driving can be set and changed appropriately.

(13)また、車両300の運動に関与する少なくともDYCアクチュエータ400と500とを有する車両300の運動制御方法であって、DYCアクチュエータ400またはDYCアクチュエータ500の駆動条件を調整するための調整情報53Aを正常に受信したか否かを判定する受信判定ステップ(ステップS202)と、調整情報53Aを正常に受信したと判定した場合(ステップS202:Yes)、調整情報53Aに基づいてDYCアクチュエータ400又はDYCアクチュエータ500を駆動するためのDYCアクチュエータ指令値EC1又はDYCアクチュエータ指令値FC1を共通の制御アルゴリズムにより演算する演算ステップ(ステップS204)と、を有する構成とした。 (13) A motion control method of the vehicle 300 having at least the DYC actuators 400 and 500 involved in the motion of the vehicle 300, the adjustment information 53A for adjusting the drive condition of the DYC actuator 400 or the DYC actuator 500 A reception determination step (step S202) to determine whether the information has been received normally, and when it is determined that the adjustment information 53A has been received normally (step S202: Yes), the DYC actuator 400 or DYC actuator based on the adjustment information 53A. And d) calculating the DYC actuator command value EC1 for driving 500 or the DYC actuator command value FC1 according to a common control algorithm (step S204).

このように構成すると、DYC制御器70A、80Aは、上位の制御器30Aから運動状況や周囲状況に基づいて演算された調整情報53Aを取得することができる。よって、DYC制御器70A、80Aは、調整情報53Aに基づく車両300のDYC制御を適切に行うことができる。   According to this configuration, the DYC controllers 70A and 80A can acquire adjustment information 53A calculated based on the exercise status and the surrounding status from the upper controller 30A. Thus, the DYC controllers 70A and 80A can appropriately perform DYC control of the vehicle 300 based on the adjustment information 53A.

(14)また、DYC制御器70A、80Aは、調整情報53に基づいて、DYCアクチュエータ400、500の介入閾値K3、K4、介入条件の少なくとも何れか一つを変更する構成とした。 (14) Further, the DYC controllers 70A and 80A are configured to change at least one of the intervention threshold values K3 and K4 of the DYC actuators 400 and 500 and the intervention condition based on the adjustment information 53.

このように構成すると、DYC制御器70A、80Aは、車両300の運転状況や運転シーンに応じて、介入閾値K3、K4を設定、変更することができ、車両300のヨーモーメント制御をより適切に行うことができる。   With this configuration, the DYC controllers 70A and 80A can set and change the intervention threshold values K3 and K4 according to the driving situation and driving scene of the vehicle 300, and the yaw moment control of the vehicle 300 can be more appropriately performed. It can be carried out.

(15)また、演算ステップ(ステップS202)は、調整情報53Aを正常に受信していないと判定した場合(ステップS202:No)、予め設定された事前調整情報(介入閾値)に基づいて、DYCアクチュエータ400又はDYCアクチュエータ500を駆動するためのDYCアクチュエータ指令値EC1又はDYCアクチュエータ指令値FC1を共通の制御アルゴリズムにより演算する構成とした。 (15) Further, when it is determined that the adjustment information 53A is not properly received (step S202: No), the calculation step (step S202) determines DYC based on the preset advance adjustment information (intervention threshold). The DYC actuator command value EC1 for driving the actuator 400 or the DYC actuator 500 or the DYC actuator command value FC1 is calculated by a common control algorithm.

このように構成すると、上位の制御器30Aにおいて、調整情報53Aを正常に演算できない状況にある場合や、上位の制御器30Aとの通信エラーなどにより調整情報53Aを取得できない場合でも、DYC制御器70A、80Aは、予め設定された調整情報に基づいてDYCアクチュエータ400、500の制御を適切に行うことができる。   When configured in this way, the DYC controller can not obtain the adjustment information 53A even if the upper controller 30A can not calculate the adjustment information 53A normally or because a communication error with the upper controller 30A or the like can not be obtained. The 70A and 80A can appropriately control the DYC actuators 400 and 500 based on preset adjustment information.

なお、本発明は、前述した実施の形態に限定されるものではなく、様々な実施の形態が含まれるものとし、前述した第1の実施の形態にかかる運動制御装置1から第4の実施の形態にかかる運動制御装置1Cとを自在に組み合わせてもよく、他の実施の形態と組み合わせてもよい。   The present invention is not limited to the embodiments described above, but includes various embodiments, and the motion control devices 1 to 4 according to the first embodiment described above are included. The motion control device 1C according to the embodiment may be freely combined, or may be combined with other embodiments.

また、本発明は、前述した実施の形態の全ての構成を備えているものに限定されるものではなく、前述した実施の形態の構成の一部を、他の実施の形態の構成に置き換えてもよく、また、前述した実施の形態の構成を、他の実施の形態の構成に置き換えてもよい。   Further, the present invention is not limited to the one provided with all the configurations of the above-described embodiment, and a part of the configuration of the above-described embodiment is replaced with the configuration of the other embodiments. Alternatively, the configuration of the above-described embodiment may be replaced with the configuration of another embodiment.

また、前述した実施の形態の一部の構成について、他の実施の形態の構成に追加、削除、置換をしてもよい。   Further, some configurations of the embodiment described above may be added to, deleted from, or replaced with configurations of other embodiments.

また、上記した実施の形態の構成、機能、処理、手段は、それの一部又は全部を、例えば、集積回路で設計する等により、ハードウェアで実現してもよい。また、前述した構成、機能は、プロセッサがそれぞれの機能を実現するプログラムの実行により実現できるものであってもよい。
このプログラム等の情報は、メモリなどの記憶装置に記憶しておくことができる。
In addition, the configuration, functions, processing, and means of the above-described embodiment may be realized by hardware, for example, by designing part or all of them with an integrated circuit. Also, the configurations and functions described above may be realized by execution of a program in which a processor realizes each function.
The information such as this program can be stored in a storage device such as a memory.

また、前述した実施の形態で説明した、通信線や信号線は、必要と認められるものを示しており、製品上必ずしも全ての通信線や信号線を表しているものではなく、実際には、殆どすべての構成が相互に接続されていてもよい。   Further, the communication lines and signal lines described in the above-described embodiment indicate those which are deemed to be necessary, and do not necessarily represent all the communication lines and signal lines in the product, and in fact, Almost all configurations may be connected to one another.

1:運動制御装置、10、20:前後加速度制御器、11、21:基本制御演算部、12、22:GVC制御部、121:制御プログラム(GVCの制御アルゴリズム)、13、23:指令値演算部、14、24:送信部、30:制御器、50、52:アクチュエータ制御用情報、51:車両運動情報、53:調整情報、60:CAN、70、80:DYC制御器、71、81:基本制御演算部、72、82:DYC制御部、721:制御プログラム(制御アルゴリズム)、73、83:指令値演算部、74、84:送信部、100、200:加減速アクチュエータ、121:制御プログラム(DYCの制御アルゴリズム)、400、500:DYCアクチュエータ、G1:横加速度、G2:前後加速度、M:ヨーモーメント、K1〜K4:介入閾値   1: Motion control device 10, 20: Longitudinal acceleration controller 11, 21: Basic control calculation unit 12, 22: GVC control unit 121: Control program (GVC control algorithm) 13, 23: Command value calculation Unit 14, 24: Transmission unit, 30: Controller, 50, 52: Information for actuator control, 51: Vehicle motion information, 53: Adjustment information, 60: CAN, 70, 80: DYC controller, 71, 81: Basic control calculation unit 72, 82: DYC control unit 721: control program (control algorithm) 73, 83: command value calculation unit 74, 84: transmission unit 100, 200: acceleration / deceleration actuator 121: control program (DYC control algorithm) 400, 500: DYC actuator, G1: lateral acceleration, G2: longitudinal acceleration, M: yaw moment, K1 to K4: Input threshold

Claims (15)

移動体の運動に関与する少なくとも第1の構成装置と第2の構成装置とを有する移動体の運動制御装置であって、
前記第1の構成装置を制御する第1の制御器と、
前記第2の構成装置を制御する第2の制御器と、を有し、
前記第1の制御器は、
前記移動体の運動を所定の手順で制御する制御アルゴリズムを有し、
前記第2の制御器は、
前記第1の制御器と同じ前記制御アルゴリズムを有する移動体の運動制御装置。
A motion control device for a moving body, comprising at least a first component device and a second component device involved in movement of the moving object,
A first controller for controlling the first component device;
And a second controller for controlling the second component device,
The first controller is
It has a control algorithm for controlling the movement of the moving body in a predetermined procedure,
The second controller is
Motion control device for a mobile having the same control algorithm as that of the first controller.
前記第1の構成装置は、前記移動体の移動方向の速度または加速度を制御する装置であり、前記第1の制御器は、前記制御アルゴリズムに基づく前記第1の構成装置の制御により、前記移動体の移動方向の速度または加速度を制御すると共に、
前記第2の構成装置は、前記移動体の移動方向の速度または加速度を制御する装置であり、前記第2の制御器は、前記制御アルゴリズムに基づく前記第2の構成装置の制御により、前記移動体の移動方向の速度または加速度を制御する請求項1に記載の移動体の運動制御装置。
The first component device is a device for controlling the velocity or acceleration in the moving direction of the moving body, and the first controller is configured to control the movement by the control of the first component device based on the control algorithm. While controlling the speed or acceleration of the movement direction of the body,
The second component device is a device that controls the velocity or acceleration in the moving direction of the moving body, and the second controller performs the movement by control of the second component device based on the control algorithm. The motion control device for a mobile according to claim 1, which controls the velocity or acceleration in the moving direction of the body.
前記第1の制御器は、前記移動体の移動方向の速度または加速度が、第1閾値以上となった場合、前記制御アルゴリズムに基づく前記移動体の移動方向の速度または加速度の制御を実施すると共に、
前記第2の制御器は、前記移動体の移動方向の速度または加速度が、前記第1閾値よりも大きい第2閾値以上となった場合、前記制御アルゴリズムに基づく前記移動体の移動方向の速度または加速度の制御を実施する請求項2に記載の移動体の運動制御装置。
The first controller implements control of the velocity or acceleration of the moving direction of the moving object based on the control algorithm when the velocity or acceleration of the moving direction of the moving object becomes equal to or greater than a first threshold. ,
The second controller controls the velocity in the moving direction of the moving object based on the control algorithm or the velocity or the acceleration in the moving direction of the moving object is equal to or greater than a second threshold larger than the first threshold. The motion control device for a mobile according to claim 2, wherein control of acceleration is performed.
前記制御アルゴリズムは、前記移動体の横加速度の単位時間当たりの変化が大きくなるほど、前記移動体の前後方向の加速度の絶対値が大きくなるように制御する請求項3に記載の移動体の運動制御装置。   The motion control according to claim 3, wherein the control algorithm performs control such that the absolute value of the longitudinal acceleration of the movable body increases as the change per unit time of the lateral acceleration of the movable body increases. apparatus. 前記第1の構成装置は、前記移動体に作用する鉛直軸回りのヨーモーメントを制御する装置であり、前記第1の制御器は、前記制御アルゴリズムに基づく前記第1の構成装置の制御により、前記移動体に作用するヨーモーメントを制御すると共に、
前記第2の構成装置は、前記移動体に作用する鉛直軸回りのヨーモーメントを制御する装置であり、前記第2の制御器は、前記制御アルゴリズムに基づく前記第2の構成装置の制御により、前記移動体に作用するヨーモーメントを制御する請求項1に記載の移動体の運動制御装置。
The first component device is a device for controlling a yaw moment about a vertical axis acting on the moving body, and the first controller is controlled by the first component device based on the control algorithm. Controlling a yaw moment acting on the moving body,
The second component device is a device that controls a yaw moment about a vertical axis acting on the moving body, and the second controller is controlled by the second component device based on the control algorithm. The motion control device for a mobile according to claim 1, wherein the yaw moment acting on the mobile is controlled.
前記第1の制御器は、前記移動体に作用する鉛直軸回りのヨーモーメントが、第3閾値以上となった場合、前記制御アルゴリズムに基づく前記移動体に作用するヨーモーメントの制御を実施すると共に、
前記第2の制御器は、前記移動体に作用するヨーモーメントが、前記第3閾値よりも大きい第4閾値以上となった場合、前記制御アルゴリズムに基づく前記移動体に作用するヨーモーメントの制御を実施する請求項5に記載の移動体の運動制御装置。
The first controller controls the yaw moment acting on the moving body based on the control algorithm when the yaw moment about the vertical axis acting on the moving body becomes equal to or more than a third threshold. ,
The second controller controls the yaw moment acting on the moving body based on the control algorithm when the yaw moment acting on the moving body is equal to or greater than a fourth threshold larger than the third threshold. The motion control device of a mobile according to claim 5, which is implemented.
前記制御アルゴリズムは、前記移動体の横加速度の単位時間当たりの変化が大きくなるほど、前記移動体のヨーモーメントの絶対値が大きくなるように制御する請求項6に記載の移動体の運動制御装置。   The motion control device according to claim 6, wherein the control algorithm controls the absolute value of the yaw moment of the moving body to increase as the change per unit time of the lateral acceleration of the moving body increases. 前記第1の制御器と前記第2の制御器とは異なる、第3の制御器をさらに有し、
前記第3の制御器は、
前記移動体の運動状態又は周囲状況、もしくはその両方に基づいて、前記第1閾値と前記第2閾値の設定および変更、および前記第3閾値と前記第4閾値の設定および変更を実施する請求項3又は請求項6に記載の移動体の運動制御装置。
The first controller and the second controller further comprise a third controller different from the first controller,
The third controller is
Setting and changing the first threshold and the second threshold, and setting and changing the third threshold and the fourth threshold based on the motion state and / or the surrounding condition of the mobile object, The movement control device of the mobile according to claim 3 or claim 6.
移動体の運動に関与する少なくとも第1の構成装置と第2の構成装置とを有する移動体の運動制御装置として機能させるためのコンピュータプログラムであって、
前記第1の構成装置を所定の制御アルゴリズムに基づいて制御することにより、前記移動体の運動を制御する第1の制御部と、
前記第2の構成装置を前記第1の制御部と同じ制御アルゴリズムに基づいて制御することにより、前記移動体の運動を制御する第2の制御部と、をコンピュータに実現させるためのコンピュータプログラム。
A computer program for causing a mobile unit to function as a motion control unit of a mobile unit including at least a first component device and a second component unit involved in the motion of the mobile unit.
A first control unit that controls the movement of the moving body by controlling the first component device based on a predetermined control algorithm;
A computer program for causing a computer to realize a second control unit that controls the movement of the moving body by controlling the second component device based on the same control algorithm as that of the first control unit.
前記第1の構成装置は、前記移動体の移動方向の速度または加速度を制御する装置であり、前記第1の制御部は、前記制御アルゴリズムに基づく前記第1の構成装置の制御により、前記移動体の移動方向の速度または加速度を制御すると共に、
前記第2の構成装置は、前記移動体の移動方向の速度または加速度を制御する装置であり、前記第2の制御部は、前記制御アルゴリズムに基づく前記第2の構成装置の制御により、前記移動体の移動方向の速度または加速度を制御することをコンピュータに実行させる請求項9に記載のコンピュータプログラム。
The first component device is a device for controlling the velocity or acceleration in the moving direction of the movable body, and the first control unit is configured to control the movement by the control of the first component device based on the control algorithm. While controlling the speed or acceleration of the movement direction of the body,
The second component device is a device that controls the velocity or acceleration in the moving direction of the moving body, and the second control unit performs the movement by control of the second component device based on the control algorithm. The computer program according to claim 9, causing the computer to control the velocity or acceleration in the moving direction of the body.
前記第1の構成装置は、前記移動体に作用する鉛直軸回りのヨーモーメントを制御する装置であり、前記第1の制御部は、前記制御アルゴリズムに基づく前記第1の構成装置の制御により、前記移動体に作用するヨーモーメントを制御すると共に、
前記第2の構成装置は、前記移動体に作用する鉛直軸回りのヨーモーメントを制御する装置であり、前記第2の制御部は、前記制御アルゴリズムに基づく前記第2の構成装置の制御により、前記移動体に作用するヨーモーメントを制御することをコンピュータに実行させる請求項9に記載のコンピュータプログラム。
The first component device is a device that controls a yaw moment about a vertical axis acting on the movable body, and the first control unit is controlled by the first component device based on the control algorithm. Controlling a yaw moment acting on the moving body,
The second component device is a device that controls a yaw moment about a vertical axis acting on the movable body, and the second control unit is controlled by the second component device based on the control algorithm. The computer program according to claim 9, making a computer execute controlling a yaw moment acting on the moving body.
移動体の運動に関与する少なくとも第1の構成装置と第2の構成装置とを有する移動体の運動制御方法であって、
前記第1の構成装置または前記第2の構成装置の駆動条件を調整するための調整情報を正常に受信したか否かを判定する受信判定ステップと、
前記調整情報を正常に受信したと判定した場合、前記調整情報に基づいて前記第1の構成装置または前記第2の構成装置を駆動するための指令値を同一の制御アルゴリズムにより演算する演算ステップと、を有する移動体の運動制御方法。
A method of controlling movement of a mobile body, comprising at least a first component device and a second component device involved in movement of the mobile object, the method comprising:
A reception determination step of determining whether adjustment information for adjusting the drive conditions of the first component device or the second component device has been received normally;
And calculating the command value for driving the first component device or the second component device based on the adjustment information, when it is determined that the adjustment information is normally received, according to the same control algorithm. And a motion control method of a moving body.
前記演算ステップは、
前記調整情報を正常に受信していないと判定した場合、予め設定された事前調整情報に基づいて、前記第1の構成装置または前記第2の構成装置を駆動するための指令値を同一の制御アルゴリズムにより演算する請求項12に記載の移動体の運動制御方法。
The calculation step is
If it is determined that the adjustment information is not properly received, the same control value for driving the first component device or the second component device is controlled based on the preset advance adjustment information. The movement control method of a mobile according to claim 12, wherein the calculation is performed by an algorithm.
移動体の運動に関与する少なくとも第1の構成装置を制御する第1の制御器と、第2の構成装置を制御する第2の制御器とを有する制御器であって、
前記第1の制御器と前記第2の制御器は、他の制御器との通信部とを有し、
前記制御器は、前記通信部を介して、前記他の制御器から前記第1の構成装置または前記第2の構成装置の駆動条件を調整する調整情報を受信する、当該調整情報に基づいて前記第1の構成装置または前記第2の構成装置を制御する制御器。
A controller comprising: a first controller controlling at least a first component device involved in movement of a mobile body; and a second controller controlling a second component device,
The first controller and the second controller have a communication unit with another controller,
The controller receives adjustment information for adjusting a drive condition of the first component device or the second component device from the other controller via the communication unit, based on the adjustment information. A controller for controlling a first component device or the second component device.
前記制御器は、前記調整情報に基づいて、前記第1の構成装置または前記第2の構成装置の介入閾値、介入条件の少なくとも何れか一つを変更する請求項14に記載の制御器。   The controller according to claim 14, wherein the controller changes at least one of an intervention threshold value and an intervention condition of the first component device or the second component device based on the adjustment information.
JP2017168561A 2017-09-01 2017-09-01 MOVEMENT CONTROL DEVICE, COMPUTER PROGRAM, MOVEMENT CONTROL METHOD, AND CONTROLLER Active JP7178774B2 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2017168561A JP7178774B2 (en) 2017-09-01 2017-09-01 MOVEMENT CONTROL DEVICE, COMPUTER PROGRAM, MOVEMENT CONTROL METHOD, AND CONTROLLER
PCT/JP2018/015891 WO2019044025A1 (en) 2017-09-01 2018-04-17 Movement control device for mobile unit, computer program, movement control method for mobile unit, and controller

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017168561A JP7178774B2 (en) 2017-09-01 2017-09-01 MOVEMENT CONTROL DEVICE, COMPUTER PROGRAM, MOVEMENT CONTROL METHOD, AND CONTROLLER

Publications (2)

Publication Number Publication Date
JP2019043351A true JP2019043351A (en) 2019-03-22
JP7178774B2 JP7178774B2 (en) 2022-11-28

Family

ID=65527246

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017168561A Active JP7178774B2 (en) 2017-09-01 2017-09-01 MOVEMENT CONTROL DEVICE, COMPUTER PROGRAM, MOVEMENT CONTROL METHOD, AND CONTROLLER

Country Status (2)

Country Link
JP (1) JP7178774B2 (en)
WO (1) WO2019044025A1 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2021059845A1 (en) * 2019-09-27 2021-04-01 日立Astemo株式会社 Vehicle movement control device

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11440567B2 (en) * 2020-03-06 2022-09-13 Baidu Usa Llc System to handle communication delays between an autonomous driving system and vehicle

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1076925A (en) * 1996-08-27 1998-03-24 Robert Bosch Gmbh Electronic brake device for vehicle
JP2005273584A (en) * 2004-03-25 2005-10-06 Mitsubishi Fuso Truck & Bus Corp Behavior control device for vehicle
JP2008254537A (en) * 2007-04-03 2008-10-23 Denso Corp Vehicle control system
JP2014069766A (en) * 2012-10-01 2014-04-21 Hitachi Automotive Systems Ltd Motion control system of vehicle

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2719599A4 (en) * 2011-06-07 2017-05-10 Daesung Electric Co., Ltd. Device and method for detecting error in dual controller system

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1076925A (en) * 1996-08-27 1998-03-24 Robert Bosch Gmbh Electronic brake device for vehicle
JP2005273584A (en) * 2004-03-25 2005-10-06 Mitsubishi Fuso Truck & Bus Corp Behavior control device for vehicle
JP2008254537A (en) * 2007-04-03 2008-10-23 Denso Corp Vehicle control system
JP2014069766A (en) * 2012-10-01 2014-04-21 Hitachi Automotive Systems Ltd Motion control system of vehicle

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2021059845A1 (en) * 2019-09-27 2021-04-01 日立Astemo株式会社 Vehicle movement control device
JPWO2021059845A1 (en) * 2019-09-27 2021-04-01

Also Published As

Publication number Publication date
WO2019044025A1 (en) 2019-03-07
JP7178774B2 (en) 2022-11-28

Similar Documents

Publication Publication Date Title
WO2018074048A1 (en) Vehicle movement control device, vehicle movement control method, and vehicle movement control program
JP6731234B2 (en) Vehicle motion control device and method thereof
CN110799399B (en) Vehicle motion control device and method, and target trajectory generation device and method
CN108136935B (en) Vehicle speed control device
JP6333655B2 (en) Method and apparatus for assisting in driving a vehicle
EP3444157A1 (en) Vehicle control device and method
WO2015151565A1 (en) Operation control system for vehicle, vehicle, and program
JP6928512B2 (en) Driving support device, driving support method and driving support system
JP6754433B2 (en) Systems and methods for independently controlling wheel slip and vehicle acceleration
WO2019093046A1 (en) Vehicle movement control device, method, program, and system, and target trajectory generating device, method, program, and system
CN107848527B (en) Vehicle turning control device
JP6375034B2 (en) Vehicle motion control system
JP2015192471A (en) vehicle motion control device
JP2019055643A (en) Vehicle control device
WO2019044025A1 (en) Movement control device for mobile unit, computer program, movement control method for mobile unit, and controller
JP2008126985A (en) Steering control device for vehicle
JP2005153716A (en) Automatic brake control device
JP5810692B2 (en) Vehicle turning behavior control device
JP2010158963A (en) Device and method for controlling vehicle
JP6401541B2 (en) Vehicle fail-safe control device
WO2019044227A1 (en) Vehicle control device
WO2022113740A1 (en) Vehicle integrated-control device, and vehicle integrated-control method
JP6641784B2 (en) Control method and control device for electric vehicle
WO2018020760A1 (en) Vehicle movement control apparatus
JP2016137740A (en) Vehicle control device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20200127

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200901

A601 Written request for extension of time

Free format text: JAPANESE INTERMEDIATE CODE: A601

Effective date: 20201027

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20201201

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20210209

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210409

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20210622

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210914

C60 Trial request (containing other claim documents, opposition documents)

Free format text: JAPANESE INTERMEDIATE CODE: C60

Effective date: 20210914

A911 Transfer to examiner for re-examination before appeal (zenchi)

Free format text: JAPANESE INTERMEDIATE CODE: A911

Effective date: 20210927

C21 Notice of transfer of a case for reconsideration by examiners before appeal proceedings

Free format text: JAPANESE INTERMEDIATE CODE: C21

Effective date: 20210928

A912 Re-examination (zenchi) completed and case transferred to appeal board

Free format text: JAPANESE INTERMEDIATE CODE: A912

Effective date: 20211022

C211 Notice of termination of reconsideration by examiners before appeal proceedings

Free format text: JAPANESE INTERMEDIATE CODE: C211

Effective date: 20211026

C22 Notice of designation (change) of administrative judge

Free format text: JAPANESE INTERMEDIATE CODE: C22

Effective date: 20220308

C22 Notice of designation (change) of administrative judge

Free format text: JAPANESE INTERMEDIATE CODE: C22

Effective date: 20220405

C13 Notice of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: C13

Effective date: 20220517

C302 Record of communication

Free format text: JAPANESE INTERMEDIATE CODE: C302

Effective date: 20220707

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220711

C22 Notice of designation (change) of administrative judge

Free format text: JAPANESE INTERMEDIATE CODE: C22

Effective date: 20220712

C23 Notice of termination of proceedings

Free format text: JAPANESE INTERMEDIATE CODE: C23

Effective date: 20220913

C03 Trial/appeal decision taken

Free format text: JAPANESE INTERMEDIATE CODE: C03

Effective date: 20221018

C30A Notification sent

Free format text: JAPANESE INTERMEDIATE CODE: C3012

Effective date: 20221018

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20221115

R150 Certificate of patent or registration of utility model

Ref document number: 7178774

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150