thomas strcic
/
ProjetInfo2_Multi12
oki
Fork of ProjetInfo2_Multi by
coffre.cpp@3:98f5de1dd010, 2018-06-05 (annotated)
- Committer:
- thomasstrcic
- Date:
- Tue Jun 05 11:54:56 2018 +0000
- Revision:
- 3:98f5de1dd010
- Parent:
- 2:ae058dfdebac
nique bitoun
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
jujuonthebeat | 0:5755bf39c144 | 1 | #include"mbed.h" |
jujuonthebeat | 0:5755bf39c144 | 2 | |
thomasstrcic | 3:98f5de1dd010 | 3 | // ***************** VARIABLES ************************ |
jujuonthebeat | 0:5755bf39c144 | 4 | BusIn digicode(p5,p6,p7,p8,p9,p10,p11,p12,p13,p14,p15,p16); |
thomasstrcic | 2:ae058dfdebac | 5 | DigitalOut s(p17); |
thomasstrcic | 2:ae058dfdebac | 6 | Timer t; |
thomasstrcic | 2:ae058dfdebac | 7 | Timer t11; |
thomasstrcic | 3:98f5de1dd010 | 8 | int u; |
thomasstrcic | 3:98f5de1dd010 | 9 | int N_precedent; |
thomasstrcic | 3:98f5de1dd010 | 10 | int N,i; |
thomasstrcic | 3:98f5de1dd010 | 11 | int a,b,c,d; |
thomasstrcic | 3:98f5de1dd010 | 12 | int code[4]={2,1,0,3}; |
thomasstrcic | 3:98f5de1dd010 | 13 | Timer t3; |
thomasstrcic | 3:98f5de1dd010 | 14 | int etat2=1; |
thomasstrcic | 3:98f5de1dd010 | 15 | Serial pc (USBTX,USBRX); |
thomasstrcic | 3:98f5de1dd010 | 16 | //char chara; |
thomasstrcic | 3:98f5de1dd010 | 17 | //int val; |
thomasstrcic | 3:98f5de1dd010 | 18 | //Serial blue(p28,p27); |
thomasstrcic | 3:98f5de1dd010 | 19 | |
thomasstrcic | 3:98f5de1dd010 | 20 | |
thomasstrcic | 3:98f5de1dd010 | 21 | // ************* FONCTION **************** |
jujuonthebeat | 0:5755bf39c144 | 22 | |
jujuonthebeat | 0:5755bf39c144 | 23 | int lireval(){ |
jujuonthebeat | 0:5755bf39c144 | 24 | int val; |
jujuonthebeat | 0:5755bf39c144 | 25 | if(digicode.read()==0){ |
jujuonthebeat | 0:5755bf39c144 | 26 | val=-3; |
jujuonthebeat | 0:5755bf39c144 | 27 | } |
jujuonthebeat | 0:5755bf39c144 | 28 | if(digicode.read()==2){ |
jujuonthebeat | 0:5755bf39c144 | 29 | val=7; |
jujuonthebeat | 0:5755bf39c144 | 30 | } |
jujuonthebeat | 0:5755bf39c144 | 31 | if(digicode.read()==4){ |
jujuonthebeat | 0:5755bf39c144 | 32 | val=4; |
jujuonthebeat | 0:5755bf39c144 | 33 | } |
jujuonthebeat | 0:5755bf39c144 | 34 | if(digicode.read()==8){ |
jujuonthebeat | 0:5755bf39c144 | 35 | val=1; |
jujuonthebeat | 0:5755bf39c144 | 36 | } |
jujuonthebeat | 0:5755bf39c144 | 37 | if(digicode.read()==16){ |
jujuonthebeat | 0:5755bf39c144 | 38 | val=0; |
jujuonthebeat | 0:5755bf39c144 | 39 | } |
jujuonthebeat | 0:5755bf39c144 | 40 | if(digicode.read()==32){ |
jujuonthebeat | 0:5755bf39c144 | 41 | val=8; |
jujuonthebeat | 0:5755bf39c144 | 42 | } |
jujuonthebeat | 0:5755bf39c144 | 43 | if(digicode.read()==64){ |
jujuonthebeat | 0:5755bf39c144 | 44 | val=5; |
jujuonthebeat | 0:5755bf39c144 | 45 | } |
jujuonthebeat | 0:5755bf39c144 | 46 | if(digicode.read()==128){ |
jujuonthebeat | 0:5755bf39c144 | 47 | val=2; |
jujuonthebeat | 0:5755bf39c144 | 48 | } |
jujuonthebeat | 0:5755bf39c144 | 49 | if(digicode.read()==256){ |
jujuonthebeat | 0:5755bf39c144 | 50 | val=-2; |
jujuonthebeat | 0:5755bf39c144 | 51 | } |
jujuonthebeat | 0:5755bf39c144 | 52 | if(digicode.read()==512){ |
jujuonthebeat | 0:5755bf39c144 | 53 | val=9; |
jujuonthebeat | 0:5755bf39c144 | 54 | } |
jujuonthebeat | 0:5755bf39c144 | 55 | if(digicode.read()==1024){ |
jujuonthebeat | 0:5755bf39c144 | 56 | val=6; |
jujuonthebeat | 0:5755bf39c144 | 57 | } |
jujuonthebeat | 0:5755bf39c144 | 58 | if(digicode.read()==2048){ |
jujuonthebeat | 0:5755bf39c144 | 59 | val=3; |
jujuonthebeat | 0:5755bf39c144 | 60 | } |
jujuonthebeat | 0:5755bf39c144 | 61 | return val; |
thomasstrcic | 2:ae058dfdebac | 62 | } |
thomasstrcic | 2:ae058dfdebac | 63 | |
thomasstrcic | 2:ae058dfdebac | 64 | void servo() |
thomasstrcic | 2:ae058dfdebac | 65 | { |
thomasstrcic | 2:ae058dfdebac | 66 | int c=0; |
thomasstrcic | 2:ae058dfdebac | 67 | t.start(); |
thomasstrcic | 2:ae058dfdebac | 68 | t11.start(); |
thomasstrcic | 2:ae058dfdebac | 69 | { |
thomasstrcic | 2:ae058dfdebac | 70 | while(c<1) |
thomasstrcic | 2:ae058dfdebac | 71 | { |
thomasstrcic | 2:ae058dfdebac | 72 | if (t11.read()>8) |
thomasstrcic | 2:ae058dfdebac | 73 | { |
thomasstrcic | 2:ae058dfdebac | 74 | t11.reset(); |
thomasstrcic | 2:ae058dfdebac | 75 | c++; |
thomasstrcic | 2:ae058dfdebac | 76 | } |
thomasstrcic | 2:ae058dfdebac | 77 | if (t11.read()<4) |
thomasstrcic | 2:ae058dfdebac | 78 | { |
thomasstrcic | 2:ae058dfdebac | 79 | if(t.read()>0.02) |
thomasstrcic | 2:ae058dfdebac | 80 | { t.reset();} |
thomasstrcic | 2:ae058dfdebac | 81 | if (t.read()<0.0193) |
thomasstrcic | 2:ae058dfdebac | 82 | { |
thomasstrcic | 2:ae058dfdebac | 83 | s.write(1); |
thomasstrcic | 2:ae058dfdebac | 84 | } |
thomasstrcic | 2:ae058dfdebac | 85 | else |
thomasstrcic | 2:ae058dfdebac | 86 | { |
thomasstrcic | 2:ae058dfdebac | 87 | s.write(0); |
thomasstrcic | 2:ae058dfdebac | 88 | } |
thomasstrcic | 2:ae058dfdebac | 89 | } |
thomasstrcic | 2:ae058dfdebac | 90 | else |
thomasstrcic | 2:ae058dfdebac | 91 | { |
thomasstrcic | 2:ae058dfdebac | 92 | if(t.read()>0.02) |
thomasstrcic | 2:ae058dfdebac | 93 | { t.reset();} |
thomasstrcic | 2:ae058dfdebac | 94 | if (t.read()< 0.0175) |
thomasstrcic | 2:ae058dfdebac | 95 | { |
thomasstrcic | 2:ae058dfdebac | 96 | s.write(1); |
thomasstrcic | 2:ae058dfdebac | 97 | } |
thomasstrcic | 2:ae058dfdebac | 98 | else |
thomasstrcic | 2:ae058dfdebac | 99 | { |
thomasstrcic | 2:ae058dfdebac | 100 | s.write(0); |
thomasstrcic | 2:ae058dfdebac | 101 | } |
thomasstrcic | 2:ae058dfdebac | 102 | } |
thomasstrcic | 2:ae058dfdebac | 103 | |
thomasstrcic | 2:ae058dfdebac | 104 | |
thomasstrcic | 2:ae058dfdebac | 105 | } |
thomasstrcic | 2:ae058dfdebac | 106 | } |
thomasstrcic | 3:98f5de1dd010 | 107 | } |
thomasstrcic | 3:98f5de1dd010 | 108 | |
thomasstrcic | 3:98f5de1dd010 | 109 | |
thomasstrcic | 3:98f5de1dd010 | 110 | void changement_code(int *code) |
thomasstrcic | 3:98f5de1dd010 | 111 | { |
thomasstrcic | 3:98f5de1dd010 | 112 | u=0; |
thomasstrcic | 3:98f5de1dd010 | 113 | while(u<1) |
thomasstrcic | 3:98f5de1dd010 | 114 | { |
thomasstrcic | 3:98f5de1dd010 | 115 | N_precedent=N; |
thomasstrcic | 3:98f5de1dd010 | 116 | t3.start(); |
thomasstrcic | 3:98f5de1dd010 | 117 | if(t3.read()>0.1) |
thomasstrcic | 3:98f5de1dd010 | 118 | { |
thomasstrcic | 3:98f5de1dd010 | 119 | N=lireval(); |
thomasstrcic | 3:98f5de1dd010 | 120 | t3.reset(); |
thomasstrcic | 3:98f5de1dd010 | 121 | t3.stop(); |
thomasstrcic | 3:98f5de1dd010 | 122 | } |
thomasstrcic | 3:98f5de1dd010 | 123 | |
thomasstrcic | 3:98f5de1dd010 | 124 | switch(etat2) |
thomasstrcic | 3:98f5de1dd010 | 125 | { |
thomasstrcic | 3:98f5de1dd010 | 126 | case 0: |
thomasstrcic | 3:98f5de1dd010 | 127 | |
thomasstrcic | 3:98f5de1dd010 | 128 | if ( N_precedent==-3 and N == -2 ) |
thomasstrcic | 3:98f5de1dd010 | 129 | { |
thomasstrcic | 3:98f5de1dd010 | 130 | pc.printf("changement de mdp : \r\n"); |
thomasstrcic | 3:98f5de1dd010 | 131 | etat2=1; |
thomasstrcic | 3:98f5de1dd010 | 132 | } |
thomasstrcic | 3:98f5de1dd010 | 133 | pc.printf("etat 0 \n\r"); |
thomasstrcic | 3:98f5de1dd010 | 134 | break; |
thomasstrcic | 3:98f5de1dd010 | 135 | case 1: |
thomasstrcic | 3:98f5de1dd010 | 136 | |
thomasstrcic | 3:98f5de1dd010 | 137 | if(N_precedent == -3 and N== *code) |
thomasstrcic | 3:98f5de1dd010 | 138 | { |
thomasstrcic | 3:98f5de1dd010 | 139 | etat2=2; |
thomasstrcic | 3:98f5de1dd010 | 140 | } |
thomasstrcic | 3:98f5de1dd010 | 141 | if(N_precedent == -3 and N!=*code and N!=-3) |
thomasstrcic | 3:98f5de1dd010 | 142 | { |
thomasstrcic | 3:98f5de1dd010 | 143 | etat2=10; |
thomasstrcic | 3:98f5de1dd010 | 144 | } |
thomasstrcic | 3:98f5de1dd010 | 145 | pc.printf("etat 1 \n\r"); |
thomasstrcic | 3:98f5de1dd010 | 146 | break; |
thomasstrcic | 3:98f5de1dd010 | 147 | case 2: |
thomasstrcic | 3:98f5de1dd010 | 148 | if(N_precedent == -3 and N==*(code+1)) |
thomasstrcic | 3:98f5de1dd010 | 149 | { |
thomasstrcic | 3:98f5de1dd010 | 150 | etat2=3; |
thomasstrcic | 3:98f5de1dd010 | 151 | } |
thomasstrcic | 3:98f5de1dd010 | 152 | if(N_precedent == -3 and N!=*(code+1) and N!=-3) |
thomasstrcic | 3:98f5de1dd010 | 153 | { |
thomasstrcic | 3:98f5de1dd010 | 154 | etat2=10; |
thomasstrcic | 3:98f5de1dd010 | 155 | } |
thomasstrcic | 3:98f5de1dd010 | 156 | pc.printf("etat 2 \n\r"); |
thomasstrcic | 3:98f5de1dd010 | 157 | break; |
thomasstrcic | 3:98f5de1dd010 | 158 | case 3: |
thomasstrcic | 3:98f5de1dd010 | 159 | if(N_precedent == -3 and N==*(code+2)) |
thomasstrcic | 3:98f5de1dd010 | 160 | { |
thomasstrcic | 3:98f5de1dd010 | 161 | etat2=4; |
thomasstrcic | 3:98f5de1dd010 | 162 | } |
thomasstrcic | 3:98f5de1dd010 | 163 | if(N_precedent == -3 and N!=*(code+2) and N!=-3) |
thomasstrcic | 3:98f5de1dd010 | 164 | { |
thomasstrcic | 3:98f5de1dd010 | 165 | etat2=10; |
thomasstrcic | 3:98f5de1dd010 | 166 | } |
thomasstrcic | 3:98f5de1dd010 | 167 | pc.printf("etat 3 \n\r"); |
thomasstrcic | 3:98f5de1dd010 | 168 | break; |
thomasstrcic | 3:98f5de1dd010 | 169 | case 4: |
thomasstrcic | 3:98f5de1dd010 | 170 | if(N_precedent == -3 and N==*(code+3)) |
thomasstrcic | 3:98f5de1dd010 | 171 | { |
thomasstrcic | 3:98f5de1dd010 | 172 | etat2=5; |
thomasstrcic | 3:98f5de1dd010 | 173 | } |
thomasstrcic | 3:98f5de1dd010 | 174 | if(N_precedent == -3 and N!=*(code+3) and N!=-3) |
thomasstrcic | 3:98f5de1dd010 | 175 | { |
thomasstrcic | 3:98f5de1dd010 | 176 | etat2=10; |
thomasstrcic | 3:98f5de1dd010 | 177 | } |
thomasstrcic | 3:98f5de1dd010 | 178 | pc.printf("etat 4 \n\r"); |
thomasstrcic | 3:98f5de1dd010 | 179 | break; |
thomasstrcic | 3:98f5de1dd010 | 180 | case 5: |
thomasstrcic | 3:98f5de1dd010 | 181 | pc.printf("taper le nouveau code \n\r"); |
thomasstrcic | 3:98f5de1dd010 | 182 | if (N_precedent ==-3 and N!=-3) |
thomasstrcic | 3:98f5de1dd010 | 183 | { |
thomasstrcic | 3:98f5de1dd010 | 184 | a=N; |
thomasstrcic | 3:98f5de1dd010 | 185 | *code=a; |
thomasstrcic | 3:98f5de1dd010 | 186 | etat2=6; |
thomasstrcic | 3:98f5de1dd010 | 187 | } |
thomasstrcic | 3:98f5de1dd010 | 188 | pc.printf("etat 5 \n\r"); |
thomasstrcic | 3:98f5de1dd010 | 189 | break; |
thomasstrcic | 3:98f5de1dd010 | 190 | case 6: |
thomasstrcic | 3:98f5de1dd010 | 191 | if (N_precedent ==-3 and N!=-3) |
thomasstrcic | 3:98f5de1dd010 | 192 | { |
thomasstrcic | 3:98f5de1dd010 | 193 | b=N; |
thomasstrcic | 3:98f5de1dd010 | 194 | *(code+1)=b; |
thomasstrcic | 3:98f5de1dd010 | 195 | etat2=7; |
thomasstrcic | 3:98f5de1dd010 | 196 | } |
thomasstrcic | 3:98f5de1dd010 | 197 | pc.printf("etat 6 \n\r"); |
thomasstrcic | 3:98f5de1dd010 | 198 | break; |
thomasstrcic | 3:98f5de1dd010 | 199 | case 7: |
thomasstrcic | 3:98f5de1dd010 | 200 | if (N_precedent ==-3 and N!=-3) |
thomasstrcic | 3:98f5de1dd010 | 201 | { |
thomasstrcic | 3:98f5de1dd010 | 202 | c=N; |
thomasstrcic | 3:98f5de1dd010 | 203 | *(code+2)=c; |
thomasstrcic | 3:98f5de1dd010 | 204 | etat2=8; |
thomasstrcic | 3:98f5de1dd010 | 205 | } |
thomasstrcic | 3:98f5de1dd010 | 206 | pc.printf("etat 7 \n\r"); |
thomasstrcic | 3:98f5de1dd010 | 207 | break; |
thomasstrcic | 3:98f5de1dd010 | 208 | case 8: |
thomasstrcic | 3:98f5de1dd010 | 209 | if (N_precedent ==-3 and N!=-3) |
thomasstrcic | 3:98f5de1dd010 | 210 | { |
thomasstrcic | 3:98f5de1dd010 | 211 | d=N; |
thomasstrcic | 3:98f5de1dd010 | 212 | *(code+3)=d; |
thomasstrcic | 3:98f5de1dd010 | 213 | etat2=9; |
thomasstrcic | 3:98f5de1dd010 | 214 | } |
thomasstrcic | 3:98f5de1dd010 | 215 | pc.printf("etat 8 \n\r"); |
thomasstrcic | 3:98f5de1dd010 | 216 | break; |
thomasstrcic | 3:98f5de1dd010 | 217 | case 9: |
thomasstrcic | 3:98f5de1dd010 | 218 | |
thomasstrcic | 3:98f5de1dd010 | 219 | pc.printf("%d \n\r",a); |
thomasstrcic | 3:98f5de1dd010 | 220 | pc.printf("%d \n\r",b); |
thomasstrcic | 3:98f5de1dd010 | 221 | pc.printf("%d \n\r",c); |
thomasstrcic | 3:98f5de1dd010 | 222 | pc.printf("%d \n\r",d); |
thomasstrcic | 3:98f5de1dd010 | 223 | wait(3); |
thomasstrcic | 3:98f5de1dd010 | 224 | u++; |
thomasstrcic | 3:98f5de1dd010 | 225 | etat2=1; |
thomasstrcic | 3:98f5de1dd010 | 226 | break; |
thomasstrcic | 3:98f5de1dd010 | 227 | case 10: |
thomasstrcic | 3:98f5de1dd010 | 228 | pc.printf( "code errone \n\r"); |
thomasstrcic | 3:98f5de1dd010 | 229 | wait(00.5); |
thomasstrcic | 3:98f5de1dd010 | 230 | etat2=1; |
thomasstrcic | 3:98f5de1dd010 | 231 | break; |
thomasstrcic | 3:98f5de1dd010 | 232 | |
thomasstrcic | 3:98f5de1dd010 | 233 | } |
thomasstrcic | 3:98f5de1dd010 | 234 | } |
thomasstrcic | 3:98f5de1dd010 | 235 | for (i=0;i<4;i++) |
thomasstrcic | 3:98f5de1dd010 | 236 | { |
thomasstrcic | 3:98f5de1dd010 | 237 | pc.printf("%d \n\r",code[i]); |
thomasstrcic | 3:98f5de1dd010 | 238 | } |
thomasstrcic | 3:98f5de1dd010 | 239 | } |
thomasstrcic | 3:98f5de1dd010 | 240 | |
thomasstrcic | 3:98f5de1dd010 | 241 | /* |
thomasstrcic | 3:98f5de1dd010 | 242 | int bluetooth() |
thomasstrcic | 3:98f5de1dd010 | 243 | { |
thomasstrcic | 3:98f5de1dd010 | 244 | if ( blue.readable()) |
thomasstrcic | 3:98f5de1dd010 | 245 | { |
thomasstrcic | 3:98f5de1dd010 | 246 | chara=blue.getc(); |
thomasstrcic | 3:98f5de1dd010 | 247 | val=chara-'0'; |
thomasstrcic | 3:98f5de1dd010 | 248 | } |
thomasstrcic | 3:98f5de1dd010 | 249 | return val; |
thomasstrcic | 3:98f5de1dd010 | 250 | }*/ |