Skip to content

Instantly share code, notes, and snippets.

@e-Gizmo
Created June 10, 2019 09:37
Show Gist options
  • Star 0 You must be signed in to star a gist
  • Fork 0 You must be signed in to fork a gist
  • Save e-Gizmo/2313e26dd707716f359d2b30bb3ba58f to your computer and use it in GitHub Desktop.
Save e-Gizmo/2313e26dd707716f359d2b30bb3ba58f to your computer and use it in GitHub Desktop.
Sample Codes for Direction Tilt Robot with Bluetooth Receiver.
int SPEED_MOTOR = 150;
int state = 0;
void setup() {
//MOTOR PINS
pinMode(8, OUTPUT); //dirmotor1
pinMode(9, OUTPUT); //spdmotor1
pinMode(10, OUTPUT); //spdmotor2
pinMode(11, OUTPUT); //dirmotor2
Serial.begin(9600);
}
void loop() {
if (Serial.available() > 0){
state = Serial.read();
}
if(state == '3'){
STOP();
}
else if(state == '0'){
FORWARD();
}
else if(state == '2'){
TURN_RIGHT();
}
else if(state == '1'){
TURN_LEFT();
}
}
void FORWARD() {
digitalWrite(8, HIGH);
analogWrite(9, SPEED_MOTOR);
analogWrite(10, SPEED_MOTOR);
digitalWrite(11, HIGH);
}
void TURN_RIGHT() {
digitalWrite(8, HIGH);
analogWrite(9, SPEED_MOTOR);
analogWrite(10, SPEED_MOTOR);
digitalWrite(11, LOW);
}
void TURN_LEFT() {
digitalWrite(8, LOW);
analogWrite(9, SPEED_MOTOR);
analogWrite(10, SPEED_MOTOR);
digitalWrite(11, HIGH);
}
void STOP() {
//digitalWrite(8, HIGH);
analogWrite(9, 0);
analogWrite(10, 0);
//digitalWrite(11, HIGH);
}
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment