46 lines
855 B
C
46 lines
855 B
C
#define STOP 0
|
|
#define FORWARD 1
|
|
#define BACKWARD 2
|
|
|
|
#define IN 3
|
|
#define OUT 4
|
|
#define IN_OUT 5
|
|
|
|
|
|
//Posicion en la array del motor de fps
|
|
#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
|
|
#define LINEAL_MAX 4*478
|
|
#define LINEAL_MIN 4 |