Advertisement
Guest User

Unipolar motor driver

a guest
Jul 19th, 2010
619
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 0.65 KB | None | 0 0
  1. sbit T1 at PORTB1_bit;
  2. sbit T2 at PORTB2_bit;
  3. sbit T3 at PORTB3_bit;
  4. sbit T4 at PORTB4_bit;
  5. sbit dir at PORTD0_bit;
  6. sbit step at PORTC5_bit;
  7.  
  8. void main() {
  9. char krok;
  10. krok = 5;
  11. do{
  12. if (Button(&PORTC,5, 1, 1)){
  13.    if (dir == 1) krok +=1;
  14.    if (dir == 0) krok -=1;
  15.    }
  16. krok = abs(krok);
  17. if (krok >= 5) krok = 1;
  18. if (krok == 0) krok = 4;
  19.  
  20. if (krok == 1){
  21.    T1 = 1; T2=1; T3=0; T4=0;
  22.    }
  23.  
  24. krok = abs(krok);
  25. if (krok == 2){
  26.    T1 = 0; T2=1; T3=1; T4=0;
  27.    }
  28.  
  29. krok = abs(krok);
  30. if (krok == 3){
  31.    T1 = 0; T2=0; T3=1; T4=1;
  32.    }
  33.  
  34. krok = abs(krok);
  35. if (krok == 4){
  36.    T1 = 1; T2=0; T3=0; T4=1;
  37.    }
  38.  
  39. krok = abs(krok);
  40.  
  41. }while(1);
  42. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement