93 double regle (Tenseur& shift_auto,
const Tenseur& shift_comp,
double omega,
double omega_local) {
95 Tenseur shift_old (shift_auto) ;
97 double orientation = shift_auto.get_mp()->get_rot_phi() ;
98 assert ((orientation==0) || (orientation == M_PI)) ;
99 double orientation_autre = shift_comp.get_mp()->get_rot_phi() ;
100 assert ((orientation_autre==0) || (orientation_autre == M_PI)) ;
102 int alignes = (orientation == orientation_autre) ? 1 : -1 ;
105 if (*shift_comp.get_triad() == *shift_auto.get_triad())
108 int nz = shift_auto.get_mp()->get_mg()->get_nzone() ;
109 int np = shift_auto.get_mp()->get_mg()->get_np(1) ;
110 int nt = shift_auto.get_mp()->get_mg()->get_nt(1) ;
111 int nr = shift_auto.get_mp()->get_mg()->get_nr(1) ;
114 Tenseur shift_tot (*shift_auto.get_mp(), 1, CON, *shift_auto.get_triad()) ;
115 shift_tot.set_etat_qcq() ;
116 shift_tot.set(0).import_asymy (alignes*shift_comp(0)) ;
117 shift_tot.set(1).import_symy (alignes*shift_comp(1)) ;
118 shift_tot.set(2).import_asymy (shift_comp(2)) ;
120 shift_tot = shift_tot + shift_auto ;
122 double indic = (orientation == 0) ? 1 : -1 ;
124 Mtbl xa_mtbl (shift_tot.get_mp()->get_mg()) ;
125 xa_mtbl = shift_tot.get_mp()->xa ;
126 Mtbl ya_mtbl (shift_tot.get_mp()->get_mg()) ;
127 ya_mtbl = shift_tot.get_mp()->ya ;
129 Tenseur tbi (shift_tot) ;
131 for (
int i=0 ; i<3 ; i++) {
132 tbi.set(i).va.coef_i() ;
133 tbi.set(i).va.set_etat_c_qcq() ;
136 tbi.set(0) = *shift_tot(0).va.c - indic *omega * ya_mtbl(0,0,0,0) - indic*omega_local* shift_tot.get_mp()->y ;
137 tbi.set(1) = *shift_tot(1).va.c + indic *omega * xa_mtbl(0,0,0,0) + indic*omega_local* shift_tot.get_mp()->x ;
139 tbi.set(0).annule(nz-1) ;
140 tbi.set(1).annule(nz-1) ;
143 Tenseur derive_r (*shift_auto.get_mp(), 1, CON, *shift_auto.get_triad()) ;
144 derive_r.set_etat_qcq() ;
145 for (
int i=0 ; i<3 ; i++) {
146 if (tbi(i).get_etat() != ETATZERO)
147 derive_r.set(i) = tbi(i).dsdr() ;
149 derive_r.set(i).set_etat_zero() ;
154 Valeur val_hor (shift_auto.get_mp()->get_mg()) ;
155 Valeur fonction_radiale (shift_auto.get_mp()->get_mg()) ;
156 Cmp enleve (shift_auto.get_mp()) ;
159 for (
int comp=0 ; comp<3 ; comp++)
161 val_hor.annule_hard() ;
162 for (
int k=0 ; k<np ; k++)
163 for (
int j=0 ; j<nt ; j++)
164 for (
int i=0 ; i<nr ; i++)
165 val_hor.set(1, k, j, i) = derive_r(comp) (1, k, j, 0) ;
167 double r_0 = shift_auto.get_mp()->val_r (1, -1, 0, 0) ;
168 double r_1 = shift_auto.get_mp()->val_r (1, 1, 0, 0) ;
170 fonction_radiale =
pow(r_1-shift_auto.get_mp()->r, 3.)*
171 (shift_auto.get_mp()->r-r_0)/
pow(r_1-r_0, 3.) ;
172 fonction_radiale.
annule(0) ;
173 fonction_radiale.annule(2, nz-1) ;
175 enleve = fonction_radiale * val_hor ;
176 enleve.va.base = shift_auto(comp).va.base ;
178 if (
norme(enleve)(1) != 0)
179 shift_auto.set(comp) = shift_auto(comp) - enleve ;
180 if (
norme(shift_auto(comp))(1) > 1e-5) {
181 Tbl diff (
diffrelmax (shift_auto(comp), shift_old(comp))) ;
182 if (erreur < diff(1))
void annule(int l)
Sets the Cmp to zero in a given domain.
Tbl norme(const Cmp &)
Sums of the absolute values of all the values of the Cmp in each domain.
Cmp pow(const Cmp &, int)
Power .
Tbl diffrelmax(const Cmp &a, const Cmp &b)
Relative difference between two Cmp (max version).