Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- //SGVR MINI version 1.0.0
- // Features: Motor, LED
- const int motorA1 = 2; //masuk pin2
- const int motorA2 = 3; //masuk pin3
- const int motorB1 = 4; //masuk pin4
- const int motorB2 = 5; //masuk pin5
- const int ledmerah = 10; //:LED indikator on/off masuk pin10
- const int ledhijau = 11; //LED indikator jalan masuk pin11
- int incomingByte; // a variable to read incoming serial data into
- void setup() {
- // initialize serial communication:
- Serial.begin(9600);
- // initialize the LED pin as an output:
- pinMode (motorA1, OUTPUT);
- pinMode (motorA2, OUTPUT);
- pinMode (motorB1, OUTPUT);
- pinMode (motorB2, OUTPUT);
- pinMode (ledmerah, OUTPUT);
- pinMode (ledhijau, OUTPUT);
- }
- void loop() {
- digitalWrite (ledmerah, HIGH);
- // see if there's incoming serial data:
- if (Serial.available() > 0) {
- // read the oldest byte in the serial buffer:
- incomingByte = Serial.read();
- // if it's a 1 (ASCII 72), go forward:
- if (incomingByte == '1') {
- digitalWrite (motorA1, HIGH);
- digitalWrite (motorB1, HIGH);
- digitalWrite (motorA2, LOW);
- digitalWrite (motorB2, LOW);
- digitalWrite (ledhijau, HIGH);
- delay (100) ;
- digitalWrite (motorA1, LOW);
- digitalWrite (motorB1, LOW);
- digitalWrite (motorA2, LOW);
- digitalWrite (motorB2, LOW);
- digitalWrite (ledhijau, LOW);
- }
- if (incomingByte == '2') {
- digitalWrite (motorA1, LOW);
- digitalWrite (motorB1, LOW);
- digitalWrite (motorA2, HIGH);
- digitalWrite (motorB2, HIGH);
- digitalWrite (ledhijau, HIGH);
- delay (100) ;
- digitalWrite (motorA1, LOW);
- digitalWrite (motorB1, LOW);
- digitalWrite (motorA2, LOW);
- digitalWrite (motorB2, LOW);
- digitalWrite (ledhijau, LOW);
- }
- if (incomingByte == '3') {
- //digitalWrite (motorA1, HIGH);
- digitalWrite (motorB1, HIGH);
- //digitalWrite (motorA2, LOW);
- digitalWrite (motorB2, LOW);
- digitalWrite (ledhijau, HIGH);
- delay (100) ;
- //digitalWrite (motorA1, LOW);
- digitalWrite (motorB1, LOW);
- //digitalWrite (motorA2, LOW);
- digitalWrite (motorB2, LOW);
- digitalWrite (ledhijau, LOW);
- }
- if (incomingByte == '4') {
- digitalWrite (motorA1, HIGH);
- // digitalWrite (motorB1, HIGH);
- digitalWrite (motorA2, LOW);
- // digitalWrite (motorB2, LOW);
- digitalWrite (ledhijau, HIGH);
- delay (100) ;
- digitalWrite (motorA1, LOW);
- // digitalWrite (motorB1, LOW);
- digitalWrite (motorA2, LOW);
- // digitalWrite (motorB2, LOW);
- digitalWrite (ledhijau, LOW);
- }
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement