Fire Fighting Robot Code
Fire Fighting Robot Code
*/
#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);
}
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);
fire = true;