
test
main.cpp
- Committer:
- lafritedavid
- Date:
- 2021-06-10
- Revision:
- 0:e2decaadef56
File content as of revision 0:e2decaadef56:
#include "mbed.h" Serial pc ( USBTX, USBRX ); AnalogIn pot(PA_0); // potentiometre dans l'aile AnalogIn pot1(PA_1); // potentiometre de test DigitalOut MoteurIN1(PB_0); // rotation anti horaire (-20°) fil vert PB0 DigitalOut MoteurIN2(PC_1); // rotation horaire (+20°) fil blanc PC1 int main() { float MesureAngle; // mesure du potentiometre dans l'aile float ConsigneAngle; //= 0.47; // valeur entre 0,44 et 0,56 // consigne en pourcentage ou degré MoteurIN1.write(0); MoteurIN2.write(0); while(1) { MesureAngle = (pot.read()*-333)+166; // mesure d'angle en degré ConsigneAngle = pot1.read()*40-20; // consigne anngle de -20 a +20 degré pc.printf("Consigne %f Mesure %f \n\r",ConsigneAngle,MesureAngle); if ((ConsigneAngle-MesureAngle)>1) { MoteurIN1.write(0); MoteurIN2.write(1); pc.printf("Sens 1\r\n"); } else if ((ConsigneAngle-MesureAngle)<-1){ pc.printf("Sens 2\r\n"); MoteurIN1.write(1); MoteurIN2.write(0); } else { MoteurIN1.write(0); MoteurIN2.write(0); } wait(0.1); } }