You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
554 lines
15 KiB
554 lines
15 KiB
/*==LICENSE==* |
|
|
|
CyanWorlds.com Engine - MMOG client, server and tools |
|
Copyright (C) 2011 Cyan Worlds, Inc. |
|
|
|
This program is free software: you can redistribute it and/or modify |
|
it under the terms of the GNU General Public License as published by |
|
the Free Software Foundation, either version 3 of the License, or |
|
(at your option) any later version. |
|
|
|
This program is distributed in the hope that it will be useful, |
|
but WITHOUT ANY WARRANTY; without even the implied warranty of |
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|
GNU General Public License for more details. |
|
|
|
You should have received a copy of the GNU General Public License |
|
along with this program. If not, see <http://www.gnu.org/licenses/>. |
|
|
|
You can contact Cyan Worlds, Inc. by email legal@cyan.com |
|
or by snail mail at: |
|
Cyan Worlds, Inc. |
|
14617 N Newport Hwy |
|
Mead, WA 99021 |
|
|
|
*==LICENSE==*/ |
|
#include "hsKeys.h" |
|
#include "hsStream.h" |
|
|
|
const int hsKeyFrame::kMaxFrameNumber = 65535; |
|
|
|
/////////////////////////////////////////////////////////////// |
|
|
|
void hsPoint3Key::Read(hsStream *stream) |
|
{ |
|
fFrame = stream->ReadSwap16(); |
|
fValue.Read(stream); |
|
} |
|
|
|
void hsPoint3Key::Write(hsStream *stream) |
|
{ |
|
stream->WriteSwap16(fFrame); |
|
fValue.Write(stream); |
|
} |
|
|
|
hsBool hsPoint3Key::CompareValue(hsPoint3Key *key) |
|
{ |
|
return hsABS(fValue.fX - key->fValue.fX) < .01 && |
|
hsABS(fValue.fY - key->fValue.fY) < .01 && |
|
hsABS(fValue.fZ - key->fValue.fZ) < .01; |
|
} |
|
|
|
void hsBezPoint3Key::Read(hsStream *stream) |
|
{ |
|
fFrame = stream->ReadSwap16(); |
|
fInTan.Read(stream); |
|
fOutTan.Read(stream); |
|
fValue.Read(stream); |
|
} |
|
|
|
void hsBezPoint3Key::Write(hsStream *stream) |
|
{ |
|
stream->WriteSwap16(fFrame); |
|
fInTan.Write(stream); |
|
fOutTan.Write(stream); |
|
fValue.Write(stream); |
|
} |
|
|
|
hsBool hsBezPoint3Key::CompareValue(hsBezPoint3Key *key) |
|
{ |
|
return hsABS(fValue.fX - key->fValue.fX) < .01 && |
|
hsABS(fValue.fY - key->fValue.fY) < .01 && |
|
hsABS(fValue.fZ - key->fValue.fZ) < .01; |
|
} |
|
|
|
///////////////////////////////////////// |
|
|
|
void hsScalarKey::Read(hsStream *stream) |
|
{ |
|
fFrame = stream->ReadSwap16(); |
|
fValue = stream->ReadSwapScalar(); |
|
} |
|
|
|
void hsScalarKey::Write(hsStream *stream) |
|
{ |
|
stream->WriteSwap16(fFrame); |
|
stream->WriteSwapScalar(fValue); |
|
} |
|
|
|
hsBool hsScalarKey::CompareValue(hsScalarKey *key) |
|
{ |
|
return fValue == key->fValue; |
|
} |
|
|
|
void hsBezScalarKey::Read(hsStream *stream) |
|
{ |
|
fFrame = stream->ReadSwap16(); |
|
fInTan = stream->ReadSwapScalar(); |
|
fOutTan = stream->ReadSwapScalar(); |
|
fValue = stream->ReadSwapScalar(); |
|
} |
|
|
|
void hsBezScalarKey::Write(hsStream *stream) |
|
{ |
|
stream->WriteSwap16(fFrame); |
|
stream->WriteSwapScalar(fInTan); |
|
stream->WriteSwapScalar(fOutTan); |
|
stream->WriteSwapScalar(fValue); |
|
} |
|
|
|
hsBool hsBezScalarKey::CompareValue(hsBezScalarKey *key) |
|
{ |
|
return fValue == key->fValue; |
|
} |
|
|
|
///////////////////////////////////////// |
|
|
|
void hsQuatKey::Read(hsStream *stream) |
|
{ |
|
fFrame = stream->ReadSwap16(); |
|
fValue.Read(stream); |
|
} |
|
|
|
void hsQuatKey::Write(hsStream *stream) |
|
{ |
|
stream->WriteSwap16(fFrame); |
|
fValue.Write(stream); |
|
} |
|
|
|
hsBool hsQuatKey::CompareValue(hsQuatKey *key) |
|
{ |
|
return fValue == key->fValue; |
|
} |
|
|
|
////////////////////////////////////////////////////////////////////////////// |
|
|
|
const hsScalar hsCompressedQuatKey32::kOneOverRootTwo = 0.70710678; |
|
const hsScalar hsCompressedQuatKey32::k10BitScaleRange = 1023 / (2 * kOneOverRootTwo); |
|
|
|
void hsCompressedQuatKey32::Read(hsStream *stream) |
|
{ |
|
fFrame = stream->ReadSwap16(); |
|
fData = stream->ReadSwap32(); |
|
} |
|
|
|
void hsCompressedQuatKey32::Write(hsStream *stream) |
|
{ |
|
stream->WriteSwap16(fFrame); |
|
stream->WriteSwap32(fData); |
|
} |
|
|
|
hsBool hsCompressedQuatKey32::CompareValue(hsCompressedQuatKey32 *key) |
|
{ |
|
return fData == key->fData; |
|
} |
|
|
|
// To store a quat in 32 bits, we find which element is the largest and use 2 bits to |
|
// store which one it is. We now know the other 3 elements fall in the range |
|
// of [-kOneOverRootTwo, kOneOverRootTwo]. We scale that range across 10 bits |
|
// and store each. When extracting, we use the fact that the quat was normalized |
|
// to compute the 4th element. |
|
void hsCompressedQuatKey32::SetQuat(hsQuat &q) |
|
{ |
|
q.Normalize(); |
|
UInt32 maxElement = kCompQuatNukeX; |
|
hsScalar maxVal = hsABS(q.fX); |
|
if (hsABS(q.fY) > maxVal) |
|
{ |
|
maxElement = kCompQuatNukeY; |
|
maxVal = hsABS(q.fY); |
|
} |
|
if (hsABS(q.fZ) > maxVal) |
|
{ |
|
maxElement = kCompQuatNukeZ; |
|
maxVal = hsABS(q.fZ); |
|
} |
|
if (hsABS(q.fW) > maxVal) |
|
{ |
|
maxElement = kCompQuatNukeW; |
|
maxVal = hsABS(q.fW); |
|
} |
|
switch (maxElement) |
|
{ |
|
case kCompQuatNukeX: |
|
{ |
|
// Invert the quat so that the largest element is positive. |
|
// We need to do this so that later we know to use the positive root. |
|
if (q.fX < 0) |
|
q = -q; |
|
|
|
fData = (maxElement << 30) | |
|
(((UInt32)(k10BitScaleRange * (q.fY + kOneOverRootTwo))) << 20) | |
|
(((UInt32)(k10BitScaleRange * (q.fZ + kOneOverRootTwo))) << 10) | |
|
(((UInt32)(k10BitScaleRange * (q.fW + kOneOverRootTwo)))); |
|
break; |
|
} |
|
case kCompQuatNukeY: |
|
{ |
|
if (q.fY < 0) |
|
q = -q; |
|
|
|
fData = (maxElement << 30) | |
|
(((UInt32)(k10BitScaleRange * (q.fX + kOneOverRootTwo))) << 20) | |
|
(((UInt32)(k10BitScaleRange * (q.fZ + kOneOverRootTwo))) << 10) | |
|
(((UInt32)(k10BitScaleRange * (q.fW + kOneOverRootTwo)))); |
|
break; |
|
} |
|
case kCompQuatNukeZ: |
|
{ |
|
if (q.fZ < 0) |
|
q = -q; |
|
|
|
fData = (maxElement << 30) | |
|
(((UInt32)(k10BitScaleRange * (q.fX + kOneOverRootTwo))) << 20) | |
|
(((UInt32)(k10BitScaleRange * (q.fY + kOneOverRootTwo))) << 10) | |
|
(((UInt32)(k10BitScaleRange * (q.fW + kOneOverRootTwo)))); |
|
break; |
|
} |
|
case kCompQuatNukeW: |
|
default: |
|
{ |
|
if (q.fW < 0) |
|
q = -q; |
|
|
|
fData = (maxElement << 30) | |
|
(((UInt32)(k10BitScaleRange * (q.fX + kOneOverRootTwo))) << 20) | |
|
(((UInt32)(k10BitScaleRange * (q.fY + kOneOverRootTwo))) << 10) | |
|
(((UInt32)(k10BitScaleRange * (q.fZ + kOneOverRootTwo)))); |
|
break; |
|
} |
|
} |
|
} |
|
|
|
void hsCompressedQuatKey32::GetQuat(hsQuat &q) |
|
{ |
|
UInt32 maxElement = fData >> 30; |
|
switch (maxElement) |
|
{ |
|
case kCompQuatNukeX: |
|
{ |
|
q.fY = (fData >> 20 & 0x000003ff) / k10BitScaleRange - kOneOverRootTwo; |
|
q.fZ = (fData >> 10 & 0x000003ff) / k10BitScaleRange - kOneOverRootTwo; |
|
q.fW = (fData & 0x000003ff) / k10BitScaleRange - kOneOverRootTwo; |
|
q.fX = hsSquareRoot(1 - q.fY * q.fY - q.fZ * q.fZ - q.fW *q.fW); |
|
break; |
|
} |
|
case kCompQuatNukeY: |
|
{ |
|
q.fX = (fData >> 20 & 0x000003ff) / k10BitScaleRange - kOneOverRootTwo; |
|
q.fZ = (fData >> 10 & 0x000003ff) / k10BitScaleRange - kOneOverRootTwo; |
|
q.fW = (fData & 0x000003ff) / k10BitScaleRange - kOneOverRootTwo; |
|
q.fY = hsSquareRoot(1 - q.fX * q.fX - q.fZ * q.fZ - q.fW *q.fW); |
|
break; |
|
} |
|
case kCompQuatNukeZ: |
|
{ |
|
q.fX = (fData >> 20 & 0x000003ff) / k10BitScaleRange - kOneOverRootTwo; |
|
q.fY = (fData >> 10 & 0x000003ff) / k10BitScaleRange - kOneOverRootTwo; |
|
q.fW = (fData & 0x000003ff) / k10BitScaleRange - kOneOverRootTwo; |
|
q.fZ = hsSquareRoot(1 - q.fX * q.fX - q.fY * q.fY - q.fW *q.fW); |
|
break; |
|
} |
|
case kCompQuatNukeW: |
|
default: |
|
{ |
|
q.fX = (fData >> 20 & 0x000003ff) / k10BitScaleRange - kOneOverRootTwo; |
|
q.fY = (fData >> 10 & 0x000003ff) / k10BitScaleRange - kOneOverRootTwo; |
|
q.fZ = (fData & 0x000003ff) / k10BitScaleRange - kOneOverRootTwo; |
|
q.fW = hsSquareRoot(1 - q.fX * q.fX - q.fY * q.fY - q.fZ * q.fZ); |
|
break; |
|
} |
|
} |
|
} |
|
|
|
///////////////////////////////////////////////////////////////////////////// |
|
|
|
const hsScalar hsCompressedQuatKey64::kOneOverRootTwo = 0.70710678; |
|
const hsScalar hsCompressedQuatKey64::k20BitScaleRange = 1048575 / (2 * kOneOverRootTwo); |
|
const hsScalar hsCompressedQuatKey64::k21BitScaleRange = 2097151 / (2 * kOneOverRootTwo); |
|
|
|
void hsCompressedQuatKey64::Read(hsStream *stream) |
|
{ |
|
fFrame = stream->ReadSwap16(); |
|
fData[0] = stream->ReadSwap32(); |
|
fData[1] = stream->ReadSwap32(); |
|
} |
|
|
|
void hsCompressedQuatKey64::Write(hsStream *stream) |
|
{ |
|
stream->WriteSwap16(fFrame); |
|
stream->WriteSwap32(fData[0]); |
|
stream->WriteSwap32(fData[1]); |
|
} |
|
|
|
hsBool hsCompressedQuatKey64::CompareValue(hsCompressedQuatKey64 *key) |
|
{ |
|
return (fData[0] == key->fData[0]) && (fData[1] == key->fData[1]); |
|
} |
|
|
|
// To store a quat in 64 bits, we find which element is the largest and use 2 bits to |
|
// store which one it is. We now know the other 3 elements fall in the range |
|
// of [-kOneOverRootTwo, kOneOverRootTwo]. We scale that range across 20/21/21 bits |
|
// and store each. When extracting, we use the fact that the quat was normalized |
|
// to compute the 4th element. |
|
void hsCompressedQuatKey64::SetQuat(hsQuat &q) |
|
{ |
|
q.Normalize(); |
|
UInt32 maxElement = kCompQuatNukeX; |
|
hsScalar maxVal = hsABS(q.fX); |
|
if (hsABS(q.fY) > maxVal) |
|
{ |
|
maxElement = kCompQuatNukeY; |
|
maxVal = hsABS(q.fY); |
|
} |
|
if (hsABS(q.fZ) > maxVal) |
|
{ |
|
maxElement = kCompQuatNukeZ; |
|
maxVal = hsABS(q.fZ); |
|
} |
|
if (hsABS(q.fW) > maxVal) |
|
{ |
|
maxElement = kCompQuatNukeW; |
|
maxVal = hsABS(q.fW); |
|
} |
|
switch (maxElement) |
|
{ |
|
case kCompQuatNukeX: |
|
{ |
|
// Invert the quat so that the largest element is positive. |
|
// We need to do this so that later we know to use the positive root. |
|
if (q.fX < 0) |
|
q = -q; |
|
|
|
fData[0] = (maxElement << 30) | |
|
(((UInt32)(k20BitScaleRange * (q.fY + kOneOverRootTwo))) << 10) | |
|
(((UInt32)(k21BitScaleRange * (q.fZ + kOneOverRootTwo))) >> 11); |
|
fData[1] = |
|
(((UInt32)(k21BitScaleRange * (q.fZ + kOneOverRootTwo))) << 21) | |
|
(((UInt32)(k21BitScaleRange * (q.fW + kOneOverRootTwo)))); |
|
break; |
|
} |
|
case kCompQuatNukeY: |
|
{ |
|
if (q.fY < 0) |
|
q = -q; |
|
|
|
fData[0] = (maxElement << 30) | |
|
(((UInt32)(k20BitScaleRange * (q.fX + kOneOverRootTwo))) << 10) | |
|
(((UInt32)(k21BitScaleRange * (q.fZ + kOneOverRootTwo))) >> 11); |
|
fData[1] = |
|
(((UInt32)(k21BitScaleRange * (q.fZ + kOneOverRootTwo))) << 21) | |
|
(((UInt32)(k21BitScaleRange * (q.fW + kOneOverRootTwo)))); |
|
break; |
|
} |
|
case kCompQuatNukeZ: |
|
{ |
|
if (q.fZ < 0) |
|
q = -q; |
|
|
|
fData[0] = (maxElement << 30) | |
|
(((UInt32)(k20BitScaleRange * (q.fX + kOneOverRootTwo))) << 10) | |
|
(((UInt32)(k21BitScaleRange * (q.fY + kOneOverRootTwo))) >> 11); |
|
fData[1] = |
|
(((UInt32)(k21BitScaleRange * (q.fY + kOneOverRootTwo))) << 21) | |
|
(((UInt32)(k21BitScaleRange * (q.fW + kOneOverRootTwo)))); |
|
break; |
|
} |
|
case kCompQuatNukeW: |
|
default: |
|
{ |
|
if (q.fW < 0) |
|
q = -q; |
|
|
|
fData[0] = (maxElement << 30) | |
|
(((UInt32)(k20BitScaleRange * (q.fX + kOneOverRootTwo))) << 10) | |
|
(((UInt32)(k21BitScaleRange * (q.fY + kOneOverRootTwo))) >> 11); |
|
fData[1] = |
|
(((UInt32)(k21BitScaleRange * (q.fY + kOneOverRootTwo))) << 21) | |
|
(((UInt32)(k21BitScaleRange * (q.fZ + kOneOverRootTwo)))); |
|
break; |
|
} |
|
} |
|
} |
|
|
|
void hsCompressedQuatKey64::GetQuat(hsQuat &q) |
|
{ |
|
UInt32 maxElement = fData[0] >> 30; |
|
switch (maxElement) |
|
{ |
|
case kCompQuatNukeX: |
|
{ |
|
q.fY = ((fData[0] >> 10) & 0x000fffff) / k20BitScaleRange - kOneOverRootTwo; |
|
q.fZ = (((fData[0] & 0x000003ff) << 11) | (fData[1] >> 21)) / k21BitScaleRange - kOneOverRootTwo; |
|
q.fW = (fData[1] & 0x001fffff) / k21BitScaleRange - kOneOverRootTwo; |
|
q.fX = hsSquareRoot(1 - q.fY * q.fY - q.fZ * q.fZ - q.fW *q.fW); |
|
break; |
|
} |
|
case kCompQuatNukeY: |
|
{ |
|
q.fX = ((fData[0] >> 10) & 0x000fffff) / k20BitScaleRange - kOneOverRootTwo; |
|
q.fZ = (((fData[0] & 0x000003ff) << 11) | (fData[1] >> 21)) / k21BitScaleRange - kOneOverRootTwo; |
|
q.fW = (fData[1] & 0x001fffff) / k21BitScaleRange - kOneOverRootTwo; |
|
q.fY = hsSquareRoot(1 - q.fX * q.fX - q.fZ * q.fZ - q.fW *q.fW); |
|
break; |
|
} |
|
case kCompQuatNukeZ: |
|
{ |
|
q.fX = ((fData[0] >> 10) & 0x000fffff) / k20BitScaleRange - kOneOverRootTwo; |
|
q.fY = (((fData[0] & 0x000003ff) << 11) | (fData[1] >> 21)) / k21BitScaleRange - kOneOverRootTwo; |
|
q.fW = (fData[1] & 0x001fffff) / k21BitScaleRange - kOneOverRootTwo; |
|
q.fZ = hsSquareRoot(1 - q.fX * q.fX - q.fY * q.fY - q.fW *q.fW); |
|
break; |
|
} |
|
case kCompQuatNukeW: |
|
default: |
|
{ |
|
q.fX = ((fData[0] >> 10) & 0x000fffff) / k20BitScaleRange - kOneOverRootTwo; |
|
q.fY = (((fData[0] & 0x000003ff) << 11) | (fData[1] >> 21)) / k21BitScaleRange - kOneOverRootTwo; |
|
q.fZ = (fData[1] & 0x001fffff) / k21BitScaleRange - kOneOverRootTwo; |
|
q.fW = hsSquareRoot(1 - q.fX * q.fX - q.fY * q.fY - q.fZ * q.fZ); |
|
break; |
|
} |
|
} |
|
} |
|
|
|
///////////////////////////////////////// |
|
// Not a key |
|
// |
|
void hsScaleValue::Read(hsStream *stream) |
|
{ |
|
fS.Read(stream); |
|
fQ.Read(stream); |
|
} |
|
|
|
void hsScaleValue::Write(hsStream *stream) |
|
{ |
|
fS.Write(stream); |
|
fQ.Write(stream); |
|
} |
|
|
|
///////////////////////////////////////// |
|
void hsScaleKey::Read(hsStream *stream) |
|
{ |
|
fFrame = stream->ReadSwap16(); |
|
fValue.Read(stream); |
|
} |
|
|
|
void hsScaleKey::Write(hsStream *stream) |
|
{ |
|
stream->WriteSwap16(fFrame); |
|
fValue.Write(stream); |
|
} |
|
|
|
hsBool hsScaleKey::CompareValue(hsScaleKey *key) |
|
{ |
|
return fValue == key->fValue; |
|
} |
|
|
|
void hsBezScaleKey::Read(hsStream *stream) |
|
{ |
|
fFrame = stream->ReadSwap16(); |
|
fInTan.Read(stream); |
|
fOutTan.Read(stream); |
|
fValue.Read(stream); |
|
} |
|
|
|
void hsBezScaleKey::Write(hsStream *stream) |
|
{ |
|
stream->WriteSwap16(fFrame); |
|
fInTan.Write(stream); |
|
fOutTan.Write(stream); |
|
fValue.Write(stream); |
|
} |
|
|
|
hsBool hsBezScaleKey::CompareValue(hsBezScaleKey *key) |
|
{ |
|
return fValue == key->fValue; |
|
} |
|
|
|
////////////////////// |
|
|
|
void hsG3DSMaxKeyFrame::Set(hsMatrix44 *mat, UInt16 frame) |
|
{ |
|
fFrame = frame; |
|
gemAffineParts parts; |
|
decomp_affine(mat->fMap, &parts); |
|
AP_SET(fParts, parts); |
|
} |
|
|
|
void hsG3DSMaxKeyFrame::Set(const hsAffineParts &parts, UInt16 frame) |
|
{ |
|
fFrame = frame; |
|
fParts = parts; |
|
} |
|
|
|
void hsG3DSMaxKeyFrame::Read(hsStream *stream) |
|
{ |
|
fFrame = stream->ReadSwap16(); |
|
fParts.Read(stream); |
|
} |
|
|
|
void hsG3DSMaxKeyFrame::Write(hsStream *stream) |
|
{ |
|
stream->WriteSwap16(fFrame); |
|
fParts.Write(stream); |
|
} |
|
|
|
hsBool hsG3DSMaxKeyFrame::CompareValue(hsG3DSMaxKeyFrame *key) |
|
{ |
|
return fParts == key->fParts; |
|
} |
|
|
|
///////////////////////////////////////// |
|
|
|
void hsMatrix33Key::Read(hsStream *stream) |
|
{ |
|
fFrame = stream->ReadSwap16(); |
|
Int32 i,j; |
|
for(i=0;i<3;i++) |
|
for(j=0;j<3;j++) |
|
fValue.fMap[j][i] = stream->ReadSwapScalar(); |
|
} |
|
|
|
void hsMatrix33Key::Write(hsStream *stream) |
|
{ |
|
stream->WriteSwap16(fFrame); |
|
Int32 i,j; |
|
for(i=0;i<3;i++) |
|
for(j=0;j<3;j++) |
|
stream->WriteSwapScalar(fValue.fMap[j][i]); |
|
} |
|
|
|
hsBool hsMatrix33Key::CompareValue(hsMatrix33Key *key) |
|
{ |
|
return fValue == key->fValue; |
|
} |
|
|
|
///////////////////////////////////////// |
|
|
|
void hsMatrix44Key::Read(hsStream *stream) |
|
{ |
|
fFrame = stream->ReadSwap16(); |
|
fValue.Read(stream); |
|
} |
|
|
|
void hsMatrix44Key::Write(hsStream *stream) |
|
{ |
|
stream->WriteSwap16(fFrame); |
|
fValue.Write(stream); |
|
} |
|
|
|
hsBool hsMatrix44Key::CompareValue(hsMatrix44Key *key) |
|
{ |
|
return fValue == key->fValue; |
|
}
|
|
|