25.08.2010, 20:24
(
Последний раз редактировалось DANGER1979; 26.08.2010 в 06:05.
)
pawn Код:
stock ConvertNonNormaQuatToEuler(Float: qw, Float: qx, Float:qy, Float:qz,
&Float:heading, &Float:attitude, &Float:bank)
{
new Float: sqw = qw*qw;
new Float: sqx = qx*qx;
new Float: sqy = qy*qy;
new Float: sqz = qz*qz;
new Float: unit = sqx + sqy + sqz + sqw; // if normalised is one, otherwise is correction factor
//если normalised, - один, в противном случае - показатель коррекции
new Float: test = qx*qy + qz*qw;
if (test > 0.499*unit)
{ // singularity at north pole - особенность на северном полюсе
heading = 2*atan2(qx,qw);
attitude = 3.141592653/2;
bank = 0;
return 1;
}
if (test < -0.499*unit)
{ // singularity at south pole - особенность на южном полюсе
heading = -2*atan2(qx,qw);
attitude = -3.141592653/2;
bank = 0;
return 1;
}
heading = atan2(2*qy*qw - 2*qx*qz, sqx - sqy - sqz + sqw);
attitude = asin(2*test/unit);
bank = atan2(2*qx*qw - 2*qy*qz, -sqx + sqy - sqz + sqw);
return 1;
}
pawn Код:
stock GetVehicleRotation(vehicleid,&Float:heading, &Float:attitude, &Float:bank)
{
new Float:quat_w,Float:quat_x,Float:quat_y,Float:quat_z;
GetVehicleRotationQuat(vehicleid,quat_w,quat_x,quat_y,quat_z);
ConvertNonNormaQuatToEuler(quat_w,quat_x,quat_z,quat_y, heading, attitude, bank);
bank = -1*bank;
return 1;
}

