#include <SoftwareSerial.h>
char data = 0;
void setup() {
Serial.begin(9600); //Sets the data rate in bits per second (baud) for serial data transmission
// Impostazione canale A
pinMode(2, OUTPUT); // initialize direction pin (motor A)
pinMode(3, OUTPUT); // initialize brake pin (motor A)
// Impostazione canale B
pinMode(4, OUTPUT); // initialize direction pin (motor B)
pinMode(5, OUTPUT); // initialize brake pin (motor B)
}
void loop() {
if (Serial.available() > 0) // Send data only when you receive data:
{
data = Serial.read(); //Read the incoming data and store it into variable data
Serial.print(data); //Print Value inside data in Serial monitor
Serial.print("\n"); //New line
switch (data) {
case '1':
// Motor A
digitalWrite(2, HIGH); // set forward direction (motor A)
digitalWrite(3, LOW); // disactivate brake pin (motor A)
analogWrite(6, 255); // set max speed (motor A)
// Motor B
digitalWrite(4, HIGH); // set forward direction (motor B)
digitalWrite(5, LOW); // disactivate brake pin (motor B)
analogWrite(9, 255); //set max speed (motor B)
case '2':
// Motor A
digitalWrite(2, HIGH); // set forward direction (motor A)
digitalWrite(3, LOW); // disactivate brake pin (motor A)
analogWrite(6, 0); //set min speed (motor A)
// Motor B
digitalWrite(4, LOW); // set backward direction (motor B)
digitalWrite(5, LOW); // disactivate brake pin (motor B)
analogWrite(9, 0); //set min speed (motor B)
break;
case '3':
// Motor A
digitalWrite(2, HIGH); // set forward direction (motor A)
digitalWrite(3, LOW); // disactivate brake pin (motor A)
analogWrite(6, 255); //set max speed (motor A)
// Motor B
digitalWrite(4, HIGH); // set forward direction (motor B)
digitalWrite(5, LOW); // disactivate brake pin (motor B)
analogWrite(9, 127); //set half speed (motor B)
break;
case '4':
// Motor A
digitalWrite(2, HIGH); // set forward direction (motor A)
digitalWrite(3, LOW); // disactivate brake pin (motor A)
analogWrite(6, 127); //set half speed (motor A)
// Motor B
digitalWrite(4, HIGH); // set forward direction (motor B)
digitalWrite(5, LOW); // disactivate brake pin (motor B)
analogWrite(9, 255); //set max speed (motor B)
break;
}
}
}
Comments
Please log in or sign up to comment.