diff options
| author | Michael Turvey <mwturvey@users.noreply.github.com> | 2018-01-05 04:12:26 -0700 |
|---|---|---|
| committer | GitHub <noreply@github.com> | 2018-01-05 04:12:26 -0700 |
| commit | 3c64031e671e14eb3baf90ec12cfaa8c0ecb5eff (patch) | |
| tree | e5fea4c0e03d09122ac90de0f28617f3b62326e6 /src/survive_process.c | |
| parent | 98d62e595b90a76ecd6d4f87e95e5cc6af45a4ce (diff) | |
| parent | ed85661121c3ed8769a69d059fd3162aec33c6fe (diff) | |
| download | libsurvive-3c64031e671e14eb3baf90ec12cfaa8c0ecb5eff.tar.gz libsurvive-3c64031e671e14eb3baf90ec12cfaa8c0ecb5eff.tar.bz2 | |
Merge pull request #91 from mwturvey/MakeTrackingGood
Provide standard way for posers to report pose output
Diffstat (limited to 'src/survive_process.c')
| -rw-r--r-- | src/survive_process.c | 39 |
1 files changed, 30 insertions, 9 deletions
diff --git a/src/survive_process.c b/src/survive_process.c index 4b86144..1df24e9 100644 --- a/src/survive_process.c +++ b/src/survive_process.c @@ -66,20 +66,34 @@ void survive_default_angle_process( SurviveObject * so, int sensor_id, int acode void survive_default_button_process(SurviveObject * so, uint8_t eventType, uint8_t buttonId, uint8_t axis1Id, uint16_t axis1Val, uint8_t axis2Id, uint16_t axis2Val) { // do nothing. - //printf("ButtonEntry: eventType:%x, buttonId:%d, axis1:%d, axis1Val:%8.8x, axis2:%d, axis2Val:%8.8x\n", - // eventType, - // buttonId, - // axis1Id, - // axis1Val, - // axis2Id, - // axis2Val); + printf("ButtonEntry: eventType:%x, buttonId:%d, axis1:%d, axis1Val:%8.8x, axis2:%d, axis2Val:%8.8x\n", + eventType, + buttonId, + axis1Id, + axis1Val, + axis2Id, + axis2Val); if (buttonId == 24 && eventType == 1) // trigger engage { - for (int j = 0; j < 40; j++) + for (int j = 0; j < 6; j++) { - for (int i = 0; i < 0x1; i++) + for (int i = 0; i < 0x5; i++) { survive_haptic(so, 0, 0xf401, 0xb5a2, 0x0100); + //survive_haptic(so, 0, 0xf401, 0xb5a2, 0x0100); + OGUSleep(1000); + } + OGUSleep(20000); + } + } + if (buttonId == 2 && eventType == 1) // trigger engage + { + for (int j = 0; j < 6; j++) + { + for (int i = 0; i < 0x1; i++) + { + survive_haptic(so, 0, 0xf401, 0x05a2, 0xf100); + //survive_haptic(so, 0, 0xf401, 0xb5a2, 0x0100); OGUSleep(5000); } OGUSleep(20000); @@ -87,6 +101,13 @@ void survive_default_button_process(SurviveObject * so, uint8_t eventType, uint8 } } +void survive_default_raw_pose_process(SurviveObject * so, uint8_t lighthouse, FLT *pos, FLT *quat) +{ + // print the pose; + printf("Pose: [%1.1x][%s][% 08.8f,% 08.8f,% 08.8f] [% 08.8f,% 08.8f,% 08.8f,% 08.8f]\n", lighthouse, so->codename, pos[0], pos[1], pos[2], quat[0], quat[1], quat[2], quat[3]); + +} + void survive_default_imu_process( SurviveObject * so, int mask, FLT * accelgyromag, uint32_t timecode, int id ) { if( so->PoserFn ) |