|
一覧
検索
最新
ページへ戻る
履歴
Dynamixel with python
のバックアップソース(No.1)
knowledge
:Dynamixel with python のバックアップソース(No.1)
Dynamixel with python は削除されています。
Next »
#norelated #contents **はじめに [#a6234e5b] 様々なアプリケーションにおいてDYNAMIXELでつまづかないよう、最低限運転できるところまでの流れを本ページにまとめた。PCの操作やOSについても説明をしなくてはならない事も多々あるが、ここでは「ひとまず」動かせるところまでを一気に紹介する事で、分かった気になってもらう事に主眼を置いた。~ そのような中においても多少なりともTipをちりばめてあるので、最終的にはそれらを踏まえたシステムを構築して欲しい。~ 縦に長くなって閲覧しにくいかもしれないが予めご了承の程。また別ページへのリンクをクリックするとブラウザ上ではページが切り替わるが、何度も往来しているうちに元に戻るのが億劫になる事がある。リンク先を参照する際は「Ctrl」キーを押しながらクリックして新規タブで開けば、多少なりとも閲覧効率が良くなるかも知れない。 ※ここに記述された内容は断り無く更新される。 **ハードウェアの準備 [#ge9b37ab] ここではWindows PCからDYNAMIXELを動かす方法のみ紹介する。それ以外の手段で運用するケースはいずれ別のページで。 ***PC [#r04475b3] ARM版ではないWindows 10がインストールされており、USBポートが装備されたPCを用意する。USBポートは後述のUSB I/Fを接続するためにも必須の装備となる。 ***USB I/F [#pc7cb6ee] DYNAMIXELは主に2種類のI/Fが規定され、3ピンコネクタ版を俗にTTL版、4ピンコネクタ版をRS-485版と呼んでおり、電気的には相互互換性は無い。ほとんどのDYNAMIXELにはいずれかのタイプのコネクタが2個装備されている。 まずこの2種類のI/Fのコネクタを紹介する。 -TTL | Pats Name | JST Parts Number |h |基板用ヘッダー |[[S3B-EH>http://www.jst-mfg.com/product/detail.php?series=58]] | |ハウジング |[[EHR-3>http://www.jst-mfg.com/product/detail.php?series=58]] | |ターミナル |[[SEH-00x>http://www.jst-mfg.com/product/detail.php?series=58]] | #ref(DXLSHARE/jst_B3B-EH.png) | 端子番号 | 信号名 | |h |CENTER:60|CENTER:|LEFT:|c |1|GND|電源のマイナス側&br;シリアル通信のGNDと共有 | |2|VDD|電源のプラス側&br;大半のDYNAMIXELは12V | |3|TTL Signal|シリアル通信の信号&br;双方向 | -RS-485 | Pats Name | JST Parts Number |h |基板用ヘッダー |[[S4B-EH>http://www.jst-mfg.com/product/detail.php?series=58]] | |ハウジング |[[EHR-4>http://www.jst-mfg.com/product/detail.php?series=58]] | |ターミナル |[[SEH-00x>http://www.jst-mfg.com/product/detail.php?series=58]] | #ref(DXLSHARE/jst_B4B-EH.png) | 端子番号 | 信号名 | |h |CENTER:60|CENTER:|LEFT:|c |1|GND|電源のマイナス側&br;シリアル通信のGNDと共有 | |2|VDD|電源のプラス側&br;大半のDYNAMIXELはDC12V | |3|RS-485 D+|シリアル通信のプラス側差動信号&br;双方向 | |4|RS-485 D-|シリアル通信のマイナス側差動信号&br;双方向 | 紹介したTTL及びRS-485の2種類のI/Fは一般的なPCには標準装備されていないため、USBポートを介して増設するための装置が用意されている。複数のI/Fに対応していたり、いずれか1つのI/Fにのみ対応していたり、電源の供給を行えたりとラインナップが複数あるため、以下に現行品のみの比較表を示す。 | | [[USB2RS485 dongle>BTE079C]] | [[USB2TTL dongle>BTE080C]] | [[USB2DXIF dongle>BTE096]] | [[USB2DXIF>BTE101]] | [[Starter Kit A>BTH076]] | [[Starter Kit B>BTH077]] | [[PicoSHIELD]] | [[DXHUB>DXHUB2]] | [[U2D2>https://emanual.robotis.com/docs/en/parts/interface/u2d2/]] | |~| #ref(https://www.besttechnology.co.jp/uploads/onlineshop/photos/e00267e5f30aeb4b7bdf.png,15%) | #ref(https://www.besttechnology.co.jp/uploads/onlineshop/photos/p00268p5f30af2505632.png,15%) | #ref(https://www.besttechnology.co.jp/uploads/onlineshop/photos/n00269n5f30af0648685.png,15%) | #ref(https://www.besttechnology.co.jp/uploads/onlineshop/photos/k00291k61ff36e21ffa8.png,15%) | #ref(https://www.besttechnology.co.jp/uploads/onlineshop/photos/k00264k62d7c3f745615.png,15%) | #ref(https://www.besttechnology.co.jp/uploads/onlineshop/photos/h00265h62d7fbc6656a1.png,15%) | #ref(https://www.besttechnology.co.jp/uploads/onlineshop/photos/i00297i640ec82d22466.png,15%) | #ref(https://www.besttechnology.co.jp/uploads/onlineshop/photos/a00255a5dcac2c8eed34.png,15%) | #ref(https://www.besttechnology.co.jp/uploads/onlineshop/middles/k00208k5a9cf31f42b33.png,15%)| |Manufacture | BestTechnology | < | < | < | < | < | < | < | ROBOTIS | |USB | USB2.0 FS&br;USB Type-A | < | < | USB2.0 FS&br;USB Type-C | USB2.0 FS&br;USB micro-B | USB2.0 FS&br;USB Type-C | USB2.0 FS&br;micro USB Type-B | USB2.0 HS&br;USB Type-C | USB2.0 HS&br;micro USB Type-B | |FTDI Chip | [[FT234X>https://www.ftdichip.com/Products/ICs/FT234XD.html]] | < | < | < | [[FT231XS>https://ftdichip.com/products/ft231xs/]] | [[FT234X>https://www.ftdichip.com/Products/ICs/FT234XD.html]] | [[RP2040>https://www.raspberrypi.com/documentation/microcontrollers/rp2040.html]] | [[FT232H>https://www.ftdichip.com/Products/ICs/FT232H.htm]] | < | |Max DTR Rate [Mbps] | 3 | < | < | < | < | < | 3 | 12 | 6 | |DYNAMIXEL I/F | RS-485 x1 | TTL x1 | RS-485 x1, TTL x1 | RS-485 x1, TTL x1 | RS-485 x5, TTL x5 | RS-485 x4, TTL x4 | RS-485 x1 | RS-485 x6, TTL x6 | RS-485 x1, TTL x2 | |Isolation | Yes | < | < | No | < | < | < | Yes | No | |Dimension [mm] | 43.2x13.0x8.5 | < | < | 18.0x12.7x9 | | 40x40 | 51x23.5 | 52x33x15 | 48x18x14.6 | |Other spec. | Small | < | < | Tiny | | | | Power distribution | Plastic enclosure | |Software compatibility | [[DYNAMIXEL Wizard 2.0>https://emanual.robotis.com/docs/en/software/dynamixel/dynamixel_wizard2/]], [[R+2.0>https://emanual.robotis.com/docs/en/software/rplus2/manager/]], [[DXLIB]], [[DX2LIB]], [[DYNAMIXEL SDK>https://emanual.robotis.com/docs/en/software/dynamixel/dynamixel_sdk/overview/]] | < | < | < |< |< |< |< |< | ここで紹介していない古いI/F製品は概ね旧来のDYNAMIXELを前提としており、装備されているコネクタがmolex社製のものが主である。もちろんConvertible Cableを仲介させる事で現行モデルのDYNAMIXELにも接続できるので、持っているのであれば買い直す必要は無い。 ***DYNAMIXEL [#f3cc92d3] #ref(dxl_series.png) 現時点ではAX・MX・X・Pシリーズから選定する事になるが、シリーズごとの大雑把な特徴を紹介しておく。 -AXシリーズ~ BIOLOIDというロボットキットにかつて同梱されており、12V・TTL・molex社コネクタ・コアドモータ・電流センサ非搭載の廉価モデル。単体で扱おうとすると取り付けが面倒。今後ファームウェアが更新されないので、新規設計の場合はXL/XCシリーズを強く推奨。 -MXシリーズ~ 絶版のRX及びEXシリーズとの形状互換を謳った後継機で、12V・TTL/RS-485・molex社コネクタ・コアド/maxon社コアレスモータ・電流センサ搭載/非搭載。トルクによって4種類の形状(12/28/64/106)がある。MX-12Wを除きファームウェアを更新する事でXシリーズと同等に扱えるようになるが、新規設計の場合はXシリーズを推奨。 -Xシリーズ --XL-320~ ROBOTIS MINI Kitに同梱されており、7.4V・TTL・molex社2mmピッチコネクタ・コアドモータ・電流センサ非搭載。現行モデル。 --XL330~ 5V・TTL・JST社コネクタ・コアドモータ・電流センサ搭載。現行モデル。 --XC330~ 5V/12V・TTL・JST社コネクタ・コアレスモータ・電流センサ搭載。現行モデル。 --XL430~ 12V・TTL・JST社コネクタ・コアドモータ・電流センサ非搭載で廉価モデルという位置付け。2軸を内蔵した2XLもある。現行モデル。 --XC430~ 12V・TTL・JST社コネクタ・コアレスモータ・電流センサ非搭載で。2軸を内蔵した2XCもある。現行モデル。 --XM430/XM540~ 12V・TTL/RS-485・JST社コネクタ・コアレスモータ・電流センサ搭載で、トルクによって2種類の形状(430/540)がある。スタンダードな現行モデル。 --XH430/XH540~ 12/24V・TTL/RS-485・JST社コネクタ・maxon社コアレスモータ・電流センサ搭載で、トルクによって2種類の形状(430/540)がある。現行モデル。 --XD430/XD540~ 12V・RS-485・JST社コネクタ・maxon社コアレスモータ・高耐久・電流センサ搭載で、トルクによって2種類の形状(430/540)がある。現行モデル。 --XW430/XW540~ 12V・RS-485・防水コネクタ・maxon社コアレスモータ・電流センサ搭載。IP68に対応。現行モデル。 -Pシリーズ~ 24V・RS-485・JST社コネクタ・コアレス/ブラシレスモータ・電流センサ搭載・高分解能・低バックラッシュ・高トルク。3種類の形状があるのとかなり高価。唯一定格トルクを謳うハイエンド向け現行モデル。 MXとXシリーズのストールトルクと無負荷最大回転数をモデルごとにプロットしたグラフを紹介しておく。 #ref(mx_x_torque_vs_speed_graph.png,50%) アプリケーションに要求されるトルクで選定するのが一般的なのだが、DYNAMIXELの大半のモデルは定格トルクではなくストールトルクを謳っている。ストールトルクは物理的にこの値を超えて出力されることは無い値(瞬時最大トルクに近い)であり、連続的に使って良いという意味では無い。 なおここではあえてXシリーズ以降を前提とするので、AXやMXシリーズまたは廃盤品を使用する場合は差異を各自で深掘りした上で適宜読み替えてもらうものとする。また廃盤品を含む全ラインナップの一覧は[[こちら>DXLSeries]]に掲載した。 ***各装置の接続 [#zb9535bd] 各USB I/Fを使用した場合の実態配線を紹介する。~ いずれも複数のDYNAMIXELのコネクタをお互いに並列接続し、更にそこへUSB I/Fにて増設されるTTLないしRS-485 I/Fの信号と外部電源を接続する事が主な目的である。 なおmolex社のコネクタを装備したDYNAMIXELを使用する場合はJST社とmoelx社のコネクタを変換するConvertible Cableが必要だが、ここではXシリーズを前提で書き進めるので詳説しない。 ****DXHUBの場合 [#jb068510] 3ピンのTTLと4ピンのRS-485 I/Fのコネクタが複数備わっている。更にDYNAMIXELへ電源を分配供給する機能があり、その電源の入力用コネクタが装備されている。各装置をDXHUBへ接続すると基本的に接続が完結してしまう。~ #ref("BTE068C DXHUB/E148_DXL_connect.png",70&) 同一電源で構わないのであればTTLとRS-485 I/Fを装備したDYNAMIXELを同時に運用できる。 ****USB2RS485 dongleの場合 [#cc69a4e7] 4ピンのRS-485 I/Fのコネクタが1つのみ装備されており、DYNAMIXELへの電源の供給機能は無い。別途[[DXSharingBoard(RS485)]]等の分配基板を用意する事でDYNAMIXELへの電源の供給と複数台のDYNAMIXELの接続ができる。 #ref("BTE079B USB2RS485 dongle/rs485dongle_dxl_sharingboard_connect.png") この例ではPCとDYNAMIXEL間の距離はRobot Cable X4Pに支配されるが、USBドングルとPC間の接続を市販のUSB延長ケーブル等で中継する事で延長する事ができる。~ 更に正しく処置したRS-485ケーブルを作成する事で、USBドングルとDYNAMIXEL間の距離を延長できる。 **** USB2TTL dongleの場合 [#t841f21d] 3ピンのTTL I/Fのコネクタが1つのみ装備されており、DYNAMIXELへの電源の供給機能は無い。別途[[DXSharingBoard(TTL)]]等の分配基板を用意する事でDYNAMIXELへの電源の供給と複数台のDYNAMIXELの接続ができる。 #ref("BTE080B USB2TTL dongle/ttldongle_dxl_sharingboard_connect.png") この例ではPCとDYNAMIXEL間の距離はRobot Cable X3Pに支配されるが、USBドングルとPC間の接続を市販のUSB延長ケーブル等で中継する事で延長する事ができる。 **** USB2DXIF dongleの場合 [#uf65359d] USB2RS485 dongleとUSB2TTL dongleの機能を合わせ持っており、3ピンのTTL I/Fと4ピンのRS-485 I/Fのコネクタがそれぞれ1つずつ装備されている。~ そもそもUSB2RS485 dongleとUSB2TTL dongleとUSB2DXIF dongleはコネクタの実装状況が異なる以外は全く同じ代物であるので、[[USB2RS485 dongle>#cc69a4e7]]ないし[[USB2TTL dongle>#t841f21d]]を参考に接続が行える。 #ref("BTE096 USB2DXIF dongle/E160B(DUAL)_connect.png",35%) **** U2D2の場合 [#d2fd3c85] 4ピンのRS-485 I/Fのコネクタが1つ、3ピンのTTL I/Fのコネクタが2つ装備されており、DYNAMIXELへの電源の供給機能は無い。別途U2D2 PHBやDXSharingBoard等の分配基板を用意する事でDYNAMIXELへの電源の供給と複数台のDYNAMIXELの接続ができる。 #ref("u2d2phb.png",70%) TTLとRS-485 I/Fを同時に運用できる。~ なおU2D2 PHBの電源供給用のジャックはROBOTIS社のキットに同梱されるSMPSのサイズに合わせてあり、日本国内で多く流通するものには適合しない。 ***留意事項 [#i5916628] 机上では動作していたものが、実際に運用を始めた途端に問題が生じる事は良くある。DYNAMIXELを使用したアプリケーションを設計するにあたっての留意事項をいくつか紹介する。 ****DYNAMIXELのI/FとRobot Cable [#e1455d26] TTL I/Fのシリアル信号は極めて微弱かつ脆弱で、距離を延長する事ができないまでか、DYNAMIXELの電気回路を容易に故障させる可能性すらある。弊社ではTTL I/Fの選択肢しかないモデルを除き、堅牢なシステムにおいてはRS-485 I/Fを搭載したモデルを強く推奨する(モデル名のサフィックスに「-R」と記載)。 また単体製品及びDYNAMIXELに同梱されているRobot Cableはケーブルを製作せずともすぐに接続できる事を念頭に用意されており、一般的に考え得る電気的な問題を解消できるものでは無い。~ 特にRS-485 I/Fの実力を発揮させるためには既成のRobot Cableは適さないため、電源容量と延長距離に対応したケーブルの製作を推奨する。 #ref(RS-485_IdealCable.png,60%) RS-485の終端抵抗の処置も行っておきたいところだ。 ****電源装置 [#r22a2cc1] [[先の図>#zb9535bd]]では電源装置をSMPS等と表記しているが、任意電圧に設定できる電源装置やバッテリを負荷が要求する電圧と電流に合わせて用意する。しかしDYNAMIXELに内蔵されたモータの回生電力によって電圧が上昇してしまう事までは注意が行き届かないと思う。特に固定出力の一般的なスイッチングACアダプタには出力電圧と電流は規定されているが、出力側の耐圧やシンク能力までを明記しているものはまず無い。少なくとも誘導性負荷に対応しているものを選定しないと容易に故障する。 また電源からの距離をかせぐための延長ケーブルは、平行線ではなくツイストペアケーブル(より対線)を使うべきだ。 ****電気的絶縁 [#oe976ca5] 回路上PC・USBポート・USB I/F・DYNAMIXELの全てのGNDが共通になっている必要があるが、DYNAMIXEL側で電流サージが発生したりPCとDYNAMIXELに供給されている電源自体に大きな電位差があったりすると、GNDの電位が共通である事による問題が生じる場合がある。~ 大抵のPCのUSBポートには過電流保護機能が備わっているので、コネクタの抜き差し時に発生する電流サージ程度には耐性がある。しかしモータから生じるサージとなると、保護回路では太刀打ちできないレベルのものが発生する事があり得る。またUSBポートの過電流保護機能が働くとUSBポートが一時的に機能を失い、それを想定していないプログラムやOSであれば容易に暴走する。~ 更に各装置に供給される電源の電位差はサージ過電流以上に厄介で、瞬間的なものではなく定常的に過電流状態が維持されてしまい、あらゆる装置の永久破壊につながる。~ いずれの問題にも幾度となく遭遇し、壊したPCやI/Fが何台ある事か。。。 そういった諸問題を解消する目的で、USB2RS485 dongle・USB2TTL dongle・DXHUBはいずれもUSBポートとDYNAMIXEL用I/F及び電源の間を電気的に絶縁している。 なお以後の解説では接続の容易さを買って絶縁機能を持った[[DXHUB>DXHUB2]]を使用する。 **動作テストと設定変更 [#p45d723c] 複数台のDYNAMIXELの運用は理解が進んでから行う事なので、まずは1台のDYNAMIXELのみを使って最低限必要な操作方法を習得する。 ***DYNAMIXELについて知っておくべき事 [#x557721c] DYNAMIXELに関係するID番号・通信速度・モデル番号・コントロールテーブル・ファームウェアといったキーワードがあるが、大半はDYNAMIXELの外観から判別できない内部情報であり、後述するPC用のツールを用いる事で初めて認識できる。 -ID番号~ 通信プロトコルにおいて個々のDYNAMIXELの識別を行う際に0~252,254の数値を用いており、ID番号と呼ぶ。~ 出荷時および完全初期化時のID番号は一部を除き1。 -通信速度~ 本来であれば最高速度で動作していれば良いのだが、電気的だったりやハード的な制約等を回避するため任意に設定できる。~ 出荷時および完全初期化時の通信速度は一部を除き57600[bps]。 -モデル番号~ モデル名(製品名のサフィックスにある「-T」と「-R」を除いた部分)に紐付く16ビット幅の値。~ 全てのモデルが全く同じ機能を持っているものでは無いため、それを判別するためにモデル番号を用いる。 -コントロールテーブル~ 様々な情報(アイテム)をメモリ上に保持しており、それらを一覧にしたものをコントロールテーブルと呼ぶ。モデルによってアイテムの割り当て先(アドレス)が異なっていたり機能が異なっていたりする。~ 前述のID番号・通信速度・モデル番号はコントロールテーブル上に割り当てられており、通信プロトコルは主にコントロールテーブルへのアクセス手段を提供する。 -ファームウェア~ DYNAMIXELに内蔵されているマイコンの制御ソフトウェアをファームウェアと呼ぶ。そのファームウェアは時折更新される事があり、後述のツールを用いて必要に応じてDYNAMIXELに適用する事ができる。 ***ハードウェアの準備 [#kd09fa8f] 電源・電源ケーブル・USBケーブルは各製品に標準添付されていないため、必要に応じて別途調達する。 -Windows PC -[[DXHUB>DXHUB2]] + [[USBケーブル>https://www.google.com/search?q=USB+Type-C]] (DXHUBとPC間) -DYNAMIXELが要求する仕様を満足する電源 + DXHUBに電源を接続するためのケーブル等 -[[DYNAMIXEL本体>DXLSeries]] (ここでは[[2XL430-W250-T]]を想定) -Robot Cable 接続は先に紹介した[[DXHUBの場合>#jb068510]]の通りとなるが、初期設定の場合は混乱を避けるため1台のみのDYNAMIXELを接続する。~ DXHUBをPCのUSBポートに接続してデバイスドライバのインストールを行った後に、[[こちら>BTE068C DXHUB#vaffe8b2]]の情報を元に仮想COMポートの設定を予め変更しておく事を推奨する。~ またDXHUBの裏側が不用意に何かに触れてショートすると取り返しの付かない事になるため、予め四隅の取り付け穴にスペーサ等を取り付けて端子等がショートしないようにしておくと良いだろう。 ***DYNAMIXEL Wizard 2.0のインストール [#q270593c] #ref("BTE068C DXHUB/wizard2_main_001.png",40%) [[DYNAMIXEL Wizard 2.0>https://emanual.robotis.com/docs/en/software/dynamixel/dynamixel_wizard2/]]はDYNAMIXELとコミュニケーションを行うソフトウェアで、主に以下の機能を有する。 -検索~ 設定された条件が不明確なDYNAMIXELを検索し発見。 -ファームウェアの更新~ インターネットを介してDYNAMIXELの最新ファームウェアをダウンロードし更新したり、異なるファームウェアへ書き換える事が可能。 -簡易運転~ コントロールテーブルのうち主要なアイテムへ簡便にアクセスして運転可能。~ 主に動作モード・目標位置・目標速度・トルクの変更をスイッチやダイアル操作で行える。 -設定変更~ コントロールテーブルの情報全てを一覧でき、また変更可能なアイテムの編集が可能。 -複数台の一元管理~ 異なるID番号を持つ複数のDYNAMIXELの一覧を列挙し個別に操作可能。 DYNAMIXELの専用通信プロトコルを用いて対象のDYNAMIXELのコントロールテーブルにアクセスしているに過ぎないが、このようなツールを使用しない場合はちょっとした設定変更をするにしても自前でプログラムを作らざるを得ない。ROBOTIS社のサイトから[[ダウンロードしてインストール>https://emanual.robotis.com/docs/en/software/dynamixel/dynamixel_wizard2/#software-installation]]しておく。 なおDYNAMIXEL Wizard 2.0はインターネットを介してツール本体とファームウェアの更新版を取得する事ができる。ここでは詳説しないが、インターネットに接続された環境でDYNAMIXEL Wizard 2.0を起動した直後に自動的に更新がないかを確認し、必要があれば更新するか否かを問い合わせてくる。''Install Now''ボタンを押すと更新が開始されるが、特に適用する必要が無いと判断したら''Install later''ボタンを押す事で更新はキャンセルされる。 #ref(dxlwiz_update.png,80%) ***DYNAMIXEL Wizard 2.0の検索条件の設定 [#l27ab6a6] インストールしたDYNAMIXEL Wizard 2.0を起動したらツールバーの''Options''ボタンをクリックし、開いたOptionsダイアログボックスの左側の''Scan''をクリックする。 #ref(DXLWiz2_Options.png,60%) 以下の項目を設定して''OK''ボタンを押すと、DYNAMIXEL Wizard 2.0の検索条件の期設定はひとまず完了である。次回起動した際も本設定が反映される。 -Select protocol to scan.~ 「Protocol 2.0」のみにチェック。 -Select port to scan.~ DXHUBをPCに接続した際に追加されたCOMポートのみにチェック。 -Select baudrate to scan.~ 「57600 bps」のみにチェック。 -Set ID range to scan.~ Startには0、Endには252を設定。 なお本設定は出荷時のDYNAMIXEL Xシリーズを対象としているため、後々のDYNAMIXELの設定等によっては以下のように適宜変更する。 -Select protocol to scan.~ DYNAMIXEL DX/AX/RX/EX/MXシリーズやプロトコル1.0に設定したXシリーズを対象とする場合には「Protocol 1.0」をチェック。~ -Select baudrate to scan.~ 57600bps以外の通信速度に変更しているならばその通信速度をチェック、もし設定された通信速度が不明な場合は全ての通信速度をチェック。 ***DYNAMIXEL Wizard 2.0による検索[#j84d1202] DXHUBの電源スイッチをONにして電源の供給を開始すると青色のLEDが点灯し、DYNAMIXELに装備されたLEDが0.5秒だけ点灯する。その後DYNAMIXEL Wizard 2.0のツールバーの''Scan''ボタンをクリックすると、[[検索条件の設定>#l27ab6a6]]に従って検索が開始される。検索中のダイアログボックスにはプログレスバーが表示され、見つかったDYNAMIXELはダイアログボックスとメイン画面の画面左側のCOMポート番号と通信速度のツリーの配下に逐次列挙される。 #ref(DXLWiz2_Scan.png,60%) Select baudrate to scan.の全ての通信速度がチェックされていると検索の終了までにかなりの時間がかかるが、検索中に目的のDYNAMIXELが見つかったり途中で中断する場合は''Skip''ボタンを押す。 DYNAMIXEL Wizard 2.0は検索によって見つかったDYNAMIXELのみを操作対象とするため、検索は起動直後に毎回強いられる。[[検索条件の設定>#l27ab6a6]]のSelect baudrate to scan.のチェックを減らしたり、Set ID range to scan.のStat及びEndのID番号を適宜変更する事で検索時間を短縮できる。 もし検索で見つからない場合は、[[検索条件の設定>#l27ab6a6]]が対象のDYNAMIXELに合致しない・COMポートが間違っている・電源が入っていない・いずれかの装置の故障等の理由が考えられるが、原因を特定するのに少々難儀する場合もある。 ***DYNAMIXEL Wizard 2.0による試運転 [#j6880322] 出荷時状態のDYNAMIXELの動作モードは大抵「位置決め制御」モードとなっており、任意の位置を指示する事でDYNAMIXELのサーボホーンの位置がそれに伴って移動する。DYNAMIXEL Wizard 2.0では以下の手順と操作で位置を指示できる。 +検索~ 対象のDYNAMIXELが見つかっていなければ[[検索>#j84d1202]]する。 +運転対象のDYNAMIXELを選択~ 画面左側のCOMポート番号と通信速度のツリーの配下から任意のDYNAMIXELをクリックして選択すると(既に選択状態の場合もある)、DYNAMIXEL Wizardは対象のDYNAMIXELとの通信を開始する。正常であればステータスバー上のLEDやDXHUBのLEDが周期的に明滅しているはずである。 #ref(DXLWiz2_SelDX.png,60%) +TorqueをON~ 画面右上の''Torque''とあるスイッチをクリックしてON状態(赤色)にする。 #ref(DXLWiz2_DXTorqueOn.png,60%) +位置を指示~ 画面右上の円をクリックしたりドラッグするとDYNAMIXELへ位置(赤色の針の位置)が指示され、同時にDYNAMIXELのホーンの位置が移動する筈である。緑色の針は現在のホーンの位置を表している。 #ref(DXLWiz2_DXGPos.png,60%) この手順で思ったようにDYNAMIXELのホーンが動かない場合は、DYNAMIXELが故障している可能性が高い。 ***DYNAMIXEL Wizard 2.0によるID番号の変更 [#lbce237c] 複数のDYNAMIXELを同時に運用する場合は、個々に異なるID番号を設定しておかなくてはならない。通信プロトコルの仕様では複数のDYNAMIXELのID番号が同じだと個々を識別できないからである。 +検索~ 対象のDYNAMIXELが見つかっていなければ[[検索>#j84d1202]]する。 +変更対象のDYNAMIXELを選択~ 画面左側のCOMポート番号と通信速度のツリーの配下から任意のDYNAMIXELをクリックして選択すると(既に選択状態の場合もある)、DYNAMIXEL Wizardは対象のDYNAMIXELとの通信を開始する。正常であればステータスバー上のLEDやDXHUBのLEDが周期的に明滅しているはずである。 #ref(DXLWiz2_SelDX.png,60%) +TorqueをOFF~ 画面右上の''Torque''とあるスイッチがON(赤色)ならばクリックしてOFF状態(灰色)にする。 #ref(DXLWiz2_DXTorqueOff.png,60%) +画面中央のコントロールテーブルから「ID」を選択~ アドレスの7に「ID」が割り当てられているので、該当アドレスをクリックして選択状態にする。 #ref(DXLWiz2_SelCtrlTableID.png,60%) +ID番号を変更 画面右下の「ID」の一覧から任意のID番号を選択し''Save''ボタンを押す事で即時反映される(ここでは例として「ID 1」から「ID 3」へ変更)。~ #ref(DXLWiz2_ChangeID.png,60%) なお複数のDYNAMIXELが検索されている時は、既に見つかっているID番号は選択できない。 ***DYNAMIXEL Wizard 2.0による通信速度の変更 [#i4b598f8] DYNAMIXELのデフォルトの通信速度は57600bpsだが、軸数が増えたりタイトな通信をし始めるとトラフィックが渋滞し、体感的にも応答が遅いと感じたりする。高い通信速度は様々な環境に影響されやすいため最高速まで設定する必要は無いが、1000000bps程度であれば経験的に安定して使用できる速度と考える。以下に通信速度を変更する手順を示す。 +検索~ 対象のDYNAMIXELが見つかっていなければ[[検索>#j84d1202]]する。 +変更対象のDYNAMIXELを選択~ 画面左側のCOMポート番号と通信速度のツリーの配下から任意のDYNAMIXELをクリックして選択すると(既に選択状態の場合もある)、DYNAMIXEL Wizardは対象のDYNAMIXELとの通信を開始する。正常であればステータスバー上のLEDやDXHUBのLEDが周期的に明滅しているはずである。 #ref(DXLWiz2_SelDX.png,60%) +TorqueをOFF~ 画面右上の''Torque''とあるスイッチがON(赤色)ならばクリックしてOFF状態(灰色)にする。 #ref(DXLWiz2_DXTorqueOff.png,60%) +画面中央コントロールテーブルから「Baud Rate (Bus)」を選択~ アドレスの8に「Baud Rate (Bus)」が割り当てられているので、該当アドレスをクリックして選択状態にする。 #ref(DXLWiz2_SelCtrlTableBaudrate.png,60%) +通信速度を変更~ コントロールテーブル上では通信速度そのものの値ではなく、代わりに0~7の値で指示する。 | Value | 通信速度[bps] | | 0 | 9,600 | | 1 | 57,600 | | 2 | 115,200 | | 3 | 1,000,000 | | 4 | 2,000,000 | | 5 | 3,000,000 | | 6 | 4,000,000 | | 7 | 4,500,000 | 1000000bpsに変更するには画面右下のリストから「3 1Mbps」を選択し''Save''ボタンを押す事で即時反映される。 #ref(DXLWiz2_ChangeBaud.png,60%) **自作のプログラムから動かす [#x60f6e97] プログラミングの知識が無ければ何も始まらないし、それ相応の環境を整える必要もある。~ ここでは弊社が提供するWindows向けの簡易的な統合環境と専用のライブラリを用い、''C言語''でコーディングする。コンパイル後に生成されるプログラムは、いずれもCUIベースである。 ***Dynamixel Protocol 2 Library [#w080c509] DYNAMIXELは[[専用の通信プロトコル>DXProtocol2]]でのみ通信できるが、通信プロトコルを処理するプログラムを自前でコーディングするのにはそれ相応の知識と労力が要求される。その手間を軽減させる目的で提供しているのが[[Dynamixel Protocol 2 Library>DX2LIB]](DX2LIB)である。~ 他にもこういった目的のライブラリはあるが、DYNAMIXELの主要な機能を利用する際にモデルやコントロールテーブルの差異をほぼ意識しなくて済む[[追加API>DX2LIB#ac9f5496]]をDX2LIBは持っている。追加APIを使用している限りユーザーはCOMポート番号・通信速度・ID番号程度を把握していれば良く、最終的には少ないソースコード量で大抵の処理が行えると謳っている。また各APIはコンパイル済みのDLLに含まれているので、自分のプログラムから呼び出す手段さえあれば言語は問わない。~ 見ての通り追加APIのソースでは大した事はしておらず、モデルによって異なるアイテムの変換や手順を強いられるアイテムの手順操作、物理値とアイテム間の単位変換、複数IDの一括処理に終始しているだけである。しかし追加APIを使わない場合は、コントロールテーブルのアイテムの機能を習熟する段取りから始めざるを得ないので、説明を端折るにはありがたい :-P 。 なお[[プロトコルV1.0用のライブラリ>DXProtocol1]]も用意されているので、どうしてもDX/AX/RX/EX/MXシリーズを動かしたいという場合は所々読み替えて対応してもらいたい。~ また我々としてはプロトコルV1.0とV2.0を混在させた運用は危険と判断しているのでライブラリはプロトコルのバージョン別に用意しているが、[[DYNAMIXEL SDK>https://emanual.robotis.com/docs/en/software/dynamixel/dynamixel_sdk/overview/]]では同時に運用できる事になっている。 ****ダウンロードと必要なファイル [#xfb3e755] [[こちら>DX2LIB#j8bd290f]]より最新のアーカイブファイルをダウンロードし、適宜解凍する。 以後に紹介するGCC Developer Liteでコーディング・コンパイル・実行には、ライブラリに含まれる次の4つのファイルがソースコードファイルを保存したフォルダと同じ場所に配置されている事が前提となる。 | ファイル名 | 説明 |h |dx2lib.h |各APIのプロトタイプ宣言等を含むヘッダファイル | |dx2memmap.h |コントロールテーブル上の主要アイテムのアドレスが定義されたヘッダファイル | |dx2lib_x32.dll|ライブラリ本体が含まれた32ビット版DLL | |dx2lib_x64.dll|ライブラリ本体が含まれた64ビット版DLL | このうち「dx2memmap.h」は一部のDYNAMIXELのコントロールテーブルに配置されたアイテムのアドレスを記述しているファイルなのだが、アイテムのアドレスを指定してアクセスしない限り必須ではない。また32ビット版と64ビット版のDLLはコンパイル時の条件によっていずれか一方で構わない。その他のファイルは一切必要ない。 ***GCC Developer Lite[#z879d754] #ref(GCC Developer Lite/GDL.png,50%) [[GCC Developer Lite]]はマイコンボード製品向けにプログラムを手っ取り早く動かせるツールとして提供しているが、ここではWindows上で動作するプログラムをコーディング及びコンパイルする事が目的となる。~ 最近の統合環境の類いに比べたら極めて少ない機能しか備えておらず正直なところ今更な感じではあるのだが、無償かつ簡単な設定でソースコードの編集とコンパイルができるという理由だけで選定した。 ****インストーラのダウンロードとインストール [#gcd418f7] ここではWindows向けの実行プログラムを生成する事が目的なので、[[ここ>GCC Developer Lite#DOWNLOAD]]から「基本パック」と「WINパック」をダウンロードする。手順を間違えるとインストールできないので、[[こちら>GCC Developer Lite#t1d1c731]]を読んでから作業する。 ****ソースコード編集・ファイル操作 [#m53faff0] 後述のソースコードを使用する際に必要な操作を紹介する。 まずブラウザから該当のソースコードをクリップボードにコピーし、GCC Developer Liteのエディタウィンドウ上にペーストする。ソースコード中のCOMポート番号の部分("\\\\.\\COM&color(red){3};")の数値を自身の環境に合わせて書き換えたら編集作業は完了である。~ 編集中のソースコードをファイルとして保存しておけば、後々再度読み出して再利用できる。保存するには「ファイル(%%%F%%%)」メニュー内の「名前を付けて保存(%%%A%%%)...」をクリックし任意の場所と名前で保存する。なおファイル名のフルパスに全角文字・機種依存文字・空白が含まれているとコンパイルに支障をきたすので、基本的には半角の英数字で構成しておく事。 ****コンパイルオプション [#l2754b74] 64ビット版のWindows上で32ビット版のプログラムは実行できるが、その逆はできない。32ビット版と64ビット版のどちらを選んでも大きな違いは感じないと思うが、ここではどちらのOSでも実行できる32ビット版のプログラムを生成する事にする。~ コンパイルしたいソースコードを開いている状態で、「ツール(%%%T%%%)」メニュー内の「コンパイルオプション(%%%O%%%)」をクリックしコンパイルオプションダイアログボックを開く。上端の設定リストをドロップダウンし「Windows x86 (Console)」を選んで''OK''ボタンを押すと、32ビット版のコンパイル条件の設定は全て完了する。 #ref(GDL_SelCompileOption.png) ちなみに「Windows x64 (Console)」を選ぶと64ビット版の実行ファイルを生成するためのコンパイル条件となる。 なお後述の[[ビルド>#w2cf95a0]]や[[デバッグ情報付きビルド>#hf8ec1c4]]を行った既存のソースコードファイルを開き直した場合、「保存済みの環境設定ファイルが見つかりました。」というメッセージダイアログボックスが表示される。 #ref(GDL_ReloadCfg.png) このメッセージは過去にコンパイルオプションを設定してコンパイルされた事を意味し、''OK''ボタンを押す事でコンパイラオプションを設定したのと同等の扱いとなる。 ****ビルドと実行 [#w2cf95a0] 後述のライブラリを利用したソースコードをコンパイルするには、[[ライブラリに含まれる4つのファイル>#w080c509]]が必要となる。それらファイルを予めソースコードを保存したフォルダにコピーしておく事を忘れないように。~ コンパイラオプションが正常に設定されていれば、「コンパイル(%%%C%%%)」メニュー内の「ビルド(%%%B%%%)」が利用できるようになる。「ビルド(%%%B%%%)」をクリックする(もしくは「F9」キーを押す)とコンパイラが呼び出され、問題が無ければソースコードから実行可能なプログラムが同じフォルダの中に生成される。 #ref(GDL_Build.png) 例えばソースコードのファイル名が「test1.c」ならば、「test1.exe」というファイル名で実行ファイルが生成される。実行ファイルが生成されたら、そのファイルをエクスプローラー等から開いて実行する。 #ref(GDL_AppRun.png) 実行中はコマンドプロンプトが表示され、標準出力へ何かしらのメッセージが出力される。 #ref(CMD_Execute.png) なおエクスプローラーから起動したプログラムは、メッセージを確認する間もなく終了と同時にコマンドプロンプトが閉じてしまう。メッセージを確認する必要がある場合は予めコマンドプロンプト(cmd.exe)を起動しておき、その中でコンパイルしたプログラムを実行すれば終了時に勝手に閉じることはない。 ****デバッグ情報付きビルドとデバッガ [#hf8ec1c4] [[ビルドと実行>#w2cf95a0]]と大差は無いが、コンパイル後にデバッガを介してプログラムを実行する。ここではデバッガを使ってデバッグする事が目的というよりも、GCC Developer Liteのみでコンパイルからプログラムの実行まで全て行うためだけに使う。 コンパイラオプションが正常に設定されていれば、「コンパイル(%%%C%%%)」メニュー内の「デバッグビルド&デバッガで開く(%%%G%%%)」が利用できるようになる。「デバッグビルド&デバッガで開く(%%%G%%%)」をクリックする(もしくは「Ctrl」+「F9」キーを押す)とコンパイラが呼び出され、問題が無ければソースコードから実行可能なプログラムが同じフォルダの中に生成される。~ #ref(GDL_DebugBuild.png) コンパイルが成功すると「デバッガ(GDB)を起動しますか?」と問い合わせてくるので、''OK''を押すとデバッガ(GDB)が開く。~ #ref(GDL_GDBRun.png) GDBの操作説明は省くが、そのプロンプト上で「r」と入力してエンターキーを押すとコンパイルしたプログラムが実行される。 #ref(GDB_Execute.png.png,60%) なおデバッガに興味を持ったのであれば、その[[使い方>https://www.google.com/search?q=gdb+how+to+use]]を検索してみると良い。 ****その他の機能 [#waf39bb8] ソースコードの編集以外には大した機能は無いが、その中でも余り知られていない機能を紹介する。 -外部ファイル参照~ ソースコードのヘッダ等のファイル名が記述されたところにマウスカーソルを置き「Ctrl」キーを押しながらダブルクリックすると、該当のファイルを検索して別ウィンドウでそのファイルを開く事ができる。~ #ref(GDL_NewWindow.png,40%) ヘッダファイルの定義を参照する際に使える。 -ブラウザ機能~ 外部ファイル参照と似ているが、ソースコード中にコメント等でURLを記述しておき、そこにマウスカーソルを置き「Ctrl」キーを押しながらダブルクリックすると、別ウィンドウでそのサイトを開く事ができる。~ #ref(GDL_NewIEWindow.png,40%) APIのドキュメントはホームページにのみ公開しているので、そのURLをソース中のコメントに記述しておいて、適宜参照する際に利用してはどうだろうか。 -タグジャンプ~ 「検索(%%%S%%%)」メニュー内の「タグファイル自動生成(%%%C%%%)」と「タグ生成オプション」内の「タグ生成時にカレントフォルダを含める」をチェックしておく。この状態でソースコードをファイルに保存するとバックグラウンドでタグファイルが生成し直される(特に見かけ上変化はないが処理が長時間に及ぶ事もある)。~ 準備ができたらソースコードの関数名が書かれた部分にカーソルを置き、「Ctrl」キーを押しながら「]」キーを押してから「]」キーのみを放す(「Ctrl」キーのみが押された状態)とエディタウィンドウ中央にその関数名の宣言がなされているファイルの一覧が表示される。~ #ref(GDL_TagJump.png,80%) その関数名の参照先が見つからなかった場合は、ファイルの一覧は表示されない。「Ctrl」キーが押されままの状態でファイルの一覧が表示されている間にカーソルキーの上下やマウスのクリックでファイル一覧から任意のファイル名を選択すると、そのファイルが別ウィンドウが開いてかつ該当するタグが記述されている場所にジャンプする。もし編集中のソースコードが参照先の場合は、別ウィンドウは開かずにそのまま該当箇所にジャンプする。~ なおタグとソースコードとの相関はほぼ皆無なので、あくまで参考程度に。 -エンコード~ ソースコードファイルはテキストファイルなのだが、コンパイラやツール類はその文字コードに多分に影響を受ける。エディタ上では問題無く閲覧できているにもかかわらず、含まれる文字によっては不可解なエラーが発生するといった事が考えられる。~ GCC Developer LiteのデフォルトエンコードであるShift_JISでは問題が生じやすいため、できる限りUTF-8もしくはBOM付きUTF-8に変更た上でソースコードファイルを保存する事を推奨する。画面最下段のステータスバーの右側に現在のエンコードと改行の状態が表示されており、右クリックして表示されるポップアップメニューより任意のエンコードと改行に変更できる。 #ref(GDL_Encode.png,80%) -文字サイズ~ GCC Developer Liteは最近の高DPIなPCに対応していないため、高解像度になればなるほどエディタ画面の文字サイズが小さく表示され、場合によっては普通の視力では識別できない程小さく表示される。その場合は「Ctrl」キーを押しながらマウスホイールを回転させるかピンチイン・アウトさせると、それと連動して文字サイズが変わる。ソースコード全体の見通しを良くするために縮小したり、小さすぎて見えないから拡大するといった使い方ができる。 #ref(GDL_Zoom.png,55%) ***トライアウト [#i3328ac1] 紹介するソースコード上ではID番号が1~4に設定されたDYNAMIXELがあり、信速度は1Mbpsに変更してあるものとした。自身の環境向けにはPC上のDXHUBに割り当てられたCOMポートの番号を修正する程度で済む筈だ。ID番号が4つよりも少なくても多くても動かす事はできるが、少なくともID番号が1と2に設定されたDYNAMIXELが無いと一部の機能の確認ができない。~ またDYNAMIXELのコントロールテーブルには機能を大きく左右するOperating Modeなるアイテムがあり、出荷時は3(Position Control Mode)に設定されている。紹介するソースコードによってはそのモードを変更しており、DYNAMIXELの電源を投入し直してもモードはそのまま保持される。他の目的でDYNAMIXELを使用する際はOperating Modeが変更されている可能性がある事を常に失念しないよう注意する事。~ さらに初期条件を整える時を除いてエラー処理の類いを行っておらず、何かしらの不都合があったとしてもプログラムの実行は停止しないまでか異常終了する事も考えられる。DX2LIBのAPIの大半は戻り値で実行の正否の判定ができるので、堅牢なアプリケションを構成する際は判断材料にすると良いだろう。~ 少なくともソースコードをコンパイルするに当たっての前提は、 -DX2LIBの[[4つのファイルを抽出>#xfb3e755]] -[[GCC Developer Liteをインストール>#gcd418f7]]し[[コンパイルオプションを設定>#l2754b74]] -ソースコード中のCOMポート番号を自身の環境に合わせて修正 -ソースコードファイルの拡張子は「.c」となるようにし、先のDX2LIBの4つのファイルを抽出した場所に保存 である。 なおGCC Developer LiteはGNUツールを用いてコンパイルしているため、[[MSYS2>https://www.msys2.org/]]の環境でもコンパイルできる。またCOMポート名や時間にかかる関数を修正すれば、他のOSでも容易に流用できる。 ****DYNAMIXELの検索とモデル名の列挙 [#f6e7abbb] 以後のソースコードには、APIを使用するのに共通する最低限必要な処理が含まれている。 +[[LoadDLL>DX2LIB#y15bf22f]]~ 「dx2lib.h」をインクルードする前に「_DYNAMICLOAD」を宣言しているので、LoadDLLを実行してAPIを提供するDLLを動的に読み込む。実行プログラムと同じフォルダにDLLが無い場合は実行を終了させる。 +[[DX2_OpenPort>DX2LIB#zbd2f6ef]]~ COMポート名と通信速度を指定し、オープンに成功した際の戻り値を以後APIの引数に用いる。ソースコードでは"\\\\.\\COM3"といった具合にポート名に「\\\\.\\」といったプレフィクスを付与しているが、常に記述しておく事を推奨する。 +[[DXL_ScanDevices>DX2LIB#j98a660f]]~ 全ID番号を対象としたDYNAMIXELの検索と見つかったID番号のテーブルの生成を行う。戻り値は見つかったDYNAMIXELの数で、引数に指定した配列にはそのID番号が保存される。以後検索で見つからなかったID番号を指定してAPIを呼び出しても、実際には処理は行われずに無視される。 +[[DX2_ClosePort>DX2LIB#w1ab7cbb]]~ DX2_OpenPortでオープンしたCOMポートのクローズする。以後は引数で指定したデバイスIDが使用できなくなる。~ +[[UnloadDLL>DX2LIB#y15bf22f]]~ DLLの破棄を行う。この処理以後は全APIが使えなくなり、万が一呼び出してしまうと一般保護エラーが発生する。 最終的には検索とCOMポートのクローズの間に実際に行いたい処理を追記する事になる。~ DXL_ScanDevicesによる検索はDYNAMIXELのモデルが想定と違っていてもある程度順応できるようにと考えての事だが、諸設定が最適に設定されていたとしても検索が終わるまではそれ相応の時間(約10秒程度)かかる。 #html{{ <pre class="brush: c;"> // DYNAMIXELの検索とモデル名の列挙 #include <stdio.h> #define _DYNAMICLOAD // DX2LIBの動的呼び出しを宣言 #include "dx2lib.h" // DX2LIBのヘッダ int main (void) { // DLLの読み込み(成功は必須) if (LoadDLL ()) { uint8_t IDs[253]; // 見つかったIDのリスト int detectnum = 0; // 見つかった数 // COMポートのオープン TDeviceID dev = DX2_OpenPort ("\\\\.\\COM3", 1000000); // devが0でなければオープン成功 if (dev) { // 検索 detectnum = DXL_ScanDevices (dev, IDs); // 見つかったモデルをコンソールに列挙 DXL_PrintDevicesList ((void *)&printf); // この辺りに目的の処理を追記 // COMポートのクローズ DX2_ClosePort (dev); } // DLLの破棄 UnloadDLL (); } }</pre> }} 正常に検索が終了すると左からID番号・モデル名・モデル番号の順に次のような情報が表示される。 [ 1] 2XL430-W250 ($0442) [ 2] 2XL430-W250 ($0442) [ 3] 2XL430-W250 ($0442) [ 4] 2XL430-W250 ($0442) なおID番号が1~4のDYNAMIXELが存在する前提での[[DXL_GetModelInfo>DX2LIB#pfc0b4fd]] APIを使った登録方法も一応紹介しておく。こちらは指定されたID番号のみを対象に登録できるかを判断するので、全ID番号を対象とした検索を行った場合と異なりほぼ一瞬で処理が終了する。 #html{{ <style type="text/css"> .syntaxhighlighter { overflow-y: auto !important; overflow-x: auto !important; max-height: 900px; -webkit-text-size-adjust: 100%; } </style> <pre class="brush: c;"> // ID番号を決め打ちする場合 #include <stdio.h> #define _DYNAMICLOAD #include "dx2lib.h" int main (void) { // DLLの読み込み(成功は必須) if (LoadDLL ()) { // COMポートのオープン TDeviceID dev = DX2_OpenPort ("\\\\.\\COM3", 1000000); // devが0でなければオープン成功 if (dev) { // 検索の代わりにID番号を直接指定して登録 DXL_GetModelInfo (dev, 1); DXL_GetModelInfo (dev, 2); DXL_GetModelInfo (dev, 3); DXL_GetModelInfo (dev, 4); // 登録されたモデルをコンソールに列挙 DXL_PrintDevicesList ((void *)&printf); // この辺りに目的の処理を追記 // COMポートのクローズ DX2_ClosePort (dev); } // DLLの破棄 UnloadDLL (); } }</pre> }} ****LEDのON/OFF [#k74cc75a] サイレントに動作確認を行うには、DYNAMIXELに搭載されているLEDを使うと良いだろう。 ID番号を指定してLEDを明滅させる[[DXL_SetLED>DX2LIB#z55d09d0]] APIを用いて、個々のID番号を順に指定してLEDをON/OFFさせる。なおAPIの処理そのものは一瞬で終わってしまうので、目に見えるように10回のループ内のLEDのONとOFFの後にSleep命令で500msの中断を挿入した。 #html{{ <pre class="brush: c;"> // LEDのON/OFF #include <stdio.h> #define _DYNAMICLOAD #include "dx2lib.h" int main (void) { if (LoadDLL ()) { uint8_t IDs[253]; // 見つかったIDのリスト int detectnum = 0; // 見つかった数 TDeviceID dev = DX2_OpenPort ("\\\\.\\COM3", 1000000); if (dev) { detectnum = DXL_ScanDevices (dev, IDs); DXL_PrintDevicesList ((void *)&printf); // とりあえず10回繰り返す for (int i = 0; i < 10; i++) { // 全軸のLEDをONに設定 printf ("ON "); for (int j = 0; j < detectnum; j++) DXL_SetLED (dev, IDs[j], true); Sleep (500); // 全軸のLEDをOFFに設定 printf ("OFF "); for (int j = 0; j < detectnum; j++) DXL_SetLED (dev, IDs[j], false); Sleep (500); } DX2_ClosePort (dev); } UnloadDLL (); } } </pre> }} なおDYNAMIXELに何らかのアラームが発生した事によりLEDが自動点滅している間は、LEDの制御ができない。 ****トルクのON/OFF [#n0c0087d] 試運転の際にも行っている通りトルクのONという操作を予め行っておかないと、位置や速度を指令してもホーンは動かない。コントロールテーブル上のアイテム名が「Torque Enable」となっているためにトルクと称しているが、実際には設定された制御モードに従って制御を開始・停止する事を意味している。 [[DXL_SetTorqueEnablesEquival>DX2LIB#je2874de]] APIを用いて引数で指定されたID番号の一覧を用いて一斉にトルクのON/OFFを切り替える。 #html{{ <pre class="brush: c;"> // トルクのON/OFF #include <stdio.h> #define _DYNAMICLOAD #include "dx2lib.h" int main (void) { if (LoadDLL ()) { uint8_t IDs[253]; // 見つかったIDのリスト int detectnum = 0; // 見つかった数 TDeviceID dev = DX2_OpenPort ("\\\\.\\COM3", 1000000); if (dev) { detectnum = DXL_ScanDevices (dev, IDs); DXL_PrintDevicesList ((void *)&printf); // とりあえず意味も無く5回繰り返す for (int i = 0; i < 5; i++) { // 全軸のトルクをONに設定 printf ("ON "); DXL_SetTorqueEnablesEquival (dev, IDs, detectnum, true); Sleep (1000); // 全軸のトルクをOFFに設定 printf ("OFF "); DXL_SetTorqueEnablesEquival (dev, IDs, detectnum, false); Sleep (1000); } DX2_ClosePort (dev); } UnloadDLL (); } }</pre> }} トルクがOFFの時にDYNAMIXELは脱力し、外力でホーンを動かす事ができる。~ またコントロールテーブル中のアイテムの一部にはトルクがONの状態では変更できないものもあるため、APIによっては必要に応じてトルクのOFFを発行しているものがある。 ****角度指令 [#p18c2b19] DYNAMIXELの本分である位置決め制御を行う。 [[DXL_SetOperatingModesEquival>DXLIB#a14c1876]] APIを使用して全DYNAMIXELの動作モードを3:Position Control Modeに設定(このAPIは内部でトルクOFFを発行する)。全軸のトルクをON。コメントにあるように1秒かけて全軸の角度を45度へ移動→2秒かけて全軸の角度を-45度へ移動→1秒かけて全軸の角度を0度へ移動。最後に全軸のトルクをOFFにして終了する。foo関数内の[[DXL_SetGoalAnglesAndTime>DX2LIB#ecafeaa6]] APIは軸数分の角度の配列と現在の角度からの移動時間を秒で指定するAPIだが、DYNAMIXELへの指令を終えると移動時間を待たずに即時復帰する。そのため直後にSleep関数で移動している間だけプログラムの進捗を意図的に停止させている。~ #html{{ <pre class="brush: c;"> // 角度指令 #include <stdio.h> #define _DYNAMICLOAD #include "dx2lib.h" // 角度指令と時間待ち関数 bool foo (TDeviceID dvid, const uint8_t *ids, const double *angles, int num, double sec) { bool result = DXL_SetGoalAnglesAndTime (dvid, ids, angles, num, sec); Sleep (sec * 1000); // 移動完了まで待機 return result; } int main (void) { if (LoadDLL ()) { uint8_t IDs[253]; // 見つかったIDのリスト int detectnum = 0; // 見つかった数 double angles[253]; // 角度の配列 TDeviceID dev = DX2_OpenPort ("\\\\.\\COM3", 1000000); if (dev) { detectnum = DXL_ScanDevices (dev, IDs); DXL_PrintDevicesList ((void *)&printf); // 全軸を 3: Position Control に設定 DXL_SetOperatingModesEquival (dev, IDs, detectnum, 3); // 全軸のトルクをONに設定 DXL_SetTorqueEnablesEquival (dev, IDs, detectnum, true); // 1秒かけて全軸の角度を45度へ移動 printf ("45deg "); for (int j = 0; j < detectnum; j++) angles[j] = 45.0; foo (dev, IDs, angles, detectnum, 1.0); // 2秒かけて全軸の角度を-45度へ移動 printf ("-45deg "); for (int j = 0; j < detectnum; j++) angles[j] = -45.0; foo (dev, IDs, angles, detectnum, 2.0); // 1秒かけて全軸の角度を0度へ移動 printf ("0deg "); for (int j = 0; j < detectnum; j++) angles[j] = 0.0; foo (dev, IDs, angles, detectnum, 1.0); // 全軸のトルクをOFFに設定 DXL_SetTorqueEnablesEquival (dev, IDs, detectnum, false); DX2_ClosePort (dev); } UnloadDLL (); } } </pre> }} 角度や時間を変えて実際の挙動がどのようになるか試して欲しい。 ****角度取得 [#g4804369] こちらもDYNAMIXELの本分であるフィードバック値の取得を行う。 全軸のDYNAMIXELのトルクをOFFにして外力でホーンを動かせる状態にした後、[[DXL_GetPresentAngles>DX2LIB#i142d062]] APIを使用して複数軸の現在角度を取得し、ID番号と合わせて取得した角度を全軸分表示する。角度の取得と表示を何かしらのキー入力を行うまでループし続ける。 #html{{ <pre class="brush: c;"> // 角度取得 #include <stdio.h> #include <conio.h> #define _DYNAMICLOAD #include "dx2lib.h" int main (void) { if (LoadDLL ()) { uint8_t IDs[253]; // 見つかったIDのリスト int detectnum = 0; // 見つかった数 double angles[253]; // 角度の配列 TDeviceID dev = DX2_OpenPort ("\\\\.\\COM3", 1000000); if (dev) { detectnum = DXL_ScanDevices (dev, IDs); DXL_PrintDevicesList ((void *)&printf); // 全軸を 3: Position Control に設定 DXL_SetOperatingModesEquival (dev, IDs, detectnum, 3); DXL_SetTorqueEnablesEquival (dev, IDs, detectnum, false); // キー入力があるまでループ while (!_kbhit ()) { // 全軸の現在角度を取得 DXL_GetPresentAngles (dev,IDs, angles, detectnum); // 取得した角度を表示 printf ("\r"); for (int j = 0; j < detectnum; j++) printf("[%d]%6.1f ", IDs[j], angles[j]); } DX2_ClosePort (dev); } UnloadDLL (); } }</pre> }} ****角度取得と角度指令 [#td0983b7] 現在のDYNAMIXELのホーンの位置を取得して他のDYNAMIXELへの角度指令値として利用する。 ID番号が1のDYNAMIXELのトルクをOFFにして外力でホーンを動かせる状態にし、[[DXL_GetPresentAngle>DX2LIB#fb59c621]] APIで現在のホーンの角度を取得する。その後[[DXL_SetGoalAngles>DX2LIB#s1f41399]] APIを用いてその角度を全軸のDYNAMIXELへ指令する。ID番号1に対しても角度を指令しているが、予めトルクをOFFにしているのでホーンは動かない。角度の取得と位置の指令を何かしらのキー入力を行うまでループし続ける。 #html{{ <pre class="brush: c;"> // 角度取得と角度指令 #include <stdio.h> #include <conio.h> #define _DYNAMICLOAD #include "dx2lib.h" int main (void) { if (LoadDLL ()) { uint8_t IDs[253]; // 見つかったIDのリスト int detectnum = 0; // 見つかった数 double angle = 0; // 現在の角度 double angles[253]; // 角度の配列 TDeviceID dev = DX2_OpenPort ("\\\\.\\COM3", 1000000); if (dev) { detectnum = DXL_ScanDevices (dev, IDs); DXL_PrintDevicesList ((void *)&printf); // 全軸を 3: Position Control に設定 DXL_SetOperatingModesEquival (dev, IDs, detectnum, 3); DXL_SetTorqueEnablesEquival (dev, IDs, detectnum, true); // ID=1のみトルクをOFFに設定 DXL_SetTorqueEnable (dev, 1, false); // キー入力があるまでループ while (!_kbhit ()) { // ID=1の現在角度を取得 DXL_GetPresentAngle (dev, 1, &angle); printf("\rPresent Angle = %4.1f ", angle); // 全軸に同じ目標角度を指令 for (int j = 0; j < detectnum; j++) angles[j] = angle; DXL_SetGoalAngles (dev, IDs, angles, detectnum); } DXL_SetTorqueEnablesEquival (dev, IDs, detectnum, false); DX2_ClosePort (dev); } UnloadDLL (); } }</pre> }} なお[[前述>#p18c2b19]]のDXL_SetGoalAnglesAndTime APIを使ったプログラムを実行すると、移動時間の情報がDYNAMIXELに残ったままになる。その直後に本プログラムを実行した場合、ID番号1のホーンの動きに他のホーンが即応しないように見える。その場合はDYNAMIXELへ供給していた電源を一旦OFFにした後に再度ONにしてからプログラムを実行する事。 ****角速度指令 [#ned57eea] 最高速度はあまり速くはないが、DYNAMIXELにホイールを装着して台車の足回りに使う事ができる。 [[DXL_SetOperatingModesEquival>DXLIB#a14c1876]] APIを使用して全DYNAMIXELの動作モードを1:Velocity Controlに設定(このAPIは内部でトルクOFFを発行する)。全軸のトルクをON。[[DXL_SetGoalVelocities>DXLIB#f05ae68b]] APIを使用して全軸の角速度を30deg/sに設定→全軸の角速度を-30deg/sに設定→全軸の角速度を0deg/sに設定。最後に全軸のトルクをOFFにして終了する。 #html{{ <pre class="brush: c;"> // 角速度指令 #include <stdio.h> #include <conio.h> #define _DYNAMICLOAD #include "dx2lib.h" int main (void) { if (LoadDLL ()) { uint8_t IDs[253]; // 見つかったIDのリスト int detectnum = 0; // 見つかった数 double velo[253]; // 角速度の配列 TDeviceID dev = DX2_OpenPort ("\\\\.\\COM3", 1000000); if (dev) { detectnum = DXL_ScanDevices (dev, IDs); DXL_PrintDevicesList ((void *)&printf); // 全軸を 1: Velocity Control に設定 DXL_SetOperatingModesEquival (dev, IDs, detectnum, 1); DXL_SetTorqueEnablesEquival (dev, IDs, detectnum, true); // 全軸の角速度を30deg/sに printf ("30deg/s "); for (int j = 0; j < detectnum; j++) velo[j] = 30.0; DXL_SetGoalVelocities (dev, IDs, velo, detectnum); Sleep (5000); // 5秒待ち // 全軸の角速度を-30deg/sに printf ("-30deg/s "); for (int j = 0; j < detectnum; j++) velo[j] = -30.0; DXL_SetGoalVelocities (dev, IDs, velo, detectnum); Sleep (5000); // 5秒待ち // 全軸の角速度を0deg/sに printf ("0deg/s "); for (int j = 0; j < detectnum; j++) velo[j] = 0.0; DXL_SetGoalVelocities (dev, IDs, velo, detectnum); Sleep (1000); // 1秒待ち DXL_SetTorqueEnablesEquival (dev, IDs, detectnum, false); DX2_ClosePort (dev); } UnloadDLL (); } }</pre> }} ****モーション再生 [#zbfa061e] [[角度指令>#p18c2b19]]の応用で、各軸に与える角度指令値を時間に応じて複数パターンで変遷させる。 ここでは各DYNAMIXELの目標角度とその角度へ移行させる時間をTMotion構造体とし、複数のTMotion構造体を連続して実行させる事で一連の動きを実現している。またID番号1~8があるものとしてDXL_GetModelInfo APIを使用して検索時間を無くした。~ GetQueryPerformanceCounter APIはPCの起動からの時間をmsで取得できるので、モーションで指定された時間を待機する際に利用している。 #html{{ <pre class="brush: c;"> // モーション再生 #include <stdio.h> #include <conio.h> #define _DYNAMICLOAD #include "dx2lib.h" #define AXISNUM (8) // 軸数 #define MSize(d) (sizeof(d) / sizeof(d[0])) // 存在の有無にかかわらず指定軸数分のID番号のテーブル const uint8_t IDs[AXISNUM] = { 1, 2, 3, 4, 5, 6, 7, 8 }; // 各軸の角度と遷移時間の構造体 typedef struct { double angles[AXISNUM]; // 軸数分の角度情報 double sec; // 遷移時間 } TMotion; // モーションデータ1 // 8軸を1秒かけて0度(センター)に移動 const TMotion motion1[] = { {{ 0, 0, 0, 0, 0, 0, 0, 0}, 1.0}, }; // モーションデータ2 // 8軸の5つの様々な型を各秒数かけて移動 const TMotion motion2[] = { {{ 90, 390, 90, 90, 90, 90, 90, 90}, 3.0}, {{ 0, 0, 0, 0, 0, 0, 0, 0}, 2.0}, {{-290,-190, -90, -90, -90, -90, -90, -90}, 3.0}, {{ 45, 145, 45, 45, 45, 45, 45, 45}, 3.0}, {{ -30,-230, -30, -30, -30, -30, -30, -30}, 3.0}, }; // モーション再生 void PLAY (TDeviceID dev, const uint8_t *ids, const TMotion *motion, int framenum) { for (int i = 0; i < framenum; i++) { double t = GetQueryPerformanceCounter () + motion[i].sec * 1000; DXL_SetGoalAnglesAndTime (dev, ids, motion[i].angles, AXISNUM, motion[i].sec); while (t > GetQueryPerformanceCounter ()) Sleep (1); } } int main (void) { if (LoadDLL ()) { TDeviceID dev = DX2_OpenPort ("\\\\.\\COM3", 1000000); if (dev != 0) { for (int i = 0; i < AXISNUM; i++) printf ("id=%2d, ModelName=%s\n", IDs[i], DXL_GetModelInfo (dev, IDs[i])->name); // 全軸を 4: Expand Position Control に設定 DXL_SetOperatingModesEquival (dev, IDs, AXISNUM, 4); DXL_SetTorqueEnablesEquival (dev, IDs, AXISNUM, true); // motion1を再生 printf("motion1 "); PLAY (dev, IDs, motion1, MSize (motion1)); // motion2を再生 printf("motion2 "); PLAY (dev, IDs, motion2, MSize (motion2)); DXL_SetTorqueEnablesEquival (dev, IDs, AXISNUM, false); DX2_ClosePort (dev); } UnloadDLL (); } } </pre> }} ****並列処理 [#b07f9fe5] 1つのパケット処理にかかる時間が短ければ単位時間当たりにこなせるパケット数が増えるため、自ずと通信速度が高い環境が望まれる。その恩恵に与かれるものとしてOSの並列処理が挙げられる。 ここでは角度と電流値を取得してモニタし続ける処理をthread1、角度を指令し続ける処理をthread2といった具合に個別のスレッドに割り当てた。下準備と終了処理はmain内で行っているが、それ以外は各々のスレッドが各々独立して処理している。~ 各々のスレッドに使用しているAPIが互いを意識しないコードになっているのは、DX2LIBのAPIが排他的に処理されるように作られているためである。しかし1つのスレッドでAPIを無限ループで遅滞なく呼び出し続けられてしまうとリソースを独占されてしまうため、ループ中にSleepを入れて適宜コンテキストスイッチを促している。 #html{{ <pre class="brush: c;"> // マルチスレッド #include <stdio.h> #include <conio.h> #define _DYNAMICLOAD #include "dx2lib.h" #include <pthread.h> #include <math.h> bool term = false; // スレッド終了フラグ // スレッドに渡すパラメータ typedef struct { TDeviceID dev; // デバイスID const uint8_t *ids; // IDの配列 int num; // ID数 } TThInfo; // スレッド1 (モニタ) void *thread1 (TThInfo *info) { double pangle[info->num], pcur[info->num]; while (!term) { // 現在位置取得 if (DXL_GetPresentAngles (info->dev, info->ids, pangle, info->num)) { // 現在電流取得 if (DXL_GetPresentCurrents(info->dev, info->ids, pcur, info->num)) { printf("\r"); for (int i = 0; i < info->num; i++) printf ("(%d:%5.1f %6.1f) ", info->ids[i], pangle[i], pcur[i]); } } Sleep (5); } return (void *)NULL; } // スレッド2 (正弦波で角度指令) void *thread2 (TThInfo *info) { double ang, angle[info->num]; while (!term) { // 時間から±60度の角度を生成 (4秒周期) ang = sin (0.5 * M_PI * GetQueryPerformanceCounter () * 0.001) * 60.0; for (int i = 0; i < info->num; i++) angle[i] = ang; DXL_SetGoalAngles (info->dev, info->ids, angle, info->num); Sleep (5); } return (void *)NULL; } int main (void) { pthread_t th1, th2; if (LoadDLL ()) { uint8_t IDs[253]; int detectnum = 0; TDeviceID dev = DX2_OpenPort ("\\\\.\\COM3", 1000000); if (dev) { detectnum = DXL_ScanDevices (dev, IDs); DXL_PrintDevicesList ((void *)&printf); // 全軸を 3: Position Control に設定 DXL_SetOperatingModesEquival (dev, IDs, detectnum, 3); DXL_SetTorqueEnablesEquival (dev, IDs, detectnum, true); // 2つのスレッドを作成 TThInfo info = { dev, IDs, detectnum }; pthread_create(&th1, NULL, (void *)thread1, (void *)&info); pthread_create(&th2, NULL, (void *)thread2, (void *)&info); // キー入力があるまでループ while (!_kbhit ()) { Sleep (100); } // スレッド終了を励起 term = true; // スレッド終了待ち pthread_join(th1, NULL); pthread_join(th2, NULL); DXL_SetTorqueEnablesEquival (dev, IDs, detectnum, false); DX2_ClosePort (dev); } UnloadDLL (); } }</pre> }} 同時に他のアプリケーションを使用すると、大抵の場合DYNAMIXELの挙動がおかしくなる。実際にはプログラムの実行が他のアプリケーションによって阻害され、 単純なループで高速に角度指令を行っている処理(こういった角度指令の仕方は旧来のDYNAMIXELの常套手段だった)が間延びしてしまう事が原因だ。マルチタスク環境において何がどのように影響するかを微調整する術はあるので、時間があるときにでも調べて欲しい。~ またあえて諸々の通信速度を9600bpsに変更した場合も、最終的な動作にどの程度影響するかを試しても面白い。~ その結果、Windows上でいわゆるリアルタイム性を担保するのは一筋縄ではいかない事が分かってもらえれば良いかと。 ***他の言語 [#d5eca280] [[DX2LIBのページ>DX2LIB#u3ff03d9]]に紹介されている通りだが、その中でも流行の[[Python>https://www.python.jp/]]で遊んでみても面白いかと思う。~ GCC Developer LiteにはPythonが含まれており、コンパイルオプションで「Python(32bit)」や「Python(64bit)」を選ぶ事でライブラリに同梱されるPythonのサンプルソースコードが利用できる。しかし追加APIを利用したものばかりで、コントロールテーブルを読み書きする基本的なAPIは使われていない。 ここでは基本的なAPIのみを使った例を紹介するが、dx2lib.pyはC言語で作成されたライブラリをPythonで利用するためだけの記述がなされているため、Pythonならではの柔軟なコードがctypesによって変に厳格化されて使い勝手が悪い。~ ひとまずDynamixel Xシリーズを前提とし、主要なアイテムのアドレスとコントロールテーブルを宣言してみた。 #html{{ <pre class="brush: python;"> from ctypes import * ADDRESS_X_MODEL_NUMBER = 0 #W ADDRESS_X_MODEL_INFORMATION = 4 #L ADDRESS_X_VERSION_FW = 6 #B ADDRESS_X_ID = 7 #B ADDRESS_X_BAUDRATE = 8 #B ADDRESS_X_RETURN_DELAY_TIME = 9 #B ADDRESS_X_DRIVE_MODE = 10 #B ADDRESS_X_OPERATIING_MODE = 11 #B ADDRESS_X_HOMING_OFFSET = 20 #L ADDRESS_X_MAX_POSITION_LIMIT = 48 #L ADDRESS_X_MIN_POSITION_LIMIT = 52 #L ADDRESS_X_TORQUE_ENABLE = 64 #B ADDRESS_X_LED_RED = 65 #B ADDRESS_X_STATUS_RETURN_LEVEL = 69 #B ADDRESS_X_HARDWARE_ERROR_STATUS = 70 #B ADDRESS_X_VELOCITY_IGAIN = 76 #W ADDRESS_X_VELOCITY_PGAIN = 78 #W ADDRESS_X_POSITION_DGAIN = 80 #W ADDRESS_X_POSITION_IGAIN = 82 #W ADDRESS_X_POSITION_PGAIN = 84 #W ADDRESS_X_GOAL_PWM = 100 #W ADDRESS_X_GOAL_CURRENT = 102 #W ADDRESS_X_GOAL_VELOCITY = 104 #L ADDRESS_X_PROF_ACCELERATION = 108 #L ADDRESS_X_PROF_VELOCITY = 112 #L ADDRESS_X_GOAL_POSITION = 116 #L ADDRESS_X_MOVING = 122 #B ADDRESS_X_MOVING_STATUS = 123 #B ADDRESS_X_PRESENT_PWM = 124 #W ADDRESS_X_PRESENT_CURRENT = 126 #W ADDRESS_X_PRESENT_VELOCITY = 128 #L ADDRESS_X_PRESENT_POSITION = 132 #L ADDRESS_X_VELOCITY_TRAJECTORY = 136 #L ADDRESS_X_POSITION_TRAJECTORY = 140 #L ADDRESS_X_PRESENT_VOLTAGE = 144 #W ADDRESS_X_PRESENT_TEMP = 146 #B class XCtrlTable(Structure): _pack_ = 1 _fields_ = [ ('ModelNumber', c_uint16), ('ModelInformation', c_uint32), ('VersionofFirmware', c_uint8), ('ID', c_uint8), ('Baudrate', c_uint8), ('ReturnDelayTime', c_uint8), ('DriveMode', c_uint8), ('OperatingMode', c_uint8), ('SecondaryID', c_uint8), ('ProtocolVersion', c_uint8), ('reserve', c_uint8), ('reserve', c_uint8), ('reserve', c_uint8), ('reserve', c_uint8), ('reserve', c_uint8), ('reserve', c_uint8), ('HomingOffset', c_int32), ('MovingThreshold', c_uint32), ('reserve', c_uint8), ('reserve', c_uint8), ('reserve', c_uint8), ('TemperatureLimit', c_uint8), ('MaxVoltageLimit', c_uint16), ('MinVoltageLimit', c_uint16), ('PWMLimit', c_uint16), ('CurrentLimit', c_uint16), ('AccelerationLimit', c_uint32), ('VelocityLimit', c_uint32), ('MaxPositionLimit', c_uint32), ('MinPositionLimit', c_uint32), ('ExternalPortMode1', c_uint8), ('ExternalPortMode2', c_uint8), ('ExternalPortMode3', c_uint8), ('reserve', c_uint8), ('reserve', c_uint8), ('reserve', c_uint8), ('reserve', c_uint8), ('Shutdown', c_uint8), ('TorqueEnable', c_uint8), ('LED', c_uint8), ('reserve', c_uint8), ('reserve', c_uint8), ('StatusReturnLevel', c_uint8), ('RegisteredInstruction', c_uint8), ('HardwareErrorStatus', c_uint8), ('reserve', c_uint8), ('reserve', c_uint8), ('reserve', c_uint8), ('reserve', c_uint8), ('reserve', c_uint8), ('VelocityIGain', c_uint16), ('VelocityPGain', c_uint16), ('PositionDGain', c_uint16), ('PositionIGain', c_uint16), ('PositionPGain', c_uint16), ('reserve', c_uint8), ('reserve', c_uint8), ('FeedforwardAccelerationGain', c_uint16), ('FeedforwardVelocityGain, ', c_uint16), ('reserve', c_uint8), ('reserve', c_uint8), ('reserve', c_uint8), ('reserve', c_uint8), ('reserve', c_uint8), ('reserve', c_uint8), ('BusWatchdog', c_int8), ('reserve', c_uint8), ('GoalPWM', c_int16), ('GoalCurrent', c_int16), ('GoalVelocity', c_int32), ('ProfileAcceleration', c_uint32), ('ProfileVelocity', c_uint32), ('GoalPosition', c_int32), ('RealtimeTick', c_uint16), ('Moving', c_uint8), ('MovingStatus', c_uint8), ('PresentPWM', c_int16), ('PresentCurrent', c_int16), ('PresentVelocity', c_int32), ('PresentPosition', c_int32), ('VelocityTrajectory', c_uint32), ('PositionTrajectory', c_uint32), ('PresentInputVoltage', c_uint16), ('PresentTemperature', c_uint8), ('reserve', c_uint8), ('reserve', c_uint8), ('reserve', c_uint8), ('reserve', c_uint8), ('reserve', c_uint8), ('ExternalPortData1', c_uint16), ('ExternalPortData2', c_uint16), ('ExternalPortData3', c_uint16)] class VelocityGain(Structure): _pack_ = 1 _fields_ = [ ('VelocityIGain', c_uint16), ('VelocityPGain', c_uint16)] class PositionGain(Structure): _pack_ = 1 _fields_ = [ ('PositionDGain', c_uint16), ('PositionIGain', c_uint16), ('PositionPGain', c_uint16)] </pre> }} 例えばPresent PositionをID=1のDynamixelのコントロールテーブルから読み出すには、以下のコードで対応できる。 #html{{ <pre class="brush: python;"> from dx2lib import * dev = DX2_OpenPort (b'\\\\.\\COM3', 57600) if dev != None: ppos = c_int32() err = c_uint16() DX2_ReadLongData (dev, 1, ADDRESS_X_PRESENT_POSITION, cast(byref(ppos), POINTER(c_uint32)), err) DX2_ClosePort (dev) </pre> }} 更にXCtrlTable構造体を用いて変数を定義し、その変数へID=1のDynamixelのコントロールテーブルから一括読み出した値を保存する場合はDX2_ReadBlockDataを用いる。 #html{{ <pre class="brush: python;"> from dx2lib import * dev = DX2_OpenPort (b'\\\\.\\COM3', 57600) if dev != None: tbl = XCtrlTable() err = c_uint16() if DX2_ReadBlockData (dev, 1, ADDRESS_X_MODEL_NUMBER, cast(byref(tbl), POINTER(c_uint8)), sizeof(tbl), err): for field in tbl._fields_: if field[0] != 'reserve': print (tbl.__class__.__dict__[field[0]].offset, field[0], '=', getattr(tbl, field[0])) DX2_ClosePort (dev) </pre> }} 位置決め制御時のPIDゲインを設定する等の連続したアドレスに割り当てられた複数のアイテムを同時に書き換える場合はDX2_WriteBlockDataを用いる。 #html{{ <pre class="brush: python;"> from dx2lib import * dev = DX2_OpenPort (b'\\\\.\\COM3', 57600) if dev != None: gain = PositionGain(0, 0, 400) DX2_WriteBlockData (dev, 1, ADDRESS_X_POSITION_DGAIN, cast(byref(gain), POINTER(c_uint8)), sizeof (gain), None) DX2_ClosePort (dev) </pre> }} 追加APIに無い機能は基本APIを使ってコントロールテーブルへ直接アクセスするしかないため、参考にしてもらえればと思う。
Next »
Dynamixel with python のバックアップ一覧
Dynamixel with python のバックアップソース(No. All)
1: 2024-01-08 (月) 13:29:38
takaboo
現: 1970-01-01 (木) 18:00:00
Copyright© 1989,2024 BestTechnology Co.,Ltd.
メニュー
トップ
ニュース
お知らせ
新商品情報
更新情報
マニュアル類
技術情報
チュートリアル
FAQ
お問合せ
技術的なお問合せ
その他お問合せ
お見積り
ブログ
会社案内
ショッピング
ご利用案内
検索
カテゴリ 一覧
ロボットキット
Dynamixelシリーズ
マイコンボード
相撲ロボット
センサ
通信機器
お客様ページ