Modificacion para usar Puente H L298N en vez del integrado L293D
This commit is contained in:
parent
82327e4c29
commit
e6dc731415
@ -2,37 +2,37 @@
|
|||||||
#include "Sensor_TCRT5000.h"
|
#include "Sensor_TCRT5000.h"
|
||||||
class Robot_Seguidor
|
class Robot_Seguidor
|
||||||
{
|
{
|
||||||
private:
|
private:
|
||||||
Base_Robot Robot;
|
Base_Robot Robot;
|
||||||
Sensor Sensor_1;
|
Sensor Sensor_1;
|
||||||
Sensor Sensor_2;
|
Sensor Sensor_2;
|
||||||
Sensor Sensor_3;
|
Sensor Sensor_3;
|
||||||
Sensor Sensor_4;
|
Sensor Sensor_4;
|
||||||
Sensor Sensor_5;
|
Sensor Sensor_5;
|
||||||
int sensor[5];
|
int sensor[5];
|
||||||
float Error=0, P=0, I=0, D=0, PID=0;
|
float Error=0, P=0, I=0, D=0, PID=0;
|
||||||
float Error_Anterior=0, Anteriror_I=0;
|
float Error_Anterior=0, Anteriror_I=0;
|
||||||
|
|
||||||
public:
|
public:
|
||||||
Robot_Seguidor(int Pin_Motor_1A,
|
Robot_Seguidor(int Pin_Motor_1A,
|
||||||
int IN1,
|
int IN1,
|
||||||
int IN2,
|
int IN2,
|
||||||
int ENA,
|
int ENA,
|
||||||
int IN3,
|
int IN3,
|
||||||
int IN4,
|
int IN4,
|
||||||
int ENB,
|
int ENB,
|
||||||
int PinS1,
|
int PinS1,
|
||||||
int PinS2,
|
int PinS2,
|
||||||
int PinS3,
|
int PinS3,
|
||||||
int PinS4,
|
int PinS4,
|
||||||
int PinS5)
|
int PinS5)
|
||||||
:Robot(IN1, IN2, ENA, IN3, IN4, ENB),
|
:Robot(IN1, IN2, ENA, IN3, IN4, ENB),
|
||||||
Sensor_1(PinS1),
|
Sensor_1(PinS1),
|
||||||
Sensor_2(PinS2),
|
Sensor_2(PinS2),
|
||||||
Sensor_3(PinS3),
|
Sensor_3(PinS3),
|
||||||
Sensor_4(PinS4),
|
Sensor_4(PinS4),
|
||||||
Sensor_5(PinS5){}
|
Sensor_5(PinS5){}
|
||||||
void Inicializar();
|
void Inicializar();
|
||||||
void Lectura_de_sensores();
|
void Lectura_de_sensores();
|
||||||
void Modo_Seguidor(int kP,int KI,int KD,int Velocidad);
|
void Modo_Seguidor(int kP,int KI,int KD,int Velocidad);
|
||||||
};
|
};
|
||||||
|
Loading…
Reference in New Issue
Block a user