arduino maze
arduino maze
#include <Servo.h>
#include <LiquidCrystal_I2C.h>
// Constants
#define TURNING_SPEED 200
#define FORWARD_SPEED 255
#define MIN_DISTANCE 15 // Increased minimum distance for faster navigation
// LCD initialization
LiquidCrystal_I2C lcd(0x27, 16, 2);
Servo myservo;
// Global variables
int distance;
long duration;
int redValue, greenValue, blueValue;
int leftDistance, rightDistance, frontDistance;
void setup() {
// Initialize LCD
lcd.init();
lcd.backlight();
lcd.print("Fast Robot");
lcd.setCursor(0, 1);
lcd.print("Initializing...");
lcd.clear();
}
void loop() {
// Quick check for blue objects
if (isBlueDetected()) {
lcd.clear();
lcd.print("Blue Detected!");
stopMotors();
delay(3000); // Wait 3 seconds before continuing
return;
}