(57)【要約】【課題】本発明は２足ロボットのモータドライブシステム及びインテリジェント温度保護方法を提供する。  該モータドライブシステムは、モータ、パワートランジスタ、母線電解コンデンサ等のキー部品の温度を検出し、温度が第１温度閾値に達した後、モータの最大出力パワーを制御して、キー部品温度の更なる増加を抑制し、温度が第２温度閾値に達した後、温度故障情報を２足ロボットの中央コントローラーに送信して、２足ロボットに現在のタスクを停止させ、それによりモータ及びモータドライブ装置の信頼性を確保する。本発明のモータドライブシステム及びインテリジェント温度保護方法によれば、軽量化されたモータドライブシステムの信頼性を向上させることができ、２足ロボットの柔軟性及び航続力を更に向上させることが期待される。【選択図】図１
2021534725.tif 000002
【特許請求の範囲】
【請求項１】
２足ロボットのモータドライブシステムのインテリジェント温度保護方法であって、
前記モータドライブシステムは電気的に接続されるモータ及びモータドライブ装置を備え、前記モータにはそれぞれモータ回転子の位置及び温度をセンシングするための位置センサ及び温度センサが嵌め込まれ、前記モータドライブ装置はその内部に設置されるパワードライブモジュール、検出モジュール、温度指示モジュール、温度収集モジュール、プロセッサモジュールを備え、
前記検出モジュールはそれぞれモータ回転子位置、三相モータ電流及び母線電圧を検出してプロセッサモジュールに送信するための位置検出モジュール、電流検出モジュール及び母線電圧検出モジュールを備え、
前記温度収集モジュールはモータの内部、パワートランジスタの表面及び母線電解コンデンサの表面に取り付けられる各温度センサの信号を収集して、信号処理を行ってから前記プロセッサモジュールに送信することに用いられ、
前記温度指示モジュールはモータドライブシステムに部品の温度が所定の温度閾値を超えることが存在するかどうかを指示するために用いられ、
前記プロセッサモジュールは２足ロボットの中央コントローラーから送信された制御信号と、前記検出モジュール及び温度収集モジュールの信号とを受信して、受信された信号を処理してから得られたＰＷＭ信号をパワードライブモジュールに出力し、前記プロセッサモジュールはモータドライブシステムにおける部品の温度が所定の温度閾値を超えることが存在するかどうかによって前記温度指示モジュールを開閉し、システムにおける部品の温度が第１温度閾値を超えることが存在する場合、前記プロセッサモジュールは出力パワーを制限し、システムにおける部品の温度が第２温度閾値を超えることが存在する場合、前記プロセッサモジュールは温度故障信号を２足ロボットの中央コントローラーに出力し、
前記パワードライブモジュールはプロセッサモジュールから出力されたモータ制御信号を受信し、それをパワー信号に変換することにより、モータをドライブすることに用いられ、
前記インテリジェント温度保護方法は、
モータ運転過程において、モータ、各パワートランジスタ、各母線電解コンデンサの温度を読み取って、測定温度Ｔ１、Ｔ２、Ｔ３を取得し、Ｔ１がモータの現在の温度を示し、Ｔ２が各パワートランジスタの温度の最大値を示し、Ｔ３が各母線電解コンデンサの温度の最大値を示すステップＳ１と、
それぞれＴ１とモータの第１温度閾値Ｔ１ｍ−１及びモータの第２温度閾値Ｔ１ｍ−２とを、Ｔ２とパワートランジスタの第１温度閾値Ｔ２ｍ−１及びパワートランジスタの第２温度閾値Ｔ２ｍ−２とを、Ｔ３と電解コンデンサの第１温度閾値Ｔ３ｍ−１及び電解コンデンサの第２温度閾値Ｔ３ｍ−２とを比較し、システムにおいて各部品の温度が第１温度閾値、第２温度閾値を超えるかどうかを判断し、Ｔ１ｍ−１＜Ｔ１＜Ｔ１ｍ−２又はＴ２ｍ−１＜Ｔ２＜Ｔ２ｍ−２又はＴ３ｍ−１＜Ｔ３＜Ｔ３ｍ−２の場合、システムにおける部品の温度が第１温度閾値を超えることが存在すると判断し、且つ青／赤２色ＬＥＤ指示灯に青色を表示させ、Ｔ１＞Ｔ１ｍ−２又はＴ２＞Ｔ２ｍ−２又はＴ３＞Ｔ３ｍ−２の場合、システムにおける部品の温度が第２温度閾値を超えることが存在すると判断し、且つ青／赤２色ＬＥＤ指示灯に赤色を表示させ、他の場合、システムが通常の動作状態にあると判断し、青／赤２色ＬＥＤ指示灯をオフし、
Ｔ１ｍ−１＜Ｔ１ｍ−２＜Ｔ１−ｍａｘ、Ｔ２ｍ−１＜Ｔ２ｍ−２＜Ｔ２−ｍａｘ、Ｔ３ｍ−１＜Ｔ３ｍ−２＜Ｔ３−ｍａｘであり、Ｔ１−ｍａｘ、Ｔ２−ｍａｘ、Ｔ３−ｍａｘがそれぞれモータの最大動作温度、パワートランジスタの最大動作温度、電解コンデンサの最大動作温度であるステップＳ２と、
システムにおける部品の温度が第１温度閾値を超えることが存在する場合、モータの最大出力パワーＰｍａｘ−ｎｅｗを次の式のように制限し、
【数１】
2021534725.tif 000014
Ｐ１＝Ｐｍａｘ−Ｋ１×（Ｔ１−Ｔ１ｍ−１）、Ｐ２＝Ｐｍａｘ−Ｋ２×（Ｔ２−Ｔ２ｍ−１）、Ｐ３＝Ｐｍａｘ−Ｋ３×（Ｔ３−Ｔ３ｍ−１）であり、Ｋ１、Ｋ２、Ｋ３が定数係数であり、Ｐｍａｘがモータドライブシステムの元の最大出力パワーであり、Ｔｅ−ｍｉｎが現在の２足ロボットの関節運動を維持する最小トルクであり、ｎが現在の回転速度であるステップＳ３と、を含み、
システムにおける部品の温度が第２温度閾値を超えることが存在する場合、温度故障信号を２足ロボットの中央コントローラーに出力し、現在のタスクを停止させることを特徴とする２足ロボットのモータドライブシステムのインテリジェント温度保護方法。
【請求項２】
前記パワードライブモジュールはパワートランジスタドライブ回路と、ＭＯＳ又はＩＧＢＴパワートランジスタからなる三相フルブリッジ回路とを備えることを特徴とする請求項１に記載の２足ロボットのモータドライブシステムのインテリジェント温度保護方法。
【請求項３】
前記モータ回転子位置の検出はモータに嵌め込まれる位置センサの信号を収集することにより実施され、前記母線電圧の検出は抵抗を利用して母線電圧を分圧することにより実施されることを特徴とする請求項１に記載の２足ロボットのモータドライブシステムのインテリジェント温度保護方法。
【請求項４】
前記プロセッサモジュールはＳＴＭ３２又はＤＳＰを用いることを特徴とする請求項１に記載の２足ロボットのモータドライブシステムのインテリジェント温度保護方法。
【請求項５】
前記温度センサは熱抵抗を用いることを特徴とする請求項１に記載の２足ロボットのモータドライブシステムのインテリジェント温度保護方法。
【請求項６】
前記温度指示モジュールは青／赤２色ＬＥＤ指示灯を用いて実施され、システムに存在する部品の温度値が第１温度閾値を超える場合、青／赤２色ＬＥＤ指示灯は青色を表示し、第２温度閾値を超える場合、青／赤２色ＬＥＤ指示灯は赤色を表示することを特徴とする請求項１に記載の２足ロボットのモータドライブシステムのインテリジェント温度保護方法。
【請求項７】
前記モータが表面実装型永久磁石同期モータである場合、前記ステップＳ３におけるモータの最大出力パワーを制限することは、所定のｉｑ＊を制限することにより実施され、
所定のｉｑ＊を制限する計算式は、以下のとおりであり、
【数２】
2021534725.tif 000015
ｉq-ｎｅｗ＊がパワー制限した後の所定の横軸電流であり、ｉｑ＊が速度調整器から出力された元の横軸電流であり、ｎｐがモータの極対数であり、ｎがモータの現在の回転速度であり、Ψｆが永久磁石の鎖交磁束であることを特徴とする請求項１に記載の２足ロボットのモータドライブシステムのインテリジェント温度保護方法。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明はモータ制御技術分野に属し、具体的に２足ロボットのモータドライブシステム及びインテリジェント温度保護方法に関する。
【背景技術】
【０００２】
２足ロボットは直立歩行やそれに関連する動作を実現することができ、動作が柔軟且つ自在で安定するという利点を有し、人間の生活環境に良く適応でき、人間のために多くの問題を解決することが期待される。現在、電池は２足ロボットの主流のエネルギー形式であるが、航続時間が短いという問題がある。モータドライブシステムは電気ドライブ型２足ロボットの重要な構成部分であり、１つの２足ロボットには３０個以上のモータ及びドライブ装置が存在することができ、従って、モータドライブシステムの軽量化設計により２足ロボットの重量を軽減し、２足ロボットの柔軟性及び航続力を更に向上させることができる。
【０００３】
モータドライブシステムの軽量化設計を実現するために、２足ロボットのモータを設計する際にパワー密度をできる限り高くする必要があり、モータドライブ装置も軽量化設計を必要としている。モータパワー密度の向上に伴い、モータの発熱量が増加することとなり、それによりモータの温度が上昇し、モータの通常動作に影響してしまう。放熱装置はモータドライブ装置の不可欠な部分であり、軽量化設計を実現するために、モータドライブ装置の放熱装置はできる限り小さく設計される可能性があり、それにより放熱効果が低下し、ドライブ装置の内部部品の耐用年数及び信頼性に影響してしまう。従って、モータドライブシステムの軽量化設計とシステムの信頼性との間に矛盾が存在し、モータドライブシステムの重量を軽減すると、システムが過熱しやすくなり、それによりシステムの信頼性に影響してしまう。
【０００４】
従って、２足ロボットの高パワー密度の軽量化モータドライブシステムを設計するとき、システムの信頼性を確保するようにシステムのキー部品に対して温度検出を行う必要がある。中国特許番号ＣＮ２０５８８２６７６Ｕには、モータドライブ回路におけるパワートランジスタの温度を検出して、温度閾値を超えてからモータのドライブを停止させる。このような方法はモータドライブシステムの信頼性をある程度向上できるが、２足ロボットの通常走行に影響し、ひいては２足ロボットを転倒して損傷させてしまう。中国特許番号ＣＮ１０５５１７９０２Ａには、無人航空機のモータの温度を検出してパワーを動的に調整することにより、無人航空機モータの信頼性を向上させる。このような方法はモータの信頼性を向上できるが、モータドライブ装置の信頼性を確保できない。
【発明の概要】
【発明が解決しようとする課題】
【０００５】
従来技術の欠点に対して、本発明はインテリジェント温度保護機能を持つ２足ロボットのモータドライブシステム及び制御方法を提供し、具体的な技術案は以下のとおりである。
【課題を解決するための手段】
【０００６】
２足ロボットのモータドライブシステムであって、
前記モータドライブシステムは電気的に接続されるモータ及びモータドライブ装置を備え、前記モータにはそれぞれモータ回転子の位置及び温度をセンシングするための位置センサ及び温度センサが嵌め込まれ、前記モータドライブ装置はその内部に設置されるパワードライブモジュール、検出モジュール、温度指示モジュール、温度収集モジュール、プロセッサモジュールを備え、
前記検出モジュールはそれぞれモータ回転子位置、三相モータ電流及び母線電圧を検出してプロセッサモジュールに送信するための位置検出モジュール、電流検出モジュール及び母線電圧検出モジュールを備え、
前記温度収集モジュールはモータの内部、パワートランジスタの表面及び母線電解コンデンサの表面に取り付けられる各温度センサの信号を収集して、信号処理を行ってから前記プロセッサモジュールに送信することに用いられ、
前記温度指示モジュールはモータドライブシステムに部品の温度が所定の温度閾値を超えることが存在するかどうかを指示するために用いられ
前記プロセッサモジュールは２足ロボットの中央コントローラーから送信された制御信号と、前記検出モジュール及び温度収集モジュールの信号とを受信して、受信された信号を処理してから得られたＰＷＭ信号をパワードライブモジュールに出力し、前記プロセッサモジュールはモータドライブシステムにおける部品の温度が所定の温度閾値を超えることが存在するかどうかによって前記温度指示モジュールを開閉し、システムにおける部品の温度が第１温度閾値を超えることが存在する場合、前記プロセッサモジュールは出力パワーを制限し、システムにおける部品の温度が第２温度閾値を超えることが存在する場合、前記プロセッサモジュールは温度故障信号を２足ロボットの中央コントローラーに出力し、
前記パワードライブモジュールはプロセッサモジュールから出力されたモータ制御信号を受信し、それをパワー信号に変換することにより、モータをドライブすることに用いられる２足ロボットのモータドライブシステム。
【０００７】
更に、前記パワードライブモジュールはパワートランジスタドライブ回路と、ＭＯＳ又はＩＧＢＴパワートランジスタからなる三相フルブリッジ回路とを備える。
【０００８】
更に、前記モータ回転子位置の検出はモータに嵌め込まれる位置センサの信号を収集することにより実施され、前記母線電圧の検出は抵抗を利用して母線電圧を分圧することにより実施される。
【０００９】
更に、前記プロセッサモジュールはＳＴＭ３２又はＤＳＰを用いる。
【００１０】
更に、前記温度センサは熱抵抗を用いる。
【００１１】
更に、前記温度指示モジュールは青／赤２色ＬＥＤ指示灯を用いて実施され、システムに存在する部品の温度値が第１温度閾値を超える場合、青／赤２色ＬＥＤ指示灯は青色を表示し、第２温度閾値を超える場合、青／赤２色ＬＥＤ指示灯は赤色を表示する。
【００１２】
２足ロボットのモータドライブシステムのインテリジェント温度保護方法において、該方法はモータドライブシステムにより実現され、前記方法は、
モータ運転過程において、モータ、各パワートランジスタ、各母線電解コンデンサの温度を読み取って、測定温度Ｔ１、Ｔ２、Ｔ３を取得し、Ｔ１がモータの現在の温度を示し、Ｔ２が各パワートランジスタの温度の最大値を示し、Ｔ３が各母線電解コンデンサの温度の最大値を示すステップＳ１と、
それぞれＴ１とモータの第１温度閾値Ｔ１ｍ−１及びモータの第２温度閾値Ｔ１ｍ−２とを、Ｔ２とパワートランジスタの第１温度閾値Ｔ２ｍ−１及びパワートランジスタの第２温度閾値Ｔ２ｍ−２とを、Ｔ３と電解コンデンサの第１温度閾値Ｔ３ｍ−１及び電解コンデンサの第２温度閾値Ｔ３ｍ−２とを比較し、システムにおいて各部品の温度が第１温度閾値、第２温度閾値を超えるかどうかを判断し、Ｔ１ｍ−１＜Ｔ１＜Ｔ１ｍ−２又はＴ２ｍ−１＜Ｔ２＜Ｔ２ｍ−２又はＴ３ｍ−１＜Ｔ３＜Ｔ３ｍ−２の場合、システムにおける部品の温度が第１温度閾値を超えることが存在すると判断し、且つ青／赤２色ＬＥＤ指示灯に青色を表示させ、Ｔ１＞Ｔ１ｍ−２又はＴ２＞Ｔ２ｍ−２又はＴ３＞Ｔ３ｍ−２の場合、システムにおける部品の温度が第２温度閾値を超えることが存在すると判断し、且つ青／赤２色ＬＥＤ指示灯に赤色を表示させ、他の場合、システムが通常の動作状態にあると判断し、青／赤２色ＬＥＤ指示灯をオフし、
Ｔ１ｍ−１＜Ｔ１ｍ−２＜Ｔ１−ｍａｘ、Ｔ２ｍ−１＜Ｔ２ｍ−２＜Ｔ２−ｍａｘ、Ｔ３ｍ−１＜Ｔ３ｍ−２＜Ｔ３−ｍａｘであり、Ｔ１−ｍａｘ、Ｔ２−ｍａｘ、Ｔ３−ｍａｘがそれぞれモータの最大動作温度、パワートランジスタの最大動作温度、電解コンデンサの最大動作温度であるステップＳ２と、
システムにおける部品の温度が第１温度閾値を超えることが存在する場合、モータの最大出力パワーＰｍａｘ−ｎｅｗを以下の式のように制限し、
【数１】
2021534725.tif 000003
Ｐ１＝Ｐｍａｘ−Ｋ１×（Ｔ１−Ｔ１ｍ−１）、Ｐ２＝Ｐｍａｘ−Ｋ２×（Ｔ２−Ｔ２ｍ−１）、Ｐ３＝Ｐｍａｘ−Ｋ３×（Ｔ３−Ｔ３ｍ−１）であり、Ｋ１、Ｋ２、Ｋ３が定数係数であり、Ｐｍａｘがモータドライブシステムの元の最大出力パワーであり、Ｔｅ−ｍｉｎが現在の２足ロボットの関節運動を維持する最小トルクであり、ｎが現在の回転速度であるステップＳ３と、を含み、
システムにおける部品の温度が第２温度閾値を超えることが存在する場合、温度故障信号を２足ロボットの中央コントローラーに出力し、現在のタスクを停止させる。
【００１３】
更に、前記モータが表面実装型永久磁石同期モータである場合、前記ステップＳ３におけるモータの最大出力パワーを制限することは、所定のｉｑ＊を制限することにより実施され、
所定のｉｑ＊を制限する計算式は、以下のとおりであり、
【数２】
2021534725.tif 000004
ｉｑ-ｎｅｗ＊がパワー制限した後の所定の横軸電流であり、ｉｑ＊が速度調整器から出力された元の横軸電流であり、ｎｐがモータの極対数であり、ｎがモータの現在の回転速度であり、Ψｆが永久磁石の鎖交磁束である２足ロボットのモータドライブシステムのインテリジェント温度保護方法。
【発明の効果】
【００１４】
本発明の有益な効果は以下のとおりである。
【００１５】
本発明に係るモータドライブシステム及び制御方法によれば、キー部品（モータ、パワートランジスタ、母線電解コンデンサ等）に対して温度検出を行うことができ、温度が一定の温度閾値に達した後、モータの最大出力パワーを制御して、キー部品の温度の更なる増加を抑制し、温度が第２温度閾値を超えた後、温度故障情報を２足ロボットの中央コントローラーに送信して、２足ロボットに現在のタスクを直ちに停止させ、それによりモータドライブシステムが過熱により損傷されないように確保する。本発明の方法によれば、２足ロボットの軽量化されたモータドライブシステムの信頼性を向上させることに役立つ。
【図面の簡単な説明】
【００１６】
【図１】図１は本発明の２足ロボットのモータドライブシステムのブロック構成図である。
【図２】図２は本発明の２足ロボットのモータドライブシステムのインテリジェント温度保護方法のフローチャートである。
【図３】図３は本発明の一実施例の永久磁石同期モータの最大パワーを制限する制御ブロック図である。
【発明を実施するための形態】
【００１７】
以下、図面を参照しながら好適な実施例によって本発明を詳しく説明する。本発明の目的及び効果はより明らかになるであろう。理解されるように、ここで説明される具体的な実施例は本発明を解釈するためのものであって、本発明を制限するためのものではない。
【００１８】
本発明に係る２足ロボットのモータドライブシステムのブロック構成図はを図１に示す。この２足ロボットのモータドライブシステムはモータ及びモータドライブ装置を備え、一定の減速比を有する減速装置と接続することができる。前記モータにはモータ回転子位置及びモータ温度を検出する位置センサ及び温度センサが嵌め込まれる。前記モータドライブ装置はケーブルによって前記モータに接続され、前記モータを制御し、モータ内の位置センサ及び温度センサのデータを受信することに用いられる。前記減速機はよく使用されるハーモニック減速機装置を用いてもよい。
【００１９】
前記モータドライブ装置はケーシングと、放熱器と、前記ケーシングの内部に取り付けられる制御ボードとを備え、該制御ボードはパワードライブモジュール、位置・電流・母線電圧検出モジュール、温度指示モジュール、温度収集モジュール、プロセッサモジュール等を備える。
【００２０】
前記パワードライブモジュールはプロセッサモジュールから出力されたモータ制御信号を受信してそれをパワー信号に変換することにより、サーボモータをドライブすることに用いられる。
【００２１】
一実施形態として、パワードライブモジュールはパワートランジスタドライブ回路と、ＭＯＳ又はＩＧＢＴパワートランジスタからなる三相フルブリッジ回路とを備える。
【００２２】
前記位置・電流・母線電圧検出モジュールはモータ回転子位置、三相モータ電流及び母線電圧を検出して、プロセッサモジュールに送信して演算処理を行うことに用いられる。
【００２３】
サーボモータアルゴリズムを実現するために、モータ回転子位置並びに三相モータ電流及び母線電圧を検出する必要がある。前記モータ回転子位置の検出はモータに嵌め込まれる位置センサの信号を収集することにより実施され、前記モータ電流は電流検出モジュールにより検出され、前記母線電圧の検出は抵抗を利用して母線電圧を分圧することにより実施される。
【００２４】
前記温度指示モジュールは青／赤２色ＬＥＤ指示灯を用いて実現され、モータドライブシステムに部品の温度が第１温度閾値又は第２温度閾値を超えることが存在するかどうかを指示することに用いられる。
【００２５】
前記温度収集回路はモータドライブシステムの各温度センサの信号を収集して、信号増幅、フィルタリング等の処理を行うことに用いられる。前記温度センサはモータの内部、パワートランジスタの表面及び母線電解コンデンサの表面に取り付けられる。
【００２６】
温度のサンプリング精度を向上させるために、前記温度センサは白金熱抵抗を用いて、ホイートストーンブリッジと高精度の計装アンプＡＤ６２０とからなるアンプ回路によって信号を処理し、最終的にプロセッサのＡＤＣインターフェースに入力する。
【００２７】
前記プロセッサモジュールは２足ロボットの中央コントローラーから送信された制御信号を受信し、位置、電流、母線電圧、各部品の温度等の信号を収集して、モータ制御アルゴリズムを実行し、ＰＷＭ信号をドライブモジュールに出力することにより、モータ制御を実現する。一実施形態として、プロセッサモジュールは主周波数が１６８ＭＨｚであり、多くのインターフェースを有するＳＴＭ３２Ｆ４０７ＶＧチップを採用する。
【００２８】
本発明は２足ロボットのモータドライブシステムのインテリジェント温度保護方法を提供し、その制御アルゴリズムの流れは図２に示され、具体的なステップは以下のとおりである。
【００２９】
ステップ１：モータ運転過程において、キー部品（モータ、各パワートランジスタ、各母線電解コンデンサ）の温度を読み取る。測定温度Ｔ１、Ｔ２、Ｔ３を取得し、Ｔ１がモータの現在の温度を示し、Ｔ２が各パワートランジスタの温度の最大値を示し、Ｔ３が各母線電解コンデンサの温度の最大値を示す。
【００３０】
ステップ２：それぞれＴ１とモータの第１温度閾値Ｔ１ｍ−１及びモータの第２温度閾値Ｔ１ｍ−２とを、Ｔ２とパワートランジスタの第１温度閾値Ｔ２ｍ−１及びパワートランジスタの第２温度閾値Ｔ２ｍ−２とを、Ｔ３と電解コンデンサの第１温度閾値Ｔ３ｍ−１及び電解コンデンサの第２温度閾値Ｔ３ｍ−２とを比較し、システムにおける各部品の温度が第１、第２温度閾値を超えるかどうかを判断し、Ｔ１ｍ−１＜Ｔ１＜Ｔ１ｍ−２又はＴ２ｍ−１＜Ｔ２＜Ｔ２ｍ−２又はＴ３ｍ−１＜Ｔ３＜Ｔ３ｍ−２の場合、システムにおける部品の温度が第１温度閾値を超えることが存在すると判断し、且つ青／赤２色ＬＥＤ指示灯に青色を表示させ、Ｔ１＞Ｔ１ｍ−２又はＴ２＞Ｔ２ｍ−２又はＴ３＞Ｔ３ｍ−２の場合、システムにおける部品の温度が第２温度閾値を超えることが存在すると判断し、且つ青／赤２色ＬＥＤ指示灯に赤色を表示させ、他の場合、システムが通常の動作状態にあると判断し、青／赤２色ＬＥＤ指示灯をオフし、
Ｔ１ｍ−１＜Ｔ１ｍ−２＜Ｔ１−ｍａｘ、Ｔ２ｍ−１＜Ｔ２ｍ−２＜Ｔ２−ｍａｘ、Ｔ３ｍ−１＜Ｔ３ｍ−２＜Ｔ３−ｍａｘであり、式中、Ｔ１−ｍａｘ、Ｔ２−ｍａｘ、Ｔ３−ｍａｘがそれぞれモータの最大動作温度、パワートランジスタの最大動作温度、電解コンデンサの最大動作温度である。
【００３１】
ステップ３：システムにおける部品の温度が第１温度閾値を超えることが存在する場合、モータの最大出力パワーＰｍａｘ−ｎｅｗを以下の式のように制限し、
【数３】
2021534725.tif 000005
Ｐ１＝Ｐｍａｘ−Ｋ１×（Ｔ１−Ｔ１ｍ−１）、Ｐ２＝Ｐｍａｘ−Ｋ２×（Ｔ２−Ｔ２ｍ−１）、Ｐ３＝Ｐｍａｘ−Ｋ３×（Ｔ３−Ｔ３ｍ−１）であり、Ｋ１、Ｋ２、Ｋ３が定数係数であり、Ｐｍａｘがモータドライブシステムの元の最大出力パワーであり、Ｔｅ−ｍｉｎが現在の２足ロボットの関節運動を維持する最小トルクであり、ｎが現在の回転速度であり、
システムにおける部品の温度が第２温度閾値を超えることが存在する場合、温度故障信号を２足ロボットの中央コントローラーに出力して、２足ロボットに現在のタスクを直ちに停止させる。
【００３２】
ステップ３におけるモータの最大出力パワーの調整はモータ電流を制限することにより実現される。
【００３３】
一実施形態として、２足ロボットのサーボモータは表面実装型永久磁石同期モータを用いて、位置制御方式を用いる。永久磁石同期モータの最大パワーを制限する制御ブロック図は図３に示され、ｉｄ＝０に基づくベクトル制御アルゴリズムを用いて、位置サーボ制御を実現する。全体構造はカレントループ、速度ループ及び位置ループからなる。
【００３４】
システムの最も外側のループは位置ループであり、所定の位置θ＊は２足ロボットの中央コントローラーからのものであり、ある関節の角度を制御することに用いられ、フィードバック位置θはエンコーダデータによって計算して取得したものであり、位置調整器を通過した後、所定の回転速度ｎ＊を出力する。システムの中間のループは速度ループであり、所定の回転速度ｎ＊は位置ループの出力からのものであり、フィードバック回転速度ｎはエンコーダデータによって計算して取得したものであり、速度調整器を通過した後、所定の横軸電流ｉｑ＊を出力する。モータの最大出力パワーの制御を実現するために、速度ループから出力された所定の横軸電流ｉｑ＊に対して最大リミティングを行って、ｉｑ-ｎｅｗ＊を取得する。システムの最も内側のループはカレントループであり、ｄ軸及びｑ軸の２つのカレントループを含み、所定の横軸電流ｉｑ＊は最大出力パワーのリミティング出力からのものであり、直軸電流ｉｄ＊＝０であり、電流のフィードバックは測定された相電流ｉＡ、ｉＢをＣｌａｒｋ変換及びＰａｒｋ変換を通じて、現在のｉｄ、ｉｑを取得する。電流調整器を通過した後、横軸／直軸電圧を出力して、座標変換、ＳＶＰＷＭ及びインバータを通過した後、モータに出力する。永久磁石同期モータの位置−回転速度−電流の３つの閉ループの制御は本技術分野でよく使用される構造形式であり、Ｃｌａｒｋ及びＰａｒｋ座標変換、位置、回転速度、電流調整器、ＳＶＰＷＭ等のアルゴリズムはいずれも当業者がよく知られるものであるため、ここで詳細な説明は省略する。
【００３５】
モータの最大出力パワーの制御を実現するために、所定のｉｑ＊を制限することにより実現されてもよく、具体的な方法は以下のとおりである。
【００３６】
所定のｉｑ＊を制限する計算式は、以下のとおりであり、
【数４】
2021534725.tif 000006
ｉｑ-ｎｅｗ＊がパワー制限した後の所定の横軸電流であり、ｉｑ＊が速度調整器から出力された元の横軸電流であり、ｎｐがモータの極対数であり、ｎがモータの現在の回転速度であり、Ψｆが永久磁石の鎖交磁束である。
【００３７】
具体的な導出公式については、
モータトルクの計算式は、以下のとおりである。
【数５】
2021534725.tif 000007
Ψｄ、Ψｑの計算式は、以下のとおりである。
【数６】
2021534725.tif 000008
従って、以下の計算式が得られる。
【数７】
2021534725.tif 000009
【００３８】
表面実装型永磁モータＰＭＳＭに対して、Ｌｄ＝Ｌｑである。よって、モータトルクの方程式は次の式に簡素化され
【数８】
2021534725.tif 000010
従って、モータ出力パワーの計算式は以下のとおりである。
【数９】
2021534725.tif 000011
Ψｄ、Ψｑがそれぞれｄ、ｑ軸の鎖交磁束であり、ｉｄ、ｉｑがそれぞれｄ、ｑ軸の電流であり、Ｌｄ、Ｌｑがそれぞれｄ、ｑ軸のインダクタンスである。
【００３９】
ｉｄ、ｉｑの計算式は以下のとおりである。
【数１０】
2021534725.tif 000012
ｉα、ｉβの計算式は以下のとおりである。
【数１１】
2021534725.tif 000013
ｉＡ、ｉＢがそれぞれＡ、Ｂ二相電流である。
【００４０】
以上、本発明では、２足ロボットのモータドライブシステムにおける各キー部品（モータ、パワートランジスタ、母線電解コンデンサ等）に対して温度検出を行い、第１温度閾値を超える場合、この時のモータドライブシステムの温度がより高いと説明され、モータの最大出力パワーを制御することにより、２足ロボットの基本動作に影響せずにキー部品温度の更なる増加を抑制することができる。第２温度閾値を超える場合、この時のモータドライブシステムの温度が部品の最大動作温度に接近すると説明され、温度故障情報を２足ロボットの中央コントローラーに送信することにより、現在のタスクを停止し、それによりモータドライブシステムが熱故障により損傷されないように確保し、２足ロボットがモータドライブシステムの故障により異常動作してひいては損傷されないように確保する。このような方法に基づき、２足ロボットのモータドライブシステムは設計時に更に軽量化設計を行うことができ、それにより２足ロボットの柔軟性及び航続力を更に向上させることが期待される。
【００４１】
当業者であれば理解されるように、以上の説明は本発明の好適な実施例であって、本発明を制限するためのものではない。上記実施例を参照して本発明を詳しく説明したが、当業者であれば、依然として上記各実施例に記載される技術案を修正したり、その一部の技術的特徴に対して等価置換を行ったりすることができる。本発明の趣旨や原則内に行った修正や等価置換等はいずれも本発明の保護範囲内に含まれるべきである。
【図１】
2021534725.tif 000016
【図２】
2021534725.tif 000017
【図３】
2021534725.tif 000018
【国際調査報告】
2021534725.tif 000019
2021534725.tif 000020
2021534725.tif 000021
2021534725.tif 000022