Antonin,
A ce stade, il n'ay a pas de bonne ou de mauvaise formule, il faut faire des essais.
La philosophie de ces formules est de faire varier la sortie de -1 à 1 (ou -100% à 100%) lorsque l'accélération varie de -AccelerationMax à +AccelerationMax.
Il suffit ensuite de multiplier par AngleMoteurMax pour obtenir la consigne des moteurs allant de -AngleMoteurMax à +AngleMoteurMax.
Acceleration : -AccelerationMax .... 0 .... +AccelerationMax
angle de calcul : -PI/2 .... 0 .... +PI/2 (PI/2 = 90°)
sinus : -1 .... 0 .... +1
% : -100% .... 0 .... +100%
AngleMoteur : -AngleMoteurMax .... 0 .... +AngleMoteurMax
La formule complète pour une sinusoïde qui tiendrait compte des deux accélérations devrait ressembler à :
AngleMoteurRoulis = AngleMoteurRoulisMax * { k1*sin(PI/2*ax3/ax3Max) + (1-k1)*sin(PI/2*ap3/ap3Max) }
AngleMoteurTangage = AngleMoteurTangageMax * { k3*sin(PI/2*az3/az3Max) + (1-k3)*sin(PI/2*aq3/aq3Max) }
Dominique
A ce stade, il n'ay a pas de bonne ou de mauvaise formule, il faut faire des essais.
La philosophie de ces formules est de faire varier la sortie de -1 à 1 (ou -100% à 100%) lorsque l'accélération varie de -AccelerationMax à +AccelerationMax.
Il suffit ensuite de multiplier par AngleMoteurMax pour obtenir la consigne des moteurs allant de -AngleMoteurMax à +AngleMoteurMax.
Acceleration : -AccelerationMax .... 0 .... +AccelerationMax
angle de calcul : -PI/2 .... 0 .... +PI/2 (PI/2 = 90°)
sinus : -1 .... 0 .... +1
% : -100% .... 0 .... +100%
AngleMoteur : -AngleMoteurMax .... 0 .... +AngleMoteurMax
La formule complète pour une sinusoïde qui tiendrait compte des deux accélérations devrait ressembler à :
AngleMoteurRoulis = AngleMoteurRoulisMax * { k1*sin(PI/2*ax3/ax3Max) + (1-k1)*sin(PI/2*ap3/ap3Max) }
AngleMoteurTangage = AngleMoteurTangageMax * { k3*sin(PI/2*az3/az3Max) + (1-k3)*sin(PI/2*aq3/aq3Max) }
Dominique
Commentaire