Facebook
From Damian, 5 Years ago, written in C.
Embed
Download Paste or View Raw
Hits: 214
  1. #include <Servo.h>
  2. #define MotorA1   1
  3. #define MotorA2   2
  4. #define MotorAMoc 3
  5.  
  6. #define MotorB1   7
  7. #define MotorB2   8
  8. #define MotorBMoc 9
  9. #define SerwoPin 11
  10. Servo servo;
  11. int const Pozycja_Lewo = 5;
  12. int const Pozycja_Prawo = 175;
  13. int const Pozycja_Centrum = 78;
  14.  
  15.  
  16.  
  17.  
  18. void tyl(){
  19. digitalWrite (1, HIGH);                              
  20. digitalWrite (2, LOW);
  21. analogWrite(3,255); //MK
  22. digitalWrite (7, HIGH);                              
  23. digitalWrite (8, LOW);
  24. analogWrite(9,255); //MK
  25. }
  26. void przod()
  27. {
  28. digitalWrite (1, LOW);                              
  29. digitalWrite (2, HIGH);
  30. analogWrite(3,255); //MK
  31. digitalWrite (7, LOW);                              
  32. digitalWrite (8, HIGH);
  33. analogWrite(9,255); //MK
  34. }
  35.  
  36.  
  37.  
  38.  
  39.  
  40. void lewo(int t=650)
  41. {
  42. digitalWrite (MotorA1, LOW);                              
  43. digitalWrite (MotorA2, HIGH);
  44. analogWrite(MotorAMoc,255); //MK
  45. digitalWrite (MotorB1, HIGH);                              
  46. digitalWrite (MotorB2, LOW);
  47. analogWrite(MotorBMoc,255); //MK
  48. delay(t);
  49. zatrzymaj();
  50. }
  51.  
  52. void prawo(int t=650)
  53. {
  54. digitalWrite (MotorA1, HIGH);                              
  55. digitalWrite (MotorA2, LOW);
  56. analogWrite(MotorAMoc,255); //MK
  57. digitalWrite (MotorB1, LOW);                              
  58. digitalWrite (MotorB2, HIGH);
  59. analogWrite(MotorBMoc,255); //MK
  60. delay(t);
  61. zatrzymaj();
  62. }
  63.  
  64.  
  65. void zatrzymaj()
  66. {
  67.   digitalWrite (MotorA1, LOW);                              
  68. digitalWrite (MotorA2, LOW);
  69. analogWrite(MotorAMoc,0); //MK
  70. digitalWrite (MotorB1, LOW);                              
  71. digitalWrite (MotorB2, LOW);
  72. analogWrite(MotorBMoc,0); //MK
  73. }
  74.  
  75.  
  76.  
  77.  
  78.  
  79.  
  80.  
  81.  
  82.  
  83.  
  84. void setup() {
  85.   // put your setup code here, to run once:
  86. servo.attach(SerwoPin);
  87. pinMode(MotorA1, OUTPUT);
  88.   pinMode(MotorA2, OUTPUT);
  89.   pinMode(MotorAMoc, OUTPUT);
  90.   pinMode(MotorB1, OUTPUT);
  91.   pinMode(MotorB2, OUTPUT);
  92.   pinMode(MotorBMoc, OUTPUT);
  93.   servo.write(Pozycja_Centrum);
  94. }
  95.  
  96. void loop() {
  97.  
  98. przod();
  99.  
  100. }
  101.