tq_IsTargetReached()

説明

Check if the target torque has been reached in Profile Torque mode (tq).

Relevant Objects

  • Object 6041h: ステータスワード

構文

int tq_IsTargetReached();

媒介変数

なし

戻り値

Return whether the target torque has been reached.

備考

この関数は、 EthercatMaster::start(). This function is non-blocking and can 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);
}

詳細は EtherCAT CiA 402 User Manual QEC EtherCAT命令とAPI使用法参照

上部へスクロール