bahasa program robot line follower (totocsp)
#define motorkif 2
//motor kiri maju
#define motorkib 3
//motor kiri mundur
#define motorkaf 4
//motor kanan maju
#define motorkab 5
//motor kanan mundur
void setup() {
//Menentukan mode untuk masing-masing pin
pinMode(motorkif,OUTPUT);
pinMode(motorkib,OUTPUT);
pinMode(motorkaf,OUTPUT);
pinMode(motorkab,OUTPUT);
pinMode(7,INPUT);
pinMode(8,INPUT);
}
void loop() {
int sensorki=digitalRead(7); //baca sensor kiri
int sensorka=digitalRead(8); //baca sensor kanan
if((sensorki==LOW) && (sensorka==LOW))
{
//kedua sensor tidak mengenai garis hitam
//gerak maju
digitalWrite(motorkaf,HIGH);
digitalWrite(motorkab,LOW);
digitalWrite(motorkif,HIGH);
digitalWrite(motorkib,LOW);
}
else if((sensorki==HIGH) && (sensorka==LOW))
{
//sensor kiri mendeteksi garis hitam
//belok kiri
digitalWrite(motorkaf,HIGH);
digitalWrite(motorkab,LOW);
digitalWrite(motorkif,LOW);
digitalWrite(motorkib,HIGH);
}
else if((sensorki==LOW) && (sensorka==HIGH))
{
//sensor kanan mendeteksi garis hitam
//belok kanan
digitalWrite(motorkaf,LOW);
digitalWrite(motorkab,HIGH);
digitalWrite(motorkif,HIGH);
digitalWrite(motorkib,LOW);
}
else
{
//kedua sensor mendeteksi garis
//stop
digitalWrite(motorkaf,LOW);
digitalWrite(motorkif,LOW);
digitalWrite(motorkab,LOW);
digitalWrite(motorkib,LOW);
}
}
Comments
Post a Comment