回路の準備ができたので、いよいよプログラム。まずはGCC Developer Liteをインストール。コンパイルオプションは「DYNAMIXEL Library for ATmega128 USB I/O」を選択(このGDLのバージョンは2.2.0.44)。GDLのバージョンによっては違う名前のこともあるが、「DYNAMIXEL」と「ATmega128」の2つの単語が入っている設定を使えばOK。
この設定にすることで、予め用意されているAX/DX(RXも)ライブラリをそのまま利用することができる。0から自分で用意する選択肢もあるが、今回は面倒なのでパス。また、別マイコンでAX/DXモータを使う場合も、ライブラリの中身を参考にするのが楽かも。
基本になるプログラムはこんな感じ。ただし、これだけだと何もしないので焦って「動かない!」と思わないよ~に。
トルクイネーブルまでを加えたのがこのプログラム。正しく動作すれば、AX-12+モータが現在位置で保持されるのでわかるはず。ここまでできれば、後は位置制御やら無限回転やら思いのままだ!
ということで今回はここまで。
AX-12+は(AX-S1も)電源を含めた3本の線で動作させる・・・、というのはコネクタを見ればわかることですが、問題はマイコンとの接続ですね。
この図はAX-12+のマニュアルに載っている回路に追記したものです。2つのICを使って、マイコンの送信、受信端子を切り替えています。ちなみに、74HC125,126どちらもDIPパッケージなら100円しない位の価格らしいです。
切り替えに使うI/Oはどこでも良いといえばいいのですが、上の例ではPD5に接続しています。理由はベステクのATmega128用AXライブラリの接続がこの端子だったから。つまりこの接続なら用意されているAXライブラリ(実際にはDX/RXも共通)がそのまま使えるというわけです。楽チン楽チン。
前述の回路はこれで問題なく動作するのですが、ICを2種類使うのが玉にキズ。というわけで、1つのICで何とかならないかなと探したところ74HC241を使えば良さそうだ、というところで今回はここまで。
さてさて、回路が同じといってもAX-12+とICS2.0のプロトコルは全く違うので、別途送信コマンドを用意する必要があります(ま、当然ですね)。
ISC2.0のコマンドリファレンスとにらめっこしながら、適当に動かしてみました。
パリティの設定が違うのが、ハマりやすいところでしょうか。
中規模なシステムを組むのに、何かと便利なATmega128マイコンボード。
シリアルポートが2ch用意されているので、最近流行のスマートアクチュエータも動かすことができます。試しに、KONDOのKRS-401x(シリアルモード)とベステクのAX-12+の両方を動かせるボードを作ってみました。
使っている回路は同じ。電源電圧も同じ(DC12V)なので、ケーブルを付け替えるだけで両方の動作を確認できます。
追々、これを動かす様子も紹介していきたいと思います。