Advertisement
Apparcane

Quant 3.0 Movement

May 7th, 2024 (edited)
433
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 1.32 KB | Source Code | 0 0
  1. static int LeftSpeed = 5;
  2. static int RightSpeed = 10;
  3. static int LeftDir = 6;
  4. static int RightDir = 9;
  5.  
  6. static int LowSpeed = 100;
  7. static int MediumSpeed = 150;
  8. static int HighSpeed = 200;
  9.  
  10.  
  11. void Backward() {
  12.   //  Left Wheel
  13.   analogWrite(LeftSpeed, MediumSpeed);
  14.   digitalWrite(LeftDir, HIGH);
  15.   //  Right Wheel
  16.   analogWrite(RightSpeed, MediumSpeed);
  17.   digitalWrite(RightDir, HIGH);
  18. }
  19.  
  20. void Forward() {
  21.   //  Left Wheel
  22.   analogWrite(LeftSpeed, MediumSpeed);
  23.   digitalWrite(LeftDir, LOW);
  24.   //  Right Wheel
  25.   analogWrite(RightSpeed, MediumSpeed);
  26.   digitalWrite(RightDir, LOW);
  27. }
  28.  
  29. void Stop() {
  30.   //  Left Wheel
  31.   analogWrite(LeftSpeed, 0);
  32.   //  Right Wheel
  33.   analogWrite(RightSpeed, 0);
  34. }
  35.  
  36. void Right() {
  37.   //  Left Wheel
  38.   analogWrite(LeftSpeed, MediumSpeed);
  39.   digitalWrite(LeftDir, HIGH);
  40.   //  Right Wheel
  41.   analogWrite(RightSpeed, MediumSpeed);
  42.   digitalWrite(RightDir, LOW);
  43. }
  44.  
  45. void Left() {
  46.   //  Left Wheel
  47.   analogWrite(LeftSpeed, MediumSpeed);
  48.   digitalWrite(LeftDir, LOW);
  49.   //  Right Wheel
  50.   analogWrite(RightSpeed, MediumSpeed);
  51.   digitalWrite(RightDir, HIGH);
  52. }
  53.  
  54. void setup() {
  55.   pinMode(LeftSpeed, OUTPUT);
  56.   pinMode(LeftDir, OUTPUT);
  57.   pinMode(RightDir, OUTPUT);
  58.   pinMode(RightSpeed, OUTPUT);
  59. }
  60.  
  61. void loop() {
  62.   Forward();
  63.   delay(500);
  64.   Backward();
  65.   delay(500);
  66. }
Tags: C++ Arduino
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement