TITLE:FDIII-HCにPSD距離センサの信号を取り込む #norelated #contents |CENTER:BGCOLOR(red):||c | :idea:|本ページの注意事項は各製品のナレッジベースやマニュアルに準拠します。&br;各製品のナレッジベースやマニュアルをお読み頂き、ご理解頂いた上で本ページを参考にしてください。| **概要 [#g6c8e5ca] PSD距離センサは、物体との距離を測定するセンサです。距離に応じた電圧(0.35~3.2V)を出力します。 それに対しFDIII-HCは、Dynamixelプロトコルに則ったシリアル通信を行うことでDynamixelと通信を行っています。故に反射型フォトインタラプタをFDIII-HCに直接接続して運用することはできません。 そこで必要になるのがDynamixel I/O moduleです。Dynamixel I/O moduleは、センサからのアナログ・デジタル信号を取り込み、FDIII-HCへDynamixelプロトコルに則ってその情報を渡す、云わば中継役です。 ここではDynamixel I/O moduleを使って、PSD距離センサのアナログ信号をFDIII-HCへ取り込む方法を紹介します。 **用意するもの [#uc8087ab] -[[FDIII-HC]] -[[Dynamixel I/O module]] -[[PSD距離センサ]] -ケーブル -ハンダごて、ハンダ あると良いもの -ユニバーサル基板 -ピンヘッダ -[[3ピンコネクタ>http://www.besttechnology.co.jp/modules/onlineshop/index.php?fct=photo&p=98]] ケーブルには必要に応じてノイズの混入を防ぐためのシールド等の措置を講じてください。また、ケーブルが長過ぎると信号の劣化に繋がります。 FDIII-HCの変わりに[[Dynamixelコンフィギュレータ]]を使用してパソコンと通信することも可能です。 **接続 [#od38be17] 下図の様に配線を行います。 #ref(figure1.png) PSD距離センサのVCCにDynamixel I/O moduleのCN2のPin1:VOUT(5V)を接続し、電源を供給します。 PSD距離センサのGNDとDynamixel I/O moduleのCN2のPin10:GNDを接続します。 PSD距離センサのOUTとDynamixel I/O moduleのCN2のPin2:PIO0を接続します。勿論PIO1~PIO7でも構いません。 Dynamixel I/O moduleのCN2には、VCCとGND端子が1つずつしかありません。複数台のセンサを接続したり、後でセンサを取り外したりする場合は、ユニバーサル基板とピンヘッダで変換基板を作り、ケーブルと3ピンコネクタでセンサを接続するなどの工夫が必要です。 ''変換基板作成例'' #ref(figure2.png) 複数のPSD距離センサを接続する場合には注意するべき点があります。~ Dynamixel I/O moduleのCN2のVOUTから供給できる電流は限られています。~ VOUTに接続する機器の消費電流が許容量をオーバーすると、Dynamixel I/O module自体も同じ電源を使用しているため正常に動作しなくなります。 Dynamixel I/O moduleが度々リセットするような場合は、別途電源を用意しPSD距離センサに供給する必要があります。 #ref(figure3.png) DynamixelケーブルでFDIII-HCとDynamixel I/O moduleを接続します。 **PIO Configを変更する [#ea65bbe1] コントロールテーブルのPSD距離センサを接続した端子に対するPIO Configを3に設定します。 PIO Configの設定は、運用時のプログラム内では設定しないことをお勧めします。 PIO Configを含む電源を切っても保存されるEEPROMエリア(アドレス0~24)の書き換え回数には制限があるためです。 制限といっても普通に使用していれば制限を越えることはまずありません。 しかし誤ってプログラムのループの中で高速に書き換えを行ってしまった場合、あっと言う間に制限を越えてしまう危険性があります。 Dynamixel I/O moduleの設定の変更にはDxpacket Configuratorを使用します。 基本的な使い方はDynamixel Configuratorと同じですのでそちらを参考にしてください。 **プログラミング [#m50e9959] ここではFDIII-HCのプログラムを作成するための準備や書き込み方法は省略します。 Dynamixel I/O moduleのPIO0に接続したPSD距離センサの値を取得し、それを表示するプログラムは以下のようになります。 #include <fd.h> #define KEY_QUIT { if(fd_rx_buff()) fd_SoftReset();} void main (void) { uint16_t ReadData; fd_Init (0, BT_CONSOLE, FD_BEEP_MMI | FD_BEEP_PACKETERR | FD_BEEP_LOWVOLTAGE | FD_BEEP_BOOTUP, 7.4); while (1) { fd_DXReadWordData (1, 26, &ReadData); fd_printf ("%d\r", ReadData); KEY_QUIT; } } ---- fd_DXReadWordData (1, 26, &ReadData); Dynamixel I/O module(ID=1)のAD0(アドレス26,27)のデータをReadDataに代入しています。IDを変更した場合は適宜書き換えてください。
(This host) = http://www.besttechnology.co.jp