Guest User

Untitled

a guest
Feb 18th, 2010
318
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 1.14 KB | None | 0 0
  1. const int l293bPin[] =  {2,3,4,5};
  2. int ledpin =13;
  3. void setup()   {
  4.  for (int i=0;i<4;i++){  
  5.   pinMode(l293bPin[i], OUTPUT);
  6.  }  
  7. }
  8. void loop()                    
  9. {
  10. destrA();
  11. digitalWrite(ledpin,HIGH);//serve per discriminare le varie sequenze :D
  12. delay(1000);
  13. fermo();
  14. digitalWrite(ledpin,LOW);
  15. delay(1000);
  16. sinistrA();
  17. delay(1000);
  18. fermo();
  19. delay(1000);
  20. destrO();
  21. delay(1000);
  22. fermo();
  23. delay(1000);
  24. sinistrO();
  25. delay(1000);
  26. fermo();
  27. delay(1000);
  28. avanti();
  29. delay(1000);
  30. fermo();
  31. delay(1000);
  32. indietro();
  33. delay(1000);
  34. fermo();
  35. delay(1000);
  36.  
  37. }
  38. void controllo(int a,int b, int c, int d){
  39.   analogWrite(l293bPin[0],a);
  40.   analogWrite(l293bPin[1],b);
  41.   analogWrite(l293bPin[2],c);
  42.   analogWrite(l293bPin[3],d);
  43. }
  44.  
  45. void destrA(){
  46.   controllo(1023,0,0,0);// destra antiorario
  47.  }
  48. void sinistrO(){
  49.   controllo(0,0,1023,0);// sinistro orario
  50.  }
  51. void sinistrA(){
  52.   controllo(0,0,0,1023);// sinistro antiorario
  53. }
  54. void destrO(){
  55.   controllo(0,1023,0,0);// destro orario
  56.  }
  57.  
  58. void fermo(){
  59.   controllo(0,0,0,0);// fermo
  60. }
  61. void avanti(){
  62.   controllo(1023,0,0,1023);
  63. }
  64. void indietro(){
  65.   controllo(0,1023,1023,0);
  66. }
Advertisement
Add Comment
Please, Sign In to add comment