int stepper_motor::is_motor_there(int motnum){
  int tc=timeout_motor_travel/20;
  while ((get_mot_status(motnum) == mstPos) && tc>0) {
    // wait if device is busy //
    nanosleep(&twenty_millisec,&time_left);
    tc--;
  };
  return tc; // zero if timeout //
}
示例#2
0
int is_motor_there(motnum){
  int tc=timeout_motor_travel/20;
  sm30cmd.cmd=mcNone;
  while ((get_mot_status(motnum)==3) && tc>0) {
    /* wait if device is busy */
    nanosleep(&twenty_millisec,&time_left);
    tc--;
  };
  return tc; /* zero if timeout */
};