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.
626 lines
6.8 KiB
626 lines
6.8 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 "hsTypes.h" |
|
#include "hsScalar.h" |
|
#include "hsGeometry3.h" |
|
#include "hsFastMath.h" |
|
|
|
const hsScalar hsFastMath::kSqrtTwo = hsSquareRoot(2.f); |
|
const hsScalar hsFastMath::kInvSqrtTwo = hsScalarInvert(hsFastMath::kSqrtTwo); |
|
const hsScalar hsFastMath::kTwoPI = hsScalarPI * 2.f; |
|
|
|
hsPoint2 statCosSinTable[9] = // must match length in inline |
|
{ |
|
{ 1.f, 0.f }, |
|
{ hsFastMath::kInvSqrtTwo, hsFastMath::kInvSqrtTwo }, |
|
{ 0.f, 1.f }, |
|
{ -hsFastMath::kInvSqrtTwo, hsFastMath::kInvSqrtTwo }, |
|
{ -1.f, 0.f }, |
|
{ -hsFastMath::kInvSqrtTwo, -hsFastMath::kInvSqrtTwo }, |
|
{ 0.f, -1.f }, |
|
{ hsFastMath::kInvSqrtTwo, -hsFastMath::kInvSqrtTwo }, |
|
{ 1.f, 0.f } |
|
}; |
|
|
|
const hsPoint2* hsFastMath::fCosSinTable = statCosSinTable; |
|
|
|
unsigned char statSeedTable[] = { |
|
0x69, |
|
0x69, |
|
0x68, |
|
0x67, |
|
0x67, |
|
0x66, |
|
0x65, |
|
0x65, |
|
0x64, |
|
0x63, |
|
0x63, |
|
0x62, |
|
0x61, |
|
0x61, |
|
0x60, |
|
0x5f, |
|
0x5f, |
|
0x5e, |
|
0x5d, |
|
0x5d, |
|
0x5c, |
|
0x5b, |
|
0x5b, |
|
0x5a, |
|
0x5a, |
|
0x59, |
|
0x58, |
|
0x58, |
|
0x57, |
|
0x57, |
|
0x56, |
|
0x55, |
|
0x55, |
|
0x54, |
|
0x54, |
|
0x53, |
|
0x52, |
|
0x52, |
|
0x51, |
|
0x51, |
|
0x50, |
|
0x50, |
|
0x4f, |
|
0x4e, |
|
0x4e, |
|
0x4d, |
|
0x4d, |
|
0x4c, |
|
0x4c, |
|
0x4b, |
|
0x4b, |
|
0x4a, |
|
0x4a, |
|
0x49, |
|
0x48, |
|
0x48, |
|
0x47, |
|
0x47, |
|
0x46, |
|
0x46, |
|
0x45, |
|
0x45, |
|
0x44, |
|
0x44, |
|
0x43, |
|
0x43, |
|
0x42, |
|
0x42, |
|
0x41, |
|
0x41, |
|
0x40, |
|
0x40, |
|
0x3f, |
|
0x3f, |
|
0x3e, |
|
0x3e, |
|
0x3d, |
|
0x3d, |
|
0x3c, |
|
0x3c, |
|
0x3c, |
|
0x3b, |
|
0x3b, |
|
0x3a, |
|
0x3a, |
|
0x39, |
|
0x39, |
|
0x38, |
|
0x38, |
|
0x37, |
|
0x37, |
|
0x36, |
|
0x36, |
|
0x36, |
|
0x35, |
|
0x35, |
|
0x34, |
|
0x34, |
|
0x33, |
|
0x33, |
|
0x33, |
|
0x32, |
|
0x32, |
|
0x31, |
|
0x31, |
|
0x30, |
|
0x30, |
|
0x30, |
|
0x2f, |
|
0x2f, |
|
0x2e, |
|
0x2e, |
|
0x2e, |
|
0x2d, |
|
0x2d, |
|
0x2c, |
|
0x2c, |
|
0x2b, |
|
0x2b, |
|
0x2b, |
|
0x2a, |
|
0x2a, |
|
0x29, |
|
0x29, |
|
0x29, |
|
0x28, |
|
0x28, |
|
0x28, |
|
0x27, |
|
0x27, |
|
0x26, |
|
0x26, |
|
0x26, |
|
0x25, |
|
0x25, |
|
0x25, |
|
0x24, |
|
0x24, |
|
0x23, |
|
0x23, |
|
0x23, |
|
0x22, |
|
0x22, |
|
0x22, |
|
0x21, |
|
0x21, |
|
0x20, |
|
0x20, |
|
0x20, |
|
0x1f, |
|
0x1f, |
|
0x1f, |
|
0x1e, |
|
0x1e, |
|
0x1e, |
|
0x1d, |
|
0x1d, |
|
0x1d, |
|
0x1c, |
|
0x1c, |
|
0x1c, |
|
0x1b, |
|
0x1b, |
|
0x1b, |
|
0x1a, |
|
0x1a, |
|
0x1a, |
|
0x19, |
|
0x19, |
|
0x19, |
|
0x18, |
|
0x18, |
|
0x18, |
|
0x17, |
|
0x17, |
|
0x17, |
|
0x16, |
|
0x16, |
|
0x16, |
|
0x15, |
|
0x15, |
|
0x15, |
|
0x14, |
|
0x14, |
|
0x14, |
|
0x13, |
|
0x13, |
|
0x13, |
|
0x13, |
|
0x12, |
|
0x12, |
|
0x12, |
|
0x11, |
|
0x11, |
|
0x11, |
|
0x10, |
|
0x10, |
|
0x10, |
|
0xf, |
|
0xf, |
|
0xf, |
|
0xf, |
|
0xe, |
|
0xe, |
|
0xe, |
|
0xd, |
|
0xd, |
|
0xd, |
|
0xd, |
|
0xc, |
|
0xc, |
|
0xc, |
|
0xb, |
|
0xb, |
|
0xb, |
|
0xb, |
|
0xa, |
|
0xa, |
|
0xa, |
|
0x9, |
|
0x9, |
|
0x9, |
|
0x9, |
|
0x8, |
|
0x8, |
|
0x8, |
|
0x7, |
|
0x7, |
|
0x7, |
|
0x7, |
|
0x6, |
|
0x6, |
|
0x6, |
|
0x6, |
|
0x5, |
|
0x5, |
|
0x5, |
|
0x5, |
|
0x4, |
|
0x4, |
|
0x4, |
|
0x3, |
|
0x3, |
|
0x3, |
|
0x3, |
|
0x2, |
|
0x2, |
|
0x2, |
|
0x2, |
|
0x1, |
|
0x1, |
|
0x1, |
|
0x1, |
|
0x0, |
|
0x0, |
|
0x0, |
|
0xff, |
|
0xfe, |
|
0xfd, |
|
0xfc, |
|
0xfb, |
|
0xfa, |
|
0xf9, |
|
0xf8, |
|
0xf7, |
|
0xf7, |
|
0xf6, |
|
0xf5, |
|
0xf4, |
|
0xf3, |
|
0xf2, |
|
0xf1, |
|
0xf0, |
|
0xef, |
|
0xee, |
|
0xed, |
|
0xec, |
|
0xec, |
|
0xeb, |
|
0xea, |
|
0xe9, |
|
0xe8, |
|
0xe7, |
|
0xe6, |
|
0xe5, |
|
0xe5, |
|
0xe4, |
|
0xe3, |
|
0xe2, |
|
0xe1, |
|
0xe0, |
|
0xe0, |
|
0xdf, |
|
0xde, |
|
0xdd, |
|
0xdc, |
|
0xdb, |
|
0xdb, |
|
0xda, |
|
0xd9, |
|
0xd8, |
|
0xd8, |
|
0xd7, |
|
0xd6, |
|
0xd5, |
|
0xd4, |
|
0xd4, |
|
0xd3, |
|
0xd2, |
|
0xd1, |
|
0xd1, |
|
0xd0, |
|
0xcf, |
|
0xce, |
|
0xce, |
|
0xcd, |
|
0xcc, |
|
0xcb, |
|
0xcb, |
|
0xca, |
|
0xc9, |
|
0xc9, |
|
0xc8, |
|
0xc7, |
|
0xc7, |
|
0xc6, |
|
0xc5, |
|
0xc4, |
|
0xc4, |
|
0xc3, |
|
0xc2, |
|
0xc2, |
|
0xc1, |
|
0xc0, |
|
0xc0, |
|
0xbf, |
|
0xbe, |
|
0xbe, |
|
0xbd, |
|
0xbc, |
|
0xbc, |
|
0xbb, |
|
0xba, |
|
0xba, |
|
0xb9, |
|
0xb8, |
|
0xb8, |
|
0xb7, |
|
0xb7, |
|
0xb6, |
|
0xb5, |
|
0xb5, |
|
0xb4, |
|
0xb3, |
|
0xb3, |
|
0xb2, |
|
0xb2, |
|
0xb1, |
|
0xb0, |
|
0xb0, |
|
0xaf, |
|
0xaf, |
|
0xae, |
|
0xad, |
|
0xad, |
|
0xac, |
|
0xac, |
|
0xab, |
|
0xaa, |
|
0xaa, |
|
0xa9, |
|
0xa9, |
|
0xa8, |
|
0xa8, |
|
0xa7, |
|
0xa7, |
|
0xa6, |
|
0xa5, |
|
0xa5, |
|
0xa4, |
|
0xa4, |
|
0xa3, |
|
0xa3, |
|
0xa2, |
|
0xa2, |
|
0xa1, |
|
0xa0, |
|
0xa0, |
|
0x9f, |
|
0x9f, |
|
0x9e, |
|
0x9e, |
|
0x9d, |
|
0x9d, |
|
0x9c, |
|
0x9c, |
|
0x9b, |
|
0x9b, |
|
0x9a, |
|
0x9a, |
|
0x99, |
|
0x99, |
|
0x98, |
|
0x98, |
|
0x97, |
|
0x97, |
|
0x96, |
|
0x96, |
|
0x95, |
|
0x95, |
|
0x94, |
|
0x94, |
|
0x93, |
|
0x93, |
|
0x92, |
|
0x92, |
|
0x91, |
|
0x91, |
|
0x90, |
|
0x90, |
|
0x8f, |
|
0x8f, |
|
0x8e, |
|
0x8e, |
|
0x8d, |
|
0x8d, |
|
0x8c, |
|
0x8c, |
|
0x8b, |
|
0x8b, |
|
0x8b, |
|
0x8a, |
|
0x8a, |
|
0x89, |
|
0x89, |
|
0x88, |
|
0x88, |
|
0x87, |
|
0x87, |
|
0x87, |
|
0x86, |
|
0x86, |
|
0x85, |
|
0x85, |
|
0x84, |
|
0x84, |
|
0x83, |
|
0x83, |
|
0x83, |
|
0x82, |
|
0x82, |
|
0x81, |
|
0x81, |
|
0x80, |
|
0x80, |
|
0x80, |
|
0x7f, |
|
0x7f, |
|
0x7e, |
|
0x7e, |
|
0x7d, |
|
0x7d, |
|
0x7d, |
|
0x7c, |
|
0x7c, |
|
0x7b, |
|
0x7b, |
|
0x7b, |
|
0x7a, |
|
0x7a, |
|
0x79, |
|
0x79, |
|
0x79, |
|
0x78, |
|
0x78, |
|
0x77, |
|
0x77, |
|
0x77, |
|
0x76, |
|
0x76, |
|
0x75, |
|
0x75, |
|
0x75, |
|
0x74, |
|
0x74, |
|
0x74, |
|
0x73, |
|
0x73, |
|
0x72, |
|
0x72, |
|
0x72, |
|
0x71, |
|
0x71, |
|
0x71, |
|
0x70, |
|
0x70, |
|
0x6f, |
|
0x6f, |
|
0x6f, |
|
0x6e, |
|
0x6e, |
|
0x6e, |
|
0x6d, |
|
0x6d, |
|
0x6c, |
|
0x6c, |
|
0x6c, |
|
0x6b, |
|
0x6b, |
|
0x6b, |
|
0x6a, |
|
0x6a |
|
}; |
|
|
|
hsScalar hsFastMath::IATan2OverTwoPi(hsScalar y, hsScalar x) |
|
{ |
|
const int tabSize = 16; // pad with one extra because hi can go hi |
|
const int tabMax = tabSize-1; |
|
static hsScalar tab[tabSize+1] = { |
|
0.f, |
|
0.0105947f, |
|
0.0210962f, |
|
0.0314165f, |
|
0.0414762f, |
|
0.0512082f, |
|
0.0605595f, |
|
0.0694914f, |
|
0.0779791f, |
|
0.0860104f, |
|
0.0935835f, |
|
0.100705f, |
|
0.107388f, |
|
0.113651f, |
|
0.119514f, |
|
0.125f, |
|
0 }; |
|
|
|
if( (x == 0)&&(y == 0) ) |
|
return 0; |
|
|
|
hsBool xNeg, yNeg; |
|
if( yNeg = (y < 0) )y = -y; |
|
if( xNeg = (x < 0) )x = -x; |
|
hsBool yBigger = y >= x; |
|
hsScalar div = yBigger ? x / y : y / x; |
|
|
|
hsScalar fInd = div * tabMax; |
|
int lo = int(fInd); |
|
int hi = lo+1; |
|
hsScalar frac = fInd - lo; |
|
|
|
hsScalar res = tab[lo]; |
|
res += frac * (tab[hi] - res); |
|
|
|
// now move to proper half quadrant |
|
hsAssert((res >= 0)&&(res <= 0.25f), "Lookup atan2 out of bounds"); |
|
if( yBigger ) |
|
res = 0.25f - res; |
|
switch( (yNeg << 1)|xNeg ) |
|
{ |
|
case 0: |
|
break; |
|
case 1: |
|
res = 0.5f - res; |
|
break; |
|
case 3: |
|
res += 0.5f; |
|
break; |
|
case 2: |
|
res = 1.f - res; |
|
break; |
|
} |
|
return res; |
|
} |
|
|
|
|