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 // }
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 */ };