From 122fb60270e806431beb9ca115ae82c943905b5d Mon Sep 17 00:00:00 2001
From: "matthias.ringwald"
 <matthias.ringwald@1a0a8af8-31b5-11de-8e0c-53a27eea117e>
Date: Sun, 13 Jun 2010 19:26:30 +0000
Subject: [PATCH] added getRotationAngle from rotation matrix

---
 example/WiiMoteOpenGLDemo/rotation.c | 4 ++++
 1 file changed, 4 insertions(+)

diff --git a/example/WiiMoteOpenGLDemo/rotation.c b/example/WiiMoteOpenGLDemo/rotation.c
index 98050858e..1a4205f91 100644
--- a/example/WiiMoteOpenGLDemo/rotation.c
+++ b/example/WiiMoteOpenGLDemo/rotation.c
@@ -154,6 +154,10 @@ void getRotationMatrixFromVectors(float vin[3], float vout[3], float matrix[4][4
     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
 int main(void)
 {