![](/media/cache/group/default_image.jpg.50x50_q85.jpg)
carte esclave pompe 2020 V1
Dependencies: mbed ident_crac
main.cpp
- Committer:
- marwanesaich
- Date:
- 2019-05-07
- Revision:
- 2:4cc8fa2f64be
- Parent:
- 1:8a55f1d5cb26
- Child:
- 3:cf33f9d4d6ff
- Child:
- 4:82c90657da4a
File content as of revision 2:4cc8fa2f64be:
#include "mbed.h" #include "class_ventouse.h" #include "ident_CRAC.h" #define ROBOT_SMALL #define SIZE_FIFO 50 CANMessage msgRxBuffer[SIZE_FIFO]; unsigned char FIFO_ecriture=0; //Position du fifo pour la reception CAN signed char FIFO_lecture=0;//Position du fifo de lecture des messages CAN Ventouse* ventouse[8]; char end_game = 0; void get_etat_ventouses(); CAN can(PB_8,PB_9,1000000); Serial pc(USBTX,USBRX); /*********************************************************************************************************/ /* FUNCTION NAME: canRx_ISR */ /* DESCRIPTION : lit les messages sur le can et les stocke dans la FIFO */ /*********************************************************************************************************/ void canRx_ISR (void) { if (can.read(msgRxBuffer[FIFO_ecriture])) FIFO_ecriture=(FIFO_ecriture+1)%SIZE_FIFO; } /*********************************************************************************************************/ /* FUNCTION NAME: canProcessRx */ /* DESCRIPTION : Fonction de traitement des messages CAN */ /*********************************************************************************************************/ void canProcessRx(void){ static signed char FIFO_occupation=0,FIFO_max_occupation=0; CANMessage msgTx=CANMessage(); FIFO_occupation=FIFO_ecriture-FIFO_lecture; if(FIFO_occupation<0) FIFO_occupation=FIFO_occupation+SIZE_FIFO; if(FIFO_max_occupation<FIFO_occupation) FIFO_max_occupation=FIFO_occupation; if(FIFO_occupation!=0) { int identifiant=msgRxBuffer[FIFO_lecture].id; char BRAS = 0; switch(identifiant){ #ifdef ROBOT_SMALL case HACHEUR_GET_ATOM: BRAS = msgRxBuffer[FIFO_lecture].data[0]; pc.printf("HACHEUR_GET_ATOM bras %d\n", BRAS); ventouse[BRAS]->action(1); break; case HACHEUR_RELEASE_ATOM: BRAS = msgRxBuffer[FIFO_lecture].data[0]; pc.printf("HACHEUR_RELEASE_ATOM bras %d\n", BRAS); ventouse[BRAS]->action(0); break; case HACHEUR_GET_PRESENTOIR_AR: pc.printf("HACHEUR_GET_DISTRIB_AR\n"); ventouse[AR_GAUCHE]->action(1);; ventouse[AR_CENTRE]->action(1);; ventouse[AR_DROIT]->action(1);; break; case HACHEUR_GET_PRESENTOIR_AV : pc.printf("HACHEUR_GET_DISTRIB_AV\n"); ventouse[AV_GAUCHE]->action(1);; ventouse[AV_CENTRE]->action(1);; ventouse[AV_DROIT]->action(1);; break; case HACHEUR_STATUT_VENTOUSES: pc.printf("HACHEUR_GET_STATUS\n"); get_etat_ventouses(); break; case GLOBAL_GAME_END: end_game = 1; break; #endif #ifdef ROBOT_BIG #endif } FIFO_lecture=(FIFO_lecture+1)%SIZE_FIFO; } } int main() { can.attach(&canRx_ISR); // création de l'interrupt attachée à la réception sur le CAN wait(1); #ifdef ROBOT_SMALL ventouse[AR_CENTRE] = new Ventouse(PC_9, PA_8, PB_0, AR_CENTRE); ventouse[AR_DROIT] = new Ventouse(PA_9, PA_10, PB_1, AR_DROIT); ventouse[AR_BAS] = new Ventouse(PA_11, PA_15, PC_1, AR_BAS); ventouse[AV_GAUCHE] = new Ventouse(PB_7, PB_6, PC_0, AV_GAUCHE); ventouse[AV_CENTRE] = new Ventouse(PC_7,PC_8 , PC_5, AV_CENTRE); ventouse[AV_BAS] = new Ventouse(PB_10, PB_2, PC_4, AV_BAS); ventouse[AR_GAUCHE] = new Ventouse(PA_6, PA_5, PA_7, AR_GAUCHE); ventouse[AV_DROIT] = new Ventouse(PA_0, PA_1, PA_4, AV_DROIT); #endif pc.printf("LAUNCHED"); while(1) { canProcessRx(); for(int i=0; i<8; i++){ ventouse[i]->automate(); } if(end_game){ for(int i=0; i<8;i++){ ventouse[i]->setPompe(0.0); ventouse[i]->setElectrovanne(0.0); } while(1){;} } } } void get_etat_ventouses() { CANMessage etat_ventouses = CANMessage(); etat_ventouses.id=HACHEUR_STATUT_VENTOUSES; etat_ventouses.len=2; etat_ventouses.format=CANStandard; etat_ventouses.type=CANData; etat_ventouses.data[0]=0; etat_ventouses.data[0]=1; for(int i=7; i>=0; i--){ etat_ventouses.data[0] = (etat_ventouses.data[0]<<1) + ventouse[i]->getPompe(); etat_ventouses.data[1] = (etat_ventouses.data[1]<<1) + ventouse[i]->getPression(); } can.write(etat_ventouses); }