でっかいモーターをUduinoで動かしてみた話



この記事は、[UT-virtual Advent Calender 2018](https://qiita.com/advent-calendar/2018/ut-virtual) 11日目の記事として執筆しました。

※初心者が、自分のぶち当たった壁について、同じような問題に遭遇した人のために、思考過程も含めて丁寧に(冗長に)書いた記事なので、モーターを制御するという目的だけで読む人には長ったらしく感じるかもしれませんが、ご了承ください。
#でっかいモーターを動かす
私の所属する[東京大学VRサークル UT-virtual ](http://utvirtual.tech/)の[駒場祭展示「FlyFlyFly」](http://utvirtual.tech/archives/2758)で、触覚提示のための筐体づくりの任を受けた。お客さんを乗せたまま上下出来るパワフルな動力が必要になった。油圧ポンプ、エアポンプ、電動ウィンチ等、パワーのありそうな動力をたくさん考えてみたが、ハードウェアの開発は初めてで予算も限られていたこともあり、扱いが簡単そうであんまり高くないAmazonで売ってた[リニアアクチュエータ](https://www.amazon.co.jp/gp/product/B014639AMK/ref=oh_aui_detailpage_o00_s00?ie=UTF8&psc=1)を使ってみることにした。

#何もわからんからまず動かしてみよう
制御なんて高尚なことの前に、まず動かなきゃお話しにならない。まずは何も考えずに、電源のACアダプタに直刺しして、動くことを確認することにした。駆動には12V 3Aの直流が必要らしいので、秋月で[ちょうどよさそうなACアダプタ](http://akizukidenshi.com/catalog/g/gM-10661/)を買ってきた。その時、この世には2.1mm DCプラグなどという規格が存在することを知る。
![2.1mmプラグ_LI.jpg](https://qiita-image-store.s3.amazonaws.com/0/310251/5a918dfc-f132-8c82-0bd6-32e4d21195aa.jpeg)

ACアダプタに書かれているマークによると、極性は内側がプラスで外側がマイナス(GND)であるらしいということが分かった。ということで、とりあえず手元にあったジャンパワイヤなどで直刺しして確かめてみた。
この確認で、とりあえずこいつが不良品でないことと、どうやら、縮む向きが正転で、伸びる向きが逆転、つまり、赤い導線にプラスをつなぐと縮んで、黒い導線にプラスをつなぐと伸びるらしいということまでが分かった。

#モータードライバとArduinoで制御してみる
とりあえず動くことはわかったので、今度はArduinoから制御できるところまで行ってみることにした。最初は、どんな回路を組めばいいのか、電子回路初心者の自分は途方に暮れていたが、どうやらモータードライバなるものを使えばうまく行きそうだということがわかった。しかし、モータードライバについて調べていたところ、今度は世の中にはブラシレスモータなる概念が存在することを知る。調べてみたところ、永久磁石が回るかコイルが回るかという違いらしいことがわかった。ブラシレスモータ(永久磁石が回転子)は専用のモータードライバがなければ動かないらしいが、アクチュエータのデーターシートを読んでみた感じ、ブラシレスではなさそうだったので、普通のモータードライバを使うことにした。12V 3A DCという大電流に耐えられるものということで、[TB6643KQ](http://akizukidenshi.com/catalog/g/gI-07688/)を使ってみることにした。ついでに仮配線のための[ワニ口クリップ](http://akizukidenshi.com/catalog/g/gC-04354/)も買った。
![TB6643KQ.png](https://qiita-image-store.s3.amazonaws.com/0/310251/f4e17b97-abe1-fd61-d20e-d2c1409664d8.png)
普段から、ICチップを触ってる人からしたら常識なのだろうが、ピンの番号が左右のどちらから始まるのかが[データシート](http://akizukidenshi.com/download/ds/toshiba/TB6643KQ_datasheet_ja_20110621.pdf)に書いてなくて困ったので、ここに書いておく。つまりは、4番ピンをGNDに7番ピンを電源につないだ状態で、Arduinoから1番ピンに電流を流すと3番ピンから、2番ピンに電流を流すと5番ピンから大電流が流れるようになっているらしい。この通りの配線になるように、とりあえずブレッドボード上で組んでみた。しかし、12V 3AのACアダプタでは、回路中の損失などで微妙にパワー不足だったらしく、上手く動かなかったので、電力に余裕を持たせて、[12V 5AのACアダプタ](http://akizukidenshi.com/catalog/g/gM-10663/)を買ってきて、取り替えたところ上手く動いた。
[![](http://img.youtube.com/vi/ULG7QeX2rL0/0.jpg)](https://www.youtube.com/watch?v=ULG7QeX2rL0)

以下、ここまでの回路図とArduinoのスケッチ。
![Mono_ブレッドボード.png](https://qiita-image-store.s3.amazonaws.com/0/310251/2d26c945-f844-c6e8-5944-e8bd3b93ca2d.png)

```actuator_test.ino
void setup() 
{
    pinMode(5, OUTPUT);
    pinMode(6, OUTPUT);
}

void loop() 
{
    digitalWrite(5, LOW);
    digitalWrite(6, HIGH);
    delay(1000);
    digitalWrite(6, LOW);
    digitalWrite(5, HIGH);
    delay(1000);
}
```

2個同時も行けた。
<blockquote class="twitter-tweet"><p lang="ja" dir="ltr">うるさいLチカ <a href="https://t.co/eTocehL54J">pic.twitter.com/eTocehL54J</a></p>&mdash; マサト (@1B_Co_blue) <a href="https://twitter.com/1B_Co_blue/status/1053659523980771336?ref_src=twsrc%5Etfw">October 20, 2018</a></blockquote> <script async src="https://platform.twitter.com/widgets.js" charset="utf-8"></script>

#Uduinoを使う
Uduinoのインポートやセットアップは[公式ページのチュートリアル(英語)](https://marcteyssier.com/uduino/tutorials/uduino-quick-start-guide)や[「Unity2017でUDUINOを使ってArduino接続」](https://qiita.com/mizuki_izuna/items/236f11e557a339634630)に書いてある通りにやれば、特に問題なく進む。今回、椅子1つにつき、4本のアクチュエーターで制御することになっていて、前後の高さも変えられるようにしたいとのことだったので、そのためにまずはキーボード入力で動かせるような、C#のコードも書いた(デバッグ用なので、ifの処理等は適当)。

```BaseController.cs
using System.Collections;
using System.Collections.Generic;
using UnityEngine;
using Uduino;

public class BaseController : MonoBehaviour 
    {
    //ピンの番号
    const int FORE_LEFT_UP = 3;
    const int FORE_LEFT_DOWN = 2;
    const int FORE_RIGHT_UP = 5;
    const int FORE_RIGHT_DOWN = 4;
    const int BACK_LEFT_UP = 7;
    const int BACK_LEFT_DOWN = 8;
    const int BACK_RIGHT_UP = 13;
    const int BACK_RIGHT_DOWN = 12;

    //動かすときのピンのグループ
    List<int> foreUp = new List<int> { FORE_LEFT_UP, FORE_RIGHT_UP };
    List<int> backUp = new List<int> { BACK_LEFT_UP, BACK_RIGHT_UP };
    List<int> allUp = new List<int> { FORE_LEFT_UP, FORE_RIGHT_UP, BACK_LEFT_UP, BACK_RIGHT_UP };
    List<int> foreDown = new List<int> { FORE_LEFT_DOWN, FORE_RIGHT_DOWN };
    List<int> backDown = new List<int> { BACK_LEFT_DOWN, BACK_RIGHT_DOWN };
    List<int> allDown = new List<int> { FORE_LEFT_DOWN, FORE_RIGHT_DOWN, BACK_LEFT_DOWN, BACK_RIGHT_DOWN };

    void Start ()
    {
        //ピンのモードの設定
        UduinoManager.Instance.pinMode(FORE_LEFT_UP, PinMode.Output);
        UduinoManager.Instance.pinMode(FORE_LEFT_DOWN, PinMode.Output);
        UduinoManager.Instance.pinMode(FORE_RIGHT_UP, PinMode.Output);
        UduinoManager.Instance.pinMode(FORE_RIGHT_DOWN, PinMode.Output);
        UduinoManager.Instance.pinMode(BACK_LEFT_UP, PinMode.Output);
        UduinoManager.Instance.pinMode(BACK_LEFT_DOWN, PinMode.Output);
        UduinoManager.Instance.pinMode(BACK_RIGHT_UP, PinMode.Output);
        UduinoManager.Instance.pinMode(BACK_RIGHT_DOWN, PinMode.Output);
    }

    void Update ()
    {
        ManualManipulate();
    }

    //キーボード操作用関数
    void ManualManipulate()
    {
        //Qキーを押している間、前の足2本が上がる
        if (Input.GetKeyDown(KeyCode.Q))
        {
            foreach (int value in foreUp)
            {
                UduinoManager.Instance.digitalWrite(value, State.HIGH);
            }
        }
        if (Input.GetKeyUp(KeyCode.Q))
        {
            foreach (int value in foreUp)
            {
                UduinoManager.Instance.digitalWrite(value, State.LOW);
            }
        }
        /*
        以下、A:前足降下、W:後足上昇、S:後足降下、E:全足上昇、D:全足上昇として同様の処理を書いた。
        */
    }
}
```
とりあえず、これで動いた。

#Arduinoにつけるシールドを作る
何とか動かすところまではたどり着いたが、ここまですべてブレッドボード上で実装していたので、ひどいスパゲッティコード(物理)が生まれてしまった。
![IMG_4608.JPG](https://qiita-image-store.s3.amazonaws.com/0/310251/94242114-510c-42a9-7059-1f0929b4d9a7.jpeg)
なので、配線をまとめるシールドを作ることにした。[Arduino用のユニバーサル基盤](http://akizukidenshi.com/catalog/g/gP-09624/)を買い、導線むき出しだったアクチュエーターに[2.1mm DCプラグ](http://akizukidenshi.com/catalog/g/gC-02108/)を取り付け、
![IMG_5177.JPG](https://qiita-image-store.s3.amazonaws.com/0/310251/f2226df2-9cde-82c4-3892-25e506657d9a.jpeg)
とりあえず、1枚作ってみた。
![IMG_5111.JPG](https://qiita-image-store.s3.amazonaws.com/0/310251/c1b7d86b-d458-312a-ce84-fea962c455f1.jpeg)
![IMG_5112.JPG](https://qiita-image-store.s3.amazonaws.com/0/310251/96d3a106-0a9f-1ddf-818e-267b769e5fc9.jpeg)

(地味についているイヤホンジャックは別の機能用)
これをArduinoにマウントして、デバッグキーでアクチュエータの伸縮をやっていたところ、問題が発生した。突然動かなくなってしまったのだ。原因について考えてみたところ、

1. 大電流を扱ってた割に、ヒートシンクもつけず、排熱がおろそかだった。
2. 嬉々としてデバッグをやったときに、アクチュエータの正転・逆転を何度も急に切り替えたことで、アクチュエータで逆起電力が発生し、モータードライバに過剰な電流が流れてしまった。

この2点が怪しいのではないかということになった。そこで、

1. [ヒートシンク](http://akizukidenshi.com/catalog/g/gP-09498/)をつける。
2. 電源付近に[コンデンサー](http://akizukidenshi.com/catalog/g/gP-06726/)をつける。(データシートで推奨されてたのを見逃してた…)
3. モータードライバが死んだら換装できるように[ソケット](http://akizukidenshi.com/catalog/g/gC-05779/)をつける。
4. 正転・逆転を急に切り替えないようにする。(デバッグ時も、はやる気持ちを抑える)

の4点を改善することにした。完成した写真、回路図がこちら。
![IMG_5178.JPG](https://qiita-image-store.s3.amazonaws.com/0/310251/d09db48f-1f03-6865-3f1b-dbbf4b8a58cc.jpeg)
![IMG_5115.JPG](https://qiita-image-store.s3.amazonaws.com/0/310251/91bf92c7-49f7-0c5c-79ec-9f66fe8fe5cf.jpeg)
![BaseController_ブレッドボード.png](https://qiita-image-store.s3.amazonaws.com/0/310251/564176c1-6820-0935-60bf-a6eb5f2d579c.png)
ユニバーサル基盤の表面と裏面で、いい感じに配線を分けられたので、前よりもきれいになった。

#手動制御からの脱却
最後に、今まで全部手動でキーボード入力していたのを、タイムラインから自動で呼び出してもらえるように、以下の記述を追加した。

```BaseController.cs
    //動かすグループ・向きの種類
    const int STOP = 0;
    const int FORE_UP = 1;
    const int FORE_DOWN = 2;
    const int BACK_UP = 3;
    const int BACK_DOWN = 4;
    const int ALL_UP = 5;
    const int ALL_DOWN = 6;

    //現在の状態
    int state = 0;
    
    //その状態の残り時間
    float restTime = 0.0f;

    void Update ()
    {
        ManualManipulate();
        //新規追加
        CountDown();
    }

    //アクチュエータを動かし始めたいときに、動かしたいグループ・向きの変数、継続時間(単位:秒)を入れて使う
    void Ignite(int targetState, float time)
    {
        List<int> targetList = null;

        if(state == STOP)
        {
            switch (targetState)
            {
                case FORE_UP:
                    targetList = foreUp;
                    state = FORE_UP;
                    break;
                case FORE_DOWN:
                    targetList = foreDown;
                    state = FORE_DOWN;
                    break;
                case BACK_UP:
                    targetList = backUp;
                    state = BACK_UP;
                    break;
                case BACK_DOWN:
                    targetList = backDown;
                    state = BACK_DOWN;
                    break;
                case ALL_UP:
                    targetList = allUp;
                    state = ALL_UP;
                    break;
                case ALL_DOWN:
                    targetList = allDown;
                    state = ALL_DOWN;
                    break;
            }

            foreach (int value in targetList)
            {
                UduinoManager.Instance.digitalWrite(value, State.HIGH);
            }

            restTime = time;
        }
    }

    //動きを止める
    void Stop()
    {
        if(state != STOP)
        {
            List<int> targetList = null;

            switch (state)
            {
                case FORE_UP:
                    targetList = foreUp;
                    break;
                case FORE_DOWN:
                    targetList = foreDown;
                    break;
                case BACK_UP:
                    targetList = backUp;
                    break;
                case BACK_DOWN:
                    targetList = backDown;
                    break;
                case ALL_UP:
                    targetList = allUp;
                    break;
                case ALL_DOWN:
                    targetList = allDown;
                    break;
            }

            foreach(int value in targetList)
            {
                UduinoManager.Instance.digitalWrite(value, State.LOW);
            }

            state = STOP;
            restTime = 0.0f;
        }
    }

    //残り時間が来たら、アクチュエータを止める
    void CountDown()
    {
        if(restTime > 0.0f)
        {
            restTime -= Time.deltaTime;

            if(restTime <= 0.0f)
            {
                Stop();
            }
        }
    }

```

#ついに完成
シールドもスクリプトも完成したので、あとは組み立てて動かすだけ。
モータードライバを装着してArduinoにマウントし、
![IMG_5119.JPG](https://qiita-image-store.s3.amazonaws.com/0/310251/cf02c775-5ba7-5ceb-6e58-527620b4660c.jpeg)
ケーブル類を挿し、
![IMG_5180.JPG](https://qiita-image-store.s3.amazonaws.com/0/310251/df8500d0-45bb-5c10-d89c-9bf2bf8968aa.jpeg)
スイッチオン！
[![](http://img.youtube.com/vi/CJc9O3K9EJQ/0.jpg)](https://www.youtube.com/watch?v=CJc9O3K9EJQ)
動いた！(わかりづらい)

#最後に
結局本番は、かなり心配していたモータードライバの故障にも見舞われず(換装できるようにして、いっぱい買い込んだのに…)、無事に3日間の展示を乗り切ることができた。かなり稚拙な設計(電源無駄に分けてある。まだちょっとスパゲッティ。コンデンサーのつき方ダサい。ちゃんと計算してない。など…)ではあったが、何とか動いてくれて本当に良かった。とはいえ、まだまだ改善点はあるので、さらにいいものにしていきたい。
最後に、この記事を、自分の未熟さゆえに死なせてしまったTB6643KQたちに捧ぐ。
![IMG_5185.JPG](https://qiita-image-store.s3.amazonaws.com/0/310251/1bccc5b1-7d8f-a2eb-5fd4-65b4cb080479.jpeg)