void FGAuxiliary::UpdateWindMatrices(void)
{
double ca, cb, sa, sb;
ca = cos(alpha);
sa = sin(alpha);
cb = cos(beta);
sb = sin(beta);
mTw2b(1,1) = ca*cb;
mTw2b(1,2) = -ca*sb;
mTw2b(1,3) = -sa;
mTw2b(2,1) = sb;
mTw2b(2,2) = cb;
mTw2b(2,3) = 0.0;
mTw2b(3,1) = sa*cb;
mTw2b(3,2) = -sa*sb;
mTw2b(3,3) = ca;
mTb2w = mTw2b.Transposed();
}
void FGAuxiliary::UpdateWindMatrices(void)
{
double ca, cb, sa, sb;
ca = cos(alpha);
sa = sin(alpha);
cb = cos(beta);
sb = sin(beta);
mTw2b(1,1) = ca*cb;
mTw2b(1,2) = -ca*sb;
mTw2b(1,3) = -sa;
mTw2b(2,1) = sb;
mTw2b(2,2) = cb;
mTw2b(2,3) = 0.0;
mTw2b(3,1) = sa*cb;
mTw2b(3,2) = -sa*sb;
mTw2b(3,3) = ca;
mTb2w = mTw2b.Transposed();
// The pitot frame is the same as the body frame except rotated about the
// Y axis by the pitot attachment angle.
ca = cos(alpha + in.PitotAngle);
sa = sin(alpha + in.PitotAngle);
mTw2p(1,1) = ca*cb;
mTw2p(1,2) = -ca*sb;
mTw2p(1,3) = -sa;
mTw2p(2,1) = sb;
mTw2p(2,2) = cb;
mTw2p(2,3) = 0.0;
mTw2p(3,1) = sa*cb;
mTw2p(3,2) = -sa*sb;
mTw2p(3,3) = ca;
}
