Index: FAST.f90 =================================================================== --- FAST.f90 (revision 55) +++ FAST.f90 (working copy) @@ -1339,9 +1339,9 @@ DO K = 1,NumBl DO I = 1, NBlGages - AllOuts( SpnALxb(I,K) ) = DOT_PRODUCT( LinAccES(K,BldGagNd(I),:), n1(K,BldGagNd(I),:) ) - AllOuts( SpnALyb(I,K) ) = DOT_PRODUCT( LinAccES(K,BldGagNd(I),:), n2(K,BldGagNd(I),:) ) - AllOuts( SpnALzb(I,K) ) = DOT_PRODUCT( LinAccES(K,BldGagNd(I),:), n3(K,BldGagNd(I),:) ) + AllOuts( SpnALxb(I,K) ) = DOT_PRODUCT( LinAccES(K,BldGagNd(I),:) + Gravity*z2, n1(K,BldGagNd(I),:) ) + AllOuts( SpnALyb(I,K) ) = DOT_PRODUCT( LinAccES(K,BldGagNd(I),:) + Gravity*z2, n2(K,BldGagNd(I),:) ) + AllOuts( SpnALzb(I,K) ) = DOT_PRODUCT( LinAccES(K,BldGagNd(I),:) + Gravity*z2, n3(K,BldGagNd(I),:) ) rSPS = rS0S(K,BldGagNd(I),:) - RNodes(BldGagNd(I))*j3(K,:) @@ -1409,9 +1409,9 @@ AllOuts(NcIMUTVxs) = DOT_PRODUCT( LinVelEIMU, c1 ) AllOuts(NcIMUTVys) = -1.0*DOT_PRODUCT( LinVelEIMU, c3 ) AllOuts(NcIMUTVzs) = DOT_PRODUCT( LinVelEIMU, c2 ) -AllOuts(NcIMUTAxs) = DOT_PRODUCT( LinAccEIMU, c1 ) -AllOuts(NcIMUTAys) = -1.0*DOT_PRODUCT( LinAccEIMU, c3 ) -AllOuts(NcIMUTAzs) = DOT_PRODUCT( LinAccEIMU, c2 ) +AllOuts(NcIMUTAxs) = DOT_PRODUCT( LinAccEIMU + Gravity*z2, c1 ) +AllOuts(NcIMUTAys) = -1.0*DOT_PRODUCT( LinAccEIMU + Gravity*z2, c3 ) +AllOuts(NcIMUTAzs) = DOT_PRODUCT( LinAccEIMU + Gravity*z2, c2 ) AllOuts(NcIMURVxs) = DOT_PRODUCT( AngVelER , c1 )*R2D AllOuts(NcIMURVys) = -1.0*DOT_PRODUCT( AngVelER , c3 )*R2D AllOuts(NcIMURVzs) = DOT_PRODUCT( AngVelER , c2 )*R2D