25 lines
665 B
C
25 lines
665 B
C
#pragma once
|
|
|
|
//############## CONFIG STEPPERS ################
|
|
#define DIR_PIN_A 16
|
|
#define DIR_PIN_B 26
|
|
#define PULSE_PIN_A 17
|
|
#define PULSE_PIN_B 27
|
|
|
|
#define SM_A 0
|
|
#define SM_B 1
|
|
|
|
#define PULSE_PER_REV (1 / 3200.0)
|
|
//###############################################
|
|
|
|
//================ CONFIG ENCODERS =====================
|
|
#define ENCODER_RIGHT_PIN_A 12 // Lupio sam ove vrednosti
|
|
#define ENCODER_RIGHT_PIN_B 13
|
|
#define ENCODER_LEFT_PIN_A 6
|
|
#define ENCODER_LEFT_PIN_B 7
|
|
#define ENCODER_CPR 3840
|
|
|
|
#define WHEEL_RADIUS 0.0279
|
|
#define WHEEL_SEPARATION 0.31133
|
|
#define TIMER_CYCLE_US 1000
|
|
//======================================================
|