1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253 |
- int speedPin_M1 = 5; //M1 Speed Control
- int speedPin_M2 = 6; //M2 Speed Control
- int directionPin_M1 = 4; //M1 Direction Control
- int directionPin_M2 = 7; //M1 Direction Control
- void setup(){
-
- }
- void loop(){
- carAdvance(100,100);
- delay(1000);
- carBack(100,100);
- delay(1000);
- carTurnLeft(250,250);
- delay(1000);
- carTurnRight(250,250);
- delay(1000);
- }
- void carStop(){ // Motor Stop
- digitalWrite(speedPin_M2,0);
- digitalWrite(directionPin_M1,LOW);
- digitalWrite(speedPin_M1,0);
- digitalWrite(directionPin_M2,LOW);
- }
- void carTurnLeft(int leftSpeed,int rightSpeed){ //Turn Left
- analogWrite (speedPin_M2,leftSpeed); //PWM Speed Control
- digitalWrite(directionPin_M1,HIGH);
- analogWrite (speedPin_M1,rightSpeed);
- digitalWrite(directionPin_M2,HIGH);
- }
- void carTurnRight(int leftSpeed,int rightSpeed){ //Turn Right
- analogWrite (speedPin_M2,leftSpeed);
- digitalWrite(directionPin_M1,LOW);
- analogWrite (speedPin_M1,rightSpeed);
- digitalWrite(directionPin_M2,LOW);
- }
- void carBack(int leftSpeed,int rightSpeed){ //Move backward
- analogWrite (speedPin_M2,leftSpeed);
- digitalWrite(directionPin_M1,LOW);
- analogWrite (speedPin_M1,rightSpeed);
- digitalWrite(directionPin_M2,HIGH);
- }
- void carAdvance(int leftSpeed,int rightSpeed){ //Move forward
- analogWrite (speedPin_M2,leftSpeed);
- digitalWrite(directionPin_M1,HIGH);
- analogWrite (speedPin_M1,rightSpeed);
- digitalWrite(directionPin_M2,LOW);
- }
|