[637] | 1 | #include "diabolo.h"
|
---|
| 2 | #include "foyer.h"
|
---|
| 3 |
|
---|
| 4 |
|
---|
| 5 | void fit_foyer(void);
|
---|
| 6 |
|
---|
| 7 |
|
---|
| 8 |
|
---|
| 9 | #define indicemax 500
|
---|
| 10 |
|
---|
| 11 | static int bolo,indice;
|
---|
| 12 |
|
---|
| 13 | static double carte[nb_max_bolo][6]; // pour sommer chaque subscan
|
---|
| 14 |
|
---|
| 15 |
|
---|
| 16 |
|
---|
| 17 | //-------------------- fonction exec de la fenetre : foyer -------------------------------
|
---|
| 18 |
|
---|
| 19 |
|
---|
| 20 | void exec_foyer(int fen,int item,double valeur,...)
|
---|
| 21 | {
|
---|
| 22 |
|
---|
| 23 | switch(item)
|
---|
| 24 | {
|
---|
| 25 | case ouverture : gg->trace_ouvert=gg->trace_ouvert | 16 ;
|
---|
| 26 | selectgra(fen);
|
---|
| 27 |
|
---|
| 28 | graph->taille_graduations=7;
|
---|
| 29 | indice=0;
|
---|
| 30 | bolo=litD(fen,foy_bolo,0);
|
---|
| 31 | break;
|
---|
| 32 |
|
---|
| 33 |
|
---|
| 34 |
|
---|
| 35 |
|
---|
| 36 |
|
---|
| 37 | case fermeture : gg->trace_ouvert=gg->trace_ouvert & (255-16); // enleve le 16
|
---|
| 38 | break;
|
---|
| 39 |
|
---|
| 40 | case foy_pas :
|
---|
| 41 | case foy_bolo : bolo=litD(fen,foy_bolo,0);
|
---|
| 42 | fit_foyer();
|
---|
| 43 | break;
|
---|
| 44 | default : break;
|
---|
| 45 | }
|
---|
| 46 | }
|
---|
| 47 |
|
---|
| 48 |
|
---|
| 49 |
|
---|
| 50 | void trace_foyer(double *y)
|
---|
| 51 | {
|
---|
| 52 | int j;
|
---|
| 53 | // gg->compte_subscan contient le N° de subscan et est negatif entre 2 subscans
|
---|
| 54 |
|
---|
| 55 |
|
---|
| 56 | if( (gg->compte_subscan<1) ou (gg->compte_subscan>6) )
|
---|
| 57 | {
|
---|
| 58 | if(indice>0)
|
---|
| 59 | {
|
---|
| 60 | int s=-gg->compte_subscan;
|
---|
| 61 | if( (s>=1) && (s<=6) )
|
---|
| 62 | {
|
---|
| 63 | for(j=0;j<nb_max_bolo;j++) carte[j][s-1]/=(double)indice;
|
---|
| 64 | printf("-> valeur x[%d]=%g \n",bolo,carte[bolo-1][s-1]);
|
---|
| 65 | }
|
---|
| 66 | }
|
---|
| 67 | if( (indice>0) && (gg->compte_subscan==-6) ) fit_foyer();
|
---|
| 68 | indice=0;
|
---|
| 69 | // printf("ne trace pas un point (entre 2 subscans) \n");
|
---|
| 70 | return;
|
---|
| 71 | }
|
---|
| 72 |
|
---|
| 73 | if(indice==0)
|
---|
| 74 | {
|
---|
| 75 | printf("debut subscan %d ",gg->compte_subscan);
|
---|
| 76 | selectgra(fenetre_annexe);
|
---|
| 77 | graph->couleur_trace=gg->compte_subscan+1;
|
---|
| 78 | style(fenetre_annexe);
|
---|
| 79 | for(j=0;j<nb_max_bolo;j++) carte[j][gg->compte_subscan-1]=0;
|
---|
| 80 | }
|
---|
| 81 |
|
---|
| 82 | printf("%d ",indice);
|
---|
| 83 |
|
---|
| 84 | for(j=0;j<nb_max_bolo;j++) carte[j][gg->compte_subscan-1]+=y[j];
|
---|
| 85 |
|
---|
| 86 | trace(fenetre_annexe,indice,y[bolo-1]);
|
---|
| 87 | if(indice<indicemax) indice++;
|
---|
| 88 | }
|
---|
| 89 |
|
---|
| 90 | #define xcorr(x) (((x)-1)*pas)
|
---|
| 91 |
|
---|
| 92 |
|
---|
| 93 | void fit_foyer(void)
|
---|
| 94 | {
|
---|
| 95 | double a,b,c,y0,y1,y2,xmini,x;
|
---|
| 96 | int i;
|
---|
| 97 | double pas=litD(fenetre_annexe,foy_pas,0);
|
---|
| 98 | char ss[255];
|
---|
| 99 |
|
---|
| 100 | // x=0,1,2
|
---|
| 101 |
|
---|
| 102 | y0=0.5*(carte[bolo-1][0]+carte[bolo-1][5]);
|
---|
| 103 | y1=0.5*(carte[bolo-1][1]+carte[bolo-1][4]);
|
---|
| 104 | y2=0.5*(carte[bolo-1][2]+carte[bolo-1][3]);
|
---|
| 105 | c=y0;
|
---|
| 106 | a=0.5*(c-2*y1+y2);
|
---|
| 107 | b=y1-c-a;
|
---|
| 108 | // cherche le minimum
|
---|
| 109 | xmini=-0.5*b/a;
|
---|
| 110 | xmini=xcorr(xmini);
|
---|
| 111 |
|
---|
| 112 | efface(fenetre_annexe);
|
---|
| 113 | selectgra(fenetre_annexe);
|
---|
| 114 | graph->couleur_trace=rouge;
|
---|
| 115 | graph->couleur_texte=violet;graph->taille_texte=16;
|
---|
| 116 | graph->type_symbole=rondplein;graph->taille_symbole=5;graph->ligne_trace=0;
|
---|
| 117 | style(fenetre_annexe);
|
---|
| 118 |
|
---|
| 119 | for(i=0;i<3;i++) trace(fenetre_annexe,xcorr(i),carte[bolo-1][i]);
|
---|
| 120 | for(i=0;i<3;i++) trace(fenetre_annexe,xcorr(i),carte[bolo-1][5-i]);
|
---|
| 121 |
|
---|
| 122 | graph->type_symbole=rien;graph->ligne_trace=1;
|
---|
| 123 | graph->couleur_trace=bleu;
|
---|
| 124 | style(fenetre_annexe);
|
---|
| 125 |
|
---|
| 126 | for(x=-0.4;x<2.4;x+=0.05) trace(fenetre_annexe,xcorr(x),a*x*x+b*x+c);
|
---|
| 127 |
|
---|
| 128 | autox(fenetre_annexe);autoy(fenetre_annexe);retrace(fenetre_annexe);
|
---|
| 129 |
|
---|
| 130 | place(fenetre_annexe,-0.9,3*a+b+c);
|
---|
| 131 |
|
---|
| 132 | sprintf(ss,"correction %4.1f",xmini);
|
---|
| 133 | texte(fenetre_annexe,0,ss);
|
---|
| 134 |
|
---|
| 135 | }
|
---|
| 136 |
|
---|
| 137 |
|
---|
| 138 |
|
---|