編集履歴一覧に戻る
R_Castleのアイコン画像

R_Castle が 2020年02月18日15時30分28秒 に編集

コメント無し

本文の変更

-

皆さんこんにちわ。

今回はArduinoUnoで、ラジコンサーボモーターを動かすことについてご紹介します。 まずは基礎知識編として、応用的な使い方については記事を分けて行きたいと思います。 # 「サーボモーター」とは 電子工作やホビーロボットを製作している人の間ではサーボ、又はサーボモーターと言えばラジオコントロール機器の制御で使う製品の事を指します。四角い箱上の一面から回転する軸が出ている形状をした製品が多いです。 ![サーボモーターの例](https://camo.elchika.com/62867c8726d8946d972dbf9c85c6288f565f9a40/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f66646631626565652d663838622d343063352d613361662d3738333664376565353934382f63316234313830332d666335332d346238342d396163642d373633663532353435646365/) 元々の目的が無線操縦の模型に組み込む事を前提に作られていますので、普通のモーターに比べて独特の形状をしています。 ![基本的な形状のサーボモータ](https://camo.elchika.com/3015baa866940ea39b29c50d461e8be5f9729f69/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f66646631626565652d663838622d343063352d613361662d3738333664376565353934382f66313763373433342d663234642d346531322d623134382d346235393032323135633230/) 簡単な信号で回転する角度を制御する事が出来るので、ラジオコントロールのかじ取りや走行用のモーターや小型のエンジンといった動力のスロットルコントロール等に利用されるほか、マイコンボードに多数接続して簡易的なロボットの関節として利用する事が出来ます。 尚、産業用のAC/DCサーボモーターと呼ばれるモーターとは制御方式が異なりますのであくまでも商品名もしくはある種類のホビーモーターの総称として覚えておいた方が良いでしょう。 最近ではホビーロボット専用のサーボモーターも発売されていますが、これらは少々高度な通信制御が必要になりますので、後日改めて解説したいと考えています。今回は一般的なラジオコントロール機器に用いられている信号制御方式で作られているサーボモーターについて記述していきます。 サーボモーターからは3本の電線がひとまとめになってコネクタがついているケーブルが出ています。その色は各社様々なのですが、基本的なルールとして **黒(又は暗い色):GND(電源のマイナス)** **赤:Vin(電源のプラス)** **それ以外の色:制御用信号線** となっています。このコネクタにそれぞれの電源、信号線を接続すれば制御する事が出来る訳です。 ![コネクタの例](https://camo.elchika.com/d2120a24d34ea7d22362b84074610e648ac36ffc/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f66646631626565652d663838622d343063352d613361662d3738333664376565353934382f63366232646638362d633964392d346233612d386435342d336534326661386532636438/) # サーボモーターの制御方法について 図に、基本的なラジオコントロール機器の制御信号について図示しました。 ![制御信号の周期と角度の関係](https://camo.elchika.com/70f8182c5d2e80d780cc2b14a77c143b2e18a617/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f66646631626565652d663838622d343063352d613361662d3738333664376565353934382f65656431393864302d313533632d346133362d393139372d646266666636303539623164/) 周期20ミリ秒、つまり1秒間に50回の信号をサーボモーターに送るのですが、この時1周期の間にどのくらいの時間信号をONにしているか?でサーボモーターの角度を決めることが出来ます。 こういった制御手法を「PWM(Pulse Width modulation)制御」と呼びます ちょっと強引ですが、Arduinoマイコンボードに1個のサーボモーターを接続して動かしてみましょう。 ![テスト用サーボ接続図](https://camo.elchika.com/ebde451f769835b760774fd911868bd5bc0d98c3/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f66646631626565652d663838622d343063352d613361662d3738333664376565353934382f34393963656162612d333131612d346637332d626135632d316232333963303730323632/) ==サーボモーターは動作に大きな電流を必要とします。 複数のモーターをマイコンボードに直接接続すると故障の原因となりますので注意してください。== 信号のON/OFF時間を直接指示し、サーボモーターに制御命令として出力してみます。 ![サーボモーターを接続した状態](https://camo.elchika.com/8b54b72b139382f7fa6f006e2c40a97de95f35f5/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f66646631626565652d663838622d343063352d613361662d3738333664376565353934382f35633633656662342d383635372d343332302d616231642d376137343865363065373230/) ```arduino:digitalWrite命令での直接制御 int i = 0; void setup() { pinMode(5,OUTPUT); } void loop() { digitalWrite(5,HIGH); delayMicroseconds(1250); // ここに角度に該当する値を入れる。 digitalWrite(5,LOW); delay(20); } ``` モーター1個だけであればこういったやり方をベースにしても制御できますが、複数のモーターを動作させる場合や他の処理も加えたプログラムにしようとすると、この方法からの拡張では制御周期が乱れて満足にコントロール出来ないと思います。 幸いにもArduino SDKには複数のサーボモーターを制御することが出来る専用のライブラリと制御命令が用意されています。最後にきちんとしたプログラムを書き直しますのでしばらくお待ちください。 また、いちばん右端を0度、信号の長さが長くなる毎に反時計回りに回転して行き左端180度まで信号を送る事が出来ますが、不用意な力が外からサーボモーターに加わっても制御不能になる事がない様、通常の製品では20度から160度くらいまでの範囲で動作する様に制御して使用する事をお勧めします。 ## サーボモーター選定のポイント 上記の様に電気信号で簡単に角度を指定して固定する事が出来るサーボモーターですので、簡単なギミックから本格的なロボットまで色々応用する事が出来ます。 その中身は沢山の歯車がかみ合って動いている小さなギアボックスが入っています。この歯車の内容でサーボモーターから取り出せる力の大きさや動作する速度が定められています。 ![サーボモーターの構造例](https://camo.elchika.com/acf98678a4bcb265b17b60135ae612ab4e9a343d/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f66646631626565652d663838622d343063352d613361662d3738333664376565353934382f30373935646564622d333836642d346363382d386537302d383339333536663738306165/) [出典:双葉電子工業(株)製品紹介サイト](http://www.futaba.co.jp/robot/servos_for_uav/aj9da) 動作する力は「トルク」と呼ばれています。通常は回転モーメントの事を指し[N・m(ニュートン・メートル)]が用いられますが、そんな大きな力はサーボモーターからは出せませんので、メーカーが定めるカタログなどでは[kgf・cm]で表現されています。 例えば5[kgf・cm]のトルクを持っている、のであれば、軸の中心から1cmの長さのアームで5kgfの物体を動かすことが出来る事を意味しています。 ++トルクやモーメント等については垂直方向か水平方向か、摩擦はあるのか?など 厳密な解説を始めてしまうと物理の授業になってしまうので簡単な説明だけに留めておきます。++ つまり、サーボモーターのトルクとアーム先端で動かせる物体の重さの関係を簡単な関係式で示すと **[動かせる重さ]=[サーボモーターのトルク]÷[アームの長さ]** という事になります。先の5[kgf・cm]のトルクを持ったサーボモーターに2cmの長さのアームを付けた場合、アーム先端で動かすことが出来る物体の質量は5÷2=2.5kgfと、長さに反比例して小さくなって行く事が分かります。 次に重要なのが動作電圧です。サーボモーターの多くは4.8V又は6.0Vで動作する様に作られており、ロボット専用の物になると更に大きな電源が必要になります。また、動作時に必要となる電流量も非常に大きなものになりますので、複数のサーボを動かすというのであればマイコンとは別のバッテリーなど電源を用意する必要があります。 さらに制御の都合上、ほとんどのサーボモーターはマイコンの制御信号で動作速度を直接コントロールする事が出来ません。メーカーのカタログなどをチェックして、あらかじめ必要な動作速度を満たしているモデルを選定する場合もあります。 ## Arduino SDK サーボモーター制御命令 Arduino SDKで用意されているサーボモーター制御コマンドについて説明します。 ```arduino:手順1:ヘッダーファイルの読み込み #include <Servo.h> ``` ヘッダーファイルの読み込みを宣言したら、制御するサーボモーターのプログラム中での名前を宣言します。 ```arduino:手順2:プログラム中での名前を宣言 Servo elchika01; ``` 次に、接続されているデジタルポートをサーボ制御用に宣言します。 ```arduino:手順3:サーボ制御用ポートの宣言 elchika01.attach(5); ``` ++Arduinoの種類によって制御できるサーボモーターの数、ポート番号は異なります。++ 繰り返しループ内で、位置決めしたい角度を指定します。 ```arduino:手順4:角度命令を出力する elchika01.write(90); ``` プログラムに書くと以下の様になります。 ```arduino:SDKライブラリを用いたサーボモーター制御プログラム例 /*****************************************************************/ #include <Servo.h> // サーボ制御のライブラリを読み込みます。 Servo elchika01; // 制御するサーボ名を定義します。 void setup() { elchika01.attach(5); // 5番ピンの出力をサーボ制御用に宣言します。 } void loop() { elchika01.write(90); // 90度(ニュートラル) delay(1000); elchika01.write(30); // 30度(左に傾く) delay(1000); elchika01.write(90); // 90度(ニュートラル) delay(1000); elchika01.write(150); // 150度(右に傾く) delay(1000); } /*****************************************************************/ ``` このプログラムを実行すると、デジタルポート5番に接続されたサーボモーターが1秒おきに90度→30度→90度→150度→90度・・・と傾く動作を繰り返します。 それでは、以前テストした光センサーを追加して、読み取った明るさをサーボモーターの傾きで示すプログラムを書いてみたいと思います。 ブレッドボードを使って、以下の様な回路を組み立てています。 ![光センサーとサーボモーターの接続図](https://camo.elchika.com/16cd0b63b957c010d63c077e5e2a7ce3831ac967/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f66646631626565652d663838622d343063352d613361662d3738333664376565353934382f38356436343232342d393135612d343962612d623061382d633830636232666462343434/) ```arduino:光センサーの値を角度に変換してサーボモーターを動かすプログラム #include <Servo.h> // サーボ制御のライブラリを読み込みます。 Servo elchika01; // 制御するサーボ名を定義します。 int CDS = 0; int deg = 0; void setup() { elchika01.attach(5); // 5番ピンの出力をサーボ制御用に宣言します。 } void loop() { CDS = analogRead(0); deg = map(CDS,600,1024,0,180); // 光センサの読み取り値600~1024の範囲を0~180の値に割り当てるmap関数 elchika01.write(deg); delay(1000); } ``` 実際に動作させてみました。 ![ブレッドボードに配線した回路](https://camo.elchika.com/4158058443c9f269d6f8c32b921095fb809eb043/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f66646631626565652d663838622d343063352d613361662d3738333664376565353934382f38313666363165362d376536372d343836652d623639352d643937313733626262393861/) 光センサーの周りが明るい=読み取られる値が小さいと、サーボモーターへの指令値も小さくなり右回りになりました。 ![明るいと時計回り](https://camo.elchika.com/07d98f4f3c9e7a93557a1420460f93711193fb50/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f66646631626565652d663838622d343063352d613361662d3738333664376565353934382f66373531636133612d396336392d343766632d383234612d303837396566353731383866/) 反対に光センサーの周りが暗い=読み取られる値が大きいと、サーボモーターへの指令値は大きくなり左回りに動作しました。 ![暗いと反時計回り](https://camo.elchika.com/1f2c1e2559599016ec53720d0a5c81f91b9c5bf7/687474703a2f2f73746f726167652e676f6f676c65617069732e636f6d2f656c6368696b612f76312f757365722f66646631626565652d663838622d343063352d613361662d3738333664376565353934382f31376434663831372d303436362d343136352d383166662d366565376233633339666237/) 通常の回転し続けるモーターと違ってサーボモーターを制御できる様になると、こういった角度や位置を制御する事が可能になるので電子工作で動かすことが出来るアイデアの幅が更に広がると思います。 次回は応用編として、複数のサーボモーターを制御する際の工夫や工作例などを紹介したいと思います。