Changeset 639 in Sophya for trunk/Poubelle/archediab.old/archediab.sources/c/trace-DS.c

Timestamp:

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

Author:

ansari

Message:

archediab 25

File:

• trunk/Poubelle/archediab.old/archediab.sources/c/trace-DS.c (modified) (13 diffs)

trunk/Poubelle/archediab.old/archediab.sources/c/trace-DS.c

@@ -5 +5 @@
 #include "trace.h"
 #include "menu.h"
-
+#define max_couleur 10
+
+static int      ds_bolo_coul[2*nb_max_bolo];
 
         
@@ -14 +16 @@
 static  int             raz_parasite=2;
 
+void    montracen_ds(int fen,int n,double x,double *y);
 
 void    exec_trace_DS_suite(int u);
@@ -28 +31 @@
 static int u=-1;
 static flag_err=0;
+int i;
 switch(item)
     {
@@ -46 +50 @@
     case ds_temps_mort  :       
     case ds_temps_mort+1000 :
+                                        
+                                        
+    case ds_bolo_couleur :
+    case ds_bolo_couleur+1 :
+    case ds_bolo_couleur+2 :
+    case ds_bolo_couleur+3 :
+    case ds_bolo_couleur+4 :
+    case ds_bolo_couleur+5 :
+    case ds_bolo_couleur+6 :
+    case ds_bolo_couleur+7 :
+    case ds_bolo_couleur+8 :
+    case ds_bolo_couleur+9 :
+    
+                                for(i=0;i<max_couleur;i+=2)     
+                                        {
+                                        ds_bolo_coul[i]=litD(fen,ds_bolo_couleur+i,0L)-1; // 0=rien : 1=bolo0 // 2=bolo1
+                                        if( (ds_bolo_coul[i]<1) ou (ds_bolo_coul[i]>nb_max_bolo) )   ds_bolo_coul[i]=0;
+                                        if (ds_bolo_coul[i]<=24) ds_bolo_coul[i+1]=ds_bolo_coul[i]+24;
+                                        printf(" i=%d bolo=%d    ",i,ds_bolo_coul[i]);
+                                        }
+                                printf("\n");                               
+ 
                                 calcul_table_DS(synchro_periode);
                                 break;
@@ -99 +125 @@
 void    exec_trace_DS_suite(int u)      // appellé quoiqu'il arrive avec u=0,1,2,.... , npt_DS-1
 {
-static double y[nb_max_bolo+1],y1[nb_max_bolo+1],y2[nb_max_bolo+1],bb[nb_max_bolo+1];
+static double y[2*nb_max_bolo],y1[2*nb_max_bolo],y2[2*nb_max_bolo],bb[2*nb_max_bolo];
 int j;
 static double  phase_mesure[nb_max_bolo],confiance[nb_max_bolo],phase_memoire;
-
+//printf("suite avec u=%d \n");
 switch(choix_DS)
         {
@@ -119 +145 @@
                                 {
                                 phase_mesure[j]=atan2(y1[j],y2[j]);
-                                confiance[j]=log((y1[j]*y1[j]+y2[j]*y2[j])/(bb[j]*bb[j]));
-                                printf(" %d°(%2.1f)  ",degre(phase_mesure[j]),confiance[j]);
+                                confiance[j]=bb[j]*bb[j];
+                                if(confiance[j])        confiance[j]=log((y1[j]*y1[j]+y2[j]*y2[j])/(bb[j]*bb[j]));
                                 }
-                        j=1;    // bolo pur mesurer la phase
-                        phase_memoire=phase_mesure[j];
+                        j=5;    // bolo pur mesurer la phase
+                        phase_memoire=0.95*phase_memoire+0.05*phase_mesure[j];
                         ecritD(fenetre_trace_DS,ds_phase,"%d°",degre(phase_memoire));
-                        printf(": phase memoire=%g  \n",phase_memoire);
+                        printf(" phase=%d°(%2.1f)  \n",degre(phase_mesure[j]),confiance[j]);
+//                      printf(": phase memoire=%g  \n",phase_memoire);
+//                      printf(" trace y1= %g , %g , %g , %g , %g \n",y1[0],y1[1],y1[2],y1[3],y1[4]); 
+                        for(j=0;j<nb_max_bolo;j++)
+                                {
+                                y1[j+nb_max_bolo]=y2[j];
+                                }
+
+/*                              
                         for(j=0;j<nb_max_bolo;j++)
                                 {
                                 y1[j]=sin(phase_memoire)*y1[j]+cos(phase_memoire)*y2[j];
                                 }
-//                      printf(" trace y1= %g , %g , %g , %g , %g \n",y1[0],y1[1],y1[2],y1[3],y1[4]); 
+                        printf(" trace y1= %g , %g , %g , %g , %g \n",y1[0],y1[1],y1[2],y1[3],y1[4]); 
+*/
                         trace_DS(y1,0);
                         for(j=0;j<nb_max_bolo;j++)
@@ -208 +243 @@
 
 // divise par la norme, trace y puis fait un RAZ
-void trace_DS(double *y,int enregistre)         //   y [nb_max_bolo +1 ]
+void trace_DS(double *y,int enregistre)         //   y [2*nb_max_bolo]
 {
 double x;
-static double yraz[nb_max_bolo];
-static double yt[nb_max_bolo+1];
+static double yraz[2*nb_max_bolo];
+static double yt[2*nb_max_bolo];
 int j,k,moy;
-static double yfiltre[nb_max_bolo][10];
+static double yfiltre[2*nb_max_bolo][10];
 static int uf=0;
+static int scan_ds=0;
 x=gg->periode_echantillonage*(double)gg->temps_cntl-gg->temps_origine;
 
@@ -231 +267 @@
 
 
-for(j=0;j<nb_max_bolo;j++)      yt[j]=y[j];
-for(j=0;j<nb_max_bolo;j++)      y[j]=0;
+for(j=0;j<2*nb_max_bolo;j++)    yt[j]=y[j];
+for(j=0;j<2*nb_max_bolo;j++)    y[j]=0;
 
 //printf(" au debut = %g , %g , %g , %g , %g \n",yt[0],yt[1],yt[2],yt[3],yt[4]); 
@@ -239 +275 @@
 
 
-for(j=0;j<nb_max_bolo;j++)
+for(j=0;j<2*nb_max_bolo;j++)
                         {
                         yt[j]/=norme_DS;
@@ -251 +287 @@
 raz_parasite=0;
 selectgra(fenetre_trace_DS);
-yt[nb_max_bolo]=(0.95*graph->ymin+0.05*graph->ymax) + 
-                +  ( (gg->don.sync[sync_subscan]!=0) et (gg->don.sync[sync_scan]!=0) ) * 0.9 * (graph->ymax-graph->ymin);
-//printf(" signal subscan=%g  ",yt[nb_max_bolo]);
-//printf(" avant moyenne= %g , %g , %g , %g , %g \n",yt[0],yt[1],yt[2],yt[3],yt[4]); 
+if(scan_ds != ( (gg->don.sync[sync_subscan]!=0) et (gg->don.sync[sync_scan]!=0) ) )
+        {
+        if(scan_ds)     rectangle(fenetre_trace_DS,x,graph->ymin,x,graph->ymax,rouge);          // trace le segment x1,y1 - x2,y2               
+          else  rectangle(fenetre_trace_DS,x,graph->ymin,x,graph->ymax,bleu);           // trace le segment x1,y1 - x2,y2               
+
+        scan_ds = ( (gg->don.sync[sync_subscan]!=0) et (gg->don.sync[sync_scan]!=0) ) ;
+        }
+
 
 moy=litD(fenetre_trace_DS,ds_moyenne,0L);
@@ -262 +302 @@
         uf++;
         if(uf>=moy) uf=0;
-        for(j=0;j<nb_max_bolo;j++)                                      //  ne moyenne pas le signal de scan 
+        for(j=0;j<2*nb_max_bolo;j++)                                     
                 {
                 for(k=0;k<moy;k++)      yfiltre[j][k]+=yt[j];
@@ -271 +311 @@
 //printf(" montracen yt= %g , %g , %g , %g , %g \n",yt[0],yt[1],yt[2],yt[3],yt[4]); 
 //printf(" avant trace : =%g  \n",yt[nb_max_bolo]);
-montracen(fenetre_trace_DS,nb_max_bolo+1,x,yt);
-
+montracen_ds(fenetre_trace_DS,2*nb_max_bolo,x,yt);
 if(!(graph->scroll_courbe) && litD(fenetre_trace_DS,ds_retour,0L) &&
                  ( (x<graph->xmin) ou (x>graph->xmax) )) 
@@ -415 +454 @@
 }
 
+
+
+void    montracen_ds(int fen,int n,double x,double *y)
+{
+int i,cc;
+double yy[max_couleur];   // 0=rien : 1 2=bolo0 // 3 4 =bolo
+for(i=0;i<max_couleur;i++)
+        {
+        cc=ds_bolo_coul[i];
+        if(cc && (cc<=2*nb_max_bolo) )  yy[i]=y[cc-1];
+                else            yy[i]=0;
+        }
+tracen(fen,max_couleur,x,yy);
+//      printf("0=%g  1=%g  2=%g  \n",yy[0],yy[1],yy[2]);
+}
+