//program Robot Soccer
// By Rifki Haii
int kiri_mundur = 19;
int kiri_maju = 5;
int kanan_mundur = 16;
int kanan_maju = 0;
char data;
void setup() {
pinMode(kiri_mundur, OUTPUT);
pinMode(kiri_maju, OUTPUT);
pinMode(kanan_mundur, OUTPUT);
pinMode(kanan_maju, OUTPUT);
data = 'z' ;
Serial.begin(9600);
}
void maju () {
digitalWrite(kiri_mundur,LOW);
digitalWrite(kiri_maju,HIGH);
digitalWrite(kiri_mundur,LOW);
digitalWrite(kiri_maju,HIGH);
}
void mundur () {
digitalWrite(kiri_mundur,HIGH);
digitalWrite(kiri_maju,LOW);
digitalWrite(kiri_mundur,HIGH);
digitalWrite(kiri_maju,LOW);
}
void kanan () {
digitalWrite(kiri_mundur,LOW);
digitalWrite(kiri_maju,HIGH);
digitalWrite(kiri_mundur,LOW);
digitalWrite(kiri_maju,LOW);
}
void kiri () {
digitalWrite(kiri_mundur,LOW);
digitalWrite(kiri_maju,LOW);
digitalWrite(kiri_mundur,LOW);
digitalWrite(kiri_maju,HIGH);
}
void berhenti () {
digitalWrite(kiri_mundur,LOW);
digitalWrite(kiri_maju,LOW);
digitalWrite(kiri_mundur,LOW);
digitalWrite(kiri_maju,LOW);
}
void rem () {
digitalWrite(kiri_mundur,HIGH);
digitalWrite(kiri_maju,HIGH);
digitalWrite(kiri_mundur, HIGH);
digitalWrite(kiri_maju,HIGH);
}
void loop() {
if(Serial.available() >0){
data = Serial.read();
}
if(data == 'w'){
maju();
}
else if(data == 's'){
mundur();
}
else if(data == 'd'){
kanan();
}
else if(data == 'a'){
kiri();
}
else if(data == 'p'){
berhenti();
}
else if(data == 'r'){
rem();
}
}