2025-02-26 10:33:31 +01:00
|
|
|
#define FORWARD 0
|
|
|
|
#define BACKWARD 1
|
|
|
|
#define STOP 0
|
|
|
|
#define IN 1
|
|
|
|
#define OUT 2
|
|
|
|
#define IN_OUT 3
|
|
|
|
#define FPS_MOTOR 4
|
|
|
|
|
|
|
|
//Definicion de los pines del shift register
|
|
|
|
#define Data_pin 8
|
|
|
|
#define Clock_pin 4
|
|
|
|
#define Latch_pin 12
|
|
|
|
#define Enable 7
|
|
|
|
|
|
|
|
//Definicion de los Motores 0,1,2,3 en el shift register
|
|
|
|
#define M2A 0
|
|
|
|
#define M1A 1
|
|
|
|
#define M0A 2
|
|
|
|
#define M0B 3
|
|
|
|
#define M1B 4
|
|
|
|
#define M3A 5
|
|
|
|
#define M2B 6
|
|
|
|
#define M3B 7
|
|
|
|
|
|
|
|
//Definicion de los enable (PWM) de los Motores 0,1,2,3 en las gpio del Arduino
|
|
|
|
#define EN0 11
|
|
|
|
#define EN1 3
|
|
|
|
#define EN2 5
|
|
|
|
#define EN3 6
|
|
|
|
|
|
|
|
//Definicion del Motor 4
|
|
|
|
#define EN_M4 33
|
|
|
|
#define R_M4 10
|
|
|
|
#define L_M4 9
|
|
|
|
|
|
|
|
//Definicion de los pines de los sensores
|
|
|
|
#define sensor_fps 20
|
|
|
|
#define sensor_lineal_motor A0
|
|
|
|
|
|
|
|
//Definicion de los limites del sensor lineal
|
2025-03-03 10:42:59 +01:00
|
|
|
#define LINEAL_MAX 4*478
|
2025-02-26 10:33:31 +01:00
|
|
|
#define LINEAL_MIN 0
|