Robo Autonomo ESP32 Código corrigido L298N — ESP32 simulation

Robô autônomo com ESP32, sensor ultrassônico, servo SG90 e driver de motores L298P.

An interactive ESP32 circuit simulation you can run free in your browser on Velxio, by marcosfagner.

Components

Sketch code

#include <ESP32Servo.h>

// ESP32 + L298N convencional
// Motor esquerdo: ENA=25, IN1=26, IN2=27
// Motor direito:  ENB=14, IN3=32, IN4=33
// HC-SR04: TRIG=5, ECHO=18 (usar divisor resistivo)
// Servo: sinal=19
// Remova os jumpers ENA e ENB do modulo L298N.

#define PIN_ENA 25
#define PIN_IN1 26
#define PIN_IN2 27
#define PIN_ENB 14
#define PIN_IN3 32
#define PIN_IN4 33
#define PIN_TRIG 5
#define PIN_ECHO 18
#define PIN_SERVO 19

const uint32_t FREQUENCIA_PWM = 1000;
const uint8_t RESOLUCAO_PWM = 8;
const int PWM_MAXIMO = 255;

// Altere para true se o respectivo motor girar invertido.
const bool INVERTER_MOTOR_ESQUERDO = false;
const bool INVERTER_MOTOR_DIREITO = false;

const float DISTANCIA_OBSTACULO = 25.0;
const float DISTANCIA_LIBERACAO = 40.0;
const int VELOCIDADE_MAXIMA = 60;
const int VELOCIDADE_MINIMA = 35;
const float DISTANCIA_VELOCIDADE_MAXIMA = 60.0;
const int VELOCIDADE_CURVA = 65;
const int VELOCIDADE_RECUO = 50;

const int ANGULO_CENTRO = 90;
const int ANGULO_ESQUERDA = 170;
const int ANGULO_DIREITA = 10;

const unsigned long TEMPO_RECUO = 350;
const unsigned long TEMPO_CURVA = 450;
const unsigned long TEMPO_GIRO_180 = 900;
const unsigned long TEMPO_SERVO_ESQUERDA = 350;
const unsigned long TEMPO_SERVO_DIREITA = 500;
const unsigned long TEMPO_SERVO_CENTRO = 350;
const unsigned long INTERVALO_LEITURA = 100;
const unsigned long TEMPO_REANALISE = 1000;
const unsigned long TIMEOUT_SENSOR = 30000;

const int MAX_TENTATIVAS_RECUPERACAO = 3;
const int MAX_MANOBRAS_NORMAIS_FALHAS = 3;

Servo meuServo;
float distanciaFrontal = 0;
float distanciaEsquerda = 0;
float distanciaDireita = 0;
bool servoDisponivel = false;
bool motoresDisponiveis = false;
bool proximoGiroEsquerda = true;
int tentativasRecuperacao = 0;
int manobrasNormaisFalhas = 0;
int ultimaVelocidadeExibida = -1;
unsigned long tempoUltimaLeitura = 0;

enum EstadoRobo {
  INICIALIZACAO, FRENTE, DETECTOU_OBSTACULO, OLHAR_ESQUERDA,
  OLHAR_DIREITA, CENTRALIZAR_SERVO, ANALISAR_DIRECOES, RECUAR,
  GIRAR, RECUPERAR_ROTA, VERIFICAR_NOVA_DIRECAO, CAMINHO_BLOQUEADO,
  FALHA_SENSOR, IMPASSE, ERRO_HARDWARE
};
EstadoRobo estadoAtual = INICIALIZACAO;

// Compatibilidade com Arduino-ESP32 Core 2.x e 3.x.
#if __has_include(<esp_arduino_version.h>)
  #include <esp_arduino_version.h>
#endif

bool configurarPWM() {
#if defined(ESP_ARDUINO_VERSION_MAJOR) && ESP_ARDUINO_VERSION_MAJOR >= 3
  bool a = ledcAttach(PIN_ENA, FREQUENCIA_PWM, RESOLUCAO_PWM);
  bool b = ledcAttach(PIN_ENB, FREQUENCIA_PWM, RESOLUCAO_PWM);
  return a && b;
#else
  ledcSetup(0, FREQUENCIA_PWM, RESOLUCAO_PWM);
  ledcSetup(1, FREQUENCIA_PWM, RESOLUCAO_PWM);
  ledcAttachPin(PIN_ENA, 0);
  ledcAttachPin(PIN_ENB, 1);
  return true;
#endif
}

void escreverPWM(int pinoEnable, int canal, int valor) {
  valor = constrain(valor, 0, PWM_MAXIMO);
#if defined(ESP_ARDUINO_VERSION_MAJOR) && ESP_ARDUINO_VERSION_MAJOR >= 3
  ledcWrite(pinoEnable, valor);
#else
  ledcWrite(canal, valor);
#endif
}

int calcularVelocidadeAdaptativa(float distan

More projects by marcosfagner