void DoAuto(void){ int tmp = 0; int b = 0; int i = 0; tmp = RefPos(); if(!tmp){ MotorStop(); return; } MotorStart(); for(;i<20;i++){ b = borr_auto[i]; //if tmp = Nstep(b); if(!tmp){ MotorStop(); return; } tmp = DrillHole(); if(!tmp){ MotorStop(); return; } } MotorStop(); return; }
int RefPos(){ unsigned char alarmtest = 1; do{ if(BORR_STATUS & 0x1) return 1; alarmtest = Nstep(1); }while(alarmtest != 0); return 0; }
void DoAuto(void){ int i = 0; if(!RefPos()){ MotorStop(); return; } MotorStart(); while(pattern[i] != 0xFF){ if(!Nstep(pattern[i])){ MotorStop(); return; } if(!DrillHole()){ MotorStop(); return; } i++; } MotorStop(); return; }
void DoAuto(){ int pattern[21] = {0,1,1,1,1,1,1,1,2,1,5,2,2,2,2,4,4,3,8,2,255}; int antalSteg; int subrutinRes; if(RefPos()){ int i=0; MotorStart(); while(1){ antalSteg = pattern[i]; i++; if(antalSteg == 255) break; subrutinRes = Nstep(antalSteg); if(subrutinRes == 0) break; subrutinRes = DrillHole(); if(subrutinRes == 0) break; } } MotorStop(); }