Suppression de la dépendance entre QEI et Moteurs
This commit is contained in:
parent
26329bfeef
commit
ba83f1917d
@ -1,4 +1,5 @@
|
||||
#include "QEI.h"
|
||||
#include "Moteurs.h"
|
||||
|
||||
/*** C'est ici que ce fait la conversion en mm
|
||||
* ***/
|
||||
@ -26,7 +27,16 @@ void AsserMoteur_setConsigne_mm_s(enum t_moteur moteur, double _consigne_mm_s){
|
||||
}
|
||||
|
||||
double AsserMoteur_getVitesse_mm_s(enum t_moteur moteur){
|
||||
return (double) QEI_get(moteur) * (double)IMPULSION_PAR_MM;
|
||||
enum QEI_name_t qei;
|
||||
switch (moteur)
|
||||
{
|
||||
case MOTEUR_A: qei = QEI_A_NAME; break;
|
||||
case MOTEUR_B: qei = QEI_B_NAME; break;
|
||||
case MOTEUR_C: qei = QEI_C_NAME; break;
|
||||
|
||||
default: break;
|
||||
}
|
||||
return (double) QEI_get(qei) / (double)IMPULSION_PAR_MM;
|
||||
}
|
||||
|
||||
void AsserMoteur_Gestion(int step_ms){
|
||||
|
10
QEI.c
10
QEI.c
@ -54,18 +54,18 @@ void QEI_update(){
|
||||
|
||||
}
|
||||
|
||||
int QEI_get(enum t_moteur moteur){
|
||||
switch (moteur)
|
||||
int QEI_get(enum QEI_name_t qei){
|
||||
switch (qei)
|
||||
{
|
||||
case MOTEUR_A:
|
||||
case QEI_A_NAME:
|
||||
return QEI_A.value;
|
||||
break;
|
||||
|
||||
case MOTEUR_B:
|
||||
case QEI_B_NAME:
|
||||
return QEI_B.value;
|
||||
break;
|
||||
|
||||
case MOTEUR_C:
|
||||
case QEI_C_NAME:
|
||||
return QEI_C.value;
|
||||
break;
|
||||
|
||||
|
10
QEI.h
10
QEI.h
@ -1,12 +1,16 @@
|
||||
#include "Moteurs.h"
|
||||
|
||||
struct QEI_t{
|
||||
int value;
|
||||
int delta;
|
||||
};
|
||||
|
||||
enum QEI_name_t{
|
||||
QEI_A_NAME=0,
|
||||
QEI_B_NAME=1,
|
||||
QEI_C_NAME=2
|
||||
};
|
||||
|
||||
extern struct QEI_t QEI_A, QEI_B, QEI_C;
|
||||
|
||||
void QEI_update(void);
|
||||
void QEI_init(void);
|
||||
int QEI_get(enum t_moteur moteur);
|
||||
int QEI_get(enum QEI_name_t qei);
|
Loading…
Reference in New Issue
Block a user