mirror/btstack
1
0
Fork 0
mirror of https://github.com/bluekitchen/btstack.git synced 2025-04-03 10:20:18 +00:00
Code Issues Packages Projects Releases Wiki Activity

added getRotationAngle from rotation matrix

Browse Source
This commit is contained in:
matthias.ringwald 2010-06-13 19:26:30 +00:00
parent fc5ceb98a9
commit 122fb60270
1 changed files with 4 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
example/WiiMoteOpenGLDemo/rotation.c
View File

@ -154,6 +154,10 @@ void getRotationMatrixFromVectors(float vin[3], float vout[3], float matrix[4][4
getRotationMatrixFromQuartenion(q,matrix); getRotationMatrixFromQuartenion(q,matrix);
} }
void getRotationAngle(float matrix[4][4], float angle){
angle = acos( (matrix[0][0]+matrix[1][1]+matrix[2][2]-1) * 0.5);
}
#if 0 #if 0
int main(void) int main(void)
{ {