diff options
author | cnlohr <lohr85@gmail.com> | 2017-03-12 03:29:24 -0400 |
---|---|---|
committer | cnlohr <lohr85@gmail.com> | 2017-03-12 03:29:24 -0400 |
commit | b754712675b5d644ae950006afe0d1ceba0e1899 (patch) | |
tree | 29de3de4f0265451f6bb88b1979052333320b5c7 /src/poser_daveortho.c | |
parent | 2231abd24eabe35b37a7a293ecdd48e370373a5a (diff) | |
download | libsurvive-b754712675b5d644ae950006afe0d1ceba0e1899.tar.gz libsurvive-b754712675b5d644ae950006afe0d1ceba0e1899.tar.bz2 |
update with another test.
Diffstat (limited to 'src/poser_daveortho.c')
-rw-r--r-- | src/poser_daveortho.c | 6 |
1 files changed, 3 insertions, 3 deletions
diff --git a/src/poser_daveortho.c b/src/poser_daveortho.c index 80ddd90..beba7ad 100644 --- a/src/poser_daveortho.c +++ b/src/poser_daveortho.c @@ -74,13 +74,13 @@ int PoserDaveOrtho( SurviveObject * so, PoserData * pd ) FLT S_out[2][SENSORS_PER_OBJECT]; OrthoSolve( tOut, S_out, S_in, X_in, max_hits ); - //Now, we need to solve where we are as a function of where + //Now, we need to solve where we are as a function of where //the lighthouses are. FLT quat[4]; FLT posoff[3] = { tOut[0][3], tOut[1][3], tOut[2][3] }; FLT MT[4][4]; - //matrix44transpose( MT, &T[0][0] ); - matrix44copy( &MT[0][0], &tOut[0][0] ); + matrix44transpose( MT, &tOut[0][0] ); + //matrix44copy( &MT[0][0], &tOut[0][0] ); quatfrommatrix( quat, &MT[0][0] ); //printf( "QUAT: %f %f %f %f = %f\n", quat[0], quat[1], quat[2], quat[3], quatmagnitude(quat) ); |