carte esclave pompe 2020 V1
Dependencies: mbed ident_crac
main.cpp@2:4cc8fa2f64be, 2019-05-07 (annotated)
- Committer:
- marwanesaich
- Date:
- Tue May 07 13:14:29 2019 +0000
- Revision:
- 2:4cc8fa2f64be
- Parent:
- 1:8a55f1d5cb26
- Child:
- 3:cf33f9d4d6ff
- Child:
- 4:82c90657da4a
gestion pompes avec automates sans ACK
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
marwanesaich | 0:84a8c24e29ae | 1 | #include "mbed.h" |
marwanesaich | 0:84a8c24e29ae | 2 | #include "class_ventouse.h" |
marwanesaich | 0:84a8c24e29ae | 3 | #include "ident_CRAC.h" |
marwanesaich | 1:8a55f1d5cb26 | 4 | |
marwanesaich | 1:8a55f1d5cb26 | 5 | #define ROBOT_SMALL |
marwanesaich | 0:84a8c24e29ae | 6 | |
marwanesaich | 0:84a8c24e29ae | 7 | #define SIZE_FIFO 50 |
marwanesaich | 0:84a8c24e29ae | 8 | |
marwanesaich | 0:84a8c24e29ae | 9 | CANMessage msgRxBuffer[SIZE_FIFO]; |
marwanesaich | 0:84a8c24e29ae | 10 | unsigned char FIFO_ecriture=0; //Position du fifo pour la reception CAN |
marwanesaich | 0:84a8c24e29ae | 11 | signed char FIFO_lecture=0;//Position du fifo de lecture des messages CAN |
marwanesaich | 0:84a8c24e29ae | 12 | |
marwanesaich | 0:84a8c24e29ae | 13 | Ventouse* ventouse[8]; |
marwanesaich | 0:84a8c24e29ae | 14 | char end_game = 0; |
marwanesaich | 0:84a8c24e29ae | 15 | |
marwanesaich | 0:84a8c24e29ae | 16 | |
marwanesaich | 0:84a8c24e29ae | 17 | void get_etat_ventouses(); |
marwanesaich | 0:84a8c24e29ae | 18 | |
marwanesaich | 2:4cc8fa2f64be | 19 | CAN can(PB_8,PB_9,1000000); |
marwanesaich | 2:4cc8fa2f64be | 20 | Serial pc(USBTX,USBRX); |
marwanesaich | 0:84a8c24e29ae | 21 | |
marwanesaich | 0:84a8c24e29ae | 22 | /*********************************************************************************************************/ |
marwanesaich | 0:84a8c24e29ae | 23 | /* FUNCTION NAME: canRx_ISR */ |
marwanesaich | 0:84a8c24e29ae | 24 | /* DESCRIPTION : lit les messages sur le can et les stocke dans la FIFO */ |
marwanesaich | 0:84a8c24e29ae | 25 | /*********************************************************************************************************/ |
marwanesaich | 0:84a8c24e29ae | 26 | void canRx_ISR (void) |
marwanesaich | 0:84a8c24e29ae | 27 | { |
marwanesaich | 0:84a8c24e29ae | 28 | if (can.read(msgRxBuffer[FIFO_ecriture])) |
marwanesaich | 0:84a8c24e29ae | 29 | FIFO_ecriture=(FIFO_ecriture+1)%SIZE_FIFO; |
marwanesaich | 0:84a8c24e29ae | 30 | } |
marwanesaich | 0:84a8c24e29ae | 31 | |
marwanesaich | 0:84a8c24e29ae | 32 | |
marwanesaich | 0:84a8c24e29ae | 33 | /*********************************************************************************************************/ |
marwanesaich | 0:84a8c24e29ae | 34 | /* FUNCTION NAME: canProcessRx */ |
marwanesaich | 0:84a8c24e29ae | 35 | /* DESCRIPTION : Fonction de traitement des messages CAN */ |
marwanesaich | 0:84a8c24e29ae | 36 | /*********************************************************************************************************/ |
marwanesaich | 0:84a8c24e29ae | 37 | void canProcessRx(void){ |
marwanesaich | 0:84a8c24e29ae | 38 | static signed char FIFO_occupation=0,FIFO_max_occupation=0; |
marwanesaich | 0:84a8c24e29ae | 39 | CANMessage msgTx=CANMessage(); |
marwanesaich | 0:84a8c24e29ae | 40 | FIFO_occupation=FIFO_ecriture-FIFO_lecture; |
marwanesaich | 0:84a8c24e29ae | 41 | if(FIFO_occupation<0) |
marwanesaich | 0:84a8c24e29ae | 42 | FIFO_occupation=FIFO_occupation+SIZE_FIFO; |
marwanesaich | 0:84a8c24e29ae | 43 | if(FIFO_max_occupation<FIFO_occupation) |
marwanesaich | 0:84a8c24e29ae | 44 | FIFO_max_occupation=FIFO_occupation; |
marwanesaich | 0:84a8c24e29ae | 45 | if(FIFO_occupation!=0) { |
marwanesaich | 0:84a8c24e29ae | 46 | int identifiant=msgRxBuffer[FIFO_lecture].id; |
marwanesaich | 1:8a55f1d5cb26 | 47 | char BRAS = 0; |
marwanesaich | 1:8a55f1d5cb26 | 48 | |
marwanesaich | 0:84a8c24e29ae | 49 | switch(identifiant){ |
marwanesaich | 0:84a8c24e29ae | 50 | |
marwanesaich | 0:84a8c24e29ae | 51 | #ifdef ROBOT_SMALL |
marwanesaich | 0:84a8c24e29ae | 52 | case HACHEUR_GET_ATOM: |
marwanesaich | 1:8a55f1d5cb26 | 53 | BRAS = msgRxBuffer[FIFO_lecture].data[0]; |
marwanesaich | 1:8a55f1d5cb26 | 54 | pc.printf("HACHEUR_GET_ATOM bras %d\n", BRAS); |
marwanesaich | 2:4cc8fa2f64be | 55 | ventouse[BRAS]->action(1); |
marwanesaich | 0:84a8c24e29ae | 56 | break; |
marwanesaich | 0:84a8c24e29ae | 57 | |
marwanesaich | 0:84a8c24e29ae | 58 | case HACHEUR_RELEASE_ATOM: |
marwanesaich | 1:8a55f1d5cb26 | 59 | BRAS = msgRxBuffer[FIFO_lecture].data[0]; |
marwanesaich | 1:8a55f1d5cb26 | 60 | pc.printf("HACHEUR_RELEASE_ATOM bras %d\n", BRAS); |
marwanesaich | 2:4cc8fa2f64be | 61 | ventouse[BRAS]->action(0); |
marwanesaich | 0:84a8c24e29ae | 62 | break; |
marwanesaich | 0:84a8c24e29ae | 63 | |
marwanesaich | 1:8a55f1d5cb26 | 64 | case HACHEUR_GET_PRESENTOIR_AR: |
marwanesaich | 0:84a8c24e29ae | 65 | pc.printf("HACHEUR_GET_DISTRIB_AR\n"); |
marwanesaich | 2:4cc8fa2f64be | 66 | ventouse[AR_GAUCHE]->action(1);; |
marwanesaich | 2:4cc8fa2f64be | 67 | ventouse[AR_CENTRE]->action(1);; |
marwanesaich | 2:4cc8fa2f64be | 68 | ventouse[AR_DROIT]->action(1);; |
marwanesaich | 0:84a8c24e29ae | 69 | break; |
marwanesaich | 0:84a8c24e29ae | 70 | |
marwanesaich | 1:8a55f1d5cb26 | 71 | case HACHEUR_GET_PRESENTOIR_AV : |
marwanesaich | 0:84a8c24e29ae | 72 | pc.printf("HACHEUR_GET_DISTRIB_AV\n"); |
marwanesaich | 2:4cc8fa2f64be | 73 | ventouse[AV_GAUCHE]->action(1);; |
marwanesaich | 2:4cc8fa2f64be | 74 | ventouse[AV_CENTRE]->action(1);; |
marwanesaich | 2:4cc8fa2f64be | 75 | ventouse[AV_DROIT]->action(1);; |
marwanesaich | 0:84a8c24e29ae | 76 | break; |
marwanesaich | 0:84a8c24e29ae | 77 | |
marwanesaich | 0:84a8c24e29ae | 78 | case HACHEUR_STATUT_VENTOUSES: |
marwanesaich | 0:84a8c24e29ae | 79 | pc.printf("HACHEUR_GET_STATUS\n"); |
marwanesaich | 0:84a8c24e29ae | 80 | get_etat_ventouses(); |
marwanesaich | 0:84a8c24e29ae | 81 | break; |
marwanesaich | 0:84a8c24e29ae | 82 | |
marwanesaich | 0:84a8c24e29ae | 83 | case GLOBAL_GAME_END: |
marwanesaich | 0:84a8c24e29ae | 84 | end_game = 1; |
marwanesaich | 0:84a8c24e29ae | 85 | break; |
marwanesaich | 0:84a8c24e29ae | 86 | #endif |
marwanesaich | 0:84a8c24e29ae | 87 | |
marwanesaich | 0:84a8c24e29ae | 88 | #ifdef ROBOT_BIG |
marwanesaich | 0:84a8c24e29ae | 89 | |
marwanesaich | 0:84a8c24e29ae | 90 | #endif |
marwanesaich | 0:84a8c24e29ae | 91 | } |
marwanesaich | 0:84a8c24e29ae | 92 | FIFO_lecture=(FIFO_lecture+1)%SIZE_FIFO; |
marwanesaich | 0:84a8c24e29ae | 93 | } |
marwanesaich | 0:84a8c24e29ae | 94 | } |
marwanesaich | 0:84a8c24e29ae | 95 | |
marwanesaich | 0:84a8c24e29ae | 96 | int main() { |
marwanesaich | 0:84a8c24e29ae | 97 | |
marwanesaich | 0:84a8c24e29ae | 98 | can.attach(&canRx_ISR); // création de l'interrupt attachée à la réception sur le CAN |
marwanesaich | 0:84a8c24e29ae | 99 | wait(1); |
marwanesaich | 1:8a55f1d5cb26 | 100 | #ifdef ROBOT_SMALL |
marwanesaich | 2:4cc8fa2f64be | 101 | ventouse[AR_CENTRE] = new Ventouse(PC_9, PA_8, PB_0, AR_CENTRE); |
marwanesaich | 2:4cc8fa2f64be | 102 | ventouse[AR_DROIT] = new Ventouse(PA_9, PA_10, PB_1, AR_DROIT); |
marwanesaich | 2:4cc8fa2f64be | 103 | ventouse[AR_BAS] = new Ventouse(PA_11, PA_15, PC_1, AR_BAS); |
marwanesaich | 2:4cc8fa2f64be | 104 | ventouse[AV_GAUCHE] = new Ventouse(PB_7, PB_6, PC_0, AV_GAUCHE); |
marwanesaich | 0:84a8c24e29ae | 105 | |
marwanesaich | 2:4cc8fa2f64be | 106 | ventouse[AV_CENTRE] = new Ventouse(PC_7,PC_8 , PC_5, AV_CENTRE); |
marwanesaich | 2:4cc8fa2f64be | 107 | ventouse[AV_BAS] = new Ventouse(PB_10, PB_2, PC_4, AV_BAS); |
marwanesaich | 2:4cc8fa2f64be | 108 | ventouse[AR_GAUCHE] = new Ventouse(PA_6, PA_5, PA_7, AR_GAUCHE); |
marwanesaich | 2:4cc8fa2f64be | 109 | ventouse[AV_DROIT] = new Ventouse(PA_0, PA_1, PA_4, AV_DROIT); |
marwanesaich | 0:84a8c24e29ae | 110 | |
marwanesaich | 1:8a55f1d5cb26 | 111 | #endif |
marwanesaich | 1:8a55f1d5cb26 | 112 | pc.printf("LAUNCHED"); |
marwanesaich | 0:84a8c24e29ae | 113 | while(1) { |
marwanesaich | 0:84a8c24e29ae | 114 | canProcessRx(); |
marwanesaich | 2:4cc8fa2f64be | 115 | for(int i=0; i<8; i++){ |
marwanesaich | 2:4cc8fa2f64be | 116 | ventouse[i]->automate(); |
marwanesaich | 2:4cc8fa2f64be | 117 | } |
marwanesaich | 0:84a8c24e29ae | 118 | if(end_game){ |
marwanesaich | 0:84a8c24e29ae | 119 | for(int i=0; i<8;i++){ |
marwanesaich | 0:84a8c24e29ae | 120 | ventouse[i]->setPompe(0.0); |
marwanesaich | 0:84a8c24e29ae | 121 | ventouse[i]->setElectrovanne(0.0); |
marwanesaich | 0:84a8c24e29ae | 122 | } |
marwanesaich | 0:84a8c24e29ae | 123 | while(1){;} |
marwanesaich | 0:84a8c24e29ae | 124 | } |
marwanesaich | 0:84a8c24e29ae | 125 | } |
marwanesaich | 0:84a8c24e29ae | 126 | } |
marwanesaich | 0:84a8c24e29ae | 127 | |
marwanesaich | 0:84a8c24e29ae | 128 | |
marwanesaich | 0:84a8c24e29ae | 129 | void get_etat_ventouses() |
marwanesaich | 0:84a8c24e29ae | 130 | { |
marwanesaich | 0:84a8c24e29ae | 131 | CANMessage etat_ventouses = CANMessage(); |
marwanesaich | 0:84a8c24e29ae | 132 | etat_ventouses.id=HACHEUR_STATUT_VENTOUSES; |
marwanesaich | 0:84a8c24e29ae | 133 | etat_ventouses.len=2; |
marwanesaich | 0:84a8c24e29ae | 134 | etat_ventouses.format=CANStandard; |
marwanesaich | 0:84a8c24e29ae | 135 | etat_ventouses.type=CANData; |
marwanesaich | 2:4cc8fa2f64be | 136 | etat_ventouses.data[0]=0; |
marwanesaich | 2:4cc8fa2f64be | 137 | etat_ventouses.data[0]=1; |
marwanesaich | 0:84a8c24e29ae | 138 | for(int i=7; i>=0; i--){ |
marwanesaich | 0:84a8c24e29ae | 139 | etat_ventouses.data[0] = (etat_ventouses.data[0]<<1) + ventouse[i]->getPompe(); |
marwanesaich | 0:84a8c24e29ae | 140 | etat_ventouses.data[1] = (etat_ventouses.data[1]<<1) + ventouse[i]->getPression(); |
marwanesaich | 0:84a8c24e29ae | 141 | } |
marwanesaich | 0:84a8c24e29ae | 142 | can.write(etat_ventouses); |
marwanesaich | 0:84a8c24e29ae | 143 | |
marwanesaich | 0:84a8c24e29ae | 144 | } |