Advertisement
Guest User

Untitled

a guest
Nov 22nd, 2019
151
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.35 KB | None | 0 0
  1. #define Motor1_1 12
  2. #define Motor1_2 13
  3. #define Motor1_PWM 11
  4. #define Motor2_1 8
  5. #define Motor2_2 9
  6. #define Motor2_PWM 10
  7.  
  8. void setup() {
  9. pinMode(Motor1_1,OUTPUT);
  10. pinMode(Motor1_2,OUTPUT);
  11. pinMode(Motor1_PWM,OUTPUT);
  12. pinMode(Motor2_1,OUTPUT);
  13. pinMode(Motor2_2,OUTPUT);
  14. pinMode(Motor2_PWM,OUTPUT);
  15. }
  16.  
  17. void loop() {
  18. dopredu(255);
  19. delay(500);
  20. dopredu(180);
  21. delay(500);
  22. dopredu(120);
  23. delay(500);
  24. otoc(-100);
  25. delay(1000);
  26. otoc(100);
  27. delay(1000);
  28. dozadu(255);
  29. delay(3000);
  30.  
  31.  
  32.  
  33. }
  34. void otoc (int smer)
  35. {
  36. digitalWrite(Motor1_1,1);
  37. digitalWrite(Motor1_2,0);
  38. digitalWrite(Motor2_1,1);
  39. digitalWrite(Motor2_2,0);
  40. if (smer==0) {
  41. analogWrite(Motor1_PWM,255);
  42. analogWrite(Motor2_PWM,255);
  43. } else {
  44. if (smer>0) {
  45. analogWrite(Motor1_PWM,255);
  46. analogWrite(Motor2_PWM,smer);
  47. } else {
  48. analogWrite(Motor1_PWM,abs(smer));
  49. analogWrite(Motor2_PWM,255);
  50. }
  51. }
  52. }
  53. void dopredu(byte rychlost)
  54. {
  55. digitalWrite(Motor1_1,1);
  56. digitalWrite(Motor1_2,0);
  57. analogWrite(Motor1_PWM,rychlost);
  58. digitalWrite(Motor2_1,1);
  59. digitalWrite(Motor2_2,0);
  60. analogWrite(Motor2_PWM,rychlost);
  61. }
  62.  
  63. void dozadu(byte rychlost)
  64. {
  65. digitalWrite(Motor1_1,0);
  66. digitalWrite(Motor1_2,1);
  67. analogWrite(Motor1_PWM,rychlost);
  68. digitalWrite(Motor2_1,0);
  69. digitalWrite(Motor2_2,1);
  70. analogWrite(Motor2_PWM,rychlost);
  71. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement