diff options
| author | cnlohr <lohr85@gmail.com> | 2017-03-12 15:17:47 -0400 |
|---|---|---|
| committer | cnlohr <lohr85@gmail.com> | 2017-03-12 15:17:47 -0400 |
| commit | b528f822966cf8978cbe28936ae1f15c3032e1d2 (patch) | |
| tree | b783509720b583bc5c30aa8d6d49a99dc0ab931a /src/survive_cal.c | |
| parent | b754712675b5d644ae950006afe0d1ceba0e1899 (diff) | |
| download | libsurvive-b528f822966cf8978cbe28936ae1f15c3032e1d2.tar.gz libsurvive-b528f822966cf8978cbe28936ae1f15c3032e1d2.tar.bz2 | |
Update to posers, etc... Still not working.
Diffstat (limited to 'src/survive_cal.c')
| -rw-r--r-- | src/survive_cal.c | 37 |
1 files changed, 21 insertions, 16 deletions
diff --git a/src/survive_cal.c b/src/survive_cal.c index 59dd919..1376ee4 100644 --- a/src/survive_cal.c +++ b/src/survive_cal.c @@ -508,22 +508,24 @@ static void handle_calibration( struct SurviveCalData *cd ) SurvivePose * lhp = &ctx->bsd[lh].Pose; - lhp->Pos[0] = objfromlh->Pos[0]; +/* lhp->Pos[0] = objfromlh->Pos[0]; lhp->Pos[1] = objfromlh->Pos[1]; - lhp->Pos[2] = objfromlh->Pos[2]; + lhp->Pos[2] = objfromlh->Pos[2];*/ - lhp->Rot[0] = objfromlh->Rot[0]; + lhp->Rot[0] =-objfromlh->Rot[0]; lhp->Rot[1] = objfromlh->Rot[1]; lhp->Rot[2] = objfromlh->Rot[2]; lhp->Rot[3] = objfromlh->Rot[3]; + quatrotatevector( lhp->Pos, lhp->Rot, objfromlh->Pos ); + //Write lhp from the inverse of objfromlh //quatrotatevector( lhp->Pos, lhp->Rot, lhp->Pos ); - fprintf( stderr, "%f %f %f\n", objfromlh->Pos[0], objfromlh->Pos[1], objfromlh->Pos[2] ); - fprintf( stderr, "%f %f %f %f\n", objfromlh->Rot[0], objfromlh->Rot[1], objfromlh->Rot[2], objfromlh->Rot[3] ); - fprintf( stderr, "%f %f %f\n", lhp->Pos[0], lhp->Pos[1], lhp->Pos[2] ); + fprintf( stderr, "%f, %f, %f\n", objfromlh->Pos[0], objfromlh->Pos[1], objfromlh->Pos[2] ); + fprintf( stderr, "%f, %f, %f, %f\n", objfromlh->Rot[0], objfromlh->Rot[1], objfromlh->Rot[2], objfromlh->Rot[3] ); + /* -0.204066 3.238746 -0.856369 0.812203 -0.264897 0.505599 0.120520 @@ -554,23 +556,26 @@ static void handle_calibration( struct SurviveCalData *cd ) SurvivePose * objfromlh = &cd->hmd->FromLHPose[lh]; SurvivePose * lhp = &ctx->bsd[lh].Pose; - FLT pos[3] = { objfromlh->Pos[0], - objfromlh->Pos[1], - objfromlh->Pos[2] }; + FLT pos[3]; + quatrotatevector( pos, lhp->Rot, objfromlh->Pos ); pos[0] -= lhp->Pos[0]; pos[1] -= lhp->Pos[1]; pos[2] -= lhp->Pos[2]; - FLT rot[4] = { - lhp->Rot[0], - lhp->Rot[1], - lhp->Rot[2], - lhp->Rot[3] }; + //FLT rot[4] = { + // [0], + // lhp->Rot[1], + // lhp->Rot[2], + // lhp->Rot[3] }; + //quatrotatevector( pos, lhp->Rot, pos ); - quatrotatevector( pos, rot, pos ); + fprintf( stderr, "%f, %f, %f\n", objfromlh->Pos[0], objfromlh->Pos[1], objfromlh->Pos[2] ); + fprintf( stderr, "%f, %f, %f, %f\n", objfromlh->Rot[0], objfromlh->Rot[1], objfromlh->Rot[2], objfromlh->Rot[3] ); + fprintf( stderr, "%f, %f, %f\n", lhp->Pos[0], lhp->Pos[1], lhp->Pos[2] ); + fprintf( stderr, "%f, %f, %f, %f\n", lhp->Rot[0], lhp->Rot[1], lhp->Rot[2], lhp->Rot[3] ); - fprintf( stderr, "====> %f %f %f ", + fprintf( stderr, "====> %f %f %f\n", pos[0], pos[1], pos[2] ); } |