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();
}
