特許 6374274 制御装置及び減速機システム

(19)【発行国】日本国特許庁(JP)

(12)【公報種別】特許公報(B2)

(11)【特許番号】6374274

(24)【登録日】2018年7月27日

(45)【発行日】2018年8月15日

(54)【発明の名称】制御装置及び減速機システム

(51)【国際特許分類】

   G05D 3/12 20060101AFI20180806BHJP

   F16H 1/32 20060101ALI20180806BHJP

【ＦＩ】

   G05D3/12 T

   F16H1/32 A

【請求項の数】8

【全頁数】28

(21)【出願番号】特願2014-180453(P2014-180453)

(22)【出願日】2014年9月4日

(65)【公開番号】特開2016-53914(P2016-53914A)

(43)【公開日】2016年4月14日

【審査請求日】2017年8月30日

(73)【特許権者】

【識別番号】304021288

【氏名又は名称】国立大学法人長岡技術科学大学

(73)【特許権者】

【識別番号】503405689

【氏名又は名称】ナブテスコ株式会社

(74)【代理人】

【識別番号】100067828

【弁理士】

【氏名又は名称】小谷 悦司

(74)【代理人】

【識別番号】100115381

【弁理士】

【氏名又は名称】小谷 昌崇

(74)【代理人】

【識別番号】100109438

【弁理士】

【氏名又は名称】大月 伸介

(72)【発明者】

【氏名】大石 潔

(72)【発明者】

【氏名】横倉 勇希

(72)【発明者】

【氏名】平野 曜生

(72)【発明者】

【氏名】中村 江児

(72)【発明者】

【氏名】佐藤 正隆

【審査官】 加藤 啓

(56)【参考文献】

【文献】 特開平１−２１０６４３（ＪＰ，Ａ）

【文献】 特開２００９−１０１４４４（ＪＰ，Ａ）

【文献】 特開２０１０−２４４３４３（ＪＰ，Ａ）

【文献】 特開２００２−１７５１２０（ＪＰ，Ａ）

(58)【調査した分野】（Int.Cl.，ＤＢ名）

Ｇ０５Ｄ ３／１２

Ｆ１６Ｈ １／３２

(57)【特許請求の範囲】

【請求項1】

少なくとも１つの孔が偏心した位置に形成された揺動歯車部を有する揺動型減速機を駆動するモータを制御する制御装置であって、
前記モータの回転角を表す入力回転角に関する入力情報を取得する角度取得部と、
前記入力回転角と、前記揺動型減速機の回転角を表す出力回転角と、の間の角度誤差を、前記孔の数に基づいて推定する推定部と、
前記角度誤差に応じて補償電流値を決定し、前記補償電流値を用いて、指令電流値を補正することにより、前記モータへ供給される電流の大きさを設定する補正部と、を備える
制御装置。

【請求項2】

前記推定部は、前記入力情報と、前記モータへ供給された電流の大きさと、を入力とし、前記角度誤差を推定する状態観測器を含む
請求項１に記載の制御装置。

【請求項3】

前記揺動型減速機は、前記揺動歯車部に噛み合うＮ_ｐ本の内歯を含み、且つ、減速比Ｒ_ｇで、前記モータの角速度ω_Ｍを減速し、
前記孔の数は、自然数ｋで表され、
前記推定部は、前記揺動型減速機の角度伝達誤差の角周波数ω_ｄを数１から算出し、前記角周波数ω_ｄを行列成分として含む離散時間状態空間モデルを用いて前記角度誤差を推定する
請求項１又は２に記載の制御装置。

【数1】

【請求項4】

前記揺動歯車部は、Ｎ_ｇ個の揺動歯車を含み、
前記Ｎ_ｇ個の揺動歯車それぞれには、ｋ_ｅ個の孔が形成され、
前記自然数ｋは、数２から算出される
請求項３に記載の制御装置。

【数2】

【請求項5】

前記補正部は、前記推定部によって推定された前記角度誤差と、前記揺動型減速機のバネ特性と、から、前記角周波数ω_ｄで振動するトルク振動を算出するトルク算出部と、前記トルク振動が低減されるように前記補償電流値を算出する電流算出部と、を含む
請求項３又は４に記載の制御装置。

【請求項6】

前記トルク算出部は、前記推定部によって推定された前記角度誤差のデータから、前記角周波数ω_ｄで変動する周波数成分を抽出し、前記抽出された周波数成分を用いて、前記トルク振動を算出する
請求項５に記載の制御装置。

【請求項7】

前記電流算出部は、前記トルク振動から補償電流の大きさを表す電流データを生成し、前記電流データから、前記角周波数ω_ｄで変動する周波数成分を抽出することによって、前記補償電流値を決定する
請求項５又は６に記載の制御装置。

【請求項8】

少なくとも１つの孔が偏心した位置に形成された揺動歯車部を有する揺動型減速機と、
前記揺動型減速機を駆動するモータと、
前記モータを制御する制御装置と、を備え、
前記制御装置は、前記モータの回転角を表す入力回転角に関する入力情報を取得する角度取得部と、前記入力回転角と、前記揺動型減速機の回転角を表す出力回転角と、の間の角度誤差を、前記孔の数に基づいて推定する推定部と、前記角度誤差に応じて補償電流値を決定し、前記補償電流値を用いて、指令電流値を補正することにより、前記モータへ供給される電流の大きさを設定する補正部と、を含む
減速機システム。

【発明の詳細な説明】

【技術分野】

【0001】

本発明は、揺動型減速機を制御するための制御技術に関する。

【背景技術】

【0002】

産業用ロボットや工作機械といった様々な技術分野において、減速機の角度伝達誤差の低減が要求されている。角度伝達誤差の低減に対する要求に応じて、様々な制御技術が提案されている（特許文献１及び２を参照）。

【0003】

特許文献１は、減速機の入力側に配置されたエンコーダと、減速機の出力側に配置されたエンコーダと、を用いて、角度伝達誤差を低減することを提案する。特許文献２は、予め取得された誤差補正データを用いて、角度伝達誤差を低減することを提案する。

【先行技術文献】

【特許文献】

【0004】

【特許文献1】特開２０１２−１２２５０９号公報

【特許文献2】特開２００３−２２３２２５号公報

【発明の概要】

【発明が解決しようとする課題】

【0005】

特許文献１の開示技術は、複数のエンコーダを必要とする。したがって、特許文献１の開示技術が組み込まれた制御装置の製造コストは高くなる。

【0006】

特許文献１の開示技術は、減速機の出力側でのエンコーダの配置を必要とする。一方、減速機の出力側でのエンコーダの配置が望ましくない技術分野（たとえば、産業用ロボットの技術分野）が存在する。したがって、特許文献１の開示技術は、汎用性において課題を有する。

【0007】

特許文献２の開示技術は、減速機それぞれに対する固有の誤差補正データを予め作成することを要求する。したがって、特許文献２の開示技術は、誤差補正データの作成及び管理において、使用者に多大な労力を要求する。

【0008】

特許文献２によれば、誤差補正データは、負荷に起因する角度伝達誤差の変化を考慮することなく作成される。したがって、減速機に負荷が加わっている条件下においては、特許文献２の開示技術は、角度伝達誤差を十分に低減することはできない。

【0009】

本発明は、負荷が加えられた条件下において発生する角度伝達誤差を簡便に低減することができる制御技術を提供することを目的とする。

【課題を解決するための手段】

【0010】

本発明の一局面に係る制御装置は、少なくとも１つの孔が偏心した位置に形成された揺動歯車部を有する揺動型減速機を駆動するモータを制御する。制御装置は、前記モータの回転角を表す入力回転角に関する入力情報を取得する角度取得部と、前記入力回転角と、前記揺動型減速機の回転角を表す出力回転角と、の間の角度誤差を、前記孔の数に基づいて推定する推定部と、前記角度誤差に応じて補償電流値を決定し、前記補償電流値を用いて、指令電流値を補正することにより、前記モータへ供給される電流の大きさを設定する補正部と、を備える。

【0011】

上記構成によれば、揺動歯車部には、少なくとも１つの孔が偏心した位置に形成されるので、揺動歯車部の運動にともなって、剛性変動が生ずる。剛性変動は、軸の捩れ振動を引き起こす。この結果、揺動型減速機に、角度伝達誤差が生ずる。したがって、揺動歯車部に形成された孔の数は、角度伝達誤差の因子として作用する。

【0012】

推定部は、上述の因果関係を鑑みて、揺動歯車部に形成された孔の数に基づいて、揺動歯車部の孔に起因する剛性変動によって引き起こされる角度誤差を推定することができる。角度誤差は、複数の揺動型減速機それぞれの固有のデータを用いることなく、推定されるので、制御装置は、様々な揺動型減速機に簡便に利用可能である。補正部は、推定された角度誤差に応じて決定された補正電流値を用いて、指令電流値を補正するので、揺動型減速機の角度伝達誤差は、十分に低減される。

【0013】

上記構成において、前記入力情報と、前記モータへ供給された電流の大きさと、を入力とし、前記角度誤差を推定する状態観測器を含んでもよい。

【0014】

上記構成によれば、状態観測器は、モータの回転角を表す入力回転角に関する入力情報と、モータへ供給された電流の大きさと、を入力して、角度誤差を推定することができる。制御装置は、揺動型減速機の出力側からの情報を用いることなく、揺動型減速機の角度伝達誤差を低減することができるので、制御装置を用いて機械装置を設計する設計者は、制御に必要とされる情報を取得するための設備を簡素化することができる。設計者は、揺動型減速機の出力側での情報取得設備の配置が困難な条件下においても、制御装置を用いて、揺動型減速機の角度伝達誤差を低減することができる。

【0015】

上記構成において、前記揺動型減速機は、前記揺動歯車部に噛み合うＮ_ｐ本の内歯を含み、且つ、減速比Ｒ_ｇで、前記モータの角速度ω_Ｍを減速してもよい。前記孔の前記数は、自然数ｋで表されてもよい。前記推定部は、前記揺動型減速機の角度伝達誤差の角周波数ω_ｄを数１から算出し、前記角周波数ω_ｄを行列成分として含む離散時間状態空間モデルを用いて前記角度誤差を推定してもよい。

【0016】

【数1】

【0017】

上記構成によれば、推定部は、角周波数ω_ｄを行列成分として含む離散時間状態空間モデルを用いて角度誤差を推定するので、推定部は、揺動歯車部に形成された孔に起因する剛性変動によって引き起こされる角度伝達誤差を考慮して、角度誤差を適切に推定することができる。

【0018】

上記構成において、前記揺動歯車部は、Ｎ_ｇ個の揺動歯車を含んでもよい。前記Ｎ_ｇ個の揺動歯車それぞれには、ｋ_ｅ個の孔が形成されてもよい。前記自然数ｋは、数２から算出されてもよい。

【0019】

【数2】

【0020】

上記構成によれば、制御装置は、単数又は複数の揺動歯車を有する揺動型減速機を駆動するモータを制御するために好適に利用可能である。したがって、制御装置は、様々な揺動型減速機とともに用いられるモータの制御に利用可能である。

【0021】

上記構成において、前記補正部は、前記推定部によって推定された前記角度誤差と、前記揺動型減速機のバネ特性と、から、前記角周波数ω_ｄで振動するトルク振動を算出するトルク算出部と、前記トルク振動が低減されるように前記補償電流値を算出する電流算出部と、を含んでもよい。

【0022】

上記構成によれば、電流算出部は、トルク算出部によって算出されたトルク振動が低減されるように、補償電流値を算出するので、揺動型減速機の角度伝達誤差は、十分に低減される。

【0023】

上記構成において、前記トルク算出部は、前記推定部によって推定された前記角度誤差のデータから、前記角周波数ω_ｄで変動する周波数成分を抽出し、前記抽出された周波数成分を用いて、前記トルク振動を算出してもよい。

【0024】

上記構成によれば、トルク算出部は、推定部によって推定された角度誤差のデータから、角周波数ω_ｄで変動する周波数成分を抽出し、抽出された周波数成分を用いて、トルク振動を算出するので、算出されたトルク振動のデータに含まれるノイズは低減される。したがって、制御装置は、モータを精度よく制御することができる。

【0025】

上記構成において、前記電流算出部は、前記トルク振動から補償電流の大きさを表す電流データを生成し、前記電流データから、前記角周波数ω_ｄで変動する周波数成分を抽出することによって、前記補償電流値を決定してもよい。

【0026】

上記構成によれば、電流算出部は、トルク振動から補償電流の大きさを表す電流データを生成し、電流データから、角周波数ω_ｄで変動する周波数成分を抽出することによって、補償電流値を決定するので、補償電流値に含まれるノイズは低減される。したがって、制御装置は、モータを精度よく制御することができる。

【0027】

本発明の他の局面に係る減速機システムは、少なくとも１つの孔が偏心した位置に形成された揺動歯車部を有する揺動型減速機と、前記揺動型減速機を駆動するモータと、前記モータを制御する制御装置と、を備える。前記制御装置は、前記モータの回転角を表す入力回転角に関する入力情報を取得する角度取得部と、前記入力回転角と、前記揺動型減速機の回転角を表す出力回転角と、の間の角度誤差を、前記孔の数に基づいて推定する推定部と、前記角度誤差に応じて補償電流値を決定し、前記補償電流値を用いて、指令電流値を補正することにより、前記モータへ供給される電流の大きさを設定する補正部と、を含む。

【0028】

上記構成によれば、推定部は、揺動歯車部に形成された孔の数に基づいて、揺動歯車部の孔に起因する剛性変動によって引き起こされる角度誤差を推定することができる。角度誤差は、複数の揺動型減速機それぞれの固有のデータを用いることなく、推定されるので、制御装置は、様々な揺動型減速機に簡便に利用可能である。補正部は、推定された角度誤差に応じて決定された補正電流値を用いて、指令電流値を補正するので、揺動型減速機の角度伝達誤差は、十分に低減される。

【発明の効果】

【0029】

本発明は、揺動型減速機に負荷が加わっている条件下においても角度伝達誤差を十分に低減することができる汎用性のある制御技術を提供することができる。

【図面の簡単な説明】

【0030】

【図1】減速機システムの例示的な機能構成を表す概略的なブロック図である。

【図2A】例示的な揺動型減速機の概略的な断面図である。

【図2B】図２Ａに示されるＡ−Ａ線に沿う揺動型減速機の概略的な断面図である。

【図3】図２Ａに示される揺動型減速機の概略図である。

【図4】図３に示される揺動型減速機の揺動歯車に作用する力を表す概略図である。

【図5】図１に示される減速機システムの制御ブロック線図である。

【図6】図５に示される減速機システムの制御回路の例示的な制御動作を表す概略的なフローチャートである。

【図7A】補償電流値による補正がない条件下で得られた試験データを示す。

【図7B】補償電流値による補正がある条件下で得られた試験データを示す。

【図8A】図７Ａに示されるデータから得られたＦＦＴ解析の結果を示す。

【図8B】図７Ｂに示されるデータから得られたＦＦＴ解析の結果を示す。

【発明を実施するための形態】

【0031】

添付の図面を参照して、揺動型減速機を駆動するモータに対する制御技術に関する様々な実施形態が以下に説明される。制御技術は、以下の説明によって、明確に理解可能である。

【0032】

＜本発明者等が見出した揺動型減速機の課題＞
一般的に、減速機は、弾性、バックラッシや角度伝達誤差といった伝達特性を有する。これらの伝達特性は、減速機が組み込まれた装置の動作精度を悪化させる。産業用ロボットといった技術分野において、波動歯車装置や揺動型減速機が用いられることが多い。波動歯車装置や揺動型減速機は、一般的な減速機と比べて、精度よく動力を伝達することができる。

【0033】

揺動型減速機は、高い減速比で動力を伝達することができ、且つ、非常に小さなバックラッシを有する。揺動型減速機は、小型であり、且つ、高い剛性を有する。これらの特性を鑑みて、揺動型減速機は、大型ロボットや産業用ロボット中において、高い剛性が要求される部位にしばしば利用される。

【0034】

揺動型減速機は、環状に配列された複数の内歯と、複数の内歯に噛み合う揺動歯車部と、を有する。揺動歯車部は、内歯によって規定される定円に内接しながら移動する。

【0035】

揺動型減速機を設計する設計者は、揺動型減速機の設計上及び／又は製造上の理由から、揺動歯車部に形成された孔に、シャフトや他の部材を挿通させることがある。しかしながら、孔が形成された部位は、揺動歯車部の剛性を局所的に低下させることもある。

【0036】

本発明者等は、揺動歯車部に形成された孔が、モータの回転角と、揺動型減速機の回転角と、の間の角度誤差に周期的な変動を与え、角度伝達誤差を大きくすることを見出した。揺動歯車部に形成された孔に起因する角度伝達誤差を低減する制御技術が、以下に説明される。

【0037】

＜減速機システム＞
図１は、減速機システム１００の例示的な機能構成を表す概略的なブロック図である。図１を参照して、減速機システム１００が説明される。

【0038】

減速機システム１００は、モータ２００と、エンコーダ３００と、制御回路４００と、揺動型減速機５００と、を備える。モータ２００は、制御回路４００の制御下で、揺動型減速機５００を駆動する。本実施形態において、制御装置は、制御回路４００によって例示される。

【0039】

エンコーダ３００は、モータ２００に取り付けられてもよい。エンコーダ３００は、モータ２００の回転角を表す入力回転角に関する入力情報を生成する。本実施形態において、入力情報は、モータ２００の回転角を表す。代替的に、入力情報は、モータ２００の角速度やモータ２００の回転角に関する他の情報を表してもよい。本実施形態の制御原理は、入力情報が表す特定の内容に限定されない。

【0040】

本実施形態において、入力情報を生成する装置として、エンコーダ３００が利用される。代替的に、入力情報を生成することができる他の装置が、減速機システム１００に用いられてもよい。本実施形態の制御原理は、入力情報を生成するための特定の技術に限定されない。

【0041】

制御回路４００は、微分器４１０と、状態観測器４２０と、補正部４３０と、指令情報生成部４４０と、駆動部４５０と、を含む。上述の入力情報は、エンコーダ３００から微分器４１０へ出力される。微分器４１０は、入力情報が表す回転角に対して微分演算し、モータ２００の角速度を算出する。モータ２００の角速度に関する角速度情報は、微分器４１０から状態観測器４２０及び指令情報生成部４４０へ出力される。本実施形態において、角度取得部は、微分器４１０によって例示される。入力情報が、モータ２００の角速度を表すならば、角度取得部は、入力情報が入力される入力ポートであってもよい。本実施形態の制御原理は、角度取得部の特定の構造や特定の機能に限定されない。

【0042】

状態観測器４２０は、揺動型減速機５００の揺動歯車部に形成された孔の数に基づいて、入力情報によって表される入力回転角と、揺動型減速機５００の回転角を表す出力回転角と、の間の角度誤差θ_ｓを推定する。角度誤差θ_ｓは、以下の数式によって定義されてもよい。本実施形態において、推定部は、状態観測器４２０によって例示される。

【0043】

【数3】

【0044】

角度誤差θ_ｓに関する上述の定義式は、揺動型減速機５００の角速度の変数（ω_Ｌ）を含む。しかしながら、本実施形態の制御原理は、揺動型減速機５００の出力動作の直接的な測定を要することなく、角度誤差θ_ｓを推定することを可能にする。角度誤差θ_ｓを推定するための様々な演算技術は、後述される。角度誤差θ_ｓの推定値を表すデータは、状態観測器４２０から補正部４３０へ出力される。

【0045】

補正部４３０は、第１電流決定部４３１と、第２電流決定部４３２と、補正処理部４３３と、を含む。角度誤差θ_ｓの推定値を表すデータは、状態観測器４２０から第１電流決定部４３１及び第２電流決定部４３２へ出力される。第１電流決定部４３１は、角度誤差θ_ｓの推定値を表すデータに応じて、補償電流の大きさを表す補償電流値を決定する。第２電流決定部４３２は、角度誤差θ_ｓの推定値を表すデータに応じて、状態フィードバック電流の大きさを表す状態フィードバック電流値を決定する。補正処理部４３３は、指令情報生成部４４０によって生成された指令電流値を、補償電流値と状態フィードバック電流値とを用いて補正する。

【0046】

本実施形態において、補正部４３０は、補償電流値に加えて、状態フィードバック電流値を用いて、指令電流値を補正する。代替的に、補正部４３０は、補正電流値のみを用いて、指令電流値を補正してもよい。本実施形態の制御原理は、指定電流値を補正するための特定の演算技術に限定されない。

【0047】

指令情報生成部４４０は、位置指令生成部４４１と、速度指令生成部４４２と、電流指令生成部４４３と、を含む。位置指令生成部４４１は、エンコーダ３００から、上述の入力情報を受け取る。位置指令生成部４４１は、外部装置（図示せず）から、モータ２００の回転角を指示する指示情報を受け取る。位置指令生成部４４１は、入力情報を、指示情報と対比し、指示情報によって指定された回転角からのモータ２００の現在の回転角の偏差を算出する。算出された偏差に関する偏差情報は、位置指令生成部４４１から速度指令生成部４４２へ出力される。

【0048】

速度指令生成部４４２は、微分器４１０からモータ２００の角速度を表す角速度情報を受け取る。速度指令生成部４４２は、偏差情報と、角速度情報と、を用いて、速度を指示する速度指令情報を生成する。速度指令情報は、速度指令生成部４４２から電流指令生成部４４３へ出力される。

【0049】

電流指令生成部４４３は、速度指令情報に基づいて、指令電流値を決定する。指令電流値を表す情報は、電流指令生成部４４３から補正処理部４３３へ出力される。補正処理部４３３は、上述の如く、指令電流値を、補償電流値と状態フィードバック電流値とを用いて補正する。

【0050】

指令情報生成部４４０は、一般的なフィードバック制御技術を用いて、指令電流値を決定してもよい。したがって、本実施形態の制御原理は、指令電流値を決定するための特定の方法に限定されない。

【0051】

補正処理部４３３は、指令電流値を、補償電流値と状態フィードバック電流値とを用いて補正し、モータ２００へ供給される供給電流の大きさを設定する。モータ２００へ供給される供給電流の大きさを表す供給電流情報は、補正処理部４３３から、状態観測器４２０及び駆動部４５０へ出力される。

【0052】

駆動部４５０は、供給電流情報によって表される大きさの電流を、駆動信号として、モータ２００へ出力する。モータ２００は、駆動信号に応じて、回転運動をする。

【0053】

本実施形態において、駆動部４５０は、制御回路４００に組み込まれた駆動回路として形成される。代替的に、駆動部４５０は、制御回路４００から分離されてもよい。例えば、駆動部４５０は、上述の供給電流情報から駆動信号を生成するプログラムを実行するデジタルシグナルプロセッサであってもよい。本実施形態の制御原理は、駆動部４５０の特定の構造や特定の機能に限定されない。

【0054】

上述の如く、状態観測器４２０は、モータ２００の角速度に関する角速度情報を、微分器４１０から受け取り、且つ、モータ２００へ供給される供給電流の大きさを表す供給電流情報を、補正処理部４３３から受け取る。状態観測器４２０は、角速度情報と供給電流情報とを、上述の角度誤差θ_ｓの推定に利用する。

【0055】

＜揺動型減速機＞
図１を参照して説明された減速機システム１００の原理は、様々な揺動型減速機を駆動するために利用可能である。

【0056】

図２Ａ及び図２Ｂは、例示的な揺動型減速機５００Ａを示す。図２Ａは、揺動型減速機５００Ａの概略的な断面図である。図２Ｂは、図２Ａに示されるＡ−Ａ線に沿う揺動型減速機５００Ａの概略的な断面図である。揺動型減速機５００Ａは、図１を参照して説明された揺動型減速機５００として利用可能である。図１乃至図２Ｂを参照して、揺動型減速機５００Ａが説明される。

【0057】

揺動型減速機５００Ａは、外筒部５１０と、キャリア部５２０と、揺動歯車部５３０と、駆動機構５４０と、を備える。図２Ａ及び図２Ｂは、入力軸２１０を示す。入力軸２１０は、図１を参照して説明されたモータ２００のシャフトであってもよい。図１を参照して説明されたエンコーダ３００は、入力軸２１０に取り付けられ、入力軸２１０の回転角を表す入力回転角に関する入力情報を生成してもよい。

【0058】

外筒部５１０は、外筒５１１と、複数の内歯ピン５１２と、を含む。外筒５１１は、キャリア部５２０、揺動歯車部５３０及び駆動機構５４０が収容される円筒状の内部空間を規定する。入力軸２１０は、円筒状の内部空間の中心軸に沿って延出する。各内歯ピン５１２は、入力軸２１０の延出方向に延びる円柱状の部材である。各内歯ピン５１２は、外筒５１１の内壁に形成された溝部に嵌入される。したがって、各内歯ピン５１２は、外筒５１１によって適切に保持される。

【0059】

複数の内歯ピン５１２は、入力軸２１０周りに略一定間隔で配置される。各内歯ピン５１２の半周面は、外筒５１１の内壁から入力軸２１０に向けて突出する。したがって、複数の内歯ピン５１２は、揺動歯車部５３０と噛み合う内歯として機能する。

【0060】

キャリア部５２０は、基部５２１と、端板部５２２と、位置決めピン５２３と、固定ボルト５２４と、を含む。キャリア部５２０は、全体的に、円筒形状をなす。キャリア部５２０は、外筒部５１０に対して相対的に回転することができる。キャリア部５２０が、固定されるならば、外筒部５１０は、入力軸２１０の回転に応じて回転する。外筒部５１０が固定されるならば、キャリア部５２０は、入力軸２１０の回転に応じて回転する。入力軸２１０は、キャリア部５２０又は外筒部５１０の回転軸ＲＸに沿って延出する。

【0061】

基部５２１は、基板部５２５と、３つのシャフト部５２６と、を含む。３つのシャフト部５２６それぞれは、基板部５２５から端板部５２２に向けて延びる。３つのシャフト部５２６それぞれの先端面には、ネジ孔５２７及びリーマ孔５２８が形成される。位置決めピン５２３は、リーマ孔５２８へ挿入される。この結果、端板部５２２は、基部５２１に対して精度よく位置決めされる。固定ボルト５２４は、ネジ孔５２７に螺合する。この結果、端板部５２２は、基部５２１に適切に固定される。

【0062】

揺動歯車部５３０は、基板部５２５と端板部５２２との間に配置される。３つのシャフト部５２６は、揺動歯車部５３０を貫通し、端板部５２２に接続される。

【0063】

揺動歯車部５３０は、第１揺動歯車５３１と、第２揺動歯車５３２と、を含む。第１揺動歯車５３１は、基板部５２５と第２揺動歯車５３２との間に配置される。第２揺動歯車５３２は、端板部５２２と第１揺動歯車５３１との間に配置される。

【0064】

第１揺動歯車５３１は、形状及び大きさにおいて、第２揺動歯車５３２と同様である。第１揺動歯車５３１及び第２揺動歯車５３２は、内歯ピン５１２に噛み合いながら、外筒５１１内を周回移動する。したがって、第１揺動歯車５３１及び第２揺動歯車５３２の中心は、入力軸２１０の回転軸ＲＸ周りを周回することとなる。

【0065】

第１揺動歯車５３１の周回位相は、第２揺動歯車５３２の周回位相から略１８０°ずれている。第１揺動歯車５３１は、外筒部５１０の複数の内歯ピン５１２のうち半数に噛み合う間、第２揺動歯車５３２は、複数の内歯ピン５１２のうち残りの半数に噛み合う。したがって、揺動歯車部５３０は、外筒部５１０又はキャリア部５２０を回転させることができる。

【0066】

駆動機構５４０は、３つの伝達歯車５４１と、３本のクランク軸５４２と、主軸受部５４３と、３つのクランク軸受部５４４と、を含む。入力軸２１０の先端部には、３つの伝達歯車５４１と噛み合う歯車部２１１が形成される。したがって、３つの伝達歯車５４１は、入力軸２１０から駆動力を受けることができる。

【0067】

３つのクランク軸５４２それぞれは、第１端部５４５と、第２端部５４６と、を含む。第１端部５４５は、キャリア部５２０の基板部５２５によって取り囲まれる。第２端部５４６は、キャリア部５２０の端板部５２２によって取り囲まれる。

【0068】

３つのクランク軸５４２それぞれは、円柱状のシャフト部５４７と、第１クランク部５４８と、第２クランク部５４９と、を含む。シャフト部５４７は、第１端部５４５から第２端部５４６まで軸線ＡＸに沿って真っ直ぐに伸びる。第１クランク部５４８及び第２クランク部５４９は、軸線ＡＸから偏心した円板状の部材である。第１揺動歯車５３１と第２揺動歯車５３２との間の周回位相差は、第１クランク部５４８及び第２クランク部５４９によって決定される。

【0069】

伝達歯車５４１は、第１端部５４５に取り付けられる。入力軸２１０が回転すると、３つのクランク軸５４２それぞれは回転する。この結果、第１クランク部５４８及び第２クランク部５４９は、軸線ＡＸ周りに偏心回転する。

【0070】

主軸受部５４３は、外筒部５１０とキャリア部５２０との間に配置される。主軸受部５４３は、第１主軸受５５１と、第２主軸受５５２と、を含む。第１主軸受５５１は、外筒部５１０内で、基部５２１を回転可能に支持する。第２主軸受５５２は、外筒部５１０内で、端板部５２２を回転可能に支持する。したがって、キャリア部５２０は、外筒部５１０に対して相対的に回転することができる。

【0071】

３つのクランク軸受部５４４それぞれは、第１クランク軸受５５３と、第２クランク軸受５５４と、を含む。第１クランク軸受５５３は、第１クランク部５４８と第１揺動歯車５３１との間に配置される。第１クランク軸受５５３は、第１クランク部５４８を回転可能に支持する。クランク軸５４２が回転すると、第１クランク部５４８が偏心回転するので、第１揺動歯車５３１は、複数の内歯ピン５１２と噛み合いながら、外筒部５１０内で周回移動することができる。第２クランク軸受５５４は、第２クランク部５４９と第２揺動歯車５３２との間に配置される。第２クランク軸受５５４は、第２クランク部５４９を回転可能に支持する。クランク軸５４２が回転すると、第２クランク部５４９が偏心回転するので、第２揺動歯車５３２は、複数の内歯ピン５１２と噛み合いながら、外筒部５１０内で周回移動することができる。

【0072】

上述の「数３」において用いられた減速比Ｒ_ｇは、入力軸２１０の歯車部２１１、伝達歯車５４１、内歯ピン５１２の数、第１揺動歯車５３１及び第２揺動歯車５３２の歯数によって決定される。

【0073】

＜角度伝達誤差の発生因子＞
図３は、揺動型減速機５００Ａの概略図である。図２Ａ及び図３を参照して、角度伝達誤差の発生因子となる孔が説明される。

【0074】

図３は、外筒部５１０内に配置された揺動歯車５３３を示す。揺動歯車５３３は、図２Ａを参照して説明された第１揺動歯車５３１及び第２揺動歯車５３２それぞれに対応する。したがって、揺動歯車５３３に関する説明は、第１揺動歯車５３１及び第２揺動歯車５３２の両方に適用可能である。

【0075】

揺動歯車５３３には、中央孔５３４、３つのクランク孔５３５及び３つのシャフト孔５３６が形成されている。

【0076】

図２Ａを参照して説明された入力軸２１０は、中央孔に挿通される。中央孔５３４は、図２Ａを参照して説明された入力軸２１０の直径よりも長い直径を有する。したがって、揺動歯車５３３は、外筒部５１０の内壁に沿って周回移動することができる。

【0077】

クランク孔５３５内には、クランク軸５４２及びクランク軸受部５４４が配置される。クランク孔５３５は、クランク軸５４２とクランク軸受部５４４とによって全体的に満たされるので、クランク孔５３５の領域は、略剛体としてみなされる。したがって、クランク孔５３５は、角度伝達誤差にほとんど寄与しないと考えられる。

【0078】

シャフト孔５３６には、図２Ａを参照して説明されたシャフト部５２６が挿通される。揺動歯車５３３の上述の周回運動を許容するため、シャフト孔５３６は、シャフト部５２６の断面より広く形成される。

【0079】

図４は、揺動歯車５３３に作用する力を表す概略図である。図３及び図４を参照して、角度伝達誤差を生じさせる孔が説明される。

【0080】

図４は、各内歯ピン５１２から延びる直線Ｌを示す。各直線Ｌは、揺動歯車５３３中の点Ｐに向けて延びる。図４の各直線Ｌは、揺動歯車５３３が、内歯ピン５１２から受ける力を表す。したがって、図４は、内歯ピン５１２から受ける力が、揺動歯車５３３中の一点に集中することを表す。

【0081】

図４は、外筒部５１０の中心点Ｃを更に示す。揺動歯車５３３が、外筒部５１０内で周回移動すると、点Ｐは、中心点Ｃ周りに円軌跡を描きながら移動する。中央孔５３４は、中心点Ｃを中心として形成されるので、揺動歯車５３３が周回移動している間、中央孔５３４から点Ｐまでの距離は略一定である。このことは、中央孔５３４が、角度伝達誤差にほとんど寄与しないことを意味する。

【0082】

中央孔５３４とは異なり、３つシャフト孔５３６は、中心点Ｃから偏心した位置に形成される。点Ｐが、３つのシャフト孔５３６のうち１つに近づくと、点Ｐに接近されたシャフト孔５３６の周囲で変形が生じやすくなる。したがって、シャフト孔５３６は、角度伝達誤差の発生因子となる。

【0083】

＜制御原理＞
図５は、減速機システム１００の制御ブロック線図である。図１、図２Ａ、図３及び図５を参照して、減速機システム１００が更に説明される。

【0084】

図５に示される制御ブロック線図は、アクチュエータセクションと制御セクションとに分けられる。アクチュエータセクションは、図１を参照して説明されたモータ２００及び揺動型減速機５００を表す。制御セクションは、図１を参照して説明された制御回路４００を表す。

【0085】

アクチュエータセクションは、揺動歯車部に形成された孔に起因する角度伝達誤差の振動成分を表すブロックを、一般的な２慣性共振系モデルに追加することによって作成されている。２慣性共振系モデルは、周知であるので、角度伝達誤差の振動成分θ_ｅｒｒを算出する振動成分ブロック１１０が、主に説明される。以下の表は、アクチュエータセクションにおいて用いられる記号の定義を示す。

【0086】

【表1】

【0087】

振動成分ブロック１１０は、以下の数式から、角度伝達誤差の振動成分θ_ｅｒｒを算出する。

【0088】

【数4】

【0089】

振幅Ａ_ｋは、揺動型減速機５００に加わる負荷に影響される変数として考えられてもよい。揺動型減速機５００に加わる負荷が大きいならば、振幅Ａ_ｋは、大きな値であってもよい。揺動型減速機５００に加わる負荷が小さいならば、振幅Ａ_ｋは、小さな値であってもよい。

【0090】

位相φ_ｋは、揺動型減速機５００の構造によって決定される変数として考えられてもよい。位相φ_ｋの値は、揺動歯車部に形成された孔の配置パターンや他の構造的因子に応じて、決定されてもよい。

【0091】

上述の数式は、揺動型減速機５００の様々な構造の角度伝達誤差の振動成分θ_ｅｒｒの算出ために利用可能である。揺動型減速機５００の揺動歯車部は、１つの揺動歯車を有してもよい。代替的に、揺動型減速機５００の揺動歯車部は、複数の揺動歯車を有してもよい。したがって、揺動歯車部の孔の数ｋは、以下の数式によって表されてもよい。

【0092】

【数5】

【0093】

上述の「数５」が、図２Ａを参照して説明された揺動型減速機５００Ａに適用されるならば、「Ｎ_ｇ」の値は、「２」（第１揺動歯車５３１及び第２揺動歯車５３２）である。「ｋ_ｅ」は、角度伝達誤差に寄与する孔の数を意味する。したがって、上述の「数５」が、図２Ａを参照して説明された揺動型減速機５００Ａに適用されるならば、「ｋ_ｅ」の値は、「３」（３つのシャフト孔５３６（図３を参照））である。

【0094】

アクチュエータセクションにおいて、２慣性系共振系モデルから算出された角度伝達誤差θ_Ｓから振動成分θ_ｅｒｒを差し引いた量が、角度伝達誤差として取り扱われる。制御セクションは、振動成分θ_ｅｒｒが低減されるように構築される。

【0095】

制御セクションには、微分ブロック４１１が示されている。微分ブロック４１１は、
モータ２００の回転角θ_Ｍに対して微分演算を行い、モータ２００の角速度ω_Ｍを算出する。微分ブロック４１１は、図１を参照して説明された微分器４１０に対応する。

【0096】

制御セクションには、オブザーバ４２１が示されている。オブザーバ４２１は、角度伝達誤差の角周波数ω_ｄ（すなわち、上述の「数４」の角周波数成分）を算出する。角周波数ω_ｄは、以下の数式によって表されてもよい。

【0097】

【数6】

【0098】

上述の「数６」が、図２Ａを参照して説明された揺動型減速機５００Ａに適用されるならば、「Ｎ_ｐ」の値は、内歯ピン５１２の本数である。

【0099】

オブザーバ４２１は、角周波数ω_ｄを行列成分として含む離散時間状態空間モデルを用いて、角度誤差θ_ｓを推定する。オブザーバ４２１は、上述の離散時間状態空間モデルを用いて、モータ２００の角速度ω_Ｍと、揺動型減速機５００の角速度ω_Ｌと、を更に推定してもよい。オブザーバ４２１は、図１を参照して説明された状態観測器４２０に対応する。

【0100】

制御セクションには、第１ＢＰＦブロック４３４、トルク算出ブロック４３５、動力学補償器４３６及び第２ＢＰＦブロック４３７が示されている。推定された角度誤差θ_ｓを表す角度誤差データは、オブザーバ４２１から第１ＢＰＦブロック４３４へ出力される。第１ＢＰＦブロック４３４は、角度誤差データから角度伝達誤差の角周波数ω_ｄで変動する周波数成分を抽出するバンドパスフィルタとして機能する。第１ＢＰＦブロック４３４によって処理された角度誤差データは、トルク算出ブロック４３５へ出力される。

【0101】

トルク算出ブロック４３５は、角度誤差θ_ｓに、揺動型減速機５００のバネ特性を表す伝達関数Ｋ_ｓを乗算し、角周波数ω_ｄで振動するトルク振動τ_ｓを表すトルク振動データを生成する。トルク振動データは、トルク算出ブロック４３５から動力学補償器４３６へ出力される。本実施形態において、トルク算出部は、第１ＢＰＦブロック４３４とトルク算出ブロック４３５とによって例示される。

【0102】

トルク算出ブロック４３５によって算出されたトルク振動τ_ｓは、揺動歯車部に形成された孔によって引き起こされたトルク振動に対応する。動力学補償器４３６は、トルク振動τ_ｓが低減されるように、補償電流値Ｉ_ｃｍｐを算出し、電流データを生成する。補償電流値Ｉ_ｃｍｐを表す電流データは、動力学補償器４３６から第２ＢＰＦブロック４３７へ出力される。

【0103】

第２ＢＰＦブロック４３７は、電流データから角度伝達誤差の角周波数ω_ｄで変動する周波数成分を抽出するバンドパスフィルタとして機能する。抽出された周波数成分のデータによって、指令電流値の補正に用いられる補償電流値Ｉ_ｃｍｐが最終的に決定される。本実施形態において、電流算出部は、動力学補償器４３６と第２ＢＰＦブロック４３７とによって例示される。第１ＢＰＦブロック４３４、トルク算出ブロック４３５、動力学補償器４３６及び第２ＢＰＦブロック４３７は、図１を参照して説明された第１電流決定部４３１に対応する。

【0104】

制御セクションには、状態フィードバック制御を行う状態フィードバックブロック４３８が示されている。上述の如く、角度誤差θ_ｓの推定値を表すデータ、モータ２００の角速度ω_Ｍの推定値を表すデータ及び揺動型減速機５００の角速度ω_Ｌの推定値を表すデータは、オブザーバ４２１から状態フィードバックブロック４３８へ出力される。状態フィードバックブロック４３８は、角度誤差θ_ｓの推定値を表すデータ、モータ２００の角速度ω_Ｍの推定値を表すデータ及び揺動型減速機５００の角速度ω_Ｌの推定値を表すデータを用いて、状態フィードバック電流の大きさを表す状態フィードバック電流値Ｉ_ｓｆｂを決定する。状態フィードバック制御に関する様々な演算技術が、状態フィードバックブロック４３８に適用されてもよい。本実施形態の制御原理は、状態フィードバック電流値Ｉ_ｓｆｂを決定するための特定の演算技術に限定されない。

【0105】

制御セクションには、加え合わせ点４６１，４６２が示されている。加え合わせ点４６１において、指令電流値Ｉ_ｃｍｄに正の補償電流値Ｉ_ｃｍｐが加入される。加え合わせ点４６２において、指令電流値Ｉ_ｃｍｄに負の状態フィードバック電流値Ｉ_ｓｆｂが加入される。加え合わせ点４６１，４６２は、図１を参照して説明された補正処理部４３３に対応する。

【0106】

制御セクションには、加え合わせ点４４４が示されている。加え合わせ点４４４には、外部装置（図示せず）によって指示されたモータ２００の目標回転角θ_Ｍ^ｒｅｆを表す信号が入力される。加えて、加え合わせ点４４４には、モータ２００の回転角θ_Ｍを表す信号が入力される。モータ２００の回転角θ_Ｍを表す信号は、図１を参照して説明されたエンコーダ３００によって生成される信号に対応する。加え合わせ点４４４において、目標回転角θ_Ｍ^ｒｅｆとモータ２００の回転角θ_Ｍとの間の差が算出される。加え合わせ点４４４は、図１を参照して説明された位置指令生成部４４１に対応する。

【0107】

制御セクションには、ＰＤ制御の比例項として用いられる伝達関数Ｋ_ｐｐを表す比例項ブロック４４５、ＰＤ制御の微分項として用いられる伝達関数Ｋ_ｐｄを表す微分項ブロック４４６及び加え合わせ点４４７，４４８が示されている。比例項ブロック４４５において、目標回転角θ_Ｍ^ｒｅｆとモータ２００の回転角θ_Ｍとの間の差及び伝達関数Ｋ_ｐｐが乗算される。微分項ブロック４４６において、微分ブロック４１１によって算出されたモータ２００の角速度ω_Ｍ及び伝達関数Ｋ_ｐｄが乗算される。加え合わせ点４４７において、これらの乗算の結果得られた差分値が、速度指令値ω_Ｍ^ｒｅｆとして決定される。

【0108】

速度指令値ω_Ｍ^ｒｅｆは、加え合わせ点４４８に入力される。微分ブロック４１１によって算出されたモータ２００の角速度ω_Ｍも、加え合わせ点４４８に入力される。加え合わせ点４４８において、速度指令値ω_Ｍ^ｒｅｆと角速度ω_Ｍとの差（速度偏差）が算出される。比例項ブロック４４５、微分項ブロック４４６及び加え合わせ点４４７，４４８は、図１を参照して説明された速度指令生成部４４２に対応する。

【0109】

制御セクションには、ＰＩ制御の比例項として用いられる伝達関数Ｋ_ｐを表す比例項ブロック４７１、ＰＩ制御の積分項として用いられる伝達関数Ｋ_ｉ／ｓを表す積分項ブロック４７２及び加え合わせ点４７３が示されている。加え合わせ点４４８において算出された速度偏差に関するデータは、比例項ブロック４７１及び積分項ブロック４７２それぞれにおいて処理される。比例項ブロック４７１での処理によって得られたデータ及び積分項ブロック４７２での処理によって得られたデータは、加え合わせ点４７３で足し合わされる。この結果、指令電流値Ｉ_ｃｍｄが決定される。比例項ブロック４７１、積分項ブロック４７２及び加え合わせ点４７３は、図１を参照して説明された電流指令生成部４４３に対応する。

【0110】

上述の如く、指令電流値Ｉ_ｃｍｄは、加え合わせ点４６１，４６２において、補償電流値Ｉ_ｃｍｐ及び状態フィードバック電流値Ｉ_ｓｆｂによって補正される。補正された指令電流値Ｉ_ｃｍｄによって規定される大きさの電流が、その後、モータ２００へ供給される。

【0111】

図６は、制御回路４００の例示的な制御動作を表す概略的なフローチャートである。図１、図５及び図６を参照して、制御回路４００の制御動作が説明される。

【0112】

（ステップＳ１０５）
ステップＳ１０５において、エンコーダ３００は、モータ２００の回転角θ_Ｍを検出する。検出された回転角θ_Ｍを表す信号は、エンコーダ３００から微分器４１０（微分ブロック４１１）へ出力される。その後、ステップＳ１１０が実行される。

【0113】

（ステップＳ１１０）
ステップＳ１１０において、微分器４１０（微分ブロック４１１）は、モータ２００の角速度ω_Ｍを算出する。角速度ω_Ｍは、以下の数式によって算出されてもよい。角速度ω_Ｍの算出の後、ステップＳ１１５が実行される。

【0114】

【数7】

【0115】

（ステップＳ１１５）
ステップＳ１１５において、状態観測器４２０（オブザーバ４２１）は、角度伝達誤差の角周波数ω_ｄを算出する（上述の「数６」を参照）。その後、ステップＳ１２０が実行される。

【0116】

（ステップＳ１２０）
ステップＳ１２０において、状態観測器４２０（オブザーバ４２１）の離散時間状態空間モデルが設定される。ステップＳ１１５において算出された角周波数ω_ｄは、離散時間状態空間モデルの行列成分として用いられる。離散時間状態空間モデルの設定の後、ステップＳ１２５が実行される。

【0117】

（ステップＳ１２５）
ステップＳ１２５において、状態観測器４２０（オブザーバ４２１）は、角度誤差θ_ｓ（上述の「数３」を参照）、モータ２００の角速度ω_Ｍ及び揺動型減速機５００の角速度ω_Ｌといった状態量を推定する。角度誤差θ_ｓの推定値を表すデータは、第１電流決定部４３１へ出力される。角度誤差θ_ｓの推定値を表すデータ、モータ２００の角速度ω_Ｍの推定値を表すデータ及び揺動型減速機５００の角速度ω_Ｌの推定値を表すデータは、第２電流決定部４３２へ出力される。その後、ステップＳ１３０が実行される。

【0118】

（ステップＳ１３０）
ステップＳ１３０において、第１電流決定部４３１は、第１ＢＰＦブロック４３４及び第２ＢＰＦブロック４３７の中心周波数ωを設定する。第１ＢＰＦブロック４３４及び第２ＢＰＦブロック４３７の中心周波数ωは、上述の「数６」を参照して説明された角周波数ω_ｄを算出するための数式から算出されてもよい（すなわち、ω＝ω_ｄ）。中心周波数ωの設定の後、ステップＳ１３５が実行される。

【0119】

（ステップＳ１３５）
ステップＳ１３５において、第１電流決定部４３１は、第１ＢＰＦブロック４３４及び第２ＢＰＦブロック４３７の離散時間状態空間モデルが設定される。ステップＳ１３０において算出された角周波数ωは、第１ＢＰＦブロック４３４及び第２ＢＰＦブロック４３７の散時間状態空間モデルの行列成分として用いられる。離散時間状態空間モデルの設定の後、ステップＳ１４０が実行される。

【0120】

（ステップＳ１４０）
ステップＳ１４０において、第１電流決定部４３１（第１ＢＰＦブロック４３４）は、角度誤差θ_ｓの推定値を表すデータから、角周波数ωで変動する周波数成分を抽出する。その後、ステップＳ１４５が実行される。

【0121】

（ステップＳ１４５）
ステップＳ１４５において、第１電流決定部４３１（トルク算出ブロック４３５）は、角度誤差θ_ｓの推定値を表すデータからトルク振動τ_ｓを表すトルク振動データを生成する。ステップＳ１４０において、不要な周波数成分が、角度誤差θ_ｓの推定値を表すデータから取り除かれているので、第１電流決定部４３１（トルク算出ブロック４３５）は、トルク振動τ_ｓを精度よく算出することができる。トルク振動データの生成の後、ステップＳ１５０が実行される。

【0122】

（ステップＳ１５０）
ステップＳ１５０において、第１電流決定部４３１（動力学補償器４３６）は、トルク振動データから補償電流値Ｉ_ｃｍｐを算出する。その後、ステップＳ１５５が実行される。

【0123】

（ステップＳ１５５）
ステップＳ１５５において、第１電流決定部４３１（第２ＢＰＦブロック４３７）は、補償電流値Ｉ_ｃｍｐを表すデータから角周波数ωで変動する周波数成分を抽出し、指令電流値Ｉ_ｃｍｄの補正に用いられる補償電流値Ｉ_ｃｍｐを決定する。ステップＳ１５５において、不要な周波数成分が、補償電流値Ｉ_ｃｍｐを表すデータから取り除かれるので、指令電流値Ｉ_ｃｍｄは、補償電流値Ｉ_ｃｍｐによって精度よく補正される。補償電流値Ｉ_ｃｍｐの決定の後、ステップＳ１６０が実行される。

【0124】

（ステップＳ１６０）
ステップＳ１６０において、指令情報生成部４４０（位置指令生成部４４１，速度指令生成部４４２）は、速度指令値ω_Ｍ^ｒｅｆを算出する。速度指令値ω_Ｍ^ｒｅｆは、以下の数式から算出されてもよい。速度指令値ω_Ｍ^ｒｅｆの算出の後、ステップＳ１６５が実行される。

【0125】

【数8】

【0126】

（ステップＳ１６５）
ステップＳ１６５において、速度偏差が加算される。ステップＳ１６５における処理は、以下の数式によって表されてもよい。速度偏差の加算の後、ステップＳ１７０が実行される。

【0127】

【数9】

【0128】

（ステップＳ１７０）
ステップＳ１７０において、電流指令生成部４４３は、指令電流値Ｉ_ｃｍｄを算出する。指令電流値Ｉ_ｃｍｄは、以下の数式から算出されてもよい。指令電流値Ｉ_ｃｍｄの算出の後、ステップＳ１７５が実行される。

【0129】

【数10】

【0130】

（ステップＳ１７５）
ステップＳ１７５において、第２電流決定部４３２（状態フィードバックブロック４３８）は、状態フィードバック電流値Ｉ_ｓｆｂを算出する。状態フィードバック電流値Ｉ_ｓｆｂは、以下の数式から算出されてもよい。状態フィードバック電流値Ｉ_ｓｆｂの算出の後、ステップＳ１８０が実行される。

【0131】

【数11】

【0132】

（ステップＳ１８０）
ステップＳ１８０において、補正処理部４３３（加え合わせ点４６２）は、指令電流値Ｉ_ｃｍｄに、負の状態フィードバック電流値Ｉ_ｓｆｂを加入する。ステップＳ１８０における処理は、以下の数式によって表されてもよい。指令電流値Ｉ_ｃｍｄへの状態フィードバック電流値Ｉ_ｓｆｂの加入の後、ステップＳ１８５が実行される。

【0133】

【数12】

【0134】

（ステップＳ１８５）
ステップＳ１８５において、補正処理部４３３（加え合わせ点４６１）は、指令電流値Ｉ_ｃｍｄに、正の補償電流値Ｉ_ｃｍｐを加入する。ステップＳ１８５における処理は、以下の数式によって表されてもよい。指令電流値Ｉ_ｃｍｄへの補償電流値Ｉ_ｃｍｐの加入の後、ステップＳ１９０が実行される。

【0135】

【数13】

【0136】

（ステップＳ１９０）
ステップＳ１９０において、補正処理部４３３は、指令電流値Ｉ_ｃｍｄを駆動部４５０のＤ／Ａチャネルへ出力する。駆動部４５０は、指令電流値Ｉ_ｃｍｄに応じて、駆動信号をモータ２００へ出力する。

【0137】

＜状態観測器＞
図１、図５及び図６を参照して、状態観測器４２０（オブザーバ４２１）が説明される。

【0138】

図５に示されるアクチュエータセクションにおいて、状態変数ｘ及び入力ｕは、以下の数式で表される。

【0139】

【数14】

【0140】

図５に示されるアクチュエータセクションにおける状態方程式は、以下の数式によって与えられる。

【0141】

【数15】

【0142】

連続系における状態観測器４２０（オブザーバ４２１）の状態方程式及び行列は、以下の数式によって与えられる。

【0143】

【数16】

【0144】

離散時間モデルへの上述の連続時間モデルの変換によって、以下の状態方程式及び行列が得られる。

【0145】

【数17】

【0146】

図６を参照して説明されたステップＳ１２０において、上述の「数１７」に示される行列の演算が実行される。

【0147】

＜バンドパスフィルタ＞
図５及び図６を参照して、第１ＢＰＦブロック４３４及び第２ＢＰＦブロック４３７が説明される。

【0148】

第１ＢＰＦブロック４３４及び第２ＢＰＦブロック４３７の伝達関数は、以下の数式によって表されてもよい。以下の数式中、「Ｑ」は、ゲイン曲線の鋭さ（通過域幅）を決定する選択度（Ｑｕａｌｉｔｙ Ｆａｃｔｏｒ）を表す。

【0149】

【数18】

【0150】

第１ＢＰＦブロック４３４及び第２ＢＰＦブロック４３７の連続時間モデルから離散時間モデルへの変換によって、以下の行列が得られる。

【0151】

【数19】

【0152】

図６を参照して説明されたステップＳ１３０において、上述の「数１９」に示される行列の演算が実行される。

【0153】

＜動力学補償器＞
図５及び図６を参照して、動力学補償器４３６が説明される。

【0154】

動力学補償器４３６は、補償電流Ｉ_ｃｍｐから外乱トルクτ_ｄｉｓまでの伝達関数の逆システムとして設定される。動力学補償器４３６は、以下の数式によって表される。

【0155】

【数20】

【0156】

＜実証試験＞
本発明者等は、図２Ａを参照して説明された揺動型減速機５００Ａの設計原理に基づいて構築された減速機を用いて、角度伝達誤差の低減効果を検証した。使用された減速機は、２つの揺動歯車（Ｎ_ｇ＝２）と、４０本の内歯ピン（Ｎ_ｐ＝４０）と、を備える。各揺動歯車には、３つのシャフト孔（ｋ_ｅ＝３）が形成されている。

【0157】

減速機は、４０本の内歯ピンを備えるので、各揺動歯車が、外筒部の内壁に沿って一周するのに、クランク軸は４０回転する必要がある。クランク軸が１回転する間、各揺動歯車に、６回の剛性変動が生ずる。したがって、各揺動歯車が、外筒部の内壁に沿って一周する間に、減速機内では、２４０回の剛性変動が発生することとなる。

【0158】

図７Ａ及び図７Ｂは、実証試験の結果を表すグラフである。図７Ａは、補償電流値による補正がない条件下で得られた試験データを示す。図７Ｂは、補償電流値による補正がある条件下で得られた試験データを示す。

【0159】

図７Ａ及び図７Ｂの横軸は、減速機の出力回転角を表す。図７Ａ及び図７Ｂの縦軸は、角度伝達誤差を表す。図７Ａ及び図７Ｂに示される角度伝達誤差は、正規化され、パーセンテージで表される。図７Ａ及び図７Ｂのグラフの縦軸の縮尺は等しいので、図７Ａに示される角度伝達誤差と図７Ｂに示される角度伝達誤差との間の直接的な比較は可能である。

【0160】

図７Ａに示されるデータと図７Ｂに示されるデータとの間の比較から、補償電流値による補正がある条件下において、角度伝達誤差は、約３０％低減されることが実証された。

【0161】

本発明者等は、図７Ａ及び図７Ｂに示されるデータを用いて、ＦＦＴ解析を行った。本実施形態の制御原理によって角度伝達誤差が低減されているならば、２４０の角周波数成分が補償電流によって低減されていることとなる。

【0162】

図８Ａ及び図８Ｂは、ＦＦＴ解析の結果を表すグラフである。図８Ａは、図７Ａに示されるデータから得られたＦＦＴ解析の結果を示す。図８Ｂは、図７Ｂに示されるデータから得られたＦＦＴ解析の結果を示す。

【0163】

図８Ａ及び図８Ｂのグラフの横軸は、角周波数を示す。図８Ａのグラフと図８Ｂのグラフとを対比すると、２４０の角周波数成分が、大幅に低減されていることが分かる。したがって、本実施形態の制御原理が、角度伝達誤差を効果的に低減できることが実証された。

【0164】

上述の様々な実施形態の原理は、空調機器の制御に対する要求に適合するように、組み合わされてもよい。

【産業上の利用可能性】

【0165】

上述の実施形態の原理は、揺動型減速機を利用する装置に好適に利用される。

【符号の説明】

【0166】

１００・・・・・・・・・・・・・・・・・・・・・・・・・減速機システム
２００・・・・・・・・・・・・・・・・・・・・・・・・・モータ
４００・・・・・・・・・・・・・・・・・・・・・・・・・制御回路
４１０・・・・・・・・・・・・・・・・・・・・・・・・・微分器
４１１・・・・・・・・・・・・・・・・・・・・・・・・・微分ブロック
４２０・・・・・・・・・・・・・・・・・・・・・・・・・状態観測器
４２１・・・・・・・・・・・・・・・・・・・・・・・・・オブザーバ
４３０・・・・・・・・・・・・・・・・・・・・・・・・・補正部
４３４・・・・・・・・・・・・・・・・・・・・・・・・・第１ＢＰＦブロック
４３５・・・・・・・・・・・・・・・・・・・・・・・・・トルク算出ブロック
４３６・・・・・・・・・・・・・・・・・・・・・・・・・動力学補償器
４３７・・・・・・・・・・・・・・・・・・・・・・・・・第２ＢＰＦブロック
５００，５００Ａ・・・・・・・・・・・・・・・・・・・・揺動型減速機
５１２・・・・・・・・・・・・・・・・・・・・・・・・・内歯ピン
５３０・・・・・・・・・・・・・・・・・・・・・・・・・揺動歯車部
５３１・・・・・・・・・・・・・・・・・・・・・・・・・第１揺動歯車
５３２・・・・・・・・・・・・・・・・・・・・・・・・・第２揺動歯車
５３３・・・・・・・・・・・・・・・・・・・・・・・・・揺動歯車
５３６・・・・・・・・・・・・・・・・・・・・・・・・・シャフト孔

【図1】

【図2A】

【図2B】

【図3】

【図4】

【図5】

【図6】

【図7A】

【図7B】

【図8A】

【図8B】