テクニカルサポート
発行済み 2026-03-24
ロボット アームの開発に携わっている友人にとって、最大の悩みは構造設計ではなく、数行のステアリング ギア制御コードであることがよくあります。ハードウェアはすべて設置されているのに、電源を入れるとパーキンソン病のように震えたり、思った角度に曲がらなかったり、動作が半拍遅すぎます。これらの問題は、実際にはすべて制御コードにあります。今日は書き方についてお話しますサーボロボットアームをスムーズに動かし、正確に位置決めするための制御コード。
ステアリングギア制御の本質はPWM信号を出力することです。 PWM はパルス幅変調です。簡単に言うと、ハイレベルの持続時間を変更することで、ステアリングギアがさまざまな角度に回転するように制御します。ほとんどサーボ20ms サイクルを使用し、ハイレベル時間は 0.5ms ～ 2.5ms で、0 ～ 180 度に対応します。コードを記述するときは、まずタイマーを初期化し、PWM 周波数と分解能を設定してから、角度を対応するデューティ サイクル値に変換する関数を記述する必要があります。たとえば、使用する場合は、直接呼び出しますそれは次のように行うことができます地図関数。ただし、STM32 などのマイクロコントローラーを使用する場合は、タイマー比較レジスタを自分で設定する必要があります。
実際の開発では、カプセル化することをお勧めします。サーボ制御を独立したモジュールに統合します。初期化関数、アングル設定関数、マルチサーバ同期制御関数を定義します。このようにして、コード構造が明確になり、その後のメンテナンスやデバッグが容易になります。たとえば、6 自由度でロボット アームを制御する必要がある場合、各サーボに個別の PWM チャネルがあり、配列を使用して各サーボのターゲット角度を保存し、メイン ループで均一に更新します。このようにして記述されたコードは可読性が高く、さまざまなサーボの応答速度に応じて微調整することができます。
サーボの振動は、多くの人が最初に遭遇する落とし穴です。最も一般的な原因は電源不足です。サーボ起動時の電流は非常に大きくなります。電源が投入できない場合、電圧が低下すると制御信号が不安定になります。解決策はとても簡単です。サーボに電力を供給するには、別の安定化電源を使用してください。電源をマイクロコントローラーと共有しないでください。特に複数のサーボを同時に動作させる場合には、電源電流に十分な余裕を持たせる必要があります。たとえば、1 つのサーボは 1A であり、6 つのサーボには少なくとも 5A の電源を装備する必要があります。たとえば、サーボ電源の両端に大きなコンデンサを並列に接続して、瞬間的な電圧降下を効果的に除去することもできます。
ジッターのもう 1 つの原因は、制御信号の周波数とデューティ サイクルの精度が不十分であることです。一部のサーボは PWM 周波数に敏感で、標準の 50Hz が振動することがあります。 300Hz以上に調整してみることもできますが、サーボの許容範囲を超えないようにしてください。デューティ サイクルの精度も重要です。タイマーの分解能が 8 ビットのみの場合、0 ～ 180 度は 256 ステップにのみ分割でき、各ステップは約 0.7 度になります。細かい制御ではジッターが発生しやすくなります。 16 ビット タイマーに切り替え、分解能を 0.003 度に上げると、動きが自然にスムーズになります。
ロボットアームが繊細な作業を行えるかどうかは、精度が鍵となります。制御精度を向上させるには、まずサーボの中心位置と移動範囲を校正する必要があります。各サーボの工場出荷時のパラメータはわずかに異なるため、コード内で調整する必要があります。たとえば、サーボを 90 度に回転し、実際の角度を測定して、コード内のオフセットを補正します。ソフトウェア フィルタリングを使用して、複数回サンプリングされた角度値を平均して、単一コマンドのジャンプを回避することもできます。溶接やディスペンスなどのアプリケーションでは、0.1 度以内の繰り返し位置決め精度が必要なため、キャリブレーションとフィルタリングが不可欠です。
より高度なアプローチは、閉ループ制御を追加することです。通常のサーボには位置フィードバックラインしかありませんが、デジタルサーボの中には現在の角度を読み取ることができるものもあります。コード内のフィードバック値を読み取り、目標角度と比較し、PID アルゴリズムを使用して出力をリアルタイムで修正します。これにより、負荷の変化や外力の干渉があっても、サーボは目標位置で安定して停止することができます。コードはより複雑ですが、高精度のロボット アームの場合、この投資には十分な価値があります。単純な比例制御から始めて、徐々に積分項と微分項を追加して、動作を高速かつ安定させることができます。
書かれたコードをロボットアームに直接インストールして実行することはできません。最初に単体テストを行う必要があります。最も簡単な方法は、サーボを固定し、別のテストプログラムを作成し、0 度から 180 度までサイクルさせ、遅れや異音が発生するかどうかを観察することです。オシロスコープを使用して PWM 波形を測定し、周波数とデューティ サイクルが安定しているかどうかを確認します。波形に不具合が見つかった場合は、コード内にタイマー出力を妨げている割り込みサービス関数が存在するかどうかを確認してください。オシロスコープがない場合は、ロジック アナライザーを使用できます。数十ドルするUSB版ならはっきり見えます。
負荷テストも重要です。ロボットアームのコネクティングロッドやエンドツールなどの実際の重量をサーボに加え、さまざまな速度でのパフォーマンスを観察します。サーボの応答時間、オーバーシュート、静的保持トルクを記録する必要があります。コードに簡単なデータ記録機能を追加し、シリアルポートを介して目標角度と実際のフィードバック角度を出力し、Excel を使用して分析用の曲線グラフを描くことができます。応答が遅いことが判明した場合は、PWM 周波数を増やすか、コードの実行効率を最適化します。オーバーシュートが大きい場合は、加速カーブを調整してサーボの起動と停止が緩やかになるようにしてください。
初心者が犯す最も一般的な間違いは、ピン構成が正しくないことです。たとえば、PWM 出力ピンとサーボ信号線が整列していないか、ピンが他のペリフェラルによって占有されています。コードを書く際には必ず回路図を確認してピン番号を確認し、初期化関数でピン多重機能を明確に設定してください。もう 1 つのよくある間違いは、遅れディレイコントロール機能。クリティカルなループでデッド待機遅延が使用されると、プログラム全体がスタックし、他のタスクが実行できなくなります。正しいアプローチは、タイマー割り込みまたはステート マシンを使用して、サーボをバックグラウンドで独立して更新させることです。
もう 1 つの隠れた間違いは、サーボのデッド ゾーンを無視することです。サーボが角度指令を受け取った後、目標角度と現在角度の差が非常に小さい場合、サーボが動かないことがあります。これはデッドゾーンです。コードがわずかに変化する角度値を頻繁に送信すると、サーボは繰り返しわずかに動きますが、実際には回転せず、熱と摩耗が発生します。コード内で角度変更の最小しきい値 (0.5 度など) を設定する必要があります。変更がこの値を超えた場合にのみ、新しいコマンドが送信されます。これにより、ステアリングギアを効果的に保護できます。
コードの最適化は、ロボット アームに複数のサーボがある場合に特に重要です。最も簡単な最適化は、角度変換値を事前に計算することです。角度と PWM デューティ サイクルの対応関係は事前に計算されて配列に保存され、毎回浮動小数点演算を実行することなく、実行時にテーブルが直接参照されます。 STM32 などのチップの場合は、次を使用します。(((".")))キー配列を密結合メモリに配置すると、アクセス速度が数倍速くなります。サーボの数が 8 を超える場合は、DMA (ダイレクト メモリ アクセス) を使用して PWM 値を更新することを検討できます。これにより、CPU への負荷は基本的にゼロになります。
複数のサーボの同期制御は技術的に困難です。多くの人が行うのは、角度コマンドを順番に送信し、結果として連続したアクションを実行することです。真の同期を実現するには、タイマーを使用してコード内で更新をトリガーし、すべてのサーボが新しい PWM 値を同時に受信できるようにする必要があります。たとえば、STM32 のアドバンスト タイマを使用して、同じ割り込み内のすべての比較レジスタの値をバッチ更新する同期トリガ機能を構成します。これにより、物体を掴む際の同期ずれによる物体の落下を防ぐロボットアームの移動軌跡を確保することができる。
ロボット アームのサーボ コードをデバッグするときに、特に解決が難しいジッターの問題に遭遇したことがありますか?結局どうやって完成させたんですか？コメント欄であなたの経験を共有するか、プライベートメッセージを送ってより技術的な詳細を交換してください。この記事が役立つと思われる場合は、ロボット アームを作成するより多くの友人がこの記事を見てもらえるように、忘れずに「いいね！」を押して保存してください。
更新時間：2026-03-24
