Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- static int LeftSpeed = 5;
- static int RightSpeed = 10;
- static int LeftDir = 6;
- static int RightDir = 9;
- static int LowSpeed = 100;
- static int MediumSpeed = 150;
- static int HighSpeed = 200;
- void Backward() {
- // Left Wheel
- analogWrite(LeftSpeed, MediumSpeed);
- digitalWrite(LeftDir, HIGH);
- // Right Wheel
- analogWrite(RightSpeed, MediumSpeed);
- digitalWrite(RightDir, HIGH);
- }
- void Forward() {
- // Left Wheel
- analogWrite(LeftSpeed, MediumSpeed);
- digitalWrite(LeftDir, LOW);
- // Right Wheel
- analogWrite(RightSpeed, MediumSpeed);
- digitalWrite(RightDir, LOW);
- }
- void Stop() {
- // Left Wheel
- analogWrite(LeftSpeed, 0);
- // Right Wheel
- analogWrite(RightSpeed, 0);
- }
- void Right() {
- // Left Wheel
- analogWrite(LeftSpeed, MediumSpeed);
- digitalWrite(LeftDir, HIGH);
- // Right Wheel
- analogWrite(RightSpeed, MediumSpeed);
- digitalWrite(RightDir, LOW);
- }
- void Left() {
- // Left Wheel
- analogWrite(LeftSpeed, MediumSpeed);
- digitalWrite(LeftDir, LOW);
- // Right Wheel
- analogWrite(RightSpeed, MediumSpeed);
- digitalWrite(RightDir, HIGH);
- }
- void setup() {
- pinMode(LeftSpeed, OUTPUT);
- pinMode(LeftDir, OUTPUT);
- pinMode(RightDir, OUTPUT);
- pinMode(RightSpeed, OUTPUT);
- }
- void loop() {
- Forward();
- delay(500);
- Backward();
- delay(500);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement