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.
97 lines
2.9 KiB
97 lines
2.9 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 "hsMatrix33.h" |
|
#include "hsStream.h" |
|
|
|
hsMatrix33* hsMatrix33::Reset() |
|
{ |
|
static const hsMatrix33 gIdentity = { 1, 0, 0, 0, 1, 0, 0, 0, 1 }; |
|
|
|
*this = gIdentity; |
|
return this; |
|
} |
|
|
|
|
|
hsMatrix33* hsMatrix33::SetConcat(const hsMatrix33* a, const hsMatrix33* b) |
|
{ |
|
hsMatrix33 tmpMatrix; |
|
hsMatrix33* c; |
|
|
|
c = this; |
|
if (this == a || this == b) |
|
c = &tmpMatrix; |
|
|
|
c->fMap[0][0] = a->fMap[0][0] * b->fMap[0][0] + a->fMap[0][1] * b->fMap[1][0] + a->fMap[0][2] * b->fMap[2][0]; |
|
c->fMap[0][1] = a->fMap[0][0] * b->fMap[0][1] + a->fMap[0][1] * b->fMap[1][1] + a->fMap[0][2] * b->fMap[2][1]; |
|
c->fMap[0][2] = a->fMap[0][0] * b->fMap[0][2] + a->fMap[0][1] * b->fMap[1][2] + a->fMap[0][2] * b->fMap[2][2]; |
|
|
|
c->fMap[1][0] = a->fMap[1][0] * b->fMap[0][0] + a->fMap[1][1] * b->fMap[1][0] + a->fMap[1][2] * b->fMap[2][0]; |
|
c->fMap[1][1] = a->fMap[1][0] * b->fMap[0][1] + a->fMap[1][1] * b->fMap[1][1] + a->fMap[1][2] * b->fMap[2][1]; |
|
c->fMap[1][2] = a->fMap[1][0] * b->fMap[0][2] + a->fMap[1][1] * b->fMap[1][2] + a->fMap[1][2] * b->fMap[2][2]; |
|
|
|
c->fMap[2][0] = a->fMap[2][0] * b->fMap[0][0] + a->fMap[2][1] * b->fMap[1][0] + a->fMap[2][2] * b->fMap[2][0]; |
|
c->fMap[2][1] = a->fMap[2][0] * b->fMap[0][1] + a->fMap[2][1] * b->fMap[1][1] + a->fMap[2][2] * b->fMap[2][1]; |
|
c->fMap[2][2] = a->fMap[2][0] * b->fMap[0][2] + a->fMap[2][1] * b->fMap[1][2] + a->fMap[2][2] * b->fMap[2][2]; |
|
|
|
if (this != c) |
|
*this = *c; |
|
return this; |
|
} |
|
|
|
hsMatrix33 operator*(const hsMatrix33& a, const hsMatrix33& b) |
|
{ |
|
hsMatrix33 c; |
|
|
|
(void)c.SetConcat(&a, &b); |
|
|
|
return c; |
|
} |
|
|
|
void hsMatrix33::Read(hsStream* s) |
|
{ |
|
int i, j; |
|
for( i = 0; i < 3; i++ ) |
|
{ |
|
for( j = 0; j < 3; j++ ) |
|
{ |
|
fMap[i][j] = s->ReadSwapScalar(); |
|
} |
|
} |
|
} |
|
|
|
void hsMatrix33::Write(hsStream* s) |
|
{ |
|
int i, j; |
|
for( i = 0; i < 3; i++ ) |
|
{ |
|
for( j = 0; j < 3; j++ ) |
|
{ |
|
s->WriteSwapScalar(fMap[i][j]); |
|
} |
|
} |
|
} |