初版

ラジコンサーボモーターをArduinoで動かしてみる（その２）

前回記事から時間が空いてしまいましたが、今回はArduinoUnoでサーボモーターを複数動作させる時のポイントなど説明したいと思います。 ペンを持つロボットアームや日本の足で歩くロボットを作ろうと思った場合、必ず複数の動作部分が必要になります。 この動作部分にラジコン用サーボモーターを使用する事で、簡単なプログラムで自由に制御する事が出来る様になります。 本題に入る前に話しておきたいと思いますが、最近ではラジコン用のもの以外に「ロボット用」サーボモーターも販売されています。 ロボット用モーターは特殊な形状や強力な力を発生させることが出来たりと言う利点も多いのですが、これらのモーターはラジコン用のパルス制御ではなくI2Cや専用バスを用いたデータ通信で制御する方式が多く採用されている為、今回説明する方式とは制御方法が異なりますので注意して下さい。 まずは入手性も高く取り扱いも容易なラジコン用のサーボモーターを利用した方式を先にご紹介して、ロボット用モーターについての話は実際に複雑なロボットを作る時に別の記事でご紹介したいと思います。 # サーボモーターの動作 一般的なラジコン用サーボモーターの動作について、図でもう一度確認します。  通常は制御命令0度で時計回りに回りきった状態、90度で反時計回りに動作して動作範囲の中央に来ます、基本的にはこの位置を中央＝ニュートラルとして、左右等しく回転する様に取り付けて動かします。そして制御命令180度で反時計回りに回りきった位置になります。 尚、ラジコン用のサーボモーターは模型飛行機や自動車に使用した際のトラブル防止を目的に機械的なストッパーが内部に組み込まれている事が多く、実際の動作範囲は140度～160度位になっている物があります。ロボットに使用する際は事前に確認する等注意して使用してください。 # 簡単な歩行ロボットを想定した使い方 それでは、複数のサーボモーターを使って実際に動くロボットを想定したプログラムを作って見ましょう。 今回は大変申し訳ありませんが3D-CADで作ったCGでご覧ください。  このロボットは、市販の手踊り人形を被せて歩き回るロボットをイメージしてデータを作っています。 先に申し上げた、より高度なサーボ制御の仕方を紹介する時には実物を作って歩かせてみたいと考えています。 画像中の黒い四角い部分がサーボモーターで、全部で４個使用する構成になっています。 また、複数のサーボモーターを動作させる場合は、Arduino他マイコンボードから供給される電力では不足して動作不良を起こしますので、別途用意したバッテリーから給電する様にしましょう。 # マイコンボードの接続 図に接続の仕方について示します。 実機を製作する際にも、空中で電線を直接接続したりなどせず小型の物でも良いのでこういったブレッドボード等を使用する様にしましょう。  ブレッドボードに電池ボックスから＋、ＧＮＤの電線を接続します。 次に、各サーボモーターの電源線を＋、GND線をGNDの共通ラインにそれぞれ接続します。 ==この時電池ボックスは電源スイッチ付きのものを使用する事をお勧めします。この電源スイッチで全体の電源ON／OFFを制御する事が出来ます。==  電源が配線出来たら信号線を接続します。今回はArduinoUNOの8番～11番ピンに順番に接続しています。 これからプログラムの説明に入りますが、各サーボモーターの取り付け位置は下図の①～④の位置にあるものとして進めて行きます。  図を確認したら、サーボモーターを使える様に準備して、４つのサーボモーターが中立＝９０度の位置になるプログラムを作成してダウンロードします。 ```arduino:4つのサーボモーターを動作させるプログラム（準備） #include <Servo.h> // サーボ制御のライブラリを読み込みます。 Servo servo1; // 制御するサーボ名１～４を定義します。 Servo servo2; Servo servo3; Servo servo4; void setup() { servo1.attach(8); // ８番ピンの出力をサーボ制御用に宣言します。 servo2.attach(9); // ９番ピン宣言。 servo3.attach(10); // １０番ピン宣言。 servo4.attach(11); // １１番ピン宣言。 } void loop() { servo1.write(90); // 90度（ニュートラル） servo2.write(90); servo3.write(90); servo4.write(90); delay(1000); } /*****************************************************************/ ``` プログラムを動作させて各モーターの位置調整を行います。 大きくずれている時はロボットのサーボモーターの取り付け位置を再組立して調整します。 もしズレが1度2度程度であった場合、プログラム中に用意した変数を調整する様にした方が、効率が良い場合もあります。 # 歩行プログラムを作る 今回用意した様なロボットの場合、図中上部にある球の様な部分にそれなりの重量が無いと安定して歩くことが出来ません。目安としてはロボットの重心がサーボモーターよりも上に来る様な重りを乗せます。 （図で説明） 簡単なのは電池ボックスを上に乗せる方式です。バランスの調整が出来たら動作プログラムを作ります。 一番簡単な「一歩」の歩行パターンは次の様になります。 |No.|動作パターン| |---|---| |1|左足に重心を乗せる| |2|右足を前に出す| |3|右足に重心を乗せる| |4|左足を前に出す| |5|重心を戻す| これを、4個のサーボモーターの動作に置き換えると下表の様になります。 |No.|動作パターン|各サーボモーターの動作| |---|---|---| |1|左足に重心を乗せる| ③のモーターを時計回り、④のモーターを時計回り（少し多め）| |2|右足を前に出す|①のモーターを反時計回り、②のモーターを反時計回り| |3|右足に重心を乗せる(1)|③のモーターを反時計回り、④のモーターを反時計回り（少し多め）| ||右足に重心を乗せる(2)|③のモーターを反時計回り（少し多め）、④のモーターを反時計回り| |4|左足を前に出す|①のモーターを時計回り、②のモーターを時計回り| |5|重心を戻す|③のモーターを時計回り（少し多め）、④のモーターを時計回り| この、全部で５ステップの動作命令をプログラムしてみましょう。 ```arduino:4つのサーボモーターを動作させるプログラム（一歩分） /*****************************************************************/ #include <Servo.h> // サーボ制御のライブラリを読み込みます。 Servo servo1; // 制御するサーボ名１～４を定義します。 Servo servo2; Servo servo3; Servo servo4; void setup() { servo1.attach(8); // ８番ピンの出力をサーボ制御用に宣言します。 servo2.attach(9); // ９番ピン宣言。 servo3.attach(10); // １０番ピン宣言。 servo4.attach(11); // １１番ピン宣言。 } void loop() { // Step.0 又は Step.5「中立位置／重心を戻す」 servo1.write(90); // 90度（ニュートラル） servo2.write(90); servo3.write(90); servo4.write(90); delay(800); // Step.1「左足に重心を乗せる」 servo1.write(90); servo2.write(90); servo3.write(75); // 時計回り（今回は-15度） servo4.write(70); // 少し多めの時計回り（今回は-20度） delay(800); // Step.2「右足を前に出す」 servo1.write(105); // 反時計回り（今回は15度） servo2.write(105); // 反時計回り servo3.write(75); servo4.write(70); delay(800); // Step.3「右足に重心を乗せる」 // （１）重心を中央へ servo1.write(105); servo2.write(105); servo3.write(90); // 中立位置 servo4.write(90); // 中立位置 delay(800); // （２） 重心を右脚へ servo1.write(105); servo2.write(105); servo3.write(110); // 少し多めの反時計回り（今回は+20度） servo4.write(105); // 反時計回り（今回は+15度） delay(800); // Step.4「左足を前に出す」 servo1.write(90); // 時計回り（今回は-15度） servo2.write(90); // 時計回り servo3.write(110); servo4.write(105); delay(800); // Step.5　はループの先頭に戻る } /*****************************************************************/ ``` モーター部分だけのモデルで５ステップの状態を示すと、以下の様になります。        以上のステップを繰り返して動作します。 今回のプログラムのままだとひたすら直進していってしまうので、途中で向きを変えたりバックしてみたりといった動作パターンを作る必要があります。 簡単な構成のロボットであれば、この様に動作命令に直接角度の値を入れてしまえば良いのですが、他にもいくつか記述の手法がありますので、以下に紹介します。 # 中立位置からの増減命令で制御する方法 サーボモーターを中立の位置にする為に、通常は90度を基準の角度にしています。この値を中心に時計回り＝値をマイナス、反時計回り＝値をプラスする様な命令の仕方でも同様に制御する事ができます。 もっと沢山のサーボモーターを使用する場合は基準角度からの増減ではなく「今の角度」を変数に保管しておき、そこからの増減で命令するやり方でも良いと思います。 ```arduino:4つのサーボモーターを動作させるプログラム（一歩分） /*****************************************************************/ #include <Servo.h> // サーボ制御のライブラリを読み込みます。 Servo servo1; // 制御するサーボ名１～４を定義します。 Servo servo2; Servo servo3; Servo servo4; int Stand1 = 90; // 各サーボモーターの基準位置を90度で宣言します。 int Stand2 = 90; int Stand3 = 90; int Stand4 = 90; void setup() { servo1.attach(8); // ８番ピンの出力をサーボ制御用に宣言します。 servo2.attach(9); // ９番ピン宣言。 servo3.attach(10); // １０番ピン宣言。 servo4.attach(11); // １１番ピン宣言。 } void loop() { // Step.0 又は Step.5「中立位置／重心を戻す」 servo1.write(Stand1); // 90度（ニュートラル） servo2.write(Stand2); servo3.write(Stand3); servo4.write(Stand4); delay(800); // Step.1「左足に重心を乗せる」 servo1.write(Stand1); servo2.write(Stand2); servo3.write(Stand3 - 15); // 時計回り（今回は-15度） servo4.write(Stand4 - 20); // 少し多めの時計回り（今回は-20度） delay(800); // Step.2「右足を前に出す」 servo1.write(Stand1 + 15); // 反時計回り（今回は15度） servo2.write(Stand2 + 15); // 反時計回り servo3.write(Stand3 - 15); servo4.write(Stand4 - 20); delay(800); // Step.3「右足に重心を乗せる」 // （１）重心を中央へ servo1.write(Stand1 + 15); servo2.write(Stand2 + 15); servo3.write(Stand3); // 中立位置 servo4.write(Stand4); // 中立位置 delay(800); // （２） 重心を右脚へ servo1.write(Stand1 + 15); servo2.write(Stand2 + 15); servo3.write(Stand3 + 20); // 少し多めの反時計回り（今回は+20度） servo4.write(Stand4 + 15); // 反時計回り（今回は+15度） delay(800); // Step.4「左足を前に出す」 servo1.write(Stand1); // 時計回り（基準位置へ戻す） servo2.write(Stand2); // 時計回り（基準位置へ戻す） servo3.write(Stand3 + 20); servo4.write(Stand4 + 15); delay(800); // Step.5　はループの先頭に戻る } /*****************************************************************/ ``` # mapコマンドで回転方向を管理する方法 プログラムに「map」コマンドという物があります、普段はある変数の値を一定の範囲に引き延ばしたり狭めたりする為に使用するのですが、これを応用してサーボモーターの回転方向を管理する事が出来ます。  例えば①、②のサーボモーターを両方とも「中立を０度として、外に開く時をプラス、内側に向く時をマイナス」にしたい場合、mapコマンドの記述は次の様になります。 ```arduino:サーボモーター①、②のmapコマンド Sv11 = map(Sv01,-90,90,180,0); // ①は反転 Sv12 = map(Sv02,-90,90,0,180); // ②は同方向 ``` 次に、③、④のサーボモーターを「中立を０として、外側が下がる時をプラス、上がる時をマイナス」にしたい場合のmapコマンドは次の様な記述になります。 ```arduino:サーボモーター③、④のmapコマンド Sv13 = map(Sv03,-90,90,0,180); // ③は同方向 Sv14 = map(Sv04,-90,90,180,0); // ④は反転 ``` これらを組み込んだ、一歩の動作プログラムは次の様になります。 ```arduino:4つのサーボモーターを動作させるプログラム（mapコマンドによる一歩分） /*****************************************************************/ #include <Servo.h> // サーボ制御のライブラリを読み込みます。 Servo servo1; // 制御するサーボ名１～４を定義します。 Servo servo2; Servo servo3; Servo servo4; int Sv11 = 0; // プログラム中でサーボ制御に使用する変数を宣言します。 int Sv12 = 0; int Sv13 = 0; int Sv14 = 0; int Sv01 = 0; // プログラム中で値を指示する変数を宣言します。 int Sv02 = 0; int Sv03 = 0; int Sv04 = 0; void setup() { servo1.attach(8); // ８番ピンの出力をサーボ制御用に宣言します。 servo2.attach(9); // ９番ピン宣言。 servo3.attach(10); // １０番ピン宣言。 servo4.attach(11); // １１番ピン宣言。 } void Setmap() { // 回転方向を定義するサブルーチン Sv11 = map(Sv01,-90,90,180,0); // ①は反転 Sv12 = map(Sv02,-90,90,0,180); // ②は同方向 Sv13 = map(Sv03,-90,90,0,180); // ③は同方向 Sv14 = map(Sv04,-90,90,180,0); // ④は反転 } void Robomove() { // サーボ制御命令のサブルーチン servo1.write(Sv11); servo2.write(Sv12); servo3.write(Sv13); servo4.write(Sv14); } void loop() { // Step.0 又は Step.5「中立位置／重心を戻す」 Sv01 = 0; Sv02 = 0; Sv03 = 0; Sv04 = 0; Setmap(); Robomove(); delay(800); // Step.1「左足に重心を乗せる」 Sv01 = 0; Sv02 = 0; Sv03 = -15; Sv04 = 20; Setmap(); Robomove(); delay(800); // Step.2「右足を前に出す」 Sv01 = 15; Sv02 = -15; Sv03 = -15; Sv04 = 20; Setmap(); Robomove(); delay(800); // Step.3「右足に重心を乗せる」 // （１）重心を中央へ Sv01 = 15; Sv02 = -15; Sv03 = 0; Sv04 = 0; Setmap(); Robomove(); delay(800); // （２） 重心を右脚へ Sv01 = 15; Sv02 = -15; Sv03 = 20; Sv04 = -15; Setmap(); Robomove(); delay(800); // Step.4「左足を前に出す」 Sv01 = 0; Sv02 = 0; Sv03 = 20; Sv04 = -15; Setmap(); Robomove(); delay(800); // Step.5　はループの先頭に戻る } /*****************************************************************/ ``` 左右の腕や足で何個ものサーボモーターが対照的なレイアウトで配置された時など、動作させたい向きと回転方向が異なると混乱の基になります。 そういった際にmapコマンドを利用するのは大変有効ですが、角度命令毎に毎回実行しなければならないという手間も発生しますので注意が必要です。 次回はサーボモーターから一度離れて、模型用のDCモーターをマイコンで制御する方法についてまとめたいと思います。