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 "QEI.h"
|
||||||
|
#include "Moteurs.h"
|
||||||
|
|
||||||
/*** C'est ici que ce fait la conversion en mm
|
/*** 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){
|
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){
|
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){
|
int QEI_get(enum QEI_name_t qei){
|
||||||
switch (moteur)
|
switch (qei)
|
||||||
{
|
{
|
||||||
case MOTEUR_A:
|
case QEI_A_NAME:
|
||||||
return QEI_A.value;
|
return QEI_A.value;
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case MOTEUR_B:
|
case QEI_B_NAME:
|
||||||
return QEI_B.value;
|
return QEI_B.value;
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case MOTEUR_C:
|
case QEI_C_NAME:
|
||||||
return QEI_C.value;
|
return QEI_C.value;
|
||||||
break;
|
break;
|
||||||
|
|
||||||
|
10
QEI.h
10
QEI.h
@ -1,12 +1,16 @@
|
|||||||
#include "Moteurs.h"
|
|
||||||
|
|
||||||
struct QEI_t{
|
struct QEI_t{
|
||||||
int value;
|
int value;
|
||||||
int delta;
|
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;
|
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 t_moteur moteur);
|
int QEI_get(enum QEI_name_t qei);
|
Loading…
Reference in New Issue
Block a user