描述
Drive continuously at the target torque in Profile Torque mode (tq).
Relevant Objects
- Object 6041h: Statusword
- Object 6071h: Target torque
語法
int tq_Run(int16_t torque);
參數
[in] torque
The target torque to be set.
回傳值
Return an error code. If the returned value is zero, it indicates a successful execution of this function.
備註
This function must be called after a successful execution of EthercatMaster::start(). This function is blocking and cannot be called in callback functions.
範例程式碼
#include "Ethercat.h"
EthercatMaster master;
EthercatDevice_CiA402 motor;
void setup() {
master.begin();
motor.attach(0, master);
motor.setCiA402Mode(CIA402_TQ_MODE);
master.start();
motor.enable();
}
void loop() {
motor.tq_SetTorqueProfileType(0);
motor.tq_SetTorqueSlope(200);
motor.tq_SetMotorRatedTorque(0);
motor.tq_SetMotorRatedCurrent(0);
motor.tq_Run(50);
while (motor.tq_IsTargetReached() == 0);
delay(3000);
motor.tq_SetTorqueProfileType(0);
motor.tq_SetTorqueSlope(200);
motor.tq_SetMotorRatedTorque(0);
motor.tq_SetMotorRatedCurrent(0);
motor.tq_Run(-50);
while (motor.tq_IsTargetReached() == 0);
delay(3000);
}Please see the EtherCAT CiA 402 User Manual for more QEC EtherCAT instructions and API usage.