oculus1

annotate src/vr.cc @ 4:bb81990dc7c8

getting sensor input
author John Tsiombikas <nuclear@member.fsf.org>
date Sun, 15 Sep 2013 04:47:12 +0300
parents b069a5c27388
children 681046a82ed2
rev   line source
nuclear@1 1 #include <stdio.h>
nuclear@1 2 #include "vr.h"
nuclear@1 3 #include "vr_impl.h"
nuclear@1 4
nuclear@1 5 static bool init_ovr();
nuclear@1 6
nuclear@3 7 VRContext vr_ctx;
nuclear@1 8
nuclear@1 9 extern "C" int vr_init(enum vr_init_mode mode)
nuclear@1 10 {
nuclear@1 11 if(!init_ovr()) {
nuclear@1 12 return -1;
nuclear@1 13 }
nuclear@1 14 return 0;
nuclear@1 15 }
nuclear@1 16
nuclear@1 17 extern "C" void vr_shutdown(void)
nuclear@1 18 {
nuclear@3 19 //System::Destroy();
nuclear@1 20 }
nuclear@1 21
nuclear@1 22 static bool init_ovr()
nuclear@1 23 {
nuclear@1 24 // initialize Oculus SDK
nuclear@4 25 System::Init(Log::ConfigureDefaultLog(LogMask_All));
nuclear@3 26 if(!(vr_ctx.ovr_devman = DeviceManager::Create())) {
nuclear@1 27 fprintf(stderr, "failed to create OVR device manager\n");
nuclear@1 28 return false;
nuclear@1 29 }
nuclear@1 30
nuclear@1 31 // create the display device
nuclear@4 32 HMDInfo info;
nuclear@3 33 if(!(vr_ctx.ovr_hmd_dev = vr_ctx.ovr_devman->EnumerateDevices<HMDDevice>().CreateDevice())) {
nuclear@1 34 fprintf(stderr, "no oculus rift devices found\n");
nuclear@4 35 } else {
nuclear@4 36 if(vr_ctx.ovr_hmd_dev->GetDeviceInfo(&info)) {
nuclear@4 37 printf("oculus device info:\n");
nuclear@4 38 printf(" name: %s\n", info.DisplayDeviceName);
nuclear@4 39 printf(" ipd: %f\n", info.InterpupillaryDistance);
nuclear@4 40 printf(" distortion: %f %f %f %f\n", info.DistortionK[0],
nuclear@4 41 info.DistortionK[1], info.DistortionK[2], info.DistortionK[3]);
nuclear@4 42 }
nuclear@1 43
nuclear@4 44 // calculate and store viewing parameters
nuclear@4 45 float vhalfsz = info.VScreenSize * 0.5;
nuclear@4 46 vr_ctx.info.fov = 2.0 * atan(vhalfsz / info.EyeToScreenDistance);
nuclear@4 47
nuclear@4 48 vr_ctx.info.width = info.HResolution;
nuclear@4 49 vr_ctx.info.height = info.VResolution;
nuclear@4 50 vr_ctx.info.aspect = (float)vr_ctx.info.width / (float)vr_ctx.info.height;
nuclear@4 51
nuclear@4 52 vr_ctx.info.ipd = info.InterpupillaryDistance;
nuclear@4 53 for(int i=0; i<4; i++) {
nuclear@4 54 vr_ctx.info.distort[i] = info.DistortionK[i];
nuclear@4 55 }
nuclear@1 56 }
nuclear@1 57
nuclear@1 58 // get the sensor device
nuclear@4 59 if(vr_ctx.ovr_hmd_dev) {
nuclear@4 60 if(!(vr_ctx.ovr_sensor_dev = vr_ctx.ovr_hmd_dev->GetSensor())) {
nuclear@4 61 fprintf(stderr, "failed to get oculus sensor device\n");
nuclear@4 62 }
nuclear@4 63 } else {
nuclear@4 64 if(!(vr_ctx.ovr_sensor_dev = vr_ctx.ovr_devman->EnumerateDevices<SensorDevice>().CreateDevice())) {
nuclear@4 65 fprintf(stderr, "failed to get oculus sensor device\n");
nuclear@4 66 }
nuclear@1 67 }
nuclear@1 68
nuclear@4 69 if(vr_ctx.ovr_sensor_dev) {
nuclear@4 70 SensorInfo sinfo;
nuclear@4 71 if(vr_ctx.ovr_sensor_dev->GetDeviceInfo(&sinfo)) {
nuclear@4 72 printf("oculus sensor device info:\n");
nuclear@4 73 printf(" name: %s\n", sinfo.ProductName);
nuclear@4 74 }
nuclear@4 75
nuclear@4 76 vr_ctx.ovr_sfusion.AttachToSensor(vr_ctx.ovr_sensor_dev);
nuclear@1 77 }
nuclear@1 78 return true;
nuclear@1 79 }
nuclear@3 80
nuclear@3 81 extern "C" int vr_get_width(void)
nuclear@3 82 {
nuclear@3 83 return vr_ctx.info.width;
nuclear@3 84 }
nuclear@3 85
nuclear@3 86 extern "C" int vr_get_height(void)
nuclear@3 87 {
nuclear@3 88 return vr_ctx.info.height;
nuclear@3 89 }
nuclear@3 90
nuclear@3 91 extern "C" float vr_get_fov(void)
nuclear@3 92 {
nuclear@3 93 return vr_ctx.info.fov;
nuclear@3 94 }
nuclear@3 95
nuclear@3 96 extern "C" float vr_get_aspect(void)
nuclear@3 97 {
nuclear@3 98 return vr_ctx.info.aspect;
nuclear@3 99 }
nuclear@3 100
nuclear@3 101 extern "C" void vr_set_eyedist(float ipd)
nuclear@3 102 {
nuclear@3 103 vr_ctx.info.ipd = ipd;
nuclear@3 104 }
nuclear@3 105
nuclear@3 106 extern "C" float vr_get_eyedist(void)
nuclear@3 107 {
nuclear@3 108 return vr_ctx.info.ipd;
nuclear@3 109 }
nuclear@3 110
nuclear@3 111 extern "C" void vr_set_distort(const float *coef)
nuclear@3 112 {
nuclear@3 113 memcpy(vr_ctx.info.distort, coef, sizeof vr_ctx.info.distort);
nuclear@3 114 }
nuclear@3 115
nuclear@3 116 extern "C" void vr_get_distort(float *coef)
nuclear@3 117 {
nuclear@3 118 memcpy(coef, vr_ctx.info.distort, sizeof vr_ctx.info.distort);
nuclear@3 119 }
nuclear@3 120
nuclear@3 121 extern "C" void vr_set_prediction_sec(float dt)
nuclear@3 122 {
nuclear@3 123 vr_ctx.ovr_sfusion.SetPrediction(dt);
nuclear@3 124 }
nuclear@3 125
nuclear@3 126 extern "C" float vr_get_prediction_sec(void)
nuclear@3 127 {
nuclear@3 128 return vr_ctx.ovr_sfusion.GetPredictionDelta();
nuclear@3 129 }
nuclear@3 130
nuclear@3 131 extern "C" void vr_get_translation(float *offs)
nuclear@3 132 {
nuclear@3 133 // current oculus devkit doesn't do translation
nuclear@3 134 offs[0] = offs[1] = offs[2] = 0.0f;
nuclear@3 135 }
nuclear@3 136
nuclear@3 137 extern "C" void vr_get_rotation(float *quat)
nuclear@3 138 {
nuclear@3 139 Quatf oq = vr_ctx.ovr_sfusion.GetPredictedOrientation();
nuclear@3 140 quat[0] = oq.x;
nuclear@3 141 quat[1] = oq.y;
nuclear@3 142 quat[2] = oq.z;
nuclear@3 143 quat[3] = oq.w;
nuclear@3 144 }
nuclear@3 145
nuclear@3 146 extern "C" void vr_get_rotation_euler(float *euler)
nuclear@3 147 {
nuclear@3 148 Quatf oq = vr_ctx.ovr_sfusion.GetPredictedOrientation();
nuclear@3 149 oq.GetEulerAngles<Axis_Y, Axis_X, Axis_Z>(euler + 1, euler, euler + 2);
nuclear@3 150 }