JP2020019346A - モータ制御装置 - Google Patents

モータ制御装置 Download PDF

Info

Publication number
JP2020019346A
JP2020019346A JP2018144000A JP2018144000A JP2020019346A JP 2020019346 A JP2020019346 A JP 2020019346A JP 2018144000 A JP2018144000 A JP 2018144000A JP 2018144000 A JP2018144000 A JP 2018144000A JP 2020019346 A JP2020019346 A JP 2020019346A
Authority
JP
Japan
Prior art keywords
torque
command value
steering
disturbance
motor
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
JP2018144000A
Other languages
English (en)
Other versions
JP7116888B2 (ja
Inventor
直紀 小路
Naoki Komichi
直紀 小路
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.)
JTEKT Corp
Original Assignee
JTEKT Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by JTEKT Corp filed Critical JTEKT Corp
Priority to JP2018144000A priority Critical patent/JP7116888B2/ja
Priority to US16/521,659 priority patent/US11383759B2/en
Priority to CN201910676054.2A priority patent/CN110775151B/zh
Priority to EP19189023.5A priority patent/EP3608203B1/en
Publication of JP2020019346A publication Critical patent/JP2020019346A/ja
Application granted granted Critical
Publication of JP7116888B2 publication Critical patent/JP7116888B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D6/00Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
    • B62D6/002Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits computing target steering angles for front or rear wheels
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D5/00Power-assisted or power-driven steering
    • B62D5/04Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D1/00Steering controls, i.e. means for initiating a change of direction of the vehicle
    • B62D1/24Steering controls, i.e. means for initiating a change of direction of the vehicle not vehicle-mounted
    • B62D1/28Steering controls, i.e. means for initiating a change of direction of the vehicle not vehicle-mounted non-mechanical, e.g. following a line or other known markers
    • B62D1/286Systems for interrupting non-mechanical steering due to driver intervention
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D15/00Steering not otherwise provided for
    • B62D15/02Steering position indicators ; Steering position determination; Steering aids
    • B62D15/025Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D5/00Power-assisted or power-driven steering
    • B62D5/04Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear
    • B62D5/0457Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear characterised by control features of the drive means as such
    • B62D5/046Controlling the motor
    • B62D5/0463Controlling the motor calculating assisting torque from the motor based on driver input
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D6/00Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D6/00Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
    • B62D6/002Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits computing target steering angles for front or rear wheels
    • B62D6/003Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits computing target steering angles for front or rear wheels in order to control vehicle yaw movement, i.e. around a vertical axis
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D6/00Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
    • B62D6/08Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits responsive only to driver input torque
    • B62D6/10Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits responsive only to driver input torque characterised by means for sensing or determining torque

Landscapes

  • Engineering & Computer Science (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)
  • Power Steering Mechanism (AREA)

Abstract

【課題】外乱トルクを補償でき、精度の高い角度制御が行えるモータ制御装置を提供する。【解決手段】手動操舵指令値生成部41は、操舵トルクを用いて手動操舵指令値を生成する。統合角度指令値演算部42は、自動操舵指令値に手動操舵指令値を加算して、統合角度指令値を演算する。制御部43は、統合角度指令値に基づいて、電動モータ18を角度制御する。制御部43は、統合角度指令値に基づいて、基本トルク指令値を演算する基本トルク指令値演算部と、電動モータ18の駆動対象に作用する電動モータ18のモータトルク以外の外乱トルクを推定する外乱トルク推定部と、基本トルク指令値を外乱トルクによって補正する外乱トルク補償部とを含む。手動操舵指令値生成部41は、手動操舵指令値の生成に、外乱トルクに基づいて算出される推定トルクを用いる。【選択図】図2

Description

この発明は、舵角制御用の電動モータの制御装置に関する。
電動パワーステアリングシステム(EPS:electric power steering)、ステアバイワイヤシステムおよび後輪操舵システム等による自動運転や運転支援においては、電動モータによって転舵輪の転舵角が制御されている。この種のモータ制御には、目標転舵角と実転舵角との差に応じて、電動モータのモータトルクを制御する角度フィードバック制御が用いられている。角度フィードバック制御としては、一般的には、PID制御が用いられる。具体的には、目標転舵角と実転舵角との差の項、当該差の積分項および当該差の微分項にそれぞれ比例ゲイン、積分ゲインおよび微分ゲインが乗算された後、それらの項が加算されることにより目標トルクが演算される。そして、モータトルクが、目標トルクと等しくなるように電動モータが制御される。
特開2004−256076号公報 国際公開第2014/162769号
前述のPID制御は、線形な制御アルゴリズムであるため、路面負荷トルク(ラック軸側外乱トルク)、ステアリングシステムの摩擦トルク、操舵トルク(ステアリング側外乱トルク)等の非線形な外乱トルクの変動によって、角度制御精度の低下やばらつきが発生する。
この発明の目的は、角度制御性能への外乱トルクの影響を抑制することができ、精度の高い角度制御が行えるモータ制御装置を提供することである。
請求項1に記載の発明は、舵角制御用の電動モータ(18)を駆動制御するためのモータ制御装置(40)であって、操舵トルクを用いて手動操舵指令値を生成する手動操舵指令値生成部(41)と、自動操舵指令値に前記手動操舵指令値を加算して、統合角度指令値を演算する統合角度指令値演算部(42)と、前記統合角度指令値に基づいて、前記電動モータを角度制御する制御部(43)とを含み、前記制御部は、前記統合角度指令値に基づいて、基本トルク指令値を演算する基本トルク指令値演算部(61〜63,65)と、前記電動モータの駆動対象に作用する前記電動モータのモータトルク以外の外乱トルクを推定する外乱トルク推定部(64)と、前記基本トルク指令値を前記外乱トルクによって補正する外乱トルク補償部(66)とを含み、前記手動操舵指令値生成部は、前記手動操舵指令値の生成に、前記外乱トルクに基づいて算出される推定トルクを用いることを特徴とするモータ制御装置である。なお、括弧内の英数字は後述の実施形態における対応構成要素等を表すが、むろん、この発明の範囲は当該実施形態に限定されない。
この構成では、統合角度指令値に基づいて基本トルク指令値が演算され、外乱トルク推定部によって推定された外乱トルクによって基本トルク指令値が補正されているので、角度制御性能への外乱トルクの影響を抑制することができる。これにより、精度の高い角度制御が行えるようになる。
また、この構成では、自動操舵指令に手動操舵指令値が加算されて、統合角度指令値が演算され、この統合角度指令値に基づいて電動モータが角度制御される。これにより、手動操舵制御と自動操舵制御との間で切り替えを行うことなく、自動操舵制御主体での操舵制御を行いながら手動操舵が可能な協調制御を実現できる。これにより、手動操舵制御と自動操舵制御との間での移行をシームレスに行うことができるので、運転者の違和感を低減することができる。
また、この構成では、手動操舵指令値の生成に、外乱トルクに基づいて算出される推定トルクが用いられるので、手動操舵時に実際の路面状況に応じた操舵感を得ることが可能となる。
請求項2に記載の発明は、前記手動操舵指令値生成部は、前記操舵トルクと、前記推定トルクとを用いて、前記手動操舵指令値を生成するように構成されている、請求項1に記載のモータ制御装置である。
請求項3に記載の発明は、前記手動操舵指令値生成部は、前記操舵トルクと、仮想バネ・ダンパ負荷と、前記推定トルクとを用いて、前記手動操舵指令値を生成するように構成されている、請求項1に記載のモータ制御装置である。
請求項4に記載の発明は、前記手動操舵指令値生成部は、前記操舵トルクと、仮想バネ・ダンパ負荷と、前記推定トルクの高周波成分とを用いて、前記手動操舵指令値を生成するように構成されている、請求項1に記載のモータ制御装置である。
請求項5に記載の発明は、前記推定トルクが、前記外乱トルク、前記外乱トルクから前記操舵トルクを減算した値、ならびに前記外乱トルクから前記操舵トルクおよび所定の摩擦トルクを減算した値のうちのいずれか1つである、請求項2〜4のいずれか一項に記載のモータ制御装置である。
請求項6に記載の発明は、前記推定トルクが、前記外乱トルクの高周波成分から前記操舵トルクを減算した値、または前記外乱トルクの高周波成分から前記操舵トルクおよび所定の摩擦トルクを減算した値である、請求項3に記載のモータ制御装置である。
図1は、本発明の一実施形態に係るモータ制御装置が適用された電動パワーステアリングシステムの概略構成を示す模式図である。 図2は、モータ制御用ECUの電気的構成を説明するためのブロック図である。 図3は、手動操舵指令値生成部の構成を示すブロック図である。 図4は、操舵トルクTに対するアシストトルク指令値Tacの設定例を示すグラフである。 図5は、指令値設定部で用いられるリファレンスEPSモデルの一例を示す模式図である。 図6は、角度制御部の構成を示すブロック図である。 図7は、電動パワーステアリングシステムの物理モデルの構成例を示す模式図である。 図8は、外乱トルク推定部の構成を示すブロック図である。 図9は、トルク制御部の構成を示す模式図である。
以下では、この発明の実施の形態を、添付図面を参照して詳細に説明する。
図1は、本発明の一実施形態に係るモータ制御装置が適用された電動パワーステアリングシステムの概略構成を示す模式図である。
電動パワーステアリングシステム1は、車両を操向するための操舵部材としてのステアリングホイール(ハンドル)2と、このステアリングホイール2の回転に連動して転舵輪3を転舵する転舵機構4と、運転者の操舵を補助するための操舵補助機構5とを備えている。ステアリングホイール2と転舵機構4とは、ステアリングシャフト6および中間軸7を介して機械的に連結されている。
ステアリングシャフト6は、ステアリングホイール2に連結された入力軸8と、中間軸7に連結された出力軸9とを含む。入力軸8と出力軸9とは、トーションバー10を介して相対回転可能に連結されている。
トーションバー10の近傍には、トルクセンサ12が配置されている。トルクセンサ12は、入力軸8および出力軸9の相対回転変位量に基づいて、ステアリングホイール2に与えられた操舵トルク(トーションバートルク)Tを検出する。この実施形態では、トルクセンサ12によって検出される操舵トルクTは、例えば、左方向への操舵のためのトルクが正の値として検出され、右方向への操舵のためのトルクが負の値として検出され、その絶対値が大きいほど操舵トルクTの大きさが大きくなるものとする。
転舵機構4は、ピニオン軸13と、転舵軸としてのラック軸14とを含むラックアンドピニオン機構からなる。ラック軸14の各端部には、タイロッド15およびナックルアーム(図示略)を介して転舵輪3が連結されている。ピニオン軸13は、中間軸7に連結されている。ピニオン軸13は、ステアリングホイール2の操舵に連動して回転するようになっている。ピニオン軸13の先端には、ピニオン16が連結されている。
ラック軸14は、車両の左右方向に沿って直線状に延びている。ラック軸14の軸方向の中間部には、ピニオン16に噛み合うラック17が形成されている。このピニオン16およびラック17によって、ピニオン軸13の回転がラック軸14の軸方向移動に変換される。ラック軸14を軸方向に移動させることによって、転舵輪3を転舵することができる。
ステアリングホイール2が操舵(回転)されると、この回転が、ステアリングシャフト6および中間軸7を介して、ピニオン軸13に伝達される。そして、ピニオン軸13の回転は、ピニオン16およびラック17によって、ラック軸14の軸方向移動に変換される。これにより、転舵輪3が転舵される。
操舵補助機構5は、操舵補助力(アシストトルク)を発生するための電動モータ18と、電動モータ18の出力トルクを増幅して転舵機構4に伝達するための減速機19とを含む。減速機19は、ウォームギヤ20と、このウォームギヤ20と噛み合うウォームホイール21とを含むウォームギヤ機構からなる。減速機19は、伝達機構ハウジングとしてのギヤハウジング22内に収容されている。以下において、減速機19の減速比(ギヤ比)をNで表す場合がある。減速比Nは、ウォームホイール21の角速度ωwwに対するウォームギヤ20の角速度ωwgの比ωwg/ωwwとして定義される。
ウォームギヤ20は、電動モータ18によって回転駆動される。また、ウォームホイール21は、出力軸9に一体回転可能に連結されている。
電動モータ18によってウォームギヤ20が回転駆動されると、ウォームホイール21が回転駆動され、ステアリングシャフト6にモータトルクが付与されるとともにステアリングシャフト6(出力軸9)が回転する。そして、ステアリングシャフト6の回転は、中間軸7を介してピニオン軸13に伝達される。ピニオン軸13の回転は、ラック軸14の軸方向移動に変換される。これにより、転舵輪3が転舵される。すなわち、電動モータ18によってウォームギヤ20を回転駆動することによって、電動モータ18による操舵補助や転舵輪3の転舵が可能となる。電動モータ18には、電動モータ18のロータの回転角を検出するための回転角センサ23が設けられている。
出力軸9(電動モータ18の駆動対象の一例)に加えられるトルクとしては、電動モータ18によるモータトルクと、モータトルク以外の外乱トルクとがある。モータトルク以外の外乱トルクTlcには、操舵トルクT、路面負荷トルク(路面反力トルク)Trl、摩擦トルクT等が含まれる。
操舵トルクTは、運転者によってステアリングホイール2に加えられる力や、ステアリング慣性によって発生する力等によって、ステアリングホイール2側から出力軸9に加えられるトルクである。
路面負荷トルクTrlは、タイヤに発生するセルフアライニングトルク、サスペンションやタイヤホイールアライメントによって発生する力、ラックアンドピニオン機構の摩擦力等によって、転舵輪3側からラック軸14を介して出力軸9に加えられるトルクである。
摩擦トルクTは、出力軸9(電動モータ18の駆動対象)に加えられる摩擦トルクのうち、操舵トルクTおよび路面負荷トルクTrlに含まれていない摩擦トルクである。摩擦トルクTは、電動モータ18と出力軸9との間で発生する摩擦トルクを少なくとも含む。この実施形態では、摩擦トルクTは、主として、減速機19によって発生する摩擦トルク(ウォームホイール21とウォームギヤ20との間に発生する摩擦トルク)からなる。
車両には、車両の進行方向前方の道路を撮影するCCD(Charge Coupled Device)カメラ25、自車位置を検出するためのGPS(Global Positioning System)26、道路形状や障害物を検出するためのレーダー27および地図情報を記憶した地図情報メモリ28が搭載されている。
CCDカメラ25、GPS26、レーダー27および地図情報メモリ28は、運転支援制御や自動運転制御を行うための上位ECU(ECU:Electronic Control Unit)201に接続されている。上位ECU201は、CCDカメラ25、GPS26およびレーダー27によって得られる情報および地図情報を元に、周辺環境認識、自車位置推定、経路計画等を行い、操舵や駆動アクチュエータの制御目標値の決定を行う。
この実施形態では、上位ECU201は、自動操舵のための自動操舵指令値θadacを設定する。この実施形態では、自動操舵制御は、例えば、目標軌道に沿って車両を走行させるための制御である。自動操舵指令値θadacは、車両を目標軌道に沿って自動走行させるための操舵角の目標値である。このような自動操舵指令値θadacを設定する処理は、周知であるため、ここでは詳細な説明を省略する。
上位ECU201によって設定される自動操舵指令値θadacは、車載ネットワークを介して、モータ制御用ECU202に与えられる。トルクセンサ12によって検出される操舵トルクT、回転角センサ23の出力信号は、モータ制御用ECU202に入力される。モータ制御用ECU202は、これらの入力信号および上位ECU201から与えられる情報に基づいて、電動モータ18を制御する。
図2は、モータ制御用ECU202の電気的構成を説明するためのブロック図である。
モータ制御用ECU202は、マイクロコンピュータ40と、マイクロコンピュータ40によって制御され、電動モータ18に電力を供給する駆動回路(インバータ回路)31と、電動モータ18に流れる電流(以下、「モータ電流I」という)を検出するための電流検出回路32とを備えている。
マイクロコンピュータ40は、CPUおよびメモリ(ROM、RAM、不揮発性メモリなど)を備えており、所定のプログラムを実行することによって、複数の機能処理部として機能するようになっている。この複数の機能処理部には、手動操舵指令値生成部41と、統合角度指令値演算部42と、制御部43とを含む。
手動操舵指令値生成部41は、運転者がステアリングホイール2を操作した場合に、当該ステアリングホイール操作に応じた操舵角(より正確には出力軸9の回転角θ)を手動操舵指令値θmdacとして設定するために設けられている。手動操舵指令値生成部41は、トルクセンサ12によって検出される操舵トルクTおよび後述する制御部43内の角度制御部44から与えられる外乱トルク推定値^Tlcを用いて手動操舵指令値θmdacを生成する。
統合角度指令値演算部42は、上位ECU201によって設定される自動操舵指令値θadacに手動操舵指令値θmdacを加算して、統合角度指令値θacmdを演算する。
制御部43は、統合角度指令値θacmdに基づいて、電動モータ18を角度制御する。より具体的には、制御部43は、操舵角θ(出力軸9の回転角θ)が統合角度指令値θacmdに近づくように、駆動回路31を駆動制御する。
制御部43は、角度制御部44とトルク制御部(電流制御部)45とを含む。角度制御部44は、統合角度指令値θacmdに基づいて、電動モータ18のモータトルクの目標値であるモータトルク指令値Tを演算する。トルク制御部45は、電動モータ18のモータトルクがモータトルク指令値Tに近づくように駆動回路31を駆動する。
図3は、手動操舵指令値生成部41の構成を示すブロック図である。
手動操舵指令値生成部41は、アシストトルク指令値設定部51と、指令値設定部52とを含む。
アシストトルク指令値設定部51は、手動操作に必要なアシストトルクの目標値であるアシストトルク指令値Tacを設定する。アシストトルク指令値設定部51は、トルクセンサ12によって検出される操舵トルクTに基づいて、アシストトルク指令値Tacを設定する。操舵トルクTに対するアシストトルク指令値Tacの設定例は、図4に示されている。
アシストトルク指令値Tacは、電動モータ18から左方向操舵のための操舵補助力を発生させるべきときには正の値とされ、電動モータ18から右方向操舵のための操舵補助力を発生させるべきときには負の値とされる。アシストトルク指令値Tacは、操舵トルクTの正の値に対しては正をとり、操舵トルクTの負の値に対しては負をとる。そして、アシストトルク指令値Tacは、操舵トルクTの絶対値が大きくなるほど、その絶対値が大きくなるように設定される。
なお、アシストトルク指令値設定部51は、操舵トルクTに予め設定された定数を乗算することによって、アシストトルク指令値Tacを演算してもよい。
図3に戻り、指令値設定部52は、操舵トルクTと、アシストトルク指令値Tacと、後述する角度制御部44内の外乱トルク推定部64(図6参照)によって演算される外乱トルク推定値^Tlcとに基づいて、手動操舵指令値θmdacを設定する。
外乱トルク推定部64によって演算される外乱トルク推定値^Tlcは、電動モータ18の駆動対象(出力軸9)に作用するモータトルク以外の外乱トルクの推定値である。外乱トルク推定値^Tlcは、前述した操舵トルクT、路面負荷トルクTrl、摩擦トルクT等を含んでいる。
指令値設定部52は、基本的には、図5のリファレンスEPSモデルを用いて、手動操舵指令値θmdacを設定する。
このリファレンスEPSモデルは、ロアコラムを含む単一慣性モデルである。ロアコラムは、出力軸9およびウォームホイール21に対応する。図5において、Jは、ロアコラムの慣性であり、θはロアコラムの回転角であり、Tは、操舵トルクである。ロアコラムには、操舵トルクT、電動モータ18から出力軸9に作用するトルクN・Tおよび路面負荷トルクTrlが与えられる。
リファレンスEPSモデルの運動方程式は、次式(1)で表される。
・dθ/dt=T+N・T+Trl …(1)
この実施形態では、指令値設定部52は、図5の路面負荷トルクTrl(式(1)のTrl)として、外乱トルク推定部64(図3および図6参照)によって演算される外乱トルク推定値^Tlcを用いる。この場合には、リファレンスEPSモデルの運動方程式は、次式(2)で表される。
・dθ/dt=T+N・T+^Tlc …(2)
指令値設定部52は、Tにトルクセンサ12によって検出される操舵トルクTを代入し、N・Tにアシストトルク指令値設定部51によって設定されるアシストトルク指令値Tacを代入して、式(2)の微分方程式を解くことにより、ロアコラムの回転角θを演算する。そして、指令値設定部52は、得られたロアコラムの回転角θを手動操舵指令値θmdacとして設定する。
図6は、角度制御部44の構成を示すブロック図である。
角度制御部44は、統合角度指令値θacmdに基づいてモータトルク指令値Tを演算する。角度制御部44は、ローパスフィルタ(LPF)61と、フィードバック制御部62と、フィードフォワード制御部63と、外乱トルク推定部64と、トルク加算部65と、外乱トルク補償部66と、第1減速比除算部67と、減速比乗算部68と、回転角演算部69と、第2減速比除算部70とを含む。
減速比乗算部68は、第1減速比除算部67によって演算されるモータトルク指令値Tに減速機19の減速比Nを乗算することにより、モータトルク指令値Tを出力軸9(ウォームホイール21)に作用する操舵トルク指令値Tcmd(=N・T)に換算する。
回転角演算部69は、回転角センサ23の出力信号に基づいて、電動モータ18のロータ回転角θを演算する。第2減速比除算部70は、回転角演算部69によって演算されるロータ回転角θを減速比Nで除算することにより、ロータ回転角θを出力軸9の回転角(実操舵角)θに換算する。
ローパスフィルタ61は、統合角度指令値θacmdに対してローパスフィルタ処理を行う。ローパスフィルタ処理後の統合角度指令値θcmdは、フィードバック制御部62およびフィードフォワード制御部63に与えられる。
フィードバック制御部62は、外乱トルク推定部64によって演算される操舵角推定値^θを、ローパスフィルタ処理後の統合角度指令値θcmdに近づけるために設けられている。フィードバック制御部62は、角度偏差演算部62AとPD制御部62Bとを含む。角度偏差演算部62Aは、統合角度指令値θcmdと操舵角推定値^θとの偏差Δθ(=θcmd−^θ)を演算する。なお、角度偏差演算部62Aは、統合角度指令値θcmdと、第2減速比除算部70によって演算される実操舵角θとの偏差(θcmd−θ)を、角度偏差Δθとして演算するようにしてもよい。
PD制御部62Bは、角度偏差演算部62Aによって演算される角度偏差Δθに対してPD演算(比例微分演算)を行うことにより、フィードバック制御トルクTfbを演算する。フィードバック制御トルクTfbは、トルク加算部65に与えられる。
フィードフォワード制御部63は、電動パワーステアリングシステム1の慣性による応答性の遅れを補償して、制御の応答性を向上させるために設けられている。フィードフォワード制御部63は、角加速度演算部63Aと慣性乗算部63Bとを含む。角加速度演算部63Aは、統合角度指令値θcmdを2階微分することにより、目標角加速度dθcmd/dtを演算する。
慣性乗算部63Bは、角加速度演算部63Aによって演算された目標角加速度dθcmd/dtに、電動パワーステアリングシステム1の慣性Jを乗算することにより、フィードフォワード制御トルクTff(=J・dθcmd/dt)を演算する。慣性Jは、例えば、後述する電動パワーステアリングシステム1の物理モデル(図7参照)から求められる。フィードフォワード制御トルクTffは、慣性補償値として、トルク加算部65に与えられる。
トルク加算部65は、フィードバック制御トルクTfbにフィードフォワード制御トルクTffを加算することにより、基本トルク指令値(Tfb+Tff)を演算する。
外乱トルク推定部64は、プラント(電動モータ18の制御対象)に外乱として発生する非線形なトルク(外乱トルク:モータトルク以外のトルク)を推定するために設けられている。外乱トルク推定部64は、プラントへの入力値である操舵トルク指令値Tcmd(=N・T)と、プラントの出力である実操舵角θとに基づいて、外乱トルク(外乱負荷)Tlc、操舵角θおよび操舵角微分値(角速度)dθ/dtを推定する。外乱トルクTlc、操舵角θおよび操舵角微分値(角速度)dθ/dtの推定値を、それぞれ^Tlc、^θおよびd^θ/dtで表す。外乱トルク推定部64の詳細については、後述する。
外乱トルク推定部64によって演算された外乱トルク推定値^Tlcは、手動操舵指令値生成部41内の指令値設定部52(図3参照)に与えられるとともに、外乱トルク補償値として外乱トルク補償部66に与えられる。外乱トルク推定部64によって演算された操舵角推定値^θは、角度偏差演算部62Aに与えられる。
外乱トルク補償部66は、基本トルク指令値(Tfb+Tff)から外乱トルク推定値^Tlcを減算することにより、操舵トルク指令値Tcmd(=Tfb+Tff−^Tlc)を演算する。これにより、外乱トルクが補償された操舵トルク指令値Tcmd(出力軸9に対するトルク指令値)が得られる。
操舵トルク指令値Tcmdは、第1減速比除算部67に与えられる。第1減速比除算部67は、操舵トルク指令値Tcmdを減速比Nで除算することにより、モータトルク指令値Tを演算する。このモータトルク指令値Tが、トルク制御部45(図2参照)に与えられる。
外乱トルク推定部64について詳しく説明する。外乱トルク推定部64は、例えば、図7に示す電動パワーステアリングシステム1の物理モデル101を使用して、外乱トルクTlc、操舵角θおよび角速度dθ/dtを推定する外乱オブザーバから構成されている。
この物理モデル101は、出力軸9および出力軸9に固定されたウォームホイール21を含むプラント(モータ駆動対象の一例)102を含む。プラント102には、ステアリングホイール2からトーションバー10を介して操舵トルクTが与えられるとともに、転舵輪3側から路面負荷トルクTrlが与えられる。
さらに、プラント102には、ウォームギヤ20を介して操舵トルク指令値Tcmd(=N・T)が与えられるとともに、ウォームホイール21とウォームギヤ20との間の摩擦によって摩擦トルクTが与えられる。
プラント102の慣性をJとすると、物理モデル101の慣性についての運動方程式は、次式(3)で表される。
Figure 2020019346
θ/dtは、プラント102の角加速度である。Nは、減速機19の減速比である。Tlcは、プラント102に与えられるモータトルク以外の外乱トルクを示している。この実施形態では、外乱トルクTlcは、操舵トルクTと路面負荷トルクTrlと摩擦トルクTとの和として示されているが、実際には、外乱トルクTlcはこれら以外のトルクを含んでいる。
図7の物理モデル101に対する状態方程式は、次式(4)で表わされる。
Figure 2020019346
前記式(4)において、xは、状態変数ベクトルである。前記式(4)において、uは、既知入力ベクトルである。前記式(4)において、uは、未知入力ベクトルである。前記式(4)において、yは、出力ベクトル(測定値)である。前記式(4)において、Aは、システム行列である。前記式(4)において、Bは、第1入力行列である。前記式(4)において、Bは、第2入力行列である。前記式(4)において、Cは、出力行列である。前記式(4)において、Dは、直達行列である。
前記状態方程式を、未知入力ベクトルuを状態の1つとして含めた系に拡張する。拡張系の状態方程式(拡張状態方程式)は、次式(5)で表される。
Figure 2020019346
前記式(5)において、xは、拡張系の状態変数ベクトルであり、次式(6)で表される。
Figure 2020019346
前記式(5)において、Aは、拡張系のシステム行列である。前記式(5)において、Bは、拡張系の既知入力行列である。前記式(5)において、Ceは、拡張系の出力行列である。
前記式(5)の拡張状態方程式から、次式(7)の方程式で表される外乱オブザーバ(拡張状態オブザーバ)が構築される。
Figure 2020019346
式(7)において、^xはxの推定値を表している。また、Lはオブザーバゲインである。また、^yはyの推定値を表している。^xは、次式(8)で表される。
Figure 2020019346
式(8)において、^θはθの推定値であり、^TlcはTlcの推定値である。
外乱トルク推定部64は、前記式(7)の方程式に基づいて状態変数ベクトル^xを演算する。
図8は、外乱トルク推定部64の構成を示すブロック図である。
外乱トルク推定部64は、入力ベクトル入力部81と、出力行列乗算部82と、第1加算部83と、ゲイン乗算部84と、入力行列乗算部85と、システム行列乗算部86と、第2加算部87と、積分部88と、状態変数ベクトル出力部89とを含む。
減速比乗算部68(図6参照)によって演算される操舵トルク指令値Tcmd(=N・T)は、入力ベクトル入力部81に与えられる。入力ベクトル入力部81は、入力ベクトルuを出力する。
積分部88の出力が状態変数ベクトル^x(前記式(8)参照)となる。演算開始時には、状態変数ベクトル^xとして初期値が与えられる。状態変数ベクトル^xの初期値は、たとえば0である。
システム行列乗算部86は、状態変数ベクトル^xにシステム行列Aを乗算する。出力行列乗算部82は、状態変数ベクトル^xに出力行列Cを乗算する。
第1加算部83は、第2減速比除算部70(図6参照)によって演算された実操舵角θである出力ベクトル(測定値)yから、出力行列乗算部82の出力(C・^x)を減算する。つまり、第1加算部83は、出力ベクトルyと出力ベクトル推定値^y(=C・^x)との差(y−^y)を演算する。ゲイン乗算部84は、第1加算部83の出力(y−^y)にオブザーバゲインL(前記式(7)参照)を乗算する。
入力行列乗算部85は、入力ベクトル入力部81から出力される入力ベクトルuに入力行列Bを乗算する。第2加算部87は、入力行列乗算部85の出力(Be・u)と、システム行列乗算部86の出力(A・^x)と、ゲイン乗算部84の出力(L(y−^y))とを加算することにより、状態変数ベクトルの微分値d^x/dtを演算する。積分部88は、第2加算部87の出力(d^x/dt)を積分することにより、状態変数ベクトル^xを演算する。状態変数ベクトル出力部89は、状態変数ベクトル^xに基づいて、外乱トルク推定値^Tlc、操舵角推定値^θおよび角速度推定値d^θ/dtを演算する。
一般的な外乱オブザーバは、前述の拡張状態オブザーバとは異なり、プラントの逆モデルとローパスフィルタとから構成される。プラントの運動方程式は、前述のように式(3)で表される。したがって、プラントの逆モデルは、次式(9)となる。
Figure 2020019346
一般的な外乱オブザーバへの入力は、J・dθ/dtおよびN・Tであり、実操舵角θの2階微分値を用いるため、回転角センサ23のノイズの影響を大きく受ける。これに対して、前述の実施形態の拡張状態オブザーバでは、積分型で外乱トルクを推定するため、微分によるノイズ影響を低減できる。
なお、外乱トルク推定部64として、プラントの逆モデルとローパスフィルタとから構成される一般的な外乱オブザーバを用いてもよい。
図9は、トルク制御部45の構成を示す模式図である。
トルク制御部45(図2参照)は、モータ電流指令値演算部91と、電流偏差演算部92と、PI制御部93と、PWM(Pulse Width Modulation)制御部94とを含む。
モータ電流指令値演算部91は、角度制御部44(図2参照)によって演算されたモータトルク指令値Tを電動モータ18のトルク定数Kで除算することにより、モータ電流指令値Icmdを演算する。
電流偏差演算部92は、モータ電流指令値演算部91によって得られたモータ電流指令値Icmdと電流検出回路32によって検出されたモータ電流Iとの偏差ΔI(=Icmd−I)を演算する。
PI制御部93は、電流偏差演算部92によって演算された電流偏差ΔIに対するPI演算(比例積分演算)を行うことにより、電動モータ18に流れるモータ電流Iをモータ電流指令値Icmdに導くための駆動指令値を生成する。PWM制御部94は、前記駆動指令値に対応するデューティ比のPWM制御信号を生成して、駆動回路31に供給する。これにより、駆動指令値に対応した電力が電動モータ18に供給されることになる。
前述の実施形態では、自動操舵指令値θadacに手動操舵指令値θmdacが加算されて、統合角度指令値θacmdが演算され、この統合角度指令値θacmdに基づいて電動モータ18が制御される。これにより、手動操舵制御と自動操舵制御との間で切り替えを行うことなく、自動操舵制御主体での操舵制御を行いながら手動操舵が可能な協調制御を実現できる。また、手動操舵制御と自動操舵制御との間での移行をシームレスに行うことができるので、手動操舵を行う際に運転者に違和感を与えない。
また、前述の実施形態では、統合角度指令値θacmdに基づいて基本トルク指令値(Tfb+Tff)が演算され、外乱トルク推定部64によって演算された外乱トルク推定値^Tlcによって基本トルク指令値(Tfb+Tff)が補正されているので、角度制御性能に対する外乱トルクの影響を抑制することができる。これにより、高精度の角度制御を実現することが可能となる。
また、前述の実施形態では、外乱トルク推定部64によって演算されかつ路面負荷トルクTrlを含む外乱トルク推定値^Tlcを用いて、手動操舵指令値θmdacが設定されているので、手動操舵時に実際の路面状況に応じた操舵感を得ることが可能となる。
以下、手動操舵指令値生成部41内の指令値設定部52(図3参照)の変形例について説明する。
[第1変形例]
第1変形例では、指令値設定部52は、図5の路面負荷トルクTrl(前記式(1)のTrl)として、外乱トルク推定値^Tlc(≒T+Trl+T)から操舵トルクTを減算した値(^Tlc−T)を用いる。
この場合には、図5のリファレンスEPSモデルの運動方程式は、次式(10)で表される。
・dθ/dt=T+N・T+(^Tlc−T
=N・T+^Tlc …(10)
指令値設定部52は、N・Tにアシストトルク指令値設定部51(図3参照)によって設定されるアシストトルク指令値Tacを代入して、式(10)の微分方程式を解くことにより、ロアコラムの回転角θを演算する。そして、指令値設定部52は、得られたロアコラムの回転角θを手動操舵指令値θmdacとして設定する。
第1変形例では、外乱トルク推定値^Tlcから操舵トルクTを減算した値(^Tlc−T)を用いて、手動操舵指令値θmdacが設定されているので、外乱トルク推定値^Tlcに含まれている操舵トルクTが手動操舵指令値θmdacの設定に用いられるのを防止できる。これにより、手動操舵時に実際の路面状況に応じた操舵感をより効果的に得ることが可能となる。
[第2変形例]
第2変形例では、指令値設定部52は、図5の路面負荷トルクTrlとして、外乱トルク推定値^Tlcから操舵トルクTおよび摩擦トルクTを減算した値(^Tlc−T−T)を用いる。摩擦トルクTは、例えば、減速機19に発生する摩擦を推定する摩擦モデル等を用いて推定することができる。
この場合には、図5のリファレンスEPSモデルの運動方程式は、次式(11)で表される。
・dθ/dt=T+N・T+(^Tlc−T−T
=N・T+^Tlc−T …(11)
指令値設定部52は、N・Tにアシストトルク指令値設定部51(図3参照)によって設定されるアシストトルク指令値Tacを代入して、式(11)の微分方程式を解くことにより、ロアコラムの回転角θを演算する。そして、指令値設定部52は、得られたロアコラムの回転角θを手動操舵指令値θmdacとして設定する。
第2変形例では、外乱トルク推定値^Tlcから操舵トルクTおよび摩擦トルクTを減算した値(^Tlc−T−T)を用いて、手動操舵指令値θmdacが設定されているので、外乱トルク推定値^Tlcに含まれている操舵トルクTおよび摩擦トルクTが手動操舵指令値θmdacの設定に用いられるのを防止できる。これにより、手動操舵時に実際の路面状況に応じた操舵感をより効果的に得ることが可能となる。
[第3変形例]
第3変形例では、指令値設定部52は、図5の路面負荷トルクTrlとして、仮想バネ・ダンパ負荷Tvsdと外乱トルク推定値^Tlcとの和(Tvsd+^Tlc)を用いる。
仮想バネ・ダンパ負荷Tvsdは、ばね定数kおよび粘性減衰係数cを用いて、次式(12)で表される。
vsd=−k・θ−c(dθ/dt) …(12)
この場合には、図5のリファレンスEPSモデルの運動方程式は、次式(13)で表される。
・dθ/dt=T+N・T+{−k・θ−c(dθ/dt)}
+^Tlc …(13)
ばね定数kおよび粘性減衰係数cとして、予め実験・解析等で求めた所定値が設定される。後述する第4〜第10変形例においても同様である。
指令値設定部52は、Tにトルクセンサ12によって検出される操舵トルクTを代入し、N・Tにアシストトルク指令値設定部51(図3参照)によって設定されるアシストトルク指令値Tacを代入して、式(13)の微分方程式を解くことにより、ロアコラムの回転角θを演算する。そして、指令値設定部52は、得られたロアコラムの回転角θを手動操舵指令値θmdacとして設定する。
第3変形例では、手動操舵指令値θmdacの設定に外乱トルク推定値^Tlcが用いられているので、手動操舵時に実際の路面状況に応じた操舵感を得ることが可能となる。また、第3変形例では、手動操舵指令値θmdacの設定に仮想バネ・ダンパ負荷Tvsdが用いられているので、手動操舵時に手動操舵指令値θmdacを零に戻そうとする反力が発生する。これにより、自動操舵中に手動操作が行われたとしても、手動操作が停止されたときに、操舵角θが自動操舵指令値θadacに追従しやすくなる。
[第4変形例]
第4変形例では、指令値設定部52は、図5の路面負荷トルクTrlとして、仮想バネ・ダンパ負荷Tvsdと、外乱トルク推定値^Tlcから操舵トルクTを減算した値(^Tlc−T)との和{Tvsd+(^Tlc−T)}を用いる。
この場合には、図5のリファレンスEPSモデルの運動方程式は、次式(14)で表される。
・dθ/dt=T+N・T+{−k・θ−c(dθ/dt)}
+(^Tlc−T
=N・T+{−k・θ−c(dθ/dt)}
+^Tlc …(14)
指令値設定部52は、N・Tにアシストトルク指令値設定部51(図3参照)によって設定されるアシストトルク指令値Tacを代入して、式(14)の微分方程式を解くことにより、ロアコラムの回転角θを演算する。そして、指令値設定部52は、得られたロアコラムの回転角θを手動操舵指令値θmdacとして設定する。
第4変形例においても、第3変形例と同様な効果が得られる。
[第5変形例]
第5変形例では、指令値設定部52は、図5の路面負荷トルクTrlとして、仮想バネ・ダンパ負荷Tvsdと、外乱トルク推定値^Tlcから操舵トルクTおよび摩擦トルクTを減算した値(^Tlc−T−T)との和{Tvsd+(^Tlc−T−T)}を用いる。摩擦トルクTは、例えば、減速機19に発生する摩擦を推定する摩擦モデル等を用いて推定することができる。
この場合には、図5のリファレンスEPSモデルの運動方程式は、次式(15)で表される。
・dθ/dt=T+N・T+{−k・θ−c(dθ/dt)}
+(^Tlc−T−T
=N・T+{−k・θ−c(dθ/dt)}
+^Tlc−T …(15)
指令値設定部52は、N・Tにアシストトルク指令値設定部51(図3参照)によって設定されるアシストトルク指令値Tacを代入して、式(15)の微分方程式を解くことにより、ロアコラムの回転角θを演算する。そして、指令値設定部52は、得られたロアコラムの回転角θを手動操舵指令値θmdacとして設定する。
第5変形例においても、第3変形例と同様な効果が得られる。
[第6変形例]
外乱トルク推定部64(図6参照)によって演算される外乱トルク推定値^Tlcには、路面負荷トルクTrlが含まれている。当該路面負荷トルクTrlは、操舵角を中立位置(直進位置)に戻すための定常成分(セルフアライニングトルク)と、路面外乱トルク(例えば、路面上の石、路面表面の凹凸等によって生じる外乱トルク)、ラックアンドピニオン機構の摩擦トルク等の変動成分とを含んでいる。外乱トルク推定値^Tlcに含まれている路面負荷トルクTrlの低周波成分が定常成分であり、当該路面負荷トルクTrlの高周波成分が変動成分である。
第6変形例では、指令値設定部52は、図5の路面負荷トルクTrlとして、仮想バネ・ダンパ負荷Tvsdと、外乱トルク推定値^Tlcの高周波成分HPF(^Tlc)との和{Tvsd+HPF(^Tlc)}を用いる。外乱トルク推定値^Tlcの高周波成分HPF(^Tlc)は、ハイパスフィルタを用いて、外乱トルク推定値^Tlcの周波数成分のうち、所定周波数よりも高い周波数成分のみを抽出することによって求めることができる。
この場合には、図5のリファレンスEPSモデルの運動方程式は、次式(16)で表される。
・dθ/dt=T+N・T+{−k・θ−c(dθ/dt)}
+HPF(^Tlc) …(16)
指令値設定部52は、Tにトルクセンサ12によって検出される操舵トルクTを代入し、N・Tにアシストトルク指令値設定部51(図3参照)によって設定されるアシストトルク指令値Tacを代入して、式(16)の微分方程式を解くことにより、ロアコラムの回転角θを演算する。そして、指令値設定部52は、得られたロアコラムの回転角θを手動操舵指令値θmdacとして設定する。
第6変形例では、手動操舵指令値θmdacの設定に仮想バネ・ダンパ負荷Tvsdが用いられているので、手動操舵時に手動操舵指令値θmdacを零に戻す反力が発生する。一方、手動操舵指令値θmdacの設定に外乱トルク推定値^Tlcの低周波成分(定常成分)は用いられないので、前述の第3〜第5変形例に比べて、手動操舵時に操舵角を中立位置(直進位置)に戻すための反力は低減される。これにより、自動操舵中において手動操舵が行われたとしても、手動操作が停止されたときに、操舵角が自動操舵指令値θadacにより追従しやすくなる。
また、第6変形例では、手動操舵指令値θmdacの設定に外乱トルク推定値^Tlcの高周波成分HPF(^Tlc)が用いられている。これにより、路面外乱トルクやラックアンドピニオン機構の摩擦トルク等が手動操舵指令値θmdacの設定に用いられることになるので、手動操舵時に実際の路面状況に応じた操舵感を得ることが可能となる。
[第7変形例]
第7変形例では、指令値設定部52は、図5の路面負荷トルクTrlとして、仮想バネ・ダンパ負荷Tvsdと、外乱トルク推定値^Tlcから操舵トルクTを減算した値(^Tlc−T)の高周波成分HPF(^Tlc−T)との和{Tvsd+HPF(^Tlc−T)}を用いる。HPF(^Tlc−T)は、ハイパスフィルタを用いて、(^Tlc−T)の周波数成分のうち、所定周波数よりも高い周波数成分のみを抽出することによって求めることができる。
この場合には、図5のリファレンスEPSモデルの運動方程式は、次式(17)で表される。
・dθ/dt=T+N・T+{−k・θ−c(dθ/dt)}
+HPF(^Tlc−T) …(17)
指令値設定部52は、Tにトルクセンサ12によって検出される操舵トルクTを代入し、N・Tにアシストトルク指令値設定部51(図3参照)によって設定されるアシストトルク指令値Tacを代入して、式(17)の微分方程式を解くことにより、ロアコラムの回転角θを演算する。そして、指令値設定部52は、得られたロアコラムの回転角θを手動操舵指令値θmdacとして設定する。
第7変形例においても、第6変形例と同様な効果が得られる。
[第8変形例]
第8変形例では、指令値設定部52は、図5の路面負荷トルクTrlとして、仮想バネ・ダンパ負荷Tvsdと、外乱トルク推定値^Tlcから操舵トルクTおよび摩擦トルクTを減算した値(^Tlc−T−T)の高周波成分HPF(^Tlc−T−T)との和{Tvsd+HPF(^Tlc−T−T)}を用いる。
摩擦トルクTは、例えば、減速機19に発生する摩擦を推定する摩擦モデル等を用いて推定することができる。HPF(^Tlc−T−T)は、ハイパスフィルタを用いて、(^Tlc−T−T)の周波数成分のうち、所定周波数よりも高い周波数成分のみを抽出することによって求めることができる。
この場合には、図5のリファレンスEPSモデルの運動方程式は、次式(18)で表される。
・dθ/dt=T+N・T+{−k・θ−c(dθ/dt)}
+HPF(^Tlc−T−T) …(18)
指令値設定部52は、Tにトルクセンサ12によって検出される操舵トルクTを代入し、N・Tにアシストトルク指令値設定部51(図3参照)によって設定されるアシストトルク指令値Tacを代入して、式(18)の微分方程式を解くことにより、ロアコラムの回転角θを演算する。そして、指令値設定部52は、得られたロアコラムの回転角θを手動操舵指令値θmdacとして設定する。
第8変形例においても、第6変形例と同様な効果が得られる。
[第9変形例]
第9変形例では、指令値設定部52は、図5の路面負荷トルクTrlとして、仮想バネ・ダンパ負荷Tvsdと、外乱トルク推定値^Tlcの高周波成分HPF(^Tlc)から操舵トルクTを減算した値{HPF(^Tlc)−T}との和{Tvsd+HPF(^Tlc)−T}とを用いる。
この場合には、図5のリファレンスEPSモデルの運動方程式は、次式(19)で表される。
・dθ/dt=T+N・T+{−k・θ−c(dθ/dt)}
+{HPF(^Tlc)−T
=N・T+{−k・θ−c(dθ/dt)}
+HPF(^Tlc) …(19)
指令値設定部52は、N・Tにアシストトルク指令値設定部51(図3参照)によって設定されるアシストトルク指令値Tacを代入して、式(19)の微分方程式を解くことにより、ロアコラムの回転角θを演算する。そして、指令値設定部52は、得られたロアコラムの回転角θを手動操舵指令値θmdacとして設定する。
第9変形例においても、第6変形例と同様な効果が得られる。
[第10変形例]
第10変形例では、指令値設定部52は、図5の路面負荷トルクTrlとして、仮想バネ・ダンパ負荷Tvsdと、外乱トルク推定値^Tlcの高周波成分HPF(^Tlc)から操舵トルクTおよび摩擦トルクTを減算した値{HPF(^Tlc)−T−T}との和{Tvsd+HPF(^Tlc)−T−T}を用いる。摩擦トルクTは、例えば、減速機19に発生する摩擦を推定する摩擦モデル等を用いて推定することができる。
この場合には、図5のリファレンスEPSモデルの運動方程式は、次式(20)で表される。
・dθ/dt=T+N・T+{−k・θ−c(dθ/dt)}
+{HPF(^Tlc)−T−T
=N・T+{−k・θ−c(dθ/dt)}
+HPF(^Tlc)−T …(20)
指令値設定部52は、N・Tにアシストトルク指令値設定部51(図3参照)によって設定されるアシストトルク指令値Tacを代入して、式(20)の微分方程式を解くことにより、ロアコラムの回転角θを演算する。そして、指令値設定部52は、得られたロアコラムの回転角θを手動操舵指令値θmdacとして設定する。
第10変形例においても、第6変形例と同様な効果が得られる。
[その他の変形例]
前述の第1変形例〜第10変形例のいずれかの変形例を採用する場合には、運転者がステアリングホイール2を把持していないと判定されたときに、操舵トルクTtbと、電動モータ18から出力軸9に作用するトルクN・Tと、外乱トルク推定値^Tlcに基づく推定トルクとを、それぞれ零に設定するようにしてもよい。
外乱トルク推定値^Tlcに基づく推定トルクとは、前記式(13)の^Tlc、前記式(14)の(^Tlc−T)、前記式(15)の(^Tlc−T−T)、前記式(16)のHPF(^Tlcf)、前記式(17)のHPF(^Tlc−T)、前記式(18)のHPF(^Tlc−T−T)、前記式(19)の{HPF(^Tlc)−T}または前記式(20)の{HPF(^Tlc)−T−T}をいう。
具体的には、図2および図3に一点鎖線で示すように、運転者がステアリングホイール2を把持している(ハンズオン)か、把持していない(ハンズオフ)かを判定するためのハンズオンオフ判定部48を設ける。ハンズオンオフ判定部48としては、ステアリングホイール2に設けられたタッチセンサの出力信号に基づいてハンズオンオフを判定するもの、車内に設けられたカメラの撮像画像に基づいてハンズオンオフを判定するもの等を用いることができる。なお、ハンズオンオフ判定部48としては、ハンズオンオフを判定できるものであれば、前述の構成以外のものを用いることができる。
ハンズオンオフ判定部48から出力されるハンズオンオフ判定信号は、指令値設定部52に与えられる。指令値設定部52は、ハンズオンオフ判定部48によって運転者がステアリングホイール2を把持していると判定されているときには、外乱トルク推定値^Tlcに基づく推定トルクを用いて手動操舵指令値θmdacを演算する。つまり、指令値設定部52は、前記式 (13)〜(20)のうちのいずれかに基づいて、手動操舵指令値θmdac(=θ)を演算する。
一方、ハンズオンオフ判定部48によって運転者がステアリングホイール2を把持していないと判定されているときには、指令値設定部52は、前記式(13)〜(20)のTtb、N・Tmcおよび外乱トルク推定値^Tlcに基づく推定トルクに、それぞれ零を代入して微分方程式を解くことによって手動操舵指令値θmdac(=θ)を演算する。
この変形例では、運転者が手動操舵を行っていない場合には、手動操舵指令値生成部41に入力される操舵トルクTtbが実質的に零にされるとともに、手動操舵指令値θmdacの演算に外乱トルク推定値^Tlcに基づく推定トルクが零にされる。これにより、運転者が手動操舵を行っていない場合に、ドライバトルク以外の外乱に基づいて、手動操舵指令値θmdacが設定されるのを防止することができる。
前述のその他の変形例では、運転者がステアリングホイール2を把持していないと判定されたときに、操舵トルクTtbと、電動モータ18から出力軸9に作用するトルクN・Tと、外乱トルク推定値^Tlcに基づく推定トルクとを、それぞれ零に設定している。しかし、運転者がステアリングホイール2を把持していないと判定されたときに、操舵トルクTtbと、電動モータ18から出力軸9に作用するトルクN・Tと、外乱トルク推定値^Tlcに基づく推定トルクのうち、外乱トルク推定値^Tlcに基づく推定トルクのみを零に設定してもよいし、操舵トルクTtbと外乱トルク推定値^Tlcに基づく推定トルクとを零に設定してもよい。
以上、この発明の一実施形態について説明したが、この発明はさらに他の形態で実施することもできる。例えば、前述の実施形態では、角度制御部44(図6参照)は、フィードフォワード制御部63を備えているが、フィードフォワード制御部63を省略してもよい。この場合には、フィードバック制御部62によって演算されるフィードバック制御トルクTfbが基本トルク指令値となる。
また、前述の実施形態において、外乱トルク推定部64は、モータトルク指令値Tとプラントの回転角θとに基づいて外乱トルク推定値^Tlcを演算しているが、電動モータ18が発生しているモータトルクを取得するモータトルク取得部を設け、このモータトルク取得部で取得したモータトルクをモータトルク指令値Tの代わりに用いてもよい。
また、前述の実施形態では、この発明をコラムタイプEPSのモータ制御に適用した場合の例を示したが、この発明は、コラムタイプ以外のEPSのモータ制御にも適用することができる。また、この発明は、ステアバイワイヤシステムの転舵角制御用の電動モータの制御にも適用することができる。
その他、この発明は、特許請求の範囲に記載された事項の範囲で種々の設計変更を施すことが可能である。
1…電動パワーステアリング装置、3…転舵輪、4…転舵機構、18…電動モータ、41…手動操舵指令値生成部、42…統合角度指令値演算部、43…制御部、44…角度制御部、45…トルク制御部、48…ハンズオンオフ判定部、51…アシストトルク指令値設定部、52…指令値設定部、61…ローパスフィルタ(LPF)、62…フィードバック制御部、63…フィードフォワード制御部、64…外乱トルク推定部(外乱オブザーバ)、65…トルク加算部、66…外乱トルク補償部

Claims (6)

  1. 舵角制御用の電動モータを駆動制御するためのモータ制御装置であって、
    操舵トルクを用いて手動操舵指令値を生成する手動操舵指令値生成部と、
    自動操舵指令値に前記手動操舵指令値を加算して、統合角度指令値を演算する統合角度指令値演算部と、
    前記統合角度指令値に基づいて、前記電動モータを角度制御する制御部とを含み、
    前記制御部は、
    前記統合角度指令値に基づいて、基本トルク指令値を演算する基本トルク指令値演算部と、
    前記電動モータの駆動対象に作用する前記電動モータのモータトルク以外の外乱トルクを推定する外乱トルク推定部と、
    前記基本トルク指令値を前記外乱トルクによって補正する外乱トルク補償部とを含み、
    前記手動操舵指令値生成部は、前記手動操舵指令値の生成に、前記外乱トルクに基づいて算出される推定トルクを用いることを特徴とするモータ制御装置。
  2. 前記手動操舵指令値生成部は、前記操舵トルクと、前記推定トルクとを用いて、前記手動操舵指令値を生成するように構成されている、請求項1に記載のモータ制御装置。
  3. 前記手動操舵指令値生成部は、前記操舵トルクと、仮想バネ・ダンパ負荷と、前記推定トルクとを用いて、前記手動操舵指令値を生成するように構成されている、請求項1に記載のモータ制御装置。
  4. 前記手動操舵指令値生成部は、前記操舵トルクと、仮想バネ・ダンパ負荷と、前記推定トルクの高周波成分とを用いて、前記手動操舵指令値を生成するように構成されている、請求項1に記載のモータ制御装置。
  5. 前記推定トルクが、前記外乱トルク、前記外乱トルクから前記操舵トルクを減算した値、ならびに前記外乱トルクから前記操舵トルクおよび所定の摩擦トルクを減算した値のうちのいずれか1つである、請求項2〜4のいずれか一項に記載のモータ制御装置。
  6. 前記推定トルクが、前記外乱トルクの高周波成分から前記操舵トルクを減算した値、または前記外乱トルクの高周波成分から前記操舵トルクおよび所定の摩擦トルクを減算した値である、請求項3に記載のモータ制御装置。
JP2018144000A 2018-07-31 2018-07-31 モータ制御装置 Active JP7116888B2 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
JP2018144000A JP7116888B2 (ja) 2018-07-31 2018-07-31 モータ制御装置
US16/521,659 US11383759B2 (en) 2018-07-31 2019-07-25 Motor control apparatus
CN201910676054.2A CN110775151B (zh) 2018-07-31 2019-07-25 马达控制装置
EP19189023.5A EP3608203B1 (en) 2018-07-31 2019-07-30 Motor control apparatus

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2018144000A JP7116888B2 (ja) 2018-07-31 2018-07-31 モータ制御装置

Publications (2)

Publication Number Publication Date
JP2020019346A true JP2020019346A (ja) 2020-02-06
JP7116888B2 JP7116888B2 (ja) 2022-08-12

Family

ID=67513346

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2018144000A Active JP7116888B2 (ja) 2018-07-31 2018-07-31 モータ制御装置

Country Status (4)

Country Link
US (1) US11383759B2 (ja)
EP (1) EP3608203B1 (ja)
JP (1) JP7116888B2 (ja)
CN (1) CN110775151B (ja)

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111516752A (zh) * 2020-04-22 2020-08-11 东风汽车集团有限公司 一种自动驾驶车辆的人机共驾转向控制方法
JP2021172337A (ja) * 2020-04-20 2021-11-01 カーアー グループ アーゲー スノーモービルのための改良された運転制御システム
WO2023062853A1 (ja) * 2021-10-13 2023-04-20 株式会社ジェイテクト モータ制御装置
WO2023079776A1 (ja) * 2021-11-08 2023-05-11 株式会社ジェイテクト モータ制御装置
WO2023079764A1 (ja) * 2021-11-08 2023-05-11 株式会社ジェイテクト モータ制御装置
WO2023084646A1 (ja) * 2021-11-10 2023-05-19 株式会社ジェイテクト 操舵装置
WO2023139808A1 (ja) * 2022-01-19 2023-07-27 株式会社ジェイテクト モータ制御装置
WO2023144895A1 (ja) * 2022-01-25 2023-08-03 株式会社ジェイテクト モータ制御装置
WO2024106377A1 (ja) * 2022-11-14 2024-05-23 株式会社ジェイテクト モータ制御装置

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11180186B2 (en) * 2018-04-05 2021-11-23 Steering Solutions Ip Holding Corporation Disturbance feedforward compensation for position control in steering systems
KR102110313B1 (ko) * 2018-10-05 2020-05-13 주식회사 만도 스티어 바이 와이어 조향 장치
JP7133452B2 (ja) * 2018-12-04 2022-09-08 株式会社ジェイテクト 転舵制御装置
US11014606B2 (en) * 2019-01-29 2021-05-25 Motional Ad Llc Electric power steering torque compensation
JP6828857B2 (ja) * 2019-01-31 2021-02-10 日本精工株式会社 車両の操舵に用いられるアクチュエータ制御装置
CN112623022B (zh) * 2020-12-18 2022-11-22 浙江合众新能源汽车有限公司 一种驾驶员脱手状态下抑制方向盘摆动的方法
JP2022175343A (ja) * 2021-05-13 2022-11-25 キヤノン株式会社 モータ制御システムおよびモータ制御システムの制御方法
US11718284B2 (en) * 2021-05-14 2023-08-08 Volvo Car Corporation Steering control system

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006001420A (ja) * 2004-06-17 2006-01-05 Aisin Seiki Co Ltd 車両のレーン走行支援装置
JP2008018825A (ja) * 2006-07-12 2008-01-31 Nsk Ltd 電動パワーステアリング装置の制御装置
JP2008273226A (ja) * 2007-04-25 2008-11-13 Mitsubishi Electric Corp 車両用操舵制御装置
WO2014162769A1 (ja) * 2013-04-04 2014-10-09 日本精工株式会社 電動パワーステアリング装置
JP2016088434A (ja) * 2014-11-10 2016-05-23 株式会社デンソー モータ制御装置
WO2016088705A1 (ja) * 2014-12-02 2016-06-09 日本精工株式会社 電動パワーステアリング装置
JP2017177944A (ja) * 2016-03-29 2017-10-05 株式会社Subaru 自動操舵装置

Family Cites Families (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001341658A (ja) * 2000-03-29 2001-12-11 Toyoda Mach Works Ltd 電動パワーステアリング装置の制御装置
JP4058362B2 (ja) 2003-02-27 2008-03-05 トヨタ自動車株式会社 自動操舵装置
CN101298256B (zh) * 2008-06-25 2011-01-19 河北工业大学 电动助力转向装置及其控制方法
US8880287B2 (en) * 2013-03-06 2014-11-04 GM Global Technology Operations LLC Steering-wheel-hold detection for lane keeping assist feature
JP6142733B2 (ja) 2013-08-26 2017-06-07 株式会社ジェイテクト 車両のパワーステアリング装置
JP2016020171A (ja) * 2014-07-15 2016-02-04 株式会社ジェイテクト 電動パワーステアリング装置
JP6769047B2 (ja) 2016-03-04 2020-10-14 株式会社ジェイテクト 操舵制御装置
FR3049257B1 (fr) * 2016-03-24 2019-04-26 Jtekt Europe Procede de gestion de direction assistee avec reconstruction indirecte de l'information de couple volant
WO2018021325A1 (ja) 2016-07-28 2018-02-01 日本精工株式会社 電動パワーステアリング装置
US10597072B2 (en) * 2016-11-11 2020-03-24 Nsk Ltd. Electric power steering apparatus

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006001420A (ja) * 2004-06-17 2006-01-05 Aisin Seiki Co Ltd 車両のレーン走行支援装置
JP2008018825A (ja) * 2006-07-12 2008-01-31 Nsk Ltd 電動パワーステアリング装置の制御装置
JP2008273226A (ja) * 2007-04-25 2008-11-13 Mitsubishi Electric Corp 車両用操舵制御装置
WO2014162769A1 (ja) * 2013-04-04 2014-10-09 日本精工株式会社 電動パワーステアリング装置
JP2016088434A (ja) * 2014-11-10 2016-05-23 株式会社デンソー モータ制御装置
WO2016088705A1 (ja) * 2014-12-02 2016-06-09 日本精工株式会社 電動パワーステアリング装置
JP2017177944A (ja) * 2016-03-29 2017-10-05 株式会社Subaru 自動操舵装置

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2021172337A (ja) * 2020-04-20 2021-11-01 カーアー グループ アーゲー スノーモービルのための改良された運転制御システム
JP7189262B2 (ja) 2020-04-20 2022-12-13 カーアー グループ アーゲー スノーモービルのための改良された運転制御システム
CN111516752A (zh) * 2020-04-22 2020-08-11 东风汽车集团有限公司 一种自动驾驶车辆的人机共驾转向控制方法
CN111516752B (zh) * 2020-04-22 2021-07-06 东风汽车集团有限公司 一种自动驾驶车辆的人机共驾转向控制方法
WO2023062853A1 (ja) * 2021-10-13 2023-04-20 株式会社ジェイテクト モータ制御装置
WO2023062748A1 (ja) * 2021-10-13 2023-04-20 株式会社ジェイテクト モータ制御装置
WO2023079776A1 (ja) * 2021-11-08 2023-05-11 株式会社ジェイテクト モータ制御装置
WO2023079764A1 (ja) * 2021-11-08 2023-05-11 株式会社ジェイテクト モータ制御装置
WO2023079765A1 (ja) * 2021-11-08 2023-05-11 株式会社ジェイテクト モータ制御装置
WO2023084646A1 (ja) * 2021-11-10 2023-05-19 株式会社ジェイテクト 操舵装置
WO2023139808A1 (ja) * 2022-01-19 2023-07-27 株式会社ジェイテクト モータ制御装置
WO2023144895A1 (ja) * 2022-01-25 2023-08-03 株式会社ジェイテクト モータ制御装置
WO2024106377A1 (ja) * 2022-11-14 2024-05-23 株式会社ジェイテクト モータ制御装置

Also Published As

Publication number Publication date
EP3608203A1 (en) 2020-02-12
US11383759B2 (en) 2022-07-12
CN110775151B (zh) 2023-05-12
EP3608203B1 (en) 2021-05-19
US20200039576A1 (en) 2020-02-06
JP7116888B2 (ja) 2022-08-12
CN110775151A (zh) 2020-02-11

Similar Documents

Publication Publication Date Title
JP7116888B2 (ja) モータ制御装置
JP7194326B2 (ja) モータ制御装置
JP7129004B2 (ja) モータ制御装置
JP7236037B2 (ja) 車両用操舵装置
CN110406589B (zh) 马达控制装置
JP7108961B2 (ja) 操舵装置
JP7093504B2 (ja) ドライバトルク推定装置およびそれを備えた操舵装置
CN112154092B (zh) 马达控制装置
JP2019098817A (ja) 車両用操舵装置
JP7129003B2 (ja) モータ制御装置
US20130060426A1 (en) Electric power steering control device
JP7256958B2 (ja) 電動パワーステアリング装置
US11745792B2 (en) Steering device
WO2023100369A1 (ja) モータ制御装置
JP2023048867A (ja) モータ制御装置
WO2023079776A1 (ja) モータ制御装置
WO2023286592A1 (ja) モータ制御装置
WO2023032010A1 (ja) 操舵装置
WO2023062748A1 (ja) モータ制御装置
WO2023079764A1 (ja) モータ制御装置
WO2023084646A1 (ja) 操舵装置
JP5040414B2 (ja) 電動パワーステアリング装置の制御装置
JP2011079521A (ja) 電動パワーステアリング装置の制御装置

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20210615

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20220621

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20220630

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20220713

R150 Certificate of patent or registration of utility model

Ref document number: 7116888

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150