Scribd
Upload
104 views2 pages

Fire Fighting Robot Code

Code

Uploaded by

Samprit Nandi
Copyright
© © All Rights Reserved
We take content rights seriously. If you suspect this is your content, claim it here.
Available Formats
Download as TXT, PDF, TXT or read online on Scribd
104 views2 pages

Fire Fighting Robot Code

Code

Uploaded by

Samprit Nandi
Copyright
© © All Rights Reserved
We take content rights seriously. If you suspect this is your content, claim it here.
Available Formats
Download as TXT, PDF, TXT or read online on Scribd
You are on page 1/ 2

/* Before uploading the code, please check the connections according to my circuit

diagram. The circuit diagram is available in my YouTube video.

And please SUBSCRIBE to my YouTube channel, ElectroArt.

*/
#include <Servo.h> //include servo.h library
Servo myservo;
int pos = 0;
int motor_speed = 150;
boolean fire = false;
#define Left 4
#define Right 2
#define Forward 3
#define LM1 12
#define LM2 13
#define RM1 10
#define RM2 11
#define pump 8

void setup() {

pinMode(Left, INPUT);
pinMode(Right, INPUT);
pinMode(forward, INPUT);
pinMode(LM1, OUTPUT);
pinMode(LM2, OUTPUT);
pinMode(RM1, OUTPUT);
pinMode(RM2, OUTPUT);
pinMode(pump, OUTPUT);
analogWrite(6, motor_speed);
analogWrite(5, motor_speed);
myservo.attach(9);
myservo.write(90);
digitalWrite(pump,HIGH);
}

void put_off_fire() {

delay (500);
digitalWrite(LM1, HIGH);
digitalWrite(LM2, HIGH);
digitalWrite(RM1, HIGH);
digitalWrite(RM2, HIGH);
digitalWrite(pump, LOW);
delay(500);

for (pos = 50; pos <= 130; pos += 1) {


myservo.write(pos);
delay(10);

for (pos = 130; pos >= 50; pos -= 1) {


myservo.write(pos);
delay(10);

}
digitalWrite(pump,HIGH);
myservo.write(90);
fire=false;

void loop() {

myservo.write(90); //Sweep_Servo();
if (digitalRead(Left) ==1 && digitalRead(Right)==1 && digitalRead(Forward) ==1)
{

digitalWrite(LM1, HIGH);
digitalWrite(LM2, HIGH);
digitalWrite(RM1, HIGH);
digitalWrite(RM2, HIGH);

else if (digitalRead(Forward) ==0) {


digitalWrite(LM1, HIGH);
digitalWrite(LM2, LOW);
digitalWrite(RM1, HIGH);
digitalWrite(RM2, LOW);

fire = true;

else if (digitalRead(Left) ==0) {


digitalWrite(LM1, LOW);
digitalWrite(LM2, HIGH);
digitalWrite(RM1, HIGH);
digitalWrite(RM2, LOW);

else if (digitalRead(Right) ==0) {


digitalWrite(LM1, HIGH);
digitalWrite(LM2, LOW);
digitalWrite(RM1, LOW);
digitalWrite(RM2, HIGH);
}

delay(300);//change this value to increase the distance


while (fire == true) {
put_off_fire();

You might also like