モーター電流はロボットアクチュエータ内で発生する電磁トルクを推定できます。関節の外部トルクを直接測定するわけではありません。推定値は、出力トルクや接触トルクを表現する前に、校正済みのモータートルク定数、トランスミッションモデル、ロボットのダイナミクスを通過する必要があります。
未検証の電流コマンドではなく、測定されたトルクを発生させるq軸電流を使いましょう。次にセンサーのオフセット、符号、モーター温度、ギア比、方向依存効率、重力、慣性、摩擦を考慮します。電圧飽和や電流のクリッピングは、式が正しく見えても仮定された関係を無効にすることがあります。
このガイドは ロボットフォーストルクセンサーガイド、 関節摩擦ガイド、 システム識別ガイドと組み合わせて使用してください。電流由来トルクは、不確実性を明示したモデルベースの推定値として扱い、認定された接触力センシングとは見なさないでください。
アプリケーションに必要なトルクを定義する
電磁モータートルク、ギアボックス入力トルク、ジョイント出力トルク、外部相互作用トルクは異なる量です。コントローラーは、インナーループ調整のためにモータートルク、負荷監視用にジョイントトルク、衝突および接触推定のために外部トルクを必要とする場合があります。方程式を選ぶ前に、量、座標系、符号、サンプル時間の名前を明記してください。
また、その値が瞬時、フィルタリング、ピーク、連続、または平均されたものかを定義します。ペイロード監視に適したローパス推定は、接触検出には遅延しすぎる場合があります。高速残差はノイズが多すぎて正確な静力報告に適している場合があります。
意図した決定とユニットの両方を記録してください。数値表示、コマンドの制限、保護停止の発動には、より強力な証拠と独立性が求められます。
測定されたq軸電流から始めます
場指向制御において、q軸電流は通常、コントローラの慣習に従い表面永久磁石モーターにトルクを発生させる電流を指します。位相電流、バス電流、RMS電流、ピーク電流、電流コマンドは互換性を持ちません。ドライブのドキュメントを読み、実際のフィードバック信号とそのスケーリングや符号を記録してください。
電流センサーのオフセットはゼロ負荷時に偽トルクを生み出し、ゲイン誤差は傾斜を変えます。リップル、ADCタイミング、デッドタイム、フィルタリングは帯域幅に影響を与えます。試運転中に生の電流や最小限の処理済みの電流を捕捉し、後のフィルターで測定源が隠されないようにしましょう。
| ログド・バリュー | それが象徴するもの | 共通誤差 | 必須チェック |
|---|---|---|---|
| 現指揮 | 要求されたコントローラーアクション | クリッピングまたはトラッキングエラー | 測定電流と比較してください |
| 測定されたq軸電流 | トルク発生電流推定値 | オフセット、符号、またはスケール | ゼロ電流および基準電流試験 |
| 相電流 | 位相あたりの電流 | 変換慣例 | クラーク・パークの実装を検証 |
| 直流バス電流 | 電源電流 | モータートルクと混同されています | 電圧と効率モデルでのみ使用可能です |
| フィルター電流 | 帯域幅制限信号 | 隠れた遅延 | 測定振幅と位相応答 |
モータートルク定数を校正します
理想的な関係は、トルク定数にq軸電流を掛けたモータートルクです。カタログトルク定数はピーク電流またはRMS、ライン間または位相の慣例、指定された温度を用いる場合があります。慣例の不一致は固定スケール誤差を生み出し、それがすべてのソフトウェアテストを通過することがあります。
装着したアクチュエーターを、複数の正負電流で既知の反力トルクまたは出力力で校正します。検証済みの線形範囲内にのみオフセットと傾きを当てます。熱安定化後も同じことを繰り返します。磁石束、巻線抵抗、電流制御マージンは温度によって変化するためです。
トランスミッションを通るモータートルクのマッピング
理想的な減速器の場合、出力トルクはギア比に比例します。実出力は効率にも依存し、トルク、速度、方向、温度、潤滑、そして負荷がモーターを駆動するかどうかによって変わります。そのため、バックドライブと運転は異なるマッピングを必要とすることがあります。
モーターと望ましい出力境界の間にベアリング、シール、ケーブルの力がある場合は含めてください。すべての象限で符号を検証してください:正・負の速度と正のトルクが交差します。単一スカラー効率は、テストが支持する範囲内でのみ許容されます。
内部力学と外部トルクの分離
電流は重力、加速度、摩擦、外部相互作用のためのトルクを供給します。共通残差は、モデル化された重力、慣性、コリオリ効果や遠心効果、摩擦を電流由来のジョイントトルクから差し引くものです。残りは未モデルまたは外部トルクとして解釈されます。
この残留は純粋な接触ではありません。ペイロードエラー、フレキシブルケーブル、ギアボックスヒステリシス、構造振動、モデルミスマッチも見られます。 査読付き衝突検出研究 は、運動量や擾乱観測者がモデル残差を活用できることを示していますが、展開された閾値は依然としてロボット固有の検証を必要とします。
| 残差成分 | 典型的な署名 | 有益な実験です | 省略した場合のリスク |
|---|---|---|---|
| 重力誤差 | ポーズ依存バイアス | 既知のペイロードを持つスローポーズグリッド | ポーズの誤接触 |
| 慣性誤差 | 加速度相関ピーク | 双方向軌道掃走 | 運動中の誤衝突 |
| 摩擦 | 速度と方向の依存性 | 定速反転 | バイアスロースピードトルク |
| 伝送ヒステリシス | 履歴依存の違い | 積載および卸荷サイクル | 非重複閾値 |
| 外部連絡 | 課題依存的持続的または衝動的残差 | 計測付き接触試験 | 見逃しや遅い検出 |
閾値設定前に重力とペイロードを特定する
重力トルクはジョイントポーズ、リンク質量、重心、ペイロードに依存します。ペイロードの変化は、持続的な外部力のように見えることがあります。ペイロード特性を推定または特定し、構成データが欠落または一貫性に欠けている場合はトルク判断を拒否します。
慣性トルクを小さくするために、両方向に遅い軌道を集めます。作業空間全体で、現在由来のトルクと剛体重力予測を比較してください。フィッティングのポーズを保持して、モデルが単にキャリブレーションポイントを記憶するのではなく一般化しているかどうかを試してください。
エンコーダノイズを増幅しない慣性をモデル化します
慣性トルクは加速度とロボットの結合動力学に依存します。エンコーダ位置の数値微分は量子化やノイズを増幅し、重いフィルタリングは推定を遅らせます。同期された速度と加速度の推定値と、文書化されたフィルターレイテンシを好む。
代表的な加速度とペイロードを安全な範囲内で励起させましょう。 ジョイントアクチュエーターテストワークフロー を使って、要求された量、測定量、参照量を比較してください。加速と減速の両方で残差を確認してください。なぜなら、標識誤差は一方向にしか打ち消されないからです。
摩擦を状態依存の不確実性として扱う
摩擦には、粘性、クーロン、粘性、シール、ベアリング、トランスミッション効果が含まれます。速度、方向、位置、温度、荷重、運動履歴によって異なります。ほぼゼロ速度の場合、同じ測定電流が運動開始前のトルク範囲を支えることがあります。
専用の軌道で摩擦を合わせ、別々のサイクルで検証します。 摩擦補償ガイド は、1つの一定オフセットではほとんど十分でない理由を説明しています。正確だが支持されない値を強制するのではなく、ゼロ速度推定の信頼区間を中心に保ちましょう。
飽和と線形権威の喪失を検出
高速時には利用可能なバス電圧が要求された電流を追及するのに不十分な場合があります。電流制限、熱減格、インバーター保護も応答を妨げることがあります。このとき、コマンドとトルクの関係は成立しませんが、測定された電流はセンサー精度内で実際に発生したトルクを報告することがあります。
推定値のほかに、ログ電圧利用率、電流追跡誤差、制限状態および故障も含まれます。 ODrive制御のドキュメント は、コントローラ信号と制限を区別するドライブインターフェースの一例です。キャリブレーションされた動作範囲を超えた場合、出力を無効とマークしたり、信頼度を下げたりします。
接触検出に時系列データを用いる
衝突検出器は残差大きさ、持続時間、変化率、方向、ロボットの状態を考慮しなければなりません。指令された加速時の強いインパルスは、静的保持中の持続的な残留電流とは異なります。ヒステリシスやデバウンスはチャッターを減らす一方で、検出遅延も増加させます。
姿勢、ペイロード、速度、温度を対象にラベル付きノーコンタクトおよびコンタクト試験から閾値を構築します。偽陽性および偽陰性率と検出期間を報告してください。最も分離しやすい劇的な接触ケースだけにチューニングしないでください。
送信エラーが重要な場合は出力フィードバックを追加します
モーターエンコーダはすべてのバックラッシュ、コンプライアンス、出力側の乱れを観測することはできません。ロードサイドエンコーダは、トランスミッションツイストを露出させ、比率、ゼロ、タイムスタンプが整列した状態推定値を改善できます。モーターと負荷の角度をトルクとして解釈する前に、 デュアルエンコーダーガイド を読んでください。
剛性が既知で局所的に有効であれば、弾性たわみは別のトルク推定値として提供できます。電流由来トルクと独立した基準と比較してください。意見の相違は診断的証拠であり、盲目的に信号を平均化する理由ではありません。
独立したトルク基準に対して検証
静的チェックには校正済みのウェイトとレバーアームを使用し、動的チェックにはトルクトランスデューサー、フォーストルクセンサー、または校正済みロードセルを用いましょう。器具の適合性、レバーの形状、アライメント、センサー帯域幅、不確実性を確認しましょう。 カーネギーメロンのシリーズ弾性アクチュエータキャリブレーション論文 は、アクチュエータセンシングが明示的なキャリブレーションと比較によってどのように恩恵を受けるかを示しています。
ゼロ、スケール、線形性、ヒステリシス、再現性、帯域幅、熱ドリフト、ペイロード変化、すべての動き象限をテストします。生の同期データとソフトウェアバージョンを保存してください。推定量は、ホールドアウトトライアルで支えられたエンベロープだけを解放します。
簡潔なリリースチェックリストを使いましょう。
- トルクの境界と現在の慣例を挙げてください。
- 電流オフセット、トルク定数、トランスミッションマッピングの校正を行います。
- 検証済みの重力、慣性、摩擦モデルを差し引く。
- すべての推定に飽和、レイテンシー、信頼性を明らかにしましょう。
- 運用範囲内の独立した参照と比較してください。
よくある質問
モーターの電流は外部関節トルクを直接測定できますか？
いいえ。モーターの電磁トルクを推定します。外部トルク残差を解釈する前に、伝達損失やロボットの動力学をモデル化する必要があります。
命令電流を使うべきか、それとも計測電流を使うべきでしょうか？
校正済みのトルク発生電流を測定し、コマンドを別途ログに記録してトラッキング誤差や飽和を検出してください。
カタログのトルク定数は十分に正確ですか？
モデルの初期化は可能ですが、現在の慣例、設置されたハードウェア、温度は必要な精度のために校正されるべきです。
なぜロボットが逆回転すると推定トルクが変わるのでしょうか？
摩擦、バックラッシュ、ギアボックス効率、電流オフセット、フィルタリングはすべて方向に依存します。
電流ベースのトルク推定は安全指定の力センサーに代わることは可能でしょうか？
デフォルトではありません。安全機能は、適用されるリスクや基準に適したアーキテクチャ、診断、検証を必要とします。
推定トルクと接触安全境界
電流ベースのトルク推定はモデルに依存します。独立して検証された動作範囲を超えて接触力の精度や安全の完全性を主張しないでください。