[EtherCAT Device CiA402]
描述
Check the value of bit 13 in the statusword object.
Relevant Objects
- Object 6041h: Statusword
語法
int checkModeSpecificBit13();
參數
無
回傳值
Return the value of bit 13 in the statusword.
備註
This function must be called after a successful execution of 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.");
}
Please see the EtherCAT CiA 402 使用手冊 for more QEC EtherCAT instructions and API usage.