ROBOT CONTROL VIA SERIAL
//ROBOT CONTROL VIA SERIAL
int I1 = 4; //LEFT MOTOR
int I2 = 5; //LEFT MOTOR
int I3 = 6; //RIGHT MOTOR
int I4 = 7; //RIGHT MOTOR
int buzz = 11; // buzzer is connected to pin 11
char command;
void setup ()
{
pinMode (I1, OUTPUT);
pinMode (I2, OUTPUT);
pinMode (I3, OUTPUT);
pinMode (I4, OUTPUT);
pinMode (buzz, OUTPUT);
Serial.begin (9600); // Serial Communication
}
void loop ()
{
command = Serial.read();
if (command == ′W′)
{
digitalWrite (I1, HIGH);
digitalWrite (I2, LOW);
digitalWrite (I3, HIGH);
digitalWrite (I4, LOW);
}
else if (command == ′A′)
{
digitalWrite (I1, LOW);
digitalWrite (I2, HIGH);
digitalWrite (I3, HIGH);
digitalWrite (I4, LOW);
}
else if (command == ′S′)
{
digitalWrite (I1, LOW);
digitalWrite (I2, HIGH);
digitalWrite (I3, LOW);
digitalWrite (I4, HIGH);
}
else if (command == ′D′)
{
digitalWrite (I1, HIGH);
digitalWrite (I2, LOW);
digitalWrite (I3, LOW);
digitalWrite (I4, HIGH);
}
else if (command == ′X′)
{
digitalWrite (I1, LOW);
digitalWrite (I2, LOW);
digitalWrite (I3, LOW);
digitalWrite (I4, LOW);
}
}
ULTRASONIC SENSOR
int trig = 9;
int echo = 10;
int duration;
int buzz = 11;
void setup()
{
pinMode (trig, OUTPUT);
pinMode (echo, INPUT);
pinMode (buzz, OUTPUT);
Serial.begin(9600);
}
void loop()
{
digitalWrite (trig, HIGH);
delayMicroseconds (10);
digitalWrite (trig, LOW);
duration = pulseIn (echo, HIGH);
//Serial.println (duration);
//speed = distance/ time >>> distance = speed * time
float distance = (33400.00/1000000.00)*duration/2.00;
Serial.println (distance);
}