Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- //////////////////////////////////////////////////////////////////////////
- //Left Motors Pin Connections To Arduino Uno
- //////////////////////////////////////////////////////////////////////////
- const int L_Motor_PIN_DIR = 2; // Motor direction signal
- const int L_Motor_PIN_BRK = 3; // Motor Break signal
- const int L_Motor_PIN_PWM = 9; // 490Hz pins 3, 9, 10, 11
- const int L_Motor_PIN_S = 12; // Motor Speed Input signal
- //////////////////////////////////////////////////////////////////////////
- //------------------------------------------------------------------------
- //////////////////////////////////////////////////////////////////////////
- //Right Motors Pin Connections To Arduino Uno
- //////////////////////////////////////////////////////////////////////////
- const int R_Motor_PIN_DIR = 4; // Motor direction signal
- const int R_Motor_PIN_BRK = 5; // Motor Break signal
- const int R_Motor_PIN_PWM = 10; // 490Hz pins 3, 9, 10, 11
- const int R_Motor_PIN_S = 11; // Motor Speed Input signal
- //////////////////////////////////////////////////////////////////////////
- int set_Speed = 15;
- int tSafeTime = 100;
- void setup() {
- setupMotorDriversPins();
- Break_All_Motors();
- }
- void loop() {
- /*
- Front (25, 1000);
- delay(1000);
- Back (25, 1000);
- delay(1000);
- Left (25, 1000);
- delay(1000);
- Right (25, 1000);
- delay(1000);
- */
- Break_All_Motors();
- delay(5000);
- }
- void setupMotorDriversPins() {
- pinMode(L_Motor_PIN_DIR, OUTPUT);
- pinMode(L_Motor_PIN_BRK, OUTPUT);
- pinMode(L_Motor_PIN_PWM, OUTPUT);
- pinMode(L_Motor_PIN_S, INPUT);
- pinMode(R_Motor_PIN_DIR, OUTPUT);
- pinMode(R_Motor_PIN_BRK, OUTPUT);
- pinMode(R_Motor_PIN_PWM, OUTPUT);
- pinMode(R_Motor_PIN_S, INPUT);
- }
- void Break_All_Motors() {
- digitalWrite(L_Motor_PIN_BRK, 1);
- digitalWrite(R_Motor_PIN_BRK, 1);
- }
- void Front(int setTheSpeed, int timeToDelay) {
- safeGuardMotors();
- analogWrite(L_Motor_PIN_PWM, setTheSpeed);//15
- analogWrite(R_Motor_PIN_PWM, setTheSpeed);//15
- digitalWrite(L_Motor_PIN_DIR, 1);
- digitalWrite(R_Motor_PIN_DIR, 0);
- delay(timeToDelay);
- }
- void Back(int setTheSpeed, int timeToDelay) {
- safeGuardMotors();
- analogWrite(L_Motor_PIN_PWM, setTheSpeed);//15
- analogWrite(R_Motor_PIN_PWM, setTheSpeed);//15
- digitalWrite(L_Motor_PIN_DIR, 0);
- digitalWrite(R_Motor_PIN_DIR, 1);
- delay(timeToDelay);
- }
- void Right(int setTheSpeed, int timeToDelay) {
- safeGuardMotors();
- analogWrite(L_Motor_PIN_PWM, setTheSpeed);//15
- analogWrite(R_Motor_PIN_PWM, setTheSpeed);//15
- digitalWrite(L_Motor_PIN_DIR, 1);
- digitalWrite(R_Motor_PIN_DIR, 1);
- delay(timeToDelay);
- }
- void Left(int setTheSpeed, int timeToDelay) {
- safeGuardMotors();
- analogWrite(L_Motor_PIN_PWM, setTheSpeed);//15
- analogWrite(R_Motor_PIN_PWM, setTheSpeed);//15
- digitalWrite(L_Motor_PIN_DIR, 0);
- digitalWrite(R_Motor_PIN_DIR, 0);
- delay(timeToDelay);
- }
- void safeGuardMotors() {
- delay(tSafeTime);
- digitalWrite(L_Motor_PIN_BRK, 0);
- digitalWrite(R_Motor_PIN_BRK, 0);
- delay(tSafeTime);
- }
Advertisement
Add Comment
Please, Sign In to add comment