[EtherCAT Device CiA402]
説明
Check the value of bit 13 in the statusword object.
Relevant Objects
- Object 6041h: ステータスワード
構文
int checkModeSpecificBit13();
媒介変数
なし
戻り値
Return the value of bit 13 in the statusword.
備考
この関数は、 EthercatMaster::start(). This function is non-blocking and can be called in callback functions.
例
#include "Ethercat.h"
EthercatMaster master;
EthercatDevice_CiA402 motor;
void setup() {
Serial.begin(115200);
while (!Serial);
master.begin();
motor.attach(0, master);
motor.setCiA402Mode(CIA402_PP_MODE);
master.start();
motor.enable();
}
void loop() {
motor.setTargetPosition(100000);
motor.setModeSpecificBit6(true);
motor.setModeSpecificBit5(true);
motor.setModeSpecificBit4(true);
while (motor.checkModeSpecificBit12() == 0);
motor.setModeSpecificBit4(false);
while (motor.checkModeSpecificBit12() == 1);
while (motor.isTargetReached() == 0);
if (motor.checkModeSpecificBit13())
Serial.println("Following Error.");
motor.setTargetPosition(-100000);
motor.setModeSpecificBit6(true);
motor.setModeSpecificBit5(true);
motor.setModeSpecificBit4(true);
while (motor.checkModeSpecificBit12() == 0);
motor.setModeSpecificBit4(false);
while (motor.checkModeSpecificBit12() == 1);
while (motor.isTargetReached() == 0);
if (motor.checkModeSpecificBit13())
Serial.println("Following Error.");
}
詳細は EtherCAT CiA 402 ユーザーマニュアル QEC EtherCAT命令とAPI使用法参照