IP Force 特許公報掲載プロジェクト 2022.1.31 β版

知財求人 - 知財ポータルサイト「IP Force」

▶ 株式会社デンソーの特許一覧

<>
  • 特許-制御装置 図1
  • 特許-制御装置 図2
  • 特許-制御装置 図3
  • 特許-制御装置 図4
  • 特許-制御装置 図5
  • 特許-制御装置 図6
  • 特許-制御装置 図7
  • 特許-制御装置 図8
  • 特許-制御装置 図9
  • 特許-制御装置 図10
  • 特許-制御装置 図11
  • 特許-制御装置 図12
  • 特許-制御装置 図13
  • 特許-制御装置 図14
  • 特許-制御装置 図15
  • 特許-制御装置 図16
  • 特許-制御装置 図17
  • 特許-制御装置 図18
< >
(19)【発行国】日本国特許庁(JP)
(12)【公報種別】特許公報(B2)
(11)【特許番号】
(24)【登録日】2024-03-04
(45)【発行日】2024-03-12
(54)【発明の名称】制御装置
(51)【国際特許分類】
   B60L 15/20 20060101AFI20240305BHJP
   B60K 1/00 20060101ALI20240305BHJP
   H02P 29/00 20160101ALI20240305BHJP
   B60W 10/04 20060101ALI20240305BHJP
   B60W 10/10 20120101ALI20240305BHJP
   B60W 10/08 20060101ALI20240305BHJP
   G05B 11/36 20060101ALI20240305BHJP
【FI】
B60L15/20 J
B60K1/00
H02P29/00
B60W10/00 104
B60W10/08
G05B11/36 B
G05B11/36 501P
【請求項の数】 10
(21)【出願番号】P 2020071256
(22)【出願日】2020-04-10
(65)【公開番号】P2021168563
(43)【公開日】2021-10-21
【審査請求日】2023-03-09
(73)【特許権者】
【識別番号】000004260
【氏名又は名称】株式会社デンソー
(74)【代理人】
【識別番号】100140486
【弁理士】
【氏名又は名称】鎌田 徹
(74)【代理人】
【識別番号】100170058
【弁理士】
【氏名又は名称】津田 拓真
(72)【発明者】
【氏名】石田 純
【審査官】清水 康
(56)【参考文献】
【文献】特開2013-223374(JP,A)
【文献】米国特許出願公開第2015/0127202(US,A1)
【文献】国際公開第2018/020679(WO,A1)
【文献】米国特許出願公開第2019/0337398(US,A1)
【文献】国際公開第2016/158720(WO,A1)
(58)【調査した分野】(Int.Cl.,DB名)
B60L 1/00 - 3/12
B60L 7/00 - 13/00
B60L 15/00 - 58/40
B60K 6/20 - 6/547
B60W 10/00 - 20/50
B60K 1/00
H02P 29/00
G05B 11/36
(57)【特許請求の範囲】
【請求項1】
動力伝達システム(10)の制御装置(100)であって、
前記動力伝達システムは、指令値に応じた力を発生させる力発生装置(11)と、駆動対象である負荷(15)と、前記力発生装置で発生した力を前記負荷に伝達するための部材である伝達部材(14)と、を有するものであり、
前記力発生装置の動作速度である第1速度を前記力発生装置に設けられたセンサの出力信号により取得する第1速度取得部(110)と、
前記第1速度に基づいて、前記伝達部材の変形速度である第2速度を推定する第2速度推定部(120)と、
前記第2速度に基づいて、前記指令値への補正値を算出する補正部(150)と、を備え、
前記第2速度推定部は、前記力発生装置で発生した力が前記負荷に伝わらない不感帯(13)、の存在を表現したモデルを用いて、前記第2速度を推定する制御装置。
【請求項2】
前記力発生装置の変位量と前記負荷の変位量との差、である変位差を推定する変位差推定部(140)を更に備え、
前記モデルは、前記変位差と、前記変位差に応じて変化するパラメータと、を用いて表現されており、
前記パラメータは、
前記変位差が所定範囲の下限値よりも小さい場合には、前記変位差の値によって変化しない一定値となり、
前記変位差が前記所定範囲に収まっている場合には、前記変位差に比例した値となり、
前記変位差が、前記所定範囲の上限値よりも大きい場合には、前記変位差の値によって変化しない一定値となる、請求項1に記載の制御装置。
【請求項3】
前記変位差推定部は、前記補正値により補正される前の前記指令値を用いて前記変位差を推定する、請求項2に記載の制御装置。
【請求項4】
前記変位差推定部は、前記補正値により補正された後の前記指令値を用いて前記変位差を推定する、請求項2に記載の制御装置。
【請求項5】
前記変位差推定部は、前記第1速度を用いて前記変位差を推定する、請求項2に記載の制御装置。
【請求項6】
前記負荷の動作速度である第3速度、を推定する第3速度推定部(130)を更に備え、
前記変位差推定部は、前記第1速度と、前記第3速度と、の両方を用いて前記変位差を推定する、請求項2に記載の制御装置。
【請求項7】
前記第2速度に対しフィルタ処理を施すフィルタ処理部(160)を更に備え、
前記補正部は、前記フィルタ処理が施された後の前記第2速度に基づいて、前記補正値を算出する、請求項1乃至6のいずれか1項に記載の制御装置。
【請求項8】
前記フィルタ処理部は、バンドパス特性を持つフィルタを用いて前記フィルタ処理を行う、請求項7に記載の制御装置。
【請求項9】
前記力発生装置は、電動車両の駆動力を発生させる回転電機であり、
前記伝達部材は、前記電動車両に設けられた駆動軸であり、
前記負荷は、前記回転電機の力が前記駆動軸を介して伝達される車輪を含む前記電動車両の車体である、請求項1乃至8のいずれか1項に記載の制御装置。
【請求項10】
前記電動車両における車輪のスリップ率を取得するスリップ率取得部(170)を更に備え、
前記補正部は、前記スリップ率に応じて、前記補正値の算出に必要な制御パラメータを変化させる、請求項9に記載の制御装置。
【発明の詳細な説明】
【技術分野】
【0001】
本開示は、動力伝達システムの制御装置に関する。
【背景技術】
【0002】
動力伝達システムは、力発生装置で発生させた力を、伝達部材を介して負荷に伝達することで、当該負荷を駆動するように構成されたシステムである。このような動力伝達システムは、例えば車両や工作機械等において広く用いられている。例えば電動車両用の動力伝達システムの場合には、回転電機が上記の「力発生装置」に該当し、ドライブシャフトが上記の「伝達部材」に該当し、車輪を含む電動車両の車体が上記の「負荷」に該当する。
【0003】
力発生装置は、制御装置からの指令値に応じた力を発生させる。制御装置は、フィードバック制御などによって当該指令値を調整することにより、負荷を適切に動作させる。例えば、下記特許文献1には、回転電機へのトルク指令値を、回転電機の回転速度等に基づき算出された補正値を用いて補正し、これによりトルク振動を抑制することのできる制御装置について記載されている。
【先行技術文献】
【特許文献】
【0004】
【文献】特開2010-288332号公報
【発明の概要】
【発明が解決しようとする課題】
【0005】
動力伝達システムにおいて、力発生装置の力を負荷に伝達する経路の途中には、例えばギヤのバックラッシやスプラインのガタのような、部材間の隙間が形成されていることが多い。このため、例えば、負荷の動作方向を反転させる場合等においては、一時的に、力発生装置で生じた力が負荷に伝達されない状態になってしまう。このように、力が負荷に伝達されない動作範囲のことを、以下では「不感帯」とも称する。
【0006】
動力伝達システムにおいて、力発生装置と負荷との相対的な位置関係が上記の不感帯を通過する際においては、負荷に伝達される力の大きさが急激に変化する。このため、不感帯の存在は、伝達部材等における振動を引き起こす。
【0007】
しかしながら、上記特許文献1に記載された制御装置では、制御対象のモデルにおいて不感帯の存在が考慮されていない。このため、当該制御装置によって、車両における振動の発生を十分に抑制することは難しいと考えられる。
【0008】
本開示は、動力伝達システムにおける振動の発生を十分に抑制することのできる制御装置、を提供することを目的とする。
【課題を解決するための手段】
【0009】
本開示に係る制御装置は、動力伝達システム(10)の制御装置(100)である。制御対象である動力伝達システムは、指令値に応じた力を発生させる力発生装置(11)と、駆動対象である負荷(15)と、力発生装置で発生した力を負荷に伝達するための部材である伝達部材(14)と、を有するものである。この制御装置は、力発生装置の動作速度である第1速度を取得する第1速度取得部(110)と、第1速度に基づいて、伝達部材の変形速度である第2速度を推定する第2速度推定部(120)と、第2速度に基づいて、指令値への補正値を算出する補正部(150)と、を備える。第2速度推定部は、力発生装置で発生した力が負荷に伝わらない不感帯(13)、の存在を表現したモデルを用いて、第2速度を推定する。
【0010】
このような構成の制御装置では、不感帯の存在を表現したモデルを用いて、伝達部材の変形速度である第2速度が推定され、この第2速度に基づいて、指令値への補正値が算出される。不感帯を考慮した適切な補正値によって指令値が補正されるので、不感帯に起因した振動の発生を十分に抑制することが可能となる。
【発明の効果】
【0011】
本開示によれば、動力伝達システムにおける振動の発生を十分に抑制することのできる制御装置、が提供される。
【図面の簡単な説明】
【0012】
図1図1は、動力伝達システムの構成例を模式的に示す図である。
図2図2は、第1実施形態に係る制御装置の構成を模式的に示す図である。
図3図3は、不感帯の表現方法について説明するための図である。
図4図4は、第1実施形態に係る制御装置により実行される処理を説明するためのブロック図である。
図5図5は、第1実施形態に係る制御装置により実行される処理を説明するためのブロック図である。
図6図6は、第1実施形態に係る制御装置により実行される処理を説明するためのブロック図である。
図7図7は、回転電機のトルクの時間変化等を示すタイムチャートである。
図8図8は、第2実施形態に係る制御装置により実行される処理を説明するためのブロック図である。
図9図9は、第3実施形態に係る制御装置により実行される処理を説明するためのブロック図である。
図10図10は、第3実施形態に係る制御装置により実行される処理を説明するためのブロック図である。
図11図11は、第4実施形態に係る制御装置により実行される処理を説明するためのブロック図である。
図12図12は、第4実施形態に係る制御装置により実行される処理を説明するためのブロック図である。
図13図13は、第5実施形態に係る制御装置の構成を模式的に示す図である。
図14図14は、第5実施形態に係る制御装置により実行される処理を説明するためのブロック図である。
図15図15は、第6実施形態に係る制御装置の構成を模式的に示す図である。
図16図16は、第6実施形態に係る制御装置により実行される処理を説明するためのブロック図である。
図17図17は、第6実施形態に係る制御装置により実行される処理を説明するためのブロック図である。
図18図18は、動力伝達システムの他の構成例を模式的に示す図である。
【発明を実施するための形態】
【0013】
以下、添付図面を参照しながら本実施形態について説明する。説明の理解を容易にするため、各図面において同一の構成要素に対しては可能な限り同一の符号を付して、重複する説明は省略する。
【0014】
第1実施形態について説明する。本実施形態に係る制御装置100は、動力伝達システム10を制御するための装置として構成されている。制御装置100の説明に先立ち、制御対象である動力伝達システム10の構成について先ず説明する。
【0015】
図1には、動力伝達システム10の一般的な構成が模式的に示されている。本実施形態の動力伝達システム10は、力発生装置11と、減速要素12と、不感帯要素13と、捩りばね要素14と、負荷15と、を有している。
【0016】
力発生装置11は、回転力を発生させる装置であって、具体的には回転電機である。力発生装置11は、制御装置100から送信される指令値に応じた回転力(つまりトルク)を発生させる。このような構成を実現するために、指令値を、力発生装置11に供給される電流に変換するためのドライバが設けられているのであるが、図1においてはその図示が省略されている。力発生装置11で生じる回転力のことを、以下では「T」とも表記する。
【0017】
力発生装置11は出力軸を有しており、当該出力軸が後述の減速要素12へと繋がっている。出力軸は、力発生装置11で発生した回転力を外部に出力するための回転軸となっている。出力軸の回転速度、具体的には出力軸の回転角周波数のことを、以下では「ω]とも表記する。ωは、力発生装置11の動作速度であり、本実施形態における「第1速度」に該当する。また、出力軸のイナーシャのことを以下では「J」とも表記し、出力軸が回転する際に受ける粘性摩擦力の粘性摩擦係数のことを以下では「B」とも表記する。
【0018】
減速要素12は、力発生装置11の出力軸の回転速度を減速して、後述の捩りばね要素14へと出力するための装置である。減速要素12の減速比のことを、以下では「N」とも表記する。捩りばね要素14の回転速度は、力発生装置11の出力軸の回転速度の1/Nということになる。尚、減速要素12は必須のものではない。力発生装置11で発生した回転力が、後述の捩りばね要素14へと直接伝達される構成としてもよい。
【0019】
不感帯要素13は、力発生装置11から捩りばね要素14までの力の伝達経路における、部材間の隙間を模式的に表すものである。このような「隙間」としては、例えば、ギヤのバックラッシやスプラインのガタ等が挙げられる。不感帯要素13が存在することで、負荷15の動作方向を反転させる場合等において、一時的に、力発生装置11で生じた力が負荷15に伝達されない状態となる。このように、力が負荷に伝達されない動作範囲のことを、以下では「不感帯」とも称する。力発生装置11の出力軸と、捩りばね要素14との間の相対的な回転角において、不感帯となる角度範囲の1/2の大きさのことを、以下では「θBL」とも表記する。すなわち、上記の相対的な回転角が最大でθBL×2となる範囲において、力が負荷15に伝達されないことがある。
【0020】
捩りばね要素14は、力発生装置11で発生した回転力を負荷15に伝達するための要素である。捩りばね要素14は、本実施形態における「伝達部材」に該当する。力発生装置11の駆動力を負荷15に伝達する際においては、捩りばね要素14では捩れが生じる。捩りばね要素14の捩れ剛性のことを、以下では「K」とも表記する。
【0021】
負荷15は、動力伝達システム10の駆動対象となる部分である。上記のように、力発生装置11で発生した回転力は、減速要素12や捩りばね要素14を介して負荷15に伝達され、負荷15を回転させる。負荷15の動作速度、具体的には負荷15の回転角周波数のことを、以下では「ω]とも表記する。ωは、本実施形態における「第3速度」に該当する。また、負荷15が捩りばね要素14から受ける回転力のことを以下では「T」とも表記し、負荷15のイナーシャのことを以下では「JL0」とも表記し、負荷15が回転する際に受ける粘性摩擦力の粘性摩擦係数のことを、以下では「B」とも表記する。更に、負荷15が外部から受ける回転力のことを、以下では「T」とも表記する。
【0022】
本実施形態では、動力伝達システム10及び制御装置100のそれぞれが、電動車両EVに搭載される装置として構成されている。力発生装置11は、本実施形態の場合、電動車両EVを走行させるための駆動力を発生させる回転電機(モータージェネレータ)である。また、捩りばね要素14に該当する部材は、本実施形態の場合、電動車両EVが有する駆動軸である。
【0023】
負荷15は、本実施形態の場合、電動車両EVの車体である。尚、車体のうち実際に回転動作するのは、電動車両EVの車輪であるから、負荷15は当該車輪ということもできる。ただし、電動車両EVの通常の走行時においては、負荷15のイナーシャであるJL0として、電動車両EVの車体全体の質量を車輪のイナーシャに換算した値が用いられる。一方、電動車両EVの車輪が地面に接触していない状態で空転する場合においては、負荷15のイナーシャであるJL0として、電動車両EVが有する車輪の実際のイナーシャが用いられる。
【0024】
尚、以上のような動力伝達システム10の適用はあくまで一例である。図1に示される動力伝達システム10は、電動車両EV以外の様々な装置に適用することができる。
【0025】
ここで、上記構成の動力伝達システム10に対し、従来の制御装置により行われていた制御の概要について説明する。
【0026】
力発生装置11の出力軸の回転について、運動方程式は以下の式(1)となる。
【数1】
【0027】
式(1)の「s」は微分演算子である。以降に示す各式においても、微分演算子として「s」の表記を用いる。
【0028】
負荷15の回転について、運動方程式は以下の式(2)となる。
【数2】
【0029】
ここで、力発生装置11の変位量と、負荷15の変位量と、の間の差のことを、以下では「θ」と表記する。θのことを、以下では「変位差」とも称することがある。本実施形態の場合、上記の「変位量」とは回転角のことを示す。
【0030】
従来の制御においては、先に述べた不感帯要素13の存在を考慮することなくシステムがモデル化されていた。この場合、θとTとの関係は以下の式(3)により表されることとなる。
【数3】
【0031】
変位差であるθは、ωとωとを用いて、以下の式(4)により表される。
【数4】
【0032】
先に述べたように、変位差は、力発生装置11の変位量と、負荷15の変位量と、の間の差として定義される。式(4)を見ると明らかなように、「力発生装置11の変位量」としては、減速要素12により減速された後の変位量が用いられる。本実施形態ように減速要素12が設けられている構成においては、力発生装置11と減速要素12とを組み合わせたものの全体を、「力発生装置」と捉えることもできる。減速要素12が設けられていない場合には、式(4)におけるNの値を1とすればよい。いずれの場合であっても、「力発生装置11の変位量」とは、力発生装置11で発生した力を伝達部材に伝達する部分の変位量を意味する。
【0033】
θを微分した値、すなわち「sθ」の値のことを、以下では「ω」と表記する。ωは、伝達部材である捩りばね要素14の変形速度ということができる。ωは、本実施形態における「第2速度」に該当する。式(4)を変形すれば、ωは以下の式(5)により表される。
【数5】
【0034】
尚、実際の動力伝達システム10には不感帯が存在する点に鑑みれば、式(5)で算出されるωは、捩りばね要素14の実際の変形速度からずれてしまうことがある。ただし、現在説明している従来の制御においては、上記のようなずれは考慮されない。
【0035】
以上に挙げた式(1)乃至(5)によれば、TとTとの関係を表す以下の式(6)を導くことができる。
【数6】
【0036】
式(6)に示されるaやa等の係数は、以下の式(7)乃至(12)により表されるものである。
【数7】
【0037】
簡略化のために、粘性摩擦を表すB及びBの項を無視すると、式(6)は以下の式(13)のように変形される。
【数8】
【0038】
式(13)における「ω」は、捩りばね要素14の振動における共振周波数であり、以下の式(14)により表されるものである。
【数9】
【0039】
ここで、式(13)のTから所定のフィードバック項を減算し、これによりTの振動を抑制することについて検討する。上記のフィードバック項として、KFBsTを用いると、式(13)は以下の式(15)となる。尚、KFBはフィードバックのゲインに該当する。
【数10】
【0040】
式(15)は更に、以下の式(16)のように変形することができる。
【数11】
【0041】
ここで、KFBの値を、以下の式(17)で示される値に設定する。
【数12】
【0042】
この場合、式(16)は更に、以下の式(18)のように変形することができる。
【数13】
【0043】
式(18)の右辺分母は、KFBの値を式(17)のように設定することで、Tの振動における減衰係数が1となること、すなわち、捩りばね要素14の振動が十分に抑制されるようになることを示している。
【0044】
尚、式(15)においてTから減算されるフィードバック項は、上記とは異なる形の項であってもよい。
【0045】
その一例を以下に示す。式(3)の両辺を微分すると、以下の式(19)が得られる。
【数14】
【0046】
この場合、フィードバック項であるKFBsTを「KFB’ω」と表現すると、KFB’は以下の式(20)によって表される。
【数15】
【0047】
従って、式(20)で表されるKFB’に対し、ωを乗算したものをフィードバック項として用いた場合でも、捩りばね要素14の振動を十分に抑制することが可能となる。
【0048】
以上に述べたように、従来の制御においては、上記のようにωを含むフィードバック項を用いて振動を抑制することができる。しかしながら、動力伝達システム10を表す実際のモデルには、不感帯要素13が存在するので、式(5)で算出されるωが、捩りばね要素14の実際の変形速度からずれてしまうことがある。このため、以上に述べた従来の制御では、不感帯の存在に起因した振動を十分に抑制することは難しい。そこで、本実施形態に係る制御装置100は、不感帯の存在を表現したモデルを用いてフィードバック項を算出することで、従来よりも振動を抑制することとしている。
【0049】
本実施形態に係る制御装置100の構成について、図2を参照しながら説明する。制御装置100は、CPU、ROM、RAM等を有するコンピュータシステムとして構成されている。制御装置100は、その機能を表すブロック要素として、第1速度取得部110と、第2速度推定部120と、第3速度推定部130と、変位差推定部140と、補正部150と、を備えている。
【0050】
第1速度取得部110は、力発生装置11の動作速度である第1速度を取得する処理を行う部分である。先に述べたように、本実施形態ではωが第1速度に該当する。本実施形態では、力発生装置11に、ωを測定するための不図示のセンサが設けられている。第1速度取得部110は、当該センサから出力される信号に基づいてωの値を取得する。
【0051】
このような態様に替えて、第1速度取得部110が、他の物理量に基づいてωの値を推定し、これにより第1速度を取得する構成としてもよい。例えば、本実施形態のように力発生装置11が回転電機である場合には、力発生装置11では出力軸の回転に伴い、誘起電圧が変動することが知られている。このため、第1速度取得部110が、力発生装置11における誘起電圧の変動周期に基づいて、ωの値を推定し取得することとしてもよい。
【0052】
第2速度推定部120は、第1速度取得部110で取得された第1速度に基づいて、伝達部材の変形速度である第2速度を推定する処理を行う部分である。先に述べたように、本実施形態ではωが第2速度に該当する。第2速度推定部120がωの値を推定するための具体的な方法については、後に説明する。
【0053】
第3速度推定部130は、負荷15の動作速度である第3速度、を推定する処理を行う部分である。先に述べたように、本実施形態ではωが第3速度に該当する。第3速度推定部130がωの値を推定する具体的な方法については、後に説明する。
【0054】
変位差推定部140は、力発生装置11の変位量と負荷15の変位量との差、である変位差を推定する処理を行う部分である。先に述べたように、本実施形態ではθが変位差に該当する。変位差推定部140がθの値を推定するための具体的な方法については、後に説明する。
【0055】
補正部150は、第2速度推定部120で推定された第2速度に基づいて、力発生装置11に向けて送信される指令値への補正値を算出する処理を行う部分である。後に説明するように、補正部150により算出された補正値は、補正前の指令値から減算される。減算後の値が、力発生装置11に送信される最終的な指令値となる。力発生装置11に送信される最終的な指令値、すなわち、上記補正が行われた後の指令値のことを、以下では「T **」とも表記する。また、上記補正が行われる前の指令値のことを、以下では「T 」とも表記する。補正部150が補正値を算出するための具体的な方法については、後に説明する。
【0056】
制御装置100により行われる制御の概要について説明する。本実施形態の制御では、不感帯の存在を表現したモデルが用いられる。このため、Tは、先に述べた式(3)ではなく、以下の式(21)により表される。
【数16】
【0057】
式(21)におけるθは、捩りばね要素14の捩れ角を表している。θは、捩りばね要素14が捻じれる方向に変形した際の、一旦側の回転角と他端側の回転角との差(つまり位相差)、ということもできる。
【0058】
不感帯要素13の存在により、θとθとの関係は、図3(A)に示されるような関係となる。θの値が、-θBLからθBLまでの所定範囲に収まっているときには、θの値によることなくθは0となる。それ以外のときには、θの増加に伴い、θは傾きが1の直線に沿って増加する。
【0059】
θの値に応じて、図3(A)のように変化するθを表現するために、本実施形態では、sat(θ)というパラメータを用いる。図3(B)には、θと、これに応じて変化するsat(θ)との関係が示されている。同図に示されるように、変位差であるθが上記所定範囲の下限値(-θBL)よりも小さい場合には、sat(θ)は、θの値によって変化しない一定値(-θBL)となる。θが、上記所定範囲に収まっている場合には、θの増加に伴い、sat(θ)は傾きが1の直線に沿って増加する。つまり、sat(θ)はθに比例した値となる。θが、上記所定範囲の上限値(θBL)よりも大きい場合には、sat(θ)は、θの値によって変化しない一定値(θBL)となる。以上のように定義されるパラメータsat(θ)を式によって表すと、以下の式(22)となる。
【数17】
【0060】
sat(θ)を用いると、図3(A)のように変化するθは、以下の式(23)により表される。
【数18】
【0061】
また、式(21)と式(23)から、Tを以下の式(24)のように表すこともできる。
【数19】
【0062】
これまでに説明した式(1)、式(2)、式(4)、式(22)、式(23)、式(24)によれば、ωを表す式(25)、及びθを表す式(26)を、T=0という条件の下で、それぞれ以下のように導くことができる。
【数20】
【数21】
【0063】
式(25)及び式(26)に示されるaやa等の係数は、先に挙げた式(7)乃至(10)と、以下の式(27)乃至(32)とにより表されるものである。
【数22】
【0064】
式(25)の右辺において、ωに掛かる係数の全体をA(s)と表記し、sat(θ)に掛かる係数の全体をB(s)と表記すると、式(25)は以下の式(33)のように表される。
【数23】
【0065】
同様に、式(26)の右辺において、Tに掛かる係数の全体をC(s)と表記し、sat(θ)に掛かる係数の全体をD(s)と表記すると、式(26)は以下の式(34)のように表される。
【数24】
【0066】
本実施形態に係る制御装置100は、式(33)及び式(34)に示される関係を用いて、ωやθの値を推定し、更に、T から減算されるべき補正値を算出するように構成されている。
【0067】
制御装置100により実行される処理の具体的な内容について説明する。図4に示されるブロック図は、制御装置100が行う制御の全体を表すものとなっている。同図のブロックB01は、上位の制御装置(不図示)から入力されるトルク指令値TM0に基づいて、フィードフォワード補償を行う部分である。ブロックB01は、TM0に基づいてT を算出し出力する。尚、ブロックB01で行われるフィードフォワード補償の処理としては、公知の処理を用いることができる。
【0068】
尚、フィードフォワード補償を行うブロックB01は必須ではなく、ブロックB01が存在しない態様としてもよい。この場合、上位の制御装置から、TM0が直接減算器B02へと入力されることとなる。
【0069】
ブロックB01から出力されたT は、減算器B02へと入力される。減算器B02では、ブロックB01から入力されたT から、後述のブロックB04から入力されるTFBを減算することで、T **を算出する処理が行われる。TFBは、先に述べた補正部150により算出される補正値である。T は補正前の指令値であり、T **は補正後の指令値である。つまり、減算器B02で行われる上記処理は、補正前の指令値T から補正値TFBを減算することで、補正後の指令値T **を算出する処理である。当該処理により算出されたT **は、ブロックB03へと入力される。
【0070】
ブロックB03は、制御対象である動力伝達システム10(つまり実プラント)を示すものである。ブロックB03は、補正後のトルク指令値であるT **の入力を受けて、ωを出力するブロックとして表現されている。ブロックB03から出力されるωの値は、不図示のセンサにより測定された実測値である。ωはブロックB04へと入力される。
【0071】
ブロックB04は、入力されたωに基づきフィードバック補償を行う部分である。ブロックB04は、ωに基づいて上記のTFBを算出し、これを減算器B02へと入力する。
【0072】
図5では、ブロックB04で行われる処理の内容が、更に具体的なブロック図として示されている。同図に示されるように、ブロックB03からブロックB04へと入力されるωは、ブロックB04が有するブロックB13及びブロックB14のそれぞれへと入力される。
【0073】
ブロックB13では、入力されたωを、減速要素12の減速比Nで除する処理が行われる。当該処理により得られた値は、ブロックB13から後述の減算器B16へと入力される。
【0074】
ブロックB14では、入力されたωに対し、式(33)のA(s)による演算を施す処理が行われる。当該処理により得られた値、すなわちA(s)ωは、ブロックB14から後述の加算器B15へと入力される。
【0075】
ブロックB04には、補正前のトルク指令値であるT も入力される。T は、ブロックB04が有するブロックB11へと入力される。ブロックB11では、入力されたT に基づいて、sat(θ)の推定値を算出する処理が行われる。
【0076】
図6には、ブロックB11で行われる上記処理の内容が、更に具体的なブロック図として示されている。同図に示されるように、ブロックB11へと入力されるT は、ブロックB11が有するブロックB21へと入力される。
【0077】
ブロックB21では、入力されたT に対し、式(34)のC(s)による演算を施す処理が行われる。当該処理により得られた値、すなわちC(s)T は、ブロックB21から加算器B22へと入力される。
【0078】
加算器B22では、ブロックB21から入力されるC(s)T に対し、後述のブロックB24から入力されるD(s)sat(θ)を加算する処理が行われる。式(34)から明らかなように、当該処理により得られる値はθの推定値、すなわち変位差の推定値となる。以上のようにθの値を推定する処理は、変位差推定部140によって行われる。加算器B22において算出されたθの推定値は、ブロックB23へと入力される。
【0079】
ブロックB23では、入力されたθの推定値に基づいて、sat(θ)の推定値を算出する処理が行われる。当該処理は式(22)を用いて行われる。
【0080】
ブロックB23で算出されたsat(θ)の推定値は、図5のブロックB12に入力されると共に、ブロックB24にも入力される。ブロックB24では、入力されたsat(θ)に対し、式(34)のD(s)による演算を施す処理が行われる。当該処理により得られた値、すなわちD(s)sat(θ)は、ブロックB24から加算器B22へと入力された後、先に述べたようにθの推定値の算出に供される。
【0081】
図5に戻って説明を続ける。上記のように算出されたsat(θ)の推定値は、ブロックB11からブロックB12へと入力される。ブロックB12では、入力されたsat(θ)の推定値に対し、式(33)のB(s)による演算を施す処理が行われる。当該処理により得られた値、すなわちB(s)sat(θ)は、ブロックB12から加算器B15へと入力される。
【0082】
加算器B15では、ブロックB14から入力されたA(s)ωに、ブロックB12から入力されたB(s)sat(θ)を加算する処理が行われる。式(33)から明らかなように、当該処理により得られる値はωの推定値、すなわち第3速度の推定値となる。以上のようにωの値を推定する処理は、第3速度推定部130によって行われる。加算器B15において算出されたωの推定値は、減算器B16へと入力される。
【0083】
減算器B16では、ブロックB13から入力されたω/Nから、加算器B15から入力されたωの推定値を減算する処理が行われる。式(5)から明らかなように、当該処理により得られる値はωの推定値、すなわち第2速度の推定値となる。以上のようにωの値を推定する処理は、第2速度推定部120によって行われる。減算器B16において算出されたωの推定値は、ブロックB17へと入力される。
【0084】
ブロックB17では、入力されたωの推定値に対し、フィードバックゲインであるKFBを乗算する処理が行われる。当該処理により得られる値は、図4に示されるTFB、すなわち補正値である。尚、KFBの値としては、例えば、式(20)に示されるKFB’の値を用いることができるが、これに限定されることなく種々の値を用いることができる。以上のように補正値TFBを算出する処理は、補正部150によって行われる。ブロックB17で算出されたTFBは、先に述べたように図4の減算器B02へと入力され、T **の算出に供される。
【0085】
以上のように、本実施形態に係る制御装置100では、第2速度推定部120が、力発生装置11で発生した力が負荷15に伝わらない不感帯、の存在を表現したモデルを用いて、第2速度であるωを推定するように構成されている。「不感帯の存在を表現したモデル」は、本実施形態におけるブロックB04が該当する。ブロックB04は、上記のモデルを、変位差であるθと、θに応じて変化するsat(θ)と、を用いて表現されている。
【0086】
「不感帯の存在を表現したモデル」とは、本実施形態の場合、図3(A)のように変化するθ、もしくは図3(B)のように変化するsat(θ)、のうちの少なくとも一方を内部で算出可能なモデル、ということもできる。ただし、不感帯の存在の具体的な表現方法は、上記とは異なるものであってもよい。
【0087】
本実施形態では、不感帯の存在を表現したモデルを用いてωが推定されるので、不感帯を通過するような動作時においても、ωの推定値と、捩りばね要素14の実際の変形速度と、の間が大きく乖離してしまうことがない。このため、ブロックB17においては、正確なωの値に基づいて適切なTFBを算出し、伝達部材等における振動の発生を十分に抑制することができる。
【0088】
本実施形態の変位差推定部140は、補正値TFBにより補正される前の指令値、すなわちT を用いて、図6のブロック図に基づき変位差θを推定する。T は制御装置100により算出されるものであるから、測定ノイズ等の影響を受けることなく安定して変位差θを推定することができる。
【0089】
図7(A)、(C)、(E)には、従来の制御が行われた場合における、各測定値の時間変化の例が示されている。このうち、図7(A)に示されるのは、力発生装置11で生じる回転力の実測値、すなわちTの時間変化の例である。図7(C)に示されるのは、負荷15が捩りばね要素14から受ける回転力、すなわちTの時間変化の例である。図7(E)に示されるのは、力発生装置11の動作速度、すなわちωの時間変化の例である。
【0090】
図7(A)、(C)、(E)に示される例においては、時刻t0に、それまで減速していた電動車両EVを加速へと切り換える制御が行われている。図7(C)に示される点線DL3は、上位から送信されるトルク指令値(つまりTM0)の時間変化を示している。
【0091】
図7(C)に示されるように、時刻t0以降においてTは増加し、時刻t1において一旦0となる。その後、Tは、時刻t1から時刻t2までの期間において0のままとなっており、時刻t2以降においては再び増加している。このように、時刻t1から時刻t2までの期間においてTの値が0となるのは、動力伝達システム10が不感帯を有していることに起因している。従来の制御においては、このような不感帯の存在が考慮されていないので、図7(A)に示されるT図7(C)に示されるT、及び図7(E)に示されるωのそれぞれが、時刻t0以降において比較的大きく振動してしまっている。
【0092】
図7(A)に示される点線DL1は、減速から加速への切り換えが行われた後、Tの振動が減衰し概ね一定となった状態における、Tの平均値を示している。従来の制御においては、Tの値が点線DL1を上回る程度に大きく振動してしまっている。
【0093】
図7(B)、(D)、(F)には、制御装置100によりこれまで説明した制御が行われた場合における、各測定値の時間変化の例が示されている。このうち、図7(B)に示されるのは、力発生装置11で生じる回転力の実測値、すなわちTの時間変化の例である。図7(D)に示されるのは、負荷15が捩りばね要素14から受ける回転力、すなわちTの時間変化の例である。図7(F)に示されるのは、力発生装置11の動作速度、すなわちωの時間変化の例である。
【0094】
図7(B)、(D)、(F)に示される例においても、先の従来例と同様に、時刻t0に、それまで減速していた電動車両EVを加速へと切り換える制御が行われている。図7(D)に示される点線DL4は、上位から送信されるトルク指令値(つまりTM0)の時間変化を示している。当該時間変化は、図7(C)の点線DL3で示されるものと同じ時間変化となっている。
【0095】
図7(D)の例でも、時刻t1から時刻t2までの期間において、不感帯の影響によりTの値が0となっている。しかしながら、図7(A)と図7(B)、図7(C)と図7(D)、及び図7(E)と図7(F)をそれぞれ比較すると明らかなように、本実施形態の制御によれば、T、T、ωのそれぞれで生じる振動が、従来に比べて十分に抑制されていることがわかる。
【0096】
図7(B)に示される点線DL2は、減速から加速への切り換えが行われた後、Tの振動が減衰し概ね一定となった状態における、Tの平均値を示している。本実施形態の制御においては、Tの振動が充分に抑制される結果、Tの値が常に点線DL2以下に抑えられている。
【0097】
第2実施形態について説明する。以下では、第1実施形態と異なる点について主に説明し、第1実施形態と共通する点については適宜説明を省略する。
【0098】
図8に示されるブロック図は、本実施形態に係る制御装置100が行う制御の内容を、図5と同様の方法により描いたものである。本実施形態では、ブロックB11にT が入力されず、替わりにT **が入力される。つまり、本実施形態のブロックB11には、補正前のトルク指令値ではなく、補正後のトルク指令値が入力される。
【0099】
ブロックB11では、入力されたT **に基づいてsat(θ)の推定値を算出する処理が行われる。その算出方法は、図6を参照しながら説明した第1実施形態の算出方法において、T をT **に置き換えたものに等しい。
【0100】
以上のように、本実施形態の変位差推定部140は、補正値TFBにより補正された後の指令値、すなわちT **を用いて、図6のブロック図に基づき変位差θを推定する。T **は、実プラントを示すブロックB03に入力されるトルク指令値であるから、T に比べて、実際のトルクにより近い値となっている。このため、本実施形態では更に正確に変位差θを推定することができる。
【0101】
第3実施形態について説明する。以下では、第1実施形態と異なる点について主に説明し、第1実施形態と共通する点については適宜説明を省略する。
【0102】
図9に示されるブロック図は、本実施形態に係る制御装置100が行う制御の内容を、図5と同様の方法により描いたものである。本実施形態では、ブロックB11にT が入力されず、替わりにωが入力される。つまり、本実施形態のブロックB11には、第1速度取得部110により取得された第1速度が入力される。
【0103】
ブロックB11では、入力されたωに基づいてsat(θ)の推定値を算出する処理が行われる。その算出方法を説明するに先立ち、sat(θ)の算出のために必要となる式の導出について先ず説明する。
【0104】
先に説明した式(1)、式(2)、式(4)、式(22)、式(23)、式(24)によれば、ωを表す式(35)を以下のように導くことができる。
【数25】
【0105】
式(35)に示されるaやa等の係数は、先に挙げた式(7)乃至(10)と、以下の式(36)乃至(41)とにより表されるものである。
【数26】
【0106】
式(35)の右辺において、Tに掛かる係数の全体をE(s)と表記し、sat(θ)に掛かる係数の全体をF(s)と表記すると、式(35)は以下の式(42)のように表される。
【数27】
【0107】
また、式(42)変形することで、Tを以下の式(43)のように表すこともできる。
【数28】
【0108】
図10を参照しながら、本実施形態におけるsat(θ)の算出方法について説明する。図10には、本実施形態のブロックB11で行われる処理の内容が、具体的なブロック図として示されている。同図に示されるように、ブロックB11へと入力されるωは、ブロックB11が有する減算器B31へと入力される。
【0109】
減算器B31では、上記のように入力されたωから、後述のブロックB33で算出されたF(s)sat(θ)の値を減算する処理が行われる。当該処理の結果算出された値、すなわち「ω-F(s)sat(θ)」の値は、ブロックB32へと入力される。
【0110】
ブロックB32では、入力された「ω-F(s)sat(θ)」の値に対し、式(42)のE(s)を用いて、1/E(s)による演算を施す処理が行われる。当該処理により得られた値は、ブロックB32からブロックB21へと入力される。式(43)から明らかなように、ブロックB21に入力される値はTの推定値となる。
【0111】
ブロックB21、B22、B23、B24では、図6を参照しながら説明したものと同様の演算が行われる。すなわち、加算器B22ではθの値を推定する処理が変位差推定部140により行われ、ブロックB23ではsat(θ)の値を推定する処理が行われる。ブロックB23で算出されたsat(θ)の推定値は、第1実施形態と同様に図9のブロックB12に入力される他、ブロックB33にも入力される。ブロックB33では、入力されたsat(θ)に対し、式(42)のF(s)による演算を施す処理が行われる。当該処理により得られた値、すなわちF(s)sat(θ)は、先に述べたようにブロックB33から減算器B31へと入力される。
【0112】
以上のように、本実施形態の変位差推定部140は、第1速度であるωを用いて変位差θを推定する。これにより、センサにより測定されたωに基づいて、θの値をより正確に推定することができる。
【0113】
第4実施形態について説明する。以下では、第1実施形態と異なる点について主に説明し、第1実施形態と共通する点については適宜説明を省略する。
【0114】
図11に示されるブロック図は、本実施形態に係る制御装置100が行う制御の内容を、図5と同様の方法により描いたものである。本実施形態では、ブロックB11にT が入力されず、替わりにωとωが入力される。ブロックB11に入力されるωは、加算器B15における演算の結果として算出されたω、すなわち、第3速度推定部130により推定された負荷15の動作速度(つまり第3速度)である。また、ブロックB11に入力されるωは、第1速度取得部110により取得された第1速度である。
【0115】
ブロックB11では、入力されたω及びωに基づいてsat(θ)の推定値を算出する処理が行われる。
【0116】
図12を参照しながら、本実施形態におけるsat(θ)の算出方法について説明する。図12には、本実施形態のブロックB11で行われる処理の内容が、具体的なブロック図として示されている。同図に示されるように、ブロックB11へと入力されるωは、ブロックB11が有する減算器B41へと入力される。
【0117】
ブロックB11へと入力されるωは、ブロックB11が有するブロックB42へと入力される。ブロックB42では、入力されたωを、減速要素12の減速比Nで除する処理が行われる。当該処理により得られた値は、ブロックB42から減算器B41へと入力される。
【0118】
減算器B41では、ω/Nからωを減算する処理が行われる。当該処理の結果算出された値、すなわち「ω/N-ω」の値は、ブロックB43へと入力される。ブロックB43では、減算器B41から入力された「ω/N-ω」の値を積分する処理が行われる。当該処理により得られた値は、ブロックB43からブロックB23へと入力される。式(4)から明らかなように、ブロックB23に入力される値はθの推定値となる。ブロックB43においてθの推定値の算出する処理は、変位差推定部140により行われる。ブロックB23では、先に説明した方法により、θに基づいてsat(θ)の値を推定する処理が行われる。当該処理により算出されたsat(θ)の推定値は、第1実施形態と同様に図11のブロックB12に入力される。
【0119】
以上のように、本実施形態の変位差推定部140は、第1速度であるωと、第3速度であるωと、の両方を用いて変位差θを推定する。このような構成においては、θやsat(θ)等の算出を、図12のブロック図に示されるような比較的シンプルな演算により算出することが可能となる。その結果、制御装置100における演算負荷が小さくなるので、演算コストを抑制することができる。
【0120】
第5実施形態について説明する。以下では、第1実施形態と異なる点について主に説明し、第1実施形態と共通する点については適宜説明を省略する。
【0121】
図13に示されるように、本実施形態に係る制御装置100は、その機能を表すブロック要素として、フィルタ処理部160を更に備えている。フィルタ処理部160は、第2速度であるωに対しフィルタ処理を施す部分である。
【0122】
フィルタ処理部160が行うフィルタ処理の内容について、図14を参照しながら説明する。図14に示されるブロック図は、本実施形態に係る制御装置100が行う制御の内容を、図5と同様の方法により描いたものである。本実施形態では、減算器B16で算出されたωの推定値が、減算器B16とブロックB17との間に配置されたブロックB51へと入力される。
【0123】
ブロックB51は、減算器B16から入力されたωの推定値に対し、フィルタ処理部160によるフィルタ処理を施す部分である。当該処理を表す伝達関数G(s)は、以下の式(44)により表されるものである。
【数29】
【0124】
このような伝達関数G(s)を経ることにより、減算器B16からブロックB51に入力されたωは、共振周波数であるω以外の周波数からなる振動成分を減衰させた後、ブロックB51からブロックB17へと入力されることとなる。換言すれば、減算器B16から出力されたωの推定値のうち、概ね共振周波数ωの周波数成分のみがブロックB51を通過して、ブロックB17において補正値TFBの算出に供される。このように、フィルタ処理部160によるフィルタ処理では、概ね共振周波数ωの周波数成分のみを通過させるようなバンドパス特性を持つフィルタが用いられる。
【0125】
本実施形態の補正部150は、フィルタ処理部160による上記フィルタ処理が施された後の第2速度(ω)に基づいて、指令値への補正値を算出することとなる。共振周波数ωの周波数成分のみに基づく補正値TFBにより補正が行われるので、制御の応答性を向上させることができる。尚、フィルタ処理に用いられる伝達関数G(s)としては、式(44)により表されるものとは異なる関数であってもよい。
【0126】
また、フィルタ処理部160、及び伝達関数G(s)を表すブロックB51は、これまでに説明した他の実施形態に適用してもよい。
【0127】
第6実施形態について説明する。以下では、上記の第5実施形態と異なる点について主に説明し、第5実施形態と共通する点については適宜説明を省略する。
【0128】
図15に示されるように、本実施形態に係る制御装置100は、その機能を表すブロック要素として、スリップ率取得部170を更に備えている。スリップ率取得部170は、電動車両EVにおける車輪のスリップ率を取得する部分である。スリップ率のことを、以下では「λ」とも表記する。また、車輪のうち路面に接する部分の、車輪以外の車体部分に対する相対速度のことを、以下では「VL1」と表記する。更に、電動車両EVの車速を、以下では「V」と表記する。
【0129】
電動車両EVの駆動時においては、スリップ率λは以下の式(45)で表される。
【数30】
【0130】
一方、電動車両EVの制動時においては、スリップ率λは以下の式(46)で表される。
【数31】
【0131】
上記のVL1は、電動車両EVが有する複数の車輪のうち、駆動輪の回転数を不図示のセンサで検出した上で、当該回転数に基づいて算出することができる。また、上記のVは、電動車両EVが有する複数の車輪のうち、従動輪の回転数を不図示のセンサで検出した上で、当該回転数に基づいて算出することができる。スリップ率取得部170は、VL1及びVのそれぞれを上記のように取得した上で、λを所定の周期で繰り返し算出し取得する。
【0132】
電動車両EVの駆動力、すなわち、車輪が路面に対して加える力を「F」と表記し、電動車両EVの全体の質量を「M」と表記すると、以下式(47)で表される運動方程式が成立する。
【数32】
【0133】
また、電動車両EVの車輪の半径を「r」と表記すると、上記のFは以下の式(48)で表される。
【数33】
【0134】
これまでに説明した式(1)、式(2)、式(4)、式(22)、式(23)、式(24)、式(45)、式(46)、式(47)、式(48)によれば、以下の式(49)を導くことができる。
【数34】
【0135】
式(49)におけるJ(λ)は、電動車両EVの車体全体の質量を車輪のイナーシャに換算した値を、λの関数として表したものである。J(λ)は以下の式(50)で表される。
【数35】
【0136】
尚、式(50)における「JL0」は、ここでは車輪の実際のイナーシャを表すものとして用いられている。
【0137】
式(49)におけるBL1(λ)は、電動車両EVの車輪が受ける粘性摩擦力の粘性摩擦係数を、λの関数として表したものである。BL1(λ)は以下の式(51)で表される。
【数36】
【0138】
尚、式(51)における「B」は、スリップ率λが0の場合における粘性摩擦係数である。
【0139】
これまでに説明した式(1)、式(2)、式(4)、式(22)、式(23)、式(24)に加え、上記の式(49)を用いれば、ωを表す式(52)、及びθを表す式(53)を、それぞれ以下のように導くことができる。
【数37】
【数38】
【0140】
式(52)及び式(53)に示されるaやa等の係数は、先に挙げた式(7)乃至(10)、式(27)乃至(32)を用いて表されるものである。ただし、本実施形態では、各式中のJL0をJ(λ)に、BをBL1(λ)に、それぞれ置き換えたものが用いられる。
【0141】
式(52)の右辺において、ωに掛かる係数の全体をA(s,λ)と表記し、sat(θ)に掛かる係数の全体をB(s,λ)と表記すると、式(52)は以下の式(54)のように表される。
【数39】
【0142】
同様に、式(53)の右辺において、Tに掛かる係数の全体をC(s,λ)と表記し、sat(θ)に掛かる係数の全体をD(s,λ)と表記すると、式(53)は以下の式(55)のように表される。
【数40】
【0143】
本実施形態に係る制御装置100は、式(54)及び式(55)に示される関係を用いて、ωやθの値を推定するように構成されている。
【0144】
式(14)において、JL0を式(50)のJ(λ)に置き換えると、共振周波数ωは以下の式(56)のように表される。
【数41】
【0145】
図16を参照しながら、本実施形態において実行される処理について説明する。図16に示されるブロック図は、本実施形態に係る制御装置100が行う制御の内容を、図14と同様の方法により描いたものである。
【0146】
本実施形態のブロックB14では、入力されたωに対し、式(54)のA(s,λ)による演算を施す処理が行われる。また、本実施形態のブロックB12では、入力されたsat(θ)の推定値に対し、式(54)のB(s,λ)による演算を施す処理が行われる。更に、本実施形態のブロックB51では、入力されたωの推定値に対し、G(s,λ)によるフィルタ処理を施す処理が行われる。G(s,λ)とは、式(44)の右辺におけるωを、全て式(56)のω(λ)に置き換えることで、式(44)のG(s)をλの関数として表現したものである。
【0147】
図17に示されるブロック図は、図16のブロックB11で行われる処理の内容を、図6と同様の方法により描いたものである。ブロックB11が有するブロックB21では、入力されたT に対し、式(55)のC(s,λ)による演算を施す処理が行われる。また、ブロックB11が有するブロックB24では、入力されたsat(θ)の推定値に対し、式(55)のD(s,λ)による演算を施す処理が行われる。
【0148】
以上のように、本実施形態では、ブロックB12、B14、B51、B21、B24におけるそれぞれの伝達関数が、スリップ率取得部170で取得されたλの値によって動的に変更される。それぞれの伝達関数は、TFBの算出に必要な「制御パラメータ」ということができる。
【0149】
λの値により各伝達関数を変更する処理は、補正部150によってなされる。つまり、本実施形態の補正部150は、スリップ率λに応じて、補正値であるTFBの算出に必要な制御パラメータを変化させるように構成されている。このため、車輪のスリップ状態に応じた正確な補正値TFBを算出し、振動の発生を更に抑制することができる。
【0150】
尚、フィルタ処理部160、スリップ率取得部170、ブロックB12、B14、B51、B21、B24は、これまでに説明した他の実施形態に適用してもよい。当該適用に当たっては、フィルタ処理部160及びスリップ率取得部170の両方を適用するのではなく、スリップ率取得部170のみを適用することとしてもよい。
【0151】
以上の各実施形態においては、動力伝達システム10が、力発生装置11の回転力により、負荷15を回転運動させるものとして構成されている場合の例について説明した。しかしながら、制御対象である動力伝達システムは、力発生装置の並進力により、負荷15を並進運動させるものとして構成されているものであってもよい。
【0152】
図18には、後者のような構成の動力伝達システム20の例が模式的に示されている。動力伝達システム20は、力発生装置21と、減速要素22と、不感帯要素23と、ばね要素24と、負荷25と、を有している。このような構成の動力伝達システム20は、例えば、工作機械等に用いられる。
【0153】
力発生装置21は、並進力を発生させる装置であって、例えばリニアモーターである。力発生装置21は、制御装置100から送信される指令値に応じた並進力を発生させる。このような構成を実現するために、指令値を、力発生装置21に供給される電流に変換するためのドライバが設けられているのであるが、図18においてはその図示が省略されている。力発生装置21で生じる並進力のことを、以下では「F」とも表記する。
【0154】
力発生装置21は出力軸を有しており、当該出力軸が後述の減速要素22へと繋がっている。出力軸は、力発生装置21で発生した並進力を外部に出力する部分となっている。出力軸の並進速度のことを、以下では「V]とも表記する。Vは、力発生装置21の動作速度であり、これまでのωと同様に「第1速度」に該当する。また、出力軸の質量のことを以下では「M」とも表記し、出力軸が並進する際に受ける粘性摩擦力の粘性摩擦係数のことを以下では「C」とも表記する。
【0155】
減速要素22は、力発生装置21の出力軸の並進速度を減速して、後述のばね要素24へと出力するための装置である。減速要素22の減速比のことを、これまでと同様に「N」とも表記する。ばね要素24の並進速度は、力発生装置21の出力軸の並進速度の1/Nということになる。尚、減速要素22は必須のものではない。力発生装置21で発生した並進力が、後述のばね要素24へと直接伝達される構成としてもよい。
【0156】
不感帯要素23は、力発生装置21からばね要素24までの力の伝達経路における、部材間の隙間を模式的に表すものである。このような「隙間」としては、例えば、ギヤのバックラッシ等が挙げられる。不感帯要素23が存在することで、負荷25の動作方向を反転させる場合等において、一時的に、力発生装置21で生じた力が負荷25に伝達されない状態となる。このように、動力伝達システム20においても、動力伝達システム10と同様に不感帯が存在する。力発生装置21の出力軸と、ばね要素24との間の相対的な距離において、不感帯となる範囲の1/2の大きさのことを、以下では「xBL」とも表記する。すなわち、上記の相対的な距離が最大でxBL×2となる範囲において、力が負荷25に伝達されないことがある。
【0157】
ばね要素24は、力発生装置21で発生した並進力を負荷25に伝達するための要素である。ばね要素24は、この例における「伝達部材」に該当する。力発生装置21の駆動力を負荷25に伝達する際においては、ばね要素24では並進方向に沿った変形が生じる。ばね要素24の剛性のことを、これまでと同様に「K」とも表記する。
【0158】
負荷25は、動力伝達システム20の駆動対象となる部分である。上記のように、力発生装置21で発生した並進力は、減速要素22やばね要素24を介して負荷25に伝達され、負荷25を並進運動させる。負荷25の動作速度のことを、以下では「V]とも表記する。Vは、これまでのωと同様に「第3速度」に該当する。また、負荷25がばね要素24から受ける並進力のことを以下では「F」とも表記し、負荷25の質量のことを以下では「M」とも表記し、負荷25が並進運動する際に受ける粘性摩擦力の粘性摩擦係数のことを、以下では「C」とも表記する。更に、負荷25が外部から受ける並進力のことを、以下では「F」とも表記する。
【0159】
動力伝達システム20を制御するにあたり用いられる数式について説明する。
【0160】
力発生装置21の出力軸の動作について、運動方程式は以下の式(57)となる。
【数42】
【0161】
負荷25の動作について、運動方程式は以下の式(58)となる。
【数43】
【0162】
ここで、力発生装置21の変位量と、負荷25の変位量と、の間の差のことを、以下では「x」と表記する。xは、これまでのθのような「変位差」に該当するものである。
ばね要素24の変形量を「x」とすると、xとFとの関係は、以下の式(59)により表される。
【数44】
【0163】
不感帯要素23の存在により、xとxとの関係は、図3(A)に示されるθとθとの関係と同様の関係となる。
【0164】
当該関係を表すために、以下の式(60)で示されるsat(x)が用いられる。
【数45】
【0165】
sat(x)を用いると、xとxとの関係は以下の式(61)により表される。
【数46】
【0166】
変位差であるxは、VとVとを用いて、以下の式(62)により表される。
【数47】
【0167】
このxを微分したものが、この例における「第2速度」に該当する。
【0168】
動力伝達システム20に対しても、以上に挙げた式(57)乃至(62)を用いることで、制御装置100はこれまでに説明したものと同様の制御を適用することができる。式(57)、(58)、(59)、(60)、(61)、(62)は、それぞれ、式(1)、(2)、(21)、(22)、(23)、(4)に対応するものであり、Vとωとのような各要素の対応関係も明らかであることから、動力伝達システム20の詳細な制御については説明を省略する。
【0169】
以上、具体例を参照しつつ本実施形態について説明した。しかし、本開示はこれらの具体例に限定されるものではない。これら具体例に、当業者が適宜設計変更を加えたものも、本開示の特徴を備えている限り、本開示の範囲に包含される。前述した各具体例が備える各要素およびその配置、条件、形状などは、例示したものに限定されるわけではなく適宜変更することができる。前述した各具体例が備える各要素は、技術的な矛盾が生じない限り、適宜組み合わせを変えることができる。
【0170】
本開示に記載の制御装置及び制御方法は、コンピュータプログラムにより具体化された1つ又は複数の機能を実行するようにプログラムされたプロセッサ及びメモリを構成することによって提供された1つ又は複数の専用コンピュータにより、実現されてもよい。本開示に記載の制御装置及び制御方法は、1つ又は複数の専用ハードウェア論理回路を含むプロセッサを構成することによって提供された専用コンピュータにより、実現されてもよい。本開示に記載の制御装置及び制御方法は、1つ又は複数の機能を実行するようにプログラムされたプロセッサ及びメモリと1つ又は複数のハードウェア論理回路を含むプロセッサとの組み合わせにより構成された1つ又は複数の専用コンピュータにより、実現されてもよい。コンピュータプログラムは、コンピュータにより実行されるインストラクションとして、コンピュータ読み取り可能な非遷移有形記録媒体に記憶されていてもよい。専用ハードウェア論理回路及びハードウェア論理回路は、複数の論理回路を含むデジタル回路、又はアナログ回路により実現されてもよい。
【符号の説明】
【0171】
10:動力伝達システム
11:力発生装置
13:不感帯要素
14:伝達部材
15:負荷
100:制御装置
110:第1速度取得部
120:第2速度推定部
150:補正部
図1
図2
図3
図4
図5
図6
図7
図8
図9
図10
図11
図12
図13
図14
図15
図16
図17
図18