Robo Autonomo ESP32 — 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 <Wire.h>
#include <ESP32Servo.h>
#include <Grove_I2C_Motor_Driver.h>

// =====================================================
// CONFIGURACAO DOS PINOS
// =====================================================
#define PIN_TRIG 5
#define PIN_ECHO 18
#define PIN_SERVO 19
#define PIN_SDA 21
#define PIN_SCL 22
#define ENDERECO_DRIVER 0x0F

// MOTOR1 = motor esquerdo; MOTOR2 = motor direito

// =====================================================
// PARAMETROS DE FUNCIONAMENTO
// =====================================================
const float DISTANCIA_OBSTACULO = 25.0;
const float DISTANCIA_LIBERACAO = 40.0;

// Velocidade adaptativa
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;

// =====================================================
// OBJETOS E VARIAVEIS
// =====================================================
Servo meuServo;

float distanciaFrontal = 0;
float distanciaEsquerda = 0;
float distanciaDireita = 0;

bool servoDisponivel = 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;

// =====================================================
// CALCULO DA VELOCIDADE ADAPTATIVA
// =====================================================
int calcularVelocidadeAdaptativa(float distancia) {

  if (distancia <= DISTANCIA_OBSTACULO) {
    return 0;
  }

  if (distancia >= DISTANCIA_VELOCIDADE_MAXIMA) {
    return VELOCIDADE_MAXIMA;
  }

  float proporcao =
    (distancia - DISTANCIA_OBSTACULO) /
    (DISTANCIA_VELOCIDADE_MAXIMA - DISTANCIA_OBSTACULO);

  int velocidade = VELOCIDADE_MINIMA +
    (int)(proporcao * (VELOCIDADE_MAXIMA - VELOCIDADE_MINIMA));

  return constrain(velocidade, VELOCIDADE_MINIMA, VELOCIDADE_MAXIMA);
}

// =====================================================
// CONTROLE DOS MOTORES
// =====================================================
void pararMotores() {
  Motor.stop(MOTOR1);
  Motor.

More projects by marcosfagner