| [637] | 1 | #include "manip.h" | 
|---|
|  | 2 | #include "choix_acquisition.h" | 
|---|
|  | 3 | #include "archeops.h" | 
|---|
|  | 4 | #include "choix_param.h" | 
|---|
|  | 5 | #include "structure.h" | 
|---|
|  | 6 | #include "tm.h" | 
|---|
|  | 7 | #include "tache.h" | 
|---|
|  | 8 | #include "bolo.h" | 
|---|
|  | 9 | #include "carte_acqui.h" | 
|---|
|  | 10 | #include "carte_pci.h" | 
|---|
|  | 11 |  | 
|---|
|  | 12 |  | 
|---|
|  | 13 |  | 
|---|
|  | 14 |  | 
|---|
|  | 15 |  | 
|---|
|  | 16 |  | 
|---|
|  | 17 |  | 
|---|
|  | 18 | //***************************************************************************************** | 
|---|
|  | 19 | //                                                                                      *** | 
|---|
|  | 20 | #ifdef _diabolo //---------   pour  Diabolo    ------------------------------   *** | 
|---|
|  | 21 | //                                                                                      *** | 
|---|
|  | 22 | //***************************************************************************************** | 
|---|
|  | 23 |  | 
|---|
|  | 24 | //#define test_erreur_complet | 
|---|
|  | 25 |  | 
|---|
|  | 26 |  | 
|---|
|  | 27 |  | 
|---|
|  | 28 | #define avance_erreur  {tt->te.pos_ecrit++; if(tt->te.pos_ecrit>=long_table_err) tt->te.pos_ecrit=0;} | 
|---|
|  | 29 | #define ecrit_erreur(xx)        {avance_erreur;tt->te.err[tt->te.pos_ecrit]=900+(xx);} | 
|---|
|  | 30 |  | 
|---|
|  | 31 |  | 
|---|
|  | 32 | #define SYNCHRO                 fifo0 | 
|---|
|  | 33 | #define EPLD_occupe             fifo12 | 
|---|
|  | 34 | #define top_debut               fifo13 | 
|---|
|  | 35 |  | 
|---|
|  | 36 | #define ADC_BEBO                fifo(10) | 
|---|
|  | 37 | #define DS_BEBO                 fifo(11) | 
|---|
|  | 38 |  | 
|---|
|  | 39 |  | 
|---|
|  | 40 |  | 
|---|
|  | 41 | void    depou_un_bit(tmtc* tt,long RR); | 
|---|
|  | 42 | void    depou_un_mot_24_bit(tmtc* tt); | 
|---|
|  | 43 |  | 
|---|
|  | 44 | void    sauvedata(tmtc* tt,long * somme_ds); | 
|---|
|  | 45 |  | 
|---|
|  | 46 | //   i= position dans la periode     j=numero de bolo    k=numero de detection | 
|---|
|  | 47 |  | 
|---|
|  | 48 |  | 
|---|
|  | 49 | void init_tache(void) | 
|---|
|  | 50 | { | 
|---|
|  | 51 |  | 
|---|
|  | 52 | tt->vi.flag_ecriture_data=0; | 
|---|
|  | 53 |  | 
|---|
|  | 54 | tt->vi.i=0; | 
|---|
|  | 55 | tt->vi.pos_block_tm=0; | 
|---|
|  | 56 |  | 
|---|
|  | 57 |  | 
|---|
|  | 58 | tt->vi.reg.pid.nb_mes=0; | 
|---|
|  | 59 | tt->vi.reg.pid.code=0; | 
|---|
|  | 60 | tt->vi.reg.pid.num_bolo=0; | 
|---|
|  | 61 | tt->vi.reg.pid.nb_mes=0; | 
|---|
|  | 62 | tt->vi.reg.pid.chauf=0; | 
|---|
|  | 63 | tt->vi.reg.pid.p=0; | 
|---|
|  | 64 | tt->vi.reg.pid.i=0; | 
|---|
|  | 65 | tt->vi.reg.pid.d=0; | 
|---|
|  | 66 |  | 
|---|
|  | 67 |  | 
|---|
|  | 68 | tt->vi.reg.compteur=0; | 
|---|
|  | 69 |  | 
|---|
|  | 70 | tt->vi.reg.valeur=0; | 
|---|
|  | 71 | tt->vi.reg.anc_ecart=0; | 
|---|
|  | 72 | tt->vi.reg.tint=0; | 
|---|
|  | 73 | tt->vi.reg.cc=0; | 
|---|
|  | 74 |  | 
|---|
|  | 75 | } | 
|---|
|  | 76 |  | 
|---|
|  | 77 |  | 
|---|
|  | 78 |  | 
|---|
|  | 79 | void lecture_fifo(void* tx)                                     // appellé directement pour acquisition en interuptions | 
|---|
|  | 80 | { | 
|---|
|  | 81 | register unsigned long RR; | 
|---|
|  | 82 | tmtc* tt=(tmtc*)tx; | 
|---|
|  | 83 | long lec_fifo=0; | 
|---|
|  | 84 | int max_fifo; | 
|---|
|  | 85 |  | 
|---|
| [649] | 86 | if(acquisition_PCI)     max_fifo=3000;  //  3000  points maxi par interruption (10ms)  soit (3.3µs) | 
|---|
| [637] | 87 | else           max_fifo=200;   //  ((1000)faux )  points maxi par interruption (10ms)  soit  (20µs) | 
|---|
|  | 88 |  | 
|---|
|  | 89 |  | 
|---|
|  | 90 | while(1) | 
|---|
|  | 91 | { | 
|---|
| [649] | 92 | if(acquisition_PCI)     {lit_carte;     if(rien_a_lire) break;}//  fifo vide  ->  retour  ->  sort du while | 
|---|
| [637] | 93 | lec_fifo++; | 
|---|
|  | 94 | if (EPLD_occupe) tt->vi.flag_ecriture_data=0; | 
|---|
|  | 95 |  | 
|---|
|  | 96 |  | 
|---|
|  | 97 | //----------------------    test des erreurs PCI  a mettre ou a enlever pour aller plus vite   ------------- | 
|---|
|  | 98 | #ifdef test_erreur_complet | 
|---|
|  | 99 | { | 
|---|
|  | 100 | int j; | 
|---|
|  | 101 | /*      j=  (RR>>30) & 3;               // ***** test bonne lecture PCI (seulement carte fife ) ****** | 
|---|
|  | 102 | while (j!=5)    { | 
|---|
|  | 103 | ecrit_erreur(err_lect_pci); | 
|---|
|  | 104 | lit_carte;      if(rien_a_lire)         break; | 
|---|
|  | 105 | j=  (RR>>29) & 7; | 
|---|
|  | 106 | tt->vi.aa=0; | 
|---|
|  | 107 | } | 
|---|
|  | 108 | if(j!=5) break;         // parceque il faut sortir des deux while | 
|---|
|  | 109 | */ | 
|---|
|  | 110 | tt->vi.aa++;        // le aa du test d'erreur n'est pas le meme que le a du compteur de temps | 
|---|
|  | 111 |  | 
|---|
|  | 112 | j=  ((RR>>26) - tt->vi.aa ) & 7;                                // ***** test compteur dans carte PCI ****** | 
|---|
|  | 113 | if(j)   { | 
|---|
|  | 114 | tt->vi.aa= (RR>>26) & 7; | 
|---|
|  | 115 | avance_erreur;tt->te.err[tt->te.pos_ecrit]=j; | 
|---|
|  | 116 | ecrit_erreur(err_lect_pci); | 
|---|
|  | 117 | } | 
|---|
|  | 118 |  | 
|---|
|  | 119 | //      j= ((RR>>15) -  tt->vi.a ) & 7 ;                                // ****** test compteur dans controleur ******* | 
|---|
|  | 120 | //      if(j)           { | 
|---|
|  | 121 | //                      avance_erreur;tt->te.err[tt->te.pos_ecrit]=j; | 
|---|
|  | 122 | //                      ecrit_erreur(err_lect_ctrl); | 
|---|
|  | 123 | //                      } | 
|---|
|  | 124 | }                                       // autre erreur de synchro fifo | 
|---|
|  | 125 | #endif | 
|---|
|  | 126 | //_____________________   fin du test des erreurs facultatif    _____________________________________________ | 
|---|
|  | 127 |  | 
|---|
|  | 128 |  | 
|---|
|  | 129 | //      if(parametr.presence_bebo && (tt->vi.a==5) &&   ADC_BEBO )      ecrit_erreur(err_sync_bebo);                            // erreur synchro de la BEBO | 
|---|
|  | 130 |  | 
|---|
|  | 131 | depou_un_bit(tt,RR); | 
|---|
|  | 132 |  | 
|---|
|  | 133 | tt->vi.a++; | 
|---|
|  | 134 |  | 
|---|
|  | 135 | //  --------------------   avance les compteurs  a (position dans le mot de 24 bits)  et i (position dans la periode) | 
|---|
|  | 136 | if      (tt->vi.a>(bitmot-1)) | 
|---|
|  | 137 | { | 
|---|
|  | 138 | tt->vi.a=0;tt->vi.i++; | 
|---|
|  | 139 | if(tt->vi.i>(tt->reglage.horloge.nb_mesures-1))   tt->vi.i=0;                   // normal : fin de periode complete | 
|---|
|  | 140 | if(SYNCHRO)                     ecrit_erreur(err_sync_repart);                                  // erreur synchro du repartiteur | 
|---|
|  | 141 | if( RR&FLAG_FIFO_FULL )         {ecrit_erreur(err_fifo_pleine);read_flags();reset_fifo();}      // la fifo a débordée | 
|---|
|  | 142 | if(lec_fifo > tt->nb_lec_fofo_int)  tt->nb_lec_fofo_int=lec_fifo; | 
|---|
| [649] | 143 | if(!tt->val_con_fifo)   {tt->val_con_fifo=tt->nb_lec_fofo_int;tt->nb_lec_fofo_int=0;} | 
|---|
| [637] | 144 | if(lec_fifo>max_fifo) | 
|---|
|  | 145 | { | 
|---|
|  | 146 | if(!(RR&FLAG_NFIFOHF))  tt->nb_lec_fofo_int=2*max_fifo; // fifo plus qu'à moitié pleine | 
|---|
|  | 147 | break; | 
|---|
|  | 148 | } | 
|---|
|  | 149 | } | 
|---|
|  | 150 | //     -------------------      test    topdebut en même temps que le dernier bit du mot    -------------- | 
|---|
|  | 151 | //    si pas de top debut: les compteurs tournent normalement et pas de diagnostique d'erreur | 
|---|
|  | 152 | if(top_debut && ( tt->vi.a ou tt->vi.i) ) | 
|---|
|  | 153 | { | 
|---|
|  | 154 | ecrit_erreur(err_sync_ctrl);            // erreur synchro controlleur-mac | 
|---|
|  | 155 | tt->vi.a=0;tt->vi.i=0; | 
|---|
|  | 156 | } | 
|---|
|  | 157 |  | 
|---|
|  | 158 | } | 
|---|
|  | 159 | } | 
|---|
|  | 160 |  | 
|---|
|  | 161 |  | 
|---|
|  | 162 | //_________________________________________________________________________________________________________________ | 
|---|
|  | 163 |  | 
|---|
|  | 164 |  | 
|---|
|  | 165 |  | 
|---|
|  | 166 |  | 
|---|
|  | 167 | void depou_un_bit(tmtc* tt,long RR) | 
|---|
|  | 168 | { | 
|---|
|  | 169 | int j,n,t,s; | 
|---|
|  | 170 | n=tt->reglage.horloge.nb_mesures; | 
|---|
|  | 171 |  | 
|---|
|  | 172 |  | 
|---|
|  | 173 |  | 
|---|
|  | 174 | //___________________            calcul detection synchrone et remplissage table courante | 
|---|
|  | 175 |  | 
|---|
|  | 176 | if(tt->vi.a ==0) | 
|---|
|  | 177 | { | 
|---|
|  | 178 | depou_un_mot_24_bit(tt);        //  appel du programme qui somme les points pour calcul de la D.S. | 
|---|
|  | 179 | //  c'est aussi le programme qui rempli la table pour affichage d'une periode | 
|---|
|  | 180 | } | 
|---|
|  | 181 |  | 
|---|
|  | 182 | //___________________    B.E.B.O.        Lecture de numbol : numero du bolo de la bebo a lire | 
|---|
|  | 183 | if(tt->vi.a==2)         tt->vi.numbol=0; | 
|---|
|  | 184 |  | 
|---|
|  | 185 | if( (tt->vi.a>=2) && (tt->vi.a<=4) )    tt->vi.numbol= tt->vi.numbol | (  ADC_BEBO  << (4-tt->vi.a))  ;         // a==2, 3 et 4  ->  numero du bolo en cours de mesure | 
|---|
|  | 186 |  | 
|---|
|  | 187 |  | 
|---|
|  | 188 | for(j=0;j<nb_max_bolo;j++) | 
|---|
|  | 189 | { | 
|---|
|  | 190 | t=parametr.bolo[j].bolo_bebo; | 
|---|
|  | 191 | switch(t) | 
|---|
|  | 192 | { | 
|---|
|  | 193 | case 0  :                       //   lecture  MLPA  direct sur fifo numero t | 
|---|
|  | 194 | if  (tt->vi.a==2)       tt->vi.mot[j]=tt->vi.mot[j] | ( fifo(parametr.bolo[j].bolo_num) << 12 );                        //  a=2 : bit de phase  (ecrit pour a=0 : 2 temps de retard) | 
|---|
|  | 195 | if( (tt->vi.a>=4) && (tt->vi.a<=15) )  tt->vi.mot[j]=tt->vi.mot[j] | ( fifo(parametr.bolo[j].bolo_num)  << (15-tt->vi.a)); | 
|---|
|  | 196 | break; | 
|---|
|  | 197 |  | 
|---|
|  | 198 | case 2  :                                       // lecture beboA  :  bolo 17 à 22 | 
|---|
|  | 199 |  | 
|---|
|  | 200 | t=parametr.bolo[j].bolo_num; | 
|---|
|  | 201 | if( !t ou ( t == tt->vi.numbol ) ) | 
|---|
|  | 202 | { | 
|---|
|  | 203 | if(tt->vi.a==6)         tt->vi.mot[j]=tt->vi.mot[j] | ( ADC_BEBO  << 12 );      // a=6 : bit de phase | 
|---|
|  | 204 | if( (tt->vi.a>6) && (tt->vi.a<=18) )                                                                                                                            // a==7 ->  poid fort de l'ADC | 
|---|
|  | 205 | tt->vi.mot[j]=tt->vi.mot[j] | ( ADC_BEBO  << (18-tt->vi.a));  // données de chaque bolo individuels de la bebo | 
|---|
|  | 206 | } | 
|---|
|  | 207 | if(  ( t == (7-tt->vi.i) )  &&  (tt->vi.a>0) && (tt->vi.a<=22) )        // a==1 ->  premier bit de poid fort   --   22 bits en tout | 
|---|
|  | 208 | tt->ds.sommeA[j]=tt->ds.sommeA[j] | ( DS_BEBO  << (22-tt->vi.a));       // valeur DS de chaque bolo individuels de la bebo | 
|---|
|  | 209 | if(  ( t == (7 + n/2 -tt->vi.i) )  &&  (tt->vi.a>0) && (tt->vi.a<=22) )         // a==1 ->  premier bit de poid fort   --   22 bits en tout | 
|---|
|  | 210 | tt->ds.sommeB[j]=tt->ds.sommeB[j] | ( DS_BEBO  << (22-tt->vi.a));       // valeur DS de chaque bolo individuels de la bebo | 
|---|
|  | 211 |  | 
|---|
|  | 212 | break; | 
|---|
|  | 213 | default :       break; | 
|---|
|  | 214 | } | 
|---|
|  | 215 | } | 
|---|
|  | 216 | // ------------------- calcul des signaux de synchro (sur chaque bit de chaque mot) ------------------ | 
|---|
|  | 217 |  | 
|---|
|  | 218 | s=tt->vi.a-5; | 
|---|
|  | 219 | if( (s>=0) && (s<nb_sync) && !SYNCHRO ) tt->vi.synchro[s]++; | 
|---|
|  | 220 |  | 
|---|
|  | 221 | if(tt->PCI_actif==2) | 
|---|
|  | 222 | //if(tt->vi.a ==0) | 
|---|
|  | 223 | { | 
|---|
|  | 224 | if(((tt->vi.temps_cntl>>19)&1))         tt->vi.synchro[0]=10;else tt->vi.synchro[0]=0; | 
|---|
|  | 225 | if(((tt->vi.temps_cntl>>25)&1))         tt->vi.synchro[1]=20;else tt->vi.synchro[1]=0;  // scan | 
|---|
|  | 226 | if(((tt->vi.temps_cntl>>21)&1))         tt->vi.synchro[2]=30;else tt->vi.synchro[2]=0;  // subscan | 
|---|
|  | 227 | if(((tt->vi.temps_cntl>>22)&1))         tt->vi.synchro[3]=40;else tt->vi.synchro[3]=0; | 
|---|
|  | 228 | } | 
|---|
|  | 229 |  | 
|---|
|  | 230 | } | 
|---|
|  | 231 |  | 
|---|
|  | 232 |  | 
|---|
|  | 233 |  | 
|---|
|  | 234 |  | 
|---|
|  | 235 |  | 
|---|
|  | 236 | void    depou_un_mot_24_bit(tmtc* tt) | 
|---|
|  | 237 | { | 
|---|
|  | 238 | // -----------------   traitement d'une valeur ADC lue (typique 10 kHz)  -------------------------------- | 
|---|
|  | 239 | //------------------   appellé pour  tt->vi.a==0  avant lecture du bit correspondant   -------------- | 
|---|
|  | 240 | register long R1; | 
|---|
|  | 241 | int j,n,p; | 
|---|
|  | 242 | n=tt->reglage.horloge.nb_mesures; | 
|---|
|  | 243 |  | 
|---|
|  | 244 |  | 
|---|
|  | 245 | if(tt->PCI_actif==2) | 
|---|
|  | 246 | for(j=0;j<nb_max_bolo;j++) | 
|---|
|  | 247 | { | 
|---|
|  | 248 | int q; | 
|---|
|  | 249 | q=tt->vi.i-1;if(q<0) q=n-1;  // parceque tt->vi.i vaut 0 pour le dernier point | 
|---|
|  | 250 | //                      tt->vi.mot[j]=  0x800 - (q-(n/2)) * (((double)j+10.) * 0.1 * (double)((tt->vi.temps_cntl>>15)&0x1f)) ;  //  sans carte : mot fini sans erreur | 
|---|
|  | 251 | tt->vi.mot[j]=  0x800 - (q-(n/2)) * (int)(5.*((double)j+5.) * cos(0.01*(double)(tt->vi.temps_cntl>>8))) ;       //  sans carte : mot fini sans erreur | 
|---|
|  | 252 | tt->vi.mot[j]+= ((int)(random(0)*256.)&0xff) ;          //  bruit aléatoire 8 bits | 
|---|
|  | 253 | //                      tt->vi.mot[j]=  0x800 + ((int)(random(0)*3.)&0x3f) ;            //  bruit aléatoire 3 bits | 
|---|
|  | 254 | if(q>=n/2)      tt->vi.mot[j]+=0x1000;                  // phase | 
|---|
|  | 255 | } | 
|---|
|  | 256 |  | 
|---|
|  | 257 |  | 
|---|
|  | 258 |  | 
|---|
|  | 259 | for(j=0;j<nb_max_bolo;j++) | 
|---|
|  | 260 | { | 
|---|
|  | 261 | // --------------- pour   MLPA ou  BEBO voie zero: je calcule la detection synchrone par soft: ------------ | 
|---|
|  | 262 | if ( ( !parametr.bolo[j].bolo_bebo ) ou ( !parametr.bolo[j].bolo_num ) ) | 
|---|
|  | 263 | { | 
|---|
|  | 264 | if( (  (tt->ds.ii[j]>n/2) &&  (!(tt->vi.mot[j]&0x1000)) ) ou (tt->ds.ii[j]>n) ) | 
|---|
|  | 265 | tt->ds.ii[j]=0;         // calage de la phase sur la phase mesurée | 
|---|
|  | 266 |  | 
|---|
|  | 267 | R1=( tt->vi.mot[j]&0xfff ) * ( tt->ds.dstable[tt->ds.ii[j]] );  // calcul de la D.S. | 
|---|
|  | 268 | tt->ds.sommeA[j]+=R1;   tt->ds.sommeB[j]+=R1;                                   // somme dans les deux tables | 
|---|
|  | 269 | tt->ds.ii[j]++;                         //  avance la phase propre de chaque bolometre  ii avance de 0 à n-1 | 
|---|
|  | 270 | } | 
|---|
|  | 271 |  | 
|---|
|  | 272 |  | 
|---|
|  | 273 |  | 
|---|
|  | 274 | //---------------------------   remplissage table affichage une periode dans block tm  -------------------- | 
|---|
|  | 275 |  | 
|---|
|  | 276 | p=tt->vi.i-1;if ( p<0)  p=n-1; | 
|---|
|  | 277 | if( ( !parametr.bolo[j].bolo_bebo ) ou ( !parametr.bolo[j].bolo_num ) ou ( parametr.bolo[j].bolo_num==tt->vi.numbol) ) | 
|---|
|  | 278 | { | 
|---|
|  | 279 | tt->tm.btm[tt->tm.pos_ecrit].bol_per[j][p]=tt->vi.mot[j]<<3;            // je lit le dernier point pour i=0,  que j'ecrit en p=n-1 | 
|---|
|  | 280 | tt->tm.btm[tt->tm.pos_ecrit].flag_bolo[j]=1; | 
|---|
|  | 281 | } | 
|---|
|  | 282 | //---------------------------   reset du mot avant mesure point suivant  -------------------- | 
|---|
|  | 283 |  | 
|---|
|  | 284 | tt->vi.mot[j]=0; | 
|---|
|  | 285 |  | 
|---|
|  | 286 | //---------------------------  pour BEBO : somme et changement de signe pour calcul D.S.  -------------------- | 
|---|
|  | 287 |  | 
|---|
|  | 288 | if( (tt->vi.i==0) &&  parametr.bolo[j].bolo_bebo  && parametr.bolo[j].bolo_num  ) | 
|---|
|  | 289 | {       tt->ds.sommeB[j] = -tt->ds.sommeB[j];tt->ds.sommeA[j] += tt->ds.sommeB[j];} | 
|---|
|  | 290 |  | 
|---|
|  | 291 | if( (tt->vi.i==(n/2))  &&  parametr.bolo[j].bolo_bebo  && parametr.bolo[j].bolo_num  ) | 
|---|
|  | 292 | tt->ds.sommeB[j] += tt->ds.sommeA[j]; | 
|---|
|  | 293 | } | 
|---|
|  | 294 |  | 
|---|
|  | 295 |  | 
|---|
|  | 296 | if(tt->vi.i==0)                 sauvedata(tt,tt->ds.sommeA);                    // apres lecture et sommation du dernier point | 
|---|
|  | 297 | if(tt->vi.i==(n/2))             sauvedata(tt,tt->ds.sommeB); | 
|---|
|  | 298 | } | 
|---|
|  | 299 |  | 
|---|
|  | 300 |  | 
|---|
|  | 301 | void sauvedata(tmtc* tt,long * somme_ds) | 
|---|
|  | 302 | { | 
|---|
|  | 303 | int j,u; | 
|---|
|  | 304 |  | 
|---|
|  | 305 | tt->vi.temps_cntl ++; | 
|---|
|  | 306 |  | 
|---|
|  | 307 |  | 
|---|
|  | 308 | //------------------  ecrit table telemesure  tm | 
|---|
|  | 309 | u=tt->tm.pos_ecrit; | 
|---|
|  | 310 |  | 
|---|
|  | 311 |  | 
|---|
|  | 312 | tt->tm.btm[u].temps_cntl[tt->vi.pos_block_tm]=tt->vi.temps_cntl; | 
|---|
|  | 313 | GetDateTime(&tt->tm.btm[u].temps_mac[tt->vi.pos_block_tm]); | 
|---|
|  | 314 |  | 
|---|
|  | 315 | tt->tm.btm[u].chauf_regul=tt->vi.reg.cc; | 
|---|
|  | 316 |  | 
|---|
|  | 317 |  | 
|---|
|  | 318 | for(j=0;j<nb_max_bolo;j++) | 
|---|
|  | 319 | { | 
|---|
|  | 320 | if( (!parametr.bolo[j].bolo_bebo) ou !parametr.bolo[j].bolo_num ) | 
|---|
|  | 321 | {                                               //  pour une MLPA  ou voie 0 d'une BEBO | 
|---|
|  | 322 | tt->tm.btm[u].don[tt->vi.pos_block_tm].don_bolo[j] = (somme_ds[j]<<4) / (long)tt->ds.dsnorme; | 
|---|
|  | 323 | } | 
|---|
|  | 324 | else | 
|---|
|  | 325 | {                                               //  pour une BEBO | 
|---|
|  | 326 | //   données dans tt->tb.x -> +-22 bits  au maxi pour dsnorme= 128 ( nb total de points / periode ) | 
|---|
|  | 327 | // apres division (128=7bits),  reste +-15 bit soit un entier short signé | 
|---|
|  | 328 | tt->tm.btm[u].don[tt->vi.pos_block_tm].don_bolo[j] = somme_ds[j]  / (long)tt->ds.dsnorme; | 
|---|
|  | 329 | } | 
|---|
|  | 330 | } | 
|---|
|  | 331 |  | 
|---|
|  | 332 | for(j=0;j<nb_sync;j++)                  tt->tm.btm[u].don[tt->vi.pos_block_tm].sync[j]=tt->vi.synchro[j]; | 
|---|
|  | 333 |  | 
|---|
|  | 334 | tt->signal_scan_immediat=tt->vi.synchro[sync_scan]; | 
|---|
|  | 335 | tt->vi.pos_block_tm++; | 
|---|
|  | 336 |  | 
|---|
|  | 337 | if(tt->vi.pos_block_tm>=nb_per_block*2)         // a la fin d'un block de telemesure | 
|---|
|  | 338 | { | 
|---|
|  | 339 | tt->tm.btm[u].reglage=tt->reglage;                                              //  copie l'etat bolo courant | 
|---|
|  | 340 |  | 
|---|
|  | 341 | tt->vi.pos_block_tm=0; | 
|---|
|  | 342 |  | 
|---|
|  | 343 |  | 
|---|
|  | 344 |  | 
|---|
|  | 345 | u++; if(u>=longueur_table_tm) u=0; | 
|---|
|  | 346 | tt->tm.pos_ecrit=u; | 
|---|
|  | 347 |  | 
|---|
|  | 348 | if(tt->tm.pos_ecrit==tt->tm.pos_lit)  ecrit_erreur(err_pile_pleine); | 
|---|
|  | 349 |  | 
|---|
|  | 350 | } | 
|---|
|  | 351 | //------------------   fin ecriture table telemesure  tm | 
|---|
|  | 352 |  | 
|---|
|  | 353 |  | 
|---|
|  | 354 | tt->vi.reg.valeur+=somme_ds[tt->vi.reg.pid.num_bolo-1]; // integration de la valeur pour la regul | 
|---|
|  | 355 |  | 
|---|
|  | 356 |  | 
|---|
|  | 357 | for(j=0;j<nb_max_bolo;j++)      somme_ds[j]=0;          //      raz table données pour la suite | 
|---|
|  | 358 | for(j=0;j<nb_sync;j++)          tt->vi.synchro[j]=0;    // raz table des synchro pour la suite | 
|---|
|  | 359 | for(j=0;j<nb_max_bolo;j++)      tt->tm.btm[u].flag_bolo[j]=0; | 
|---|
|  | 360 |  | 
|---|
|  | 361 |  | 
|---|
|  | 362 |  | 
|---|
|  | 363 | raz_periodique(tt); | 
|---|
|  | 364 | regul(tt); | 
|---|
|  | 365 | decode_telecommande(tt); | 
|---|
|  | 366 |  | 
|---|
|  | 367 | tt->vi.flag_ecriture_data++;            // bon pour envoi | 
|---|
|  | 368 | } | 
|---|
|  | 369 |  | 
|---|
|  | 370 |  | 
|---|
|  | 371 | //***************************************************************************************** | 
|---|
|  | 372 | //                                                                                      *** | 
|---|
|  | 373 | #endif          //--------------------------------------------------------------------  *** | 
|---|
|  | 374 | //                                                                                      *** | 
|---|
|  | 375 | //***************************************************************************************** | 
|---|
|  | 376 |  | 
|---|