PMX C#Lib MotorWRITESingle()

『PMX Library for C#』のMotorWRITESingle()関数について解説します。

プログラムの詳細はサンプルプログラム「MotorWRITE_Single_Sample」をご参照ください。

【解説】

MotorWRITEコマンドは、PMXサーボの動作を指示するためのコマンドです。このコマンドを使用することで、命令を受け取ったサーボは設定された「制御モード」に合わせて動作します。また、パケットを受け取った返事として「応答データ指定」で指定したデータを含んで返事を返します。

・使用手順

①「制御モード」を指定する

②「応答データ指定」を指定する

③「トルクスイッチ」の設定をTorqueONに指定する

④「MotorWRITE」コマンドで動作指示をする

【構文】

status = MotorWRITESingle(ID, targetVal, receiveMode, out receiveData, controlMode);

【例】

【パラメータ】

引数1：ID（byte型）

第一引数の「ID」はサーボIDです。「ID」は、MotorWRITEコマンドの命令の対象になるサーボを指定しています。「ID」を0に指定すると、ID0のサーボを指定することができます。

引数2：targetVal（int型）

第二引数の「targetVal」は動作指示データです。各制御モードに合わせた数値を送り、サーボを動かします。位置制御の場合は角度を送ります。例えば、PMX-SCR-5204HVは-320°～320°の範囲で角度を指示できますが、単位は1/100[°]ですので、サーボに送信する「動作指示データ」は-32000～32000の範囲になります。サーボに100°を指示する場合は10000を送信します。

引数3：receiveMode（byte型）

第三引数の「receiveMode」は「応答データ指定」の設定値を渡します。

引数4：out receiveData（int配列型）

第四引数の「readMotorData」は読み出したデータを格納するための配列です。応答モードが設定されていない項目でも"None"を返しますのでデータ数に関係なく、必ず8個のデータが返ってきます。

outキーワードについては、C#の資料をご参照ください。

引数5：controlMode（byte型）

第五引数の「controlMode」は「制御モード」の設定値を渡します。PMXサーボは位置制御モードを含む場合と、速度制御のみなど無限回転する動作の場合で現在位置の値が異なります。そのため、「制御モード」を渡すことで読み出した現在位置を正しいデータに変換して返してもらいます。

位置制御モードを含む場合＝-320度～320度の範囲で検出

無限回転動作の場合＝0度～359度の範囲で検出

詳しくは「パラメータ読み出し」をご参照ください。

以上の引数を持ったMotorWRITE()関数を、サンプルの通り動作指示データ0を指定して実行すると、サーボが0°の位置に移動します。

【動作指示データ】

動作指示データは、制御モードにより単位が異なります。またサーボの機種により設定できる範囲が異なります。

・制御モードによる違い

位置制御：1/100°　例）1000＝10°

速度制御：1/10°/S　例）1000=100°/S

電流制御：mA　例）1000=1000mA

トルク制御：mN･m　例）1000=1N･m

PWM制御：デューティ比1/100%　例）10000=100%

移動時間：ms　例）1000=1000ms

・機種による違い

機種によりギヤ比やモータが異なりますので、出力できる速度、電流などに違いがあります。PMXサーボはメモリマップの「指令制限値」を読み出すことで各機種の指令値の制限値を知ることができます。

【戻り値】

戻り値：status（ushort型）

戻り値は、サーボとの通信状態とサーボの状態が正常かどうかのステータスを足したものが返ってきます。データが0であれば問題ありません。0以外の場合は、なんらかの問題が発生していますので、ステータス部がエラーの場合はオンラインマニュアルの『5.エラー状態』、または『PmxStatusErrorList』を、通信部がエラーの場合は『ComError』を参照してください。

status = PMXからの返信のステータス(PmxStatusErrorList) + 送受信の状態(ComError)

リファレンスの目次に戻る