Keuronde/RPiPico-Holonome2023
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Gestion des unités dans QEI directement

Browse Source
This commit is contained in:
Samuel 2022-11-30 21:14:47 +01:00
parent 9ee3d96738
commit a170a48e85
2 changed files with 24 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

22
QEI.c
View File

@ -6,6 +6,21 @@
#include "quadrature_encoder.pio.h" #include "quadrature_encoder.pio.h"
/*** C'est ici que se fait la conversion en mm
* ***/
// Roues 60 mm de diamètre, 188,5 mm de circonférence
// Réduction Moteur 30:1
// Réduction poulie 16:12
// Nombre d'impulsions par tour moteur : 200
// Nombre d'impulsions par tour réducteur : 6000
// Nombre d'impulsions par tour de roue : 8000
// Impulsion / mm : 42,44
#define IMPULSION_PAR_MM (42.44f)
#define ASSERMOTEUR_GAIN_P 160
#define ASSERMOTEUR_GAIN_I .80f
struct QEI_t QEI_A, QEI_B, QEI_C; struct QEI_t QEI_A, QEI_B, QEI_C;
PIO pio_QEI = pio0; PIO pio_QEI = pio0;
@ -89,4 +104,11 @@ int QEI_get(enum QEI_name_t qei){
default: default:
break; break;
} }
}
/// @brief Renvoi la distance parcourue en mm depuis la lecture précédente
/// @param qei : Nom du module à lire (QEI_A_NAME, QEI_B_NAME ou QEI_C_NAME)
/// @return la distance parcourue en mm calculée lors du dernier appel de la function QEI_Update()
double QEI_get_mm(enum QEI_name_t qei){
return (double) QEI_get(qei) / (double)IMPULSION_PAR_MM;
} }

3
QEI.h
View File

@ -13,4 +13,5 @@ extern struct QEI_t QEI_A, QEI_B, QEI_C;
void QEI_update(void); void QEI_update(void);
void QEI_init(void); void QEI_init(void);
int QEI_get(enum QEI_name_t qei); int QEI_get(enum QEI_name_t qei);
double QEI_get_mm(enum QEI_name_t qei);