euler angles, method of direction cosines and quaternions for alpha = 30,45,60 deg

2 visualizaciones (últimos 30 días)
clc;
alpha = 45
omega = 30
lam = 0.0001
p = omega*cos(alpha)
q = 0
r = omega*sin(alpha)
%%integration equations from pg 356
%%method of direction cosines
c11=1
c12=0
c13=0
c21=0
c22=1
c23=0
c31=0;
c32=0
c33=1
cd11=c12*r-c13*q
cd12=c12*p-c11*r
cd13=c11*q-c12*p
cd21=c22*r-c23*q
cd22=c23*q-c21*r
cd23=c12*q-c22*p
cd31=c32*r-c33*q
cd32=c33*p-c13*r
cd33=c31*q-c32*p
theta = asind(-c31)
phi = acosd((c33/sqrt(1-(c31^2)))*c32)
psi = acosd((c11/sqrt(1-(c31^2)))*c21)
%%Euler angles
phid=p+r*tan(theta)*cos(phi);
thetad=-r*sind(phi)
psid=r*sec(theta)*cos(phi)
%%quaternions
e0 = cos(psi/2)*cos(theta/2)*cos(phi/2)+sin(psi/2)*sin(theta/2)*sin(phi/2)
e1 = cos(psi/2)*cos(theta/2)*sin(phi/2)-sin(psi/2)*sin(theta/2)*cos(phi/2)
e2 = cos(psi/2)*sin(theta/2)*cos(phi/2)+sin(psi/2)*cos(theta/2)*sin(phi/2)
e3 = -cos(psi/2)*sin(theta/2)*sin(phi/2)+sin(psi/2)*cos(theta/2)*cos(phi/2)
E= 1-(e0^2+e1^2+e2^2+e3^2)
ed0=(-1/2)*(e1*p+e2*q+e3*r)+lam*E*e0
ed1=(1/2)*(e0*p+e2*r-e3*q)+lam*E*e1
ed2=(1/2)*(e0*q+e3*p-e1*r)+lam*E*e2
ed3=(1/2)*(e0*r+e1*q-e2*p)+lam*E*e3

Respuestas (1)

James Tursa
James Tursa el 29 de Mayo de 2015
Editada: James Tursa el 29 de Mayo de 2015
What is your question? If you want to check conversions between quaternions, direction cosine matrices, and Euler angles, I would suggest this FEX submission by John Fuller:
Also, review this tutorial:
  1 comentario
srina nair
srina nair el 29 de Mayo de 2015
I am unable to get the graph. i want to know how to perform ode45 to integrate phid in the above coding

Iniciar sesión para comentar.

Community Treasure Hunt

Find the treasures in MATLAB Central and discover how the community can help you!

Start Hunting!

Translated by