Changeset 649 in Sophya for trunk/Poubelle/archediab.old/archediab.sources/c/acquisition_archeops.c

Timestamp:

Nov 25, 1999, 2:56:34 PM (26 years ago)

Author:

ansari

Message:

archediab 28 vol

File:

• trunk/Poubelle/archediab.old/archediab.sources/c/acquisition_archeops.c (modified) (9 diffs)

trunk/Poubelle/archediab.old/archediab.sources/c/acquisition_archeops.c

@@ -42 +42 @@
                                         // de la lecture du block bolo
 
+block_type_gyro blk_gyro2;      // block memoire pour les gyros qui seront traitées lors
+                                                        // de la lecture du block bolo
+
 
 
@@ -48 +51 @@
 void lit_block_archeops(int err)
 {
-if(verifie_block_printf(blk_tm))        return;
-
-        {
-        def_nom_block
-        static int mon_num_block;
+static char ss[1000];
+def_nom_block
+static int mon_num_block;
+
+if(!fenetre(fenetre_lecture_blocks)) nouveauT(fenetre_lecture_blocks,0,"lecture blocs");
+
+if(verifie_block_printf(blk_tm))        
+                {
+                if((mon_num_block+1)==numero_block(blk_tm))
+                        {
+                        mon_num_block=numero_block(blk_tm);
+                        if(!fenetre(fenetre_lecture_blocks)) nouveauT(fenetre_lecture_blocks,0,"lecture blocs");
+                        ecritT(fenetre_lecture_blocks,fin_f,"%s\n",ss);
+                        sprintf(ss,"%d ->",mon_num_block);
+                        }
+                if(strlen(ss)<500) sprintf(ss+strlen(ss)," **%s ",nom_block[type_block(blk_tm)]);       
+                ecrit_fichier_ARCH(blk_tm);     // ecrit les fichiers en erreur sur le disque     
+                return;
+                }
+
+        {
         if(mon_num_block!=numero_block(blk_tm))
                 {
                 mon_num_block=numero_block(blk_tm);
-                printf("\n%d ->",mon_num_block);
-                }
-        printf(" %s  ",nom_block[type_block(blk_tm)]);  
+                if(!fenetre(fenetre_lecture_blocks)) nouveauT(fenetre_lecture_blocks,0,"lecture blocs");
+                ecritT(fenetre_lecture_blocks,fin_f,"%s\n",ss);
+                sprintf(ss,"%d ->",mon_num_block);
+                }
+        if(strlen(ss)<500) sprintf(ss+strlen(ss)," %s  ",nom_block[type_block(blk_tm)]);        
         }                               
 
@@ -78 +99 @@
         case block_bolo_comprime :      traite_block_bolo_comprime((block_type_bolo_comprime*)blk_tm);  break;  
         
-        case block_sst :                traite_block_sst((block_type_sst*)blk_tm);                      break;
-        case block_sst_comprime  :      traite_block_sst_comprime((block_type_sst_comprime*)blk_tm);    break;
+        case block_sst :                traite_block_sst((block_type_sst*)blk_tm);                      
+                                        traite_block_sst_brut((block_type_sst*)blk_tm);                 break;
+        case block_sst_comprime  :      traite_block_sst_comprime((block_type_sst_comprime*)blk_tm);
+                                        traite_block_sst_comprime_brut((block_type_sst_comprime*)blk_tm);break;
 
         case block_gyro :               traite_block_gyro((block_type_gyro*)blk_tm);                    break;
@@ -86 +109 @@
         case block_synchro_sol :        traite_block_synchro_sol((block_type_synchro_sol*)blk_tm);      break;
         
-        case block_status_flash :       printf("******************status flash recut  ********************* \n");son(133);                      break;
+        case block_status_flash :       printf("****  status flash recut  ****   nblock=%x  - %d *** \n",((block_type_status_flash*)blk_tm)->status.nb_total_blocks,((block_type_status_flash*)blk_tm)->status.nb_total_blocks/256);break;
         
 #ifdef  transmet_data_brute
@@ -115 +138 @@
 void    traite_block_journal(block_type_journal*        blk)
 {
+long mothexa[5];        /* les 5 mots hexa de la telecommande  */
+
 int i,code,blocknum;
 if(!fenetre(fenetre_journal)) nouveauT(fenetre_journal,0,"journal");
@@ -124 +149 @@
         blocknum=numero_block(&blk->jj[i]);
         if(code) break; // code vaut 1 pour vider une page de journal incomplete
-        ecritT(fenetre_journal,fin_f,"block_num= %d   code %d   ==>  %d %d %d %d %d %d %d %d \n",
-                blocknum,code,
-                blk->jj[i].mot[0],blk->jj[i].mot[1],blk->jj[i].mot[2],blk->jj[i].mot[3],
-                blk->jj[i].mot[0],blk->jj[4].mot[5],blk->jj[i].mot[6],blk->jj[i].mot[7]);
-        }
-}
+        mothexa[0]=blk->jj[i].mot[5];   /* 4 bit choix de commande   */
+        mothexa[1]=blk->jj[i].mot[6]>>2;        /* les 4 bits poid fort du code direction */
+        mothexa[2]=((blk->jj[i].mot[6]<<2)&0xc)  + ((blk->jj[i].mot[7]>>6)&0x3);
+        mothexa[3]=(blk->jj[i].mot[7]>>2)&0xf;  
+        mothexa[4]=(blk->jj[i].mot[7]&0x3);
+
+        if(blk->jj[i].mot[0])   
+                {
+                ecritT(fenetre_journal,fin_f,"block_num= %d   code %d   ==>  telecommande_OK : %d %d %d  ->  %x %x %x %x %x \n",
+                blocknum,code,blk->jj[4].mot[5],blk->jj[i].mot[6],blk->jj[i].mot[7]
+                        ,mothexa[0],mothexa[1],mothexa[2],mothexa[3],mothexa[4]);
+                }
+        else
+                {
+                ecritT(fenetre_journal,fin_f,"block_num= %d   code %d   ==>  erreur telecommande : %d %d %d  ->  %x %x %x %x %x \n",
+                blocknum,code,blk->jj[4].mot[5],blk->jj[i].mot[6],blk->jj[i].mot[7]
+                        ,mothexa[0],mothexa[1],mothexa[2],mothexa[3],mothexa[4]);
+                }
+        }
+}
+
+
+
 
 //-----------------------------------------------------------------------------------------     
@@ -176 +218 @@
                 if(c1==13) i=80;
                 }
+        }
+}
+
+
+
+
+
+void    traite_block_gyro_comprime(block_type_gyro_comprime* blk)
+{
+int i;
+block_type_gyro  bk_gyro;
+block_type_gyro* blk2=& bk_gyro;
+if(!fenetre(fenetre_gyroscope)) return;
+//printf("***************   decompress data gyro \n");
+for(i=0;i<3;i++)        decompress_7_2((long *)blk->gyro[i],blk2->gyro[i],nb_per_block*2);
+blk2->code1=blk->code1;
+blk2->code2=blk->code2;
+traite_block_gyro(blk2);
+}
+
+
+void    traite_block_gyro(block_type_gyro* blk)
+{
+int k;
+double  y[15];
+
+int temps_cntl;
+double secondes;
+blk_gyro2 = *blk;
+
+if(!fenetre(fenetre_gyroscope)) return;
+
+for(k=0;k<72;k++)
+        {
+        y[0]=20.*(blk->gyro[0][k]-32768)/32768.;
+        y[1]=20.*(blk->gyro[1][k]-32768)/32768.;
+        y[2]=20.*(blk->gyro[2][k]-32768)/32768.;
+                
+//      printf(" y = %g %g %g %g %g \n",y[0],y[1],y[2],y[3],y[4]);
+        temps_cntl =numero_block(blk)*nb_per_block*2+k;
+        secondes=gg->periode_echantillonage*(double)temps_cntl-gg->temps_origine;
+        tracen(fenetre_gyroscope,3,secondes,y);
+//      printf("secondes=%g\n",secondes);
         }
 }
@@ -306 +391 @@
                 gg->don.don_bolo[j]=0.5*(ancien_don_bolo[j]+s*(((val_DS(j,i)-aa)<<1)/nb_coups));                // copy bolos
                 ancien_don_bolo[j]=s*(((val_DS(j,i)-aa)<<1)/nb_coups);
+//              if( (i==1) && (j==14) ) 
+//                      {
+//                      def_gains
+//                      printf(" brut=%d  ofset=%d  nbcoups=%d gg->don.don_bolo[j]=%d  parametr.bolo[j].bolo_gain=%d  gainampli=%g  micro-volts=%g \n"
+//                              , val_DS(j,i)   ,aa     ,nb_coups    ,(int)gg->don.don_bolo[j]  ,parametr.bolo[j].bolo_gain   ,gain_ampli(gg->reglage.bolo[j])  ,(double)xbolbrut(j));
+//                      }
+//
                 }
 
@@ -313 +405 @@
                 }
         
+        gg->don.gyro[0]=20.*(blk_gyro2.gyro[0][i]-32768)/32768.;
+        gg->don.gyro[1]=20.*(blk_gyro2.gyro[1][i]-32768)/32768.;
+        gg->don.gyro[2]=20.*(blk_gyro2.gyro[2][i]-32768)/32768.;
+                
+
         
 //      gg->don.sync[j]=synchro_DS(j,i);