function y=laurens1(u); global global KPD_laurens FPD_laurens mom_max_bobine cpl_max_roue % ***************************************************************************************** % Ce qu'il faut savoir c'est que le calcul des moments magnétiques et ou( du couple roue ) % se font avec les données mesurées; mais que le couple réel, sera bien sûr calculé % avec le champ réel tel qu'il existe à l'instant t % ***************************************************************************************** % Le vecteur entrée est à 12 composantes: % u(1:3) est le vecteur dérivée pulsée du champ magnétique B' ( B'x B'y B'z ) en axes satellite % u(4:6) est le vecteur champ B pulsé mesuré (Bx By Bz en axes satellite ) % u(7:9) en colonne est le champ magnétique de consigne % u(10:12) en colonne est la dérivée temporelle du champ de consigne ( B'c ) % La fonction retourne les composantes du couple magnétique créé par les bobines % Séparation des vecteurs B_prime(1:3)=u(1:3); % en colonne dérivée pulsée B(1:3)=u(4:6); % en colonne champ magnétique pulsé Bc=u(7:9); % en colonne champ magnétique de consigne, calculé avec le champ mesuré pulsé Bc_prime=u(10:12); % en colonne dérivée du champ de consigne % ******** CALCUL DU COUPLE MAGNETIQUE INITIAL **************** NB=norm(B)^2; M_init=(KPD_laurens*(Bc-B')+FPD_laurens*(Bc_prime-B_prime'))/NB; % ******** CALCUL DU MOMENT MAGNETIQUE FINAL ECONOMIQUE **************** M=M_init-(M_init'*B')*B'/NB; % fORMULE DE LAURENS0.M % ***********CALCUL DES MOMENTS MAGNETIQUES **************** Mxx=M(1); Myy=M(2); Mzz=M(3); % ********** CALCUL DU COUPLE MAGNETIQUE RESULTANT ************* Cx1=Myy*B(3)-Mzz*B(2); Cy1=Mzz*B(1)-Mxx*B(3); Cz1=Mxx*B(2)-Myy*B(1); % Sortie du couple magnétique en colonne y=[Cx1 Cy1 Cz1]'; end % **** Fin programme ****