mirror of
https://github.com/modelec/pami.git
synced 2026-03-18 21:40:35 +01:00
43 lines
722 B
C
43 lines
722 B
C
#ifndef MAIN_H
|
|
#define MAIN_H
|
|
|
|
enum Direction
|
|
{
|
|
FORWARD,
|
|
BACKWARD,
|
|
LEFT,
|
|
RIGHT,
|
|
STOP
|
|
};
|
|
|
|
// UART
|
|
#define TX_PIN 17
|
|
#define RX_PIN 16
|
|
|
|
// Moteur 1 - Gauche
|
|
#define M1_DIR_PIN 4
|
|
#define M1_STEP_PIN 33
|
|
#define M1_ENABLE_PIN 14
|
|
|
|
// Moteur 2 - Droite
|
|
#define M2_DIR_PIN 16
|
|
#define M2_STEP_PIN 32
|
|
#define M2_ENABLE_PIN 27
|
|
|
|
// Paramètres moteurs
|
|
#define R_SENSE 0.11f
|
|
#define CURRENT 600 // mA
|
|
// Adresses des drivers TMC2209
|
|
#define DRIVER1_ADDR 0b00
|
|
#define DRIVER2_ADDR 0b01
|
|
|
|
// Capteur à ultrasons
|
|
#define TRIG_PIN 18
|
|
#define ECHO_PIN 5
|
|
|
|
// Constantes pour les roues
|
|
#define WHEEL_DIAMETER 5.5 // cm
|
|
#define STEPS_PER_REV 200 * 16 // microsteps
|
|
#define WHEEL_BASE 7.2 // cm
|
|
|
|
#endif // MAIN_H
|