nuclear@0: #include "vr_impl.h"
nuclear@0: 
nuclear@0: #ifdef USE_OPENHMD
nuclear@0: #include <stdio.h>
nuclear@0: #include <stdlib.h>
nuclear@15: #include <string.h>
nuclear@0: #include <openhmd/openhmd.h>
nuclear@0: #include "opt.h"
nuclear@0: 
nuclear@0: /* a noble spirit embiggens the framebuffer to avoid aliasing in the middle */
nuclear@1: #define FB_EMBIGGEN	1.5
nuclear@0: 
nuclear@0: static ohmd_context *ctx;
nuclear@0: static ohmd_device *dev;
nuclear@0: static void *optdb;
nuclear@0: static int new_frame = 1;
nuclear@0: 
nuclear@0: static int disp_width, disp_height;
nuclear@0: static float ipd;
nuclear@0: 
nuclear@0: static struct {
nuclear@0: 	unsigned int id;
nuclear@0: 	float umin, umax;
nuclear@0: 	float vmin, vmax;
nuclear@0: } eye_tex[2];
nuclear@0: 
nuclear@0: 
nuclear@0: static int init(void)
nuclear@0: {
nuclear@0: 	int i, num_hmds;
nuclear@8: 	float distort_k[6];
nuclear@0: 
nuclear@0: 	if(!(ctx = ohmd_ctx_create())) {
nuclear@0: 		fprintf(stderr, "failed to create OpenHMD context\n");
nuclear@0: 		ohmd_ctx_destroy(ctx);
nuclear@0: 		return -1;
nuclear@0: 	}
nuclear@0: 	if(!(num_hmds = ohmd_ctx_probe(ctx))) {
nuclear@0: 		fprintf(stderr, "no HMDs detected\n");
nuclear@0: 		return -1;
nuclear@0: 	}
nuclear@0: 
nuclear@0: 	for(i=0; i<num_hmds; i++) {
nuclear@0: 		const char *vendor = ohmd_list_gets(ctx, i, OHMD_VENDOR);
nuclear@0: 		const char *product = ohmd_list_gets(ctx, i, OHMD_PRODUCT);
nuclear@0: 		const char *devpath = ohmd_list_gets(ctx, i, OHMD_PATH);
nuclear@0: 
nuclear@0: 		printf("[%d] %s - %s (path: %s)\n", i, vendor, product, devpath);
nuclear@0: 	}
nuclear@0: 
nuclear@0: 	printf("opening device 0\n");
nuclear@0: 
nuclear@0: 	if(!(dev = ohmd_list_open_device(ctx, 0))) {
nuclear@0: 		fprintf(stderr, "failed to open device 0: %s\n", ohmd_ctx_get_error(ctx));
nuclear@0: 		return -1;
nuclear@0: 	}
nuclear@0: 
nuclear@0: 	ohmd_device_geti(dev, OHMD_SCREEN_HORIZONTAL_SIZE, &disp_width);
nuclear@0: 	ohmd_device_geti(dev, OHMD_SCREEN_VERTICAL_SIZE, &disp_height);
nuclear@0: 	ohmd_device_getf(dev, OHMD_EYE_IPD, &ipd);
nuclear@7: 	ipd /= 100.0f; /* convert ipd to meters */
nuclear@0: 
nuclear@0: 	if((optdb = create_options())) {
nuclear@15: 		int eye_width, eye_height;
nuclear@15: 
nuclear@12: 		set_option_int(optdb, VR_DISPLAY_WIDTH, disp_width);
nuclear@12: 		set_option_int(optdb, VR_DISPLAY_HEIGHT, disp_height);
nuclear@12: 		set_option_float(optdb, VR_IPD, ipd);
nuclear@0: 
nuclear@15: 		eye_width = (int)((float)(disp_width / 2) * FB_EMBIGGEN);
nuclear@15: 		eye_height = (int)((float)disp_height * FB_EMBIGGEN);
nuclear@15: 		set_option_int(optdb, VR_LEYE_XRES, eye_width);
nuclear@15: 		set_option_int(optdb, VR_LEYE_YRES, eye_height);
nuclear@15: 		set_option_int(optdb, VR_REYE_XRES, eye_width);
nuclear@15: 		set_option_int(optdb, VR_REYE_YRES, eye_height);
nuclear@0: 	}
nuclear@0: 
nuclear@8: 	ohmd_device_getf(dev, OHMD_DISTORTION_K, distort_k);
nuclear@8: 	printf("k: %g %g %g   %g %g %g\n", distort_k[0], distort_k[1], distort_k[2],
nuclear@8: 			distort_k[3], distort_k[4], distort_k[5]);
nuclear@8: 	/* TODO: DK2 returns all zeros here ... maybe we should detect that and switch to
nuclear@8: 	 * using the DK2 distortion mesh from the Oculus SDK. I'll have to connect the DK1
nuclear@8: 	 * again to finish the barrel distortion method.
nuclear@8: 	 */
nuclear@8: 
nuclear@0: 	return 0;
nuclear@0: }
nuclear@0: 
nuclear@0: static void cleanup(void)
nuclear@0: {
nuclear@0: 	if(ctx) {
nuclear@0: 		ohmd_ctx_destroy(ctx);
nuclear@0: 	}
nuclear@0: }
nuclear@0: 
nuclear@0: 
nuclear@0: static int set_option(const char *opt, enum opt_type type, void *valp)
nuclear@0: {
nuclear@15: 	float fval;
nuclear@15: 
nuclear@0: 	switch(type) {
nuclear@0: 	case OTYPE_INT:
nuclear@15: 		fval = (float)*(int*)valp;
nuclear@0: 		set_option_int(optdb, opt, *(int*)valp);
nuclear@0: 		break;
nuclear@0: 
nuclear@0: 	case OTYPE_FLOAT:
nuclear@15: 		fval = *(float*)valp;
nuclear@15: 		set_option_float(optdb, opt, fval);
nuclear@0: 		break;
nuclear@0: 	}
nuclear@15: 
nuclear@16: 	if(strcmp(opt, VR_RENDER_RES_SCALE) == 0) {
nuclear@15: 		int eye_width, eye_height;
nuclear@15: 		eye_width = (int)((float)(disp_width / 2) * FB_EMBIGGEN * fval);
nuclear@15: 		eye_height = (int)((float)disp_height * FB_EMBIGGEN * fval);
nuclear@15: 		set_option_int(optdb, VR_LEYE_XRES, eye_width);
nuclear@15: 		set_option_int(optdb, VR_LEYE_YRES, eye_height);
nuclear@15: 		set_option_int(optdb, VR_REYE_XRES, eye_width);
nuclear@15: 		set_option_int(optdb, VR_REYE_YRES, eye_height);
nuclear@15: 	}
nuclear@15: 
nuclear@0: 	return 0;
nuclear@0: }
nuclear@0: 
nuclear@0: static int get_option(const char *opt, enum opt_type type, void *valp)
nuclear@0: {
nuclear@0: 	switch(type) {
nuclear@0: 	case OTYPE_INT:
nuclear@0: 		return get_option_int(optdb, opt, valp);
nuclear@0: 	case OTYPE_FLOAT:
nuclear@0: 		return get_option_float(optdb, opt, valp);
nuclear@0: 	}
nuclear@0: 	return -1;
nuclear@0: }
nuclear@0: 
nuclear@7: static void translation(int eye, float *vec)
nuclear@0: {
nuclear@7: 	/* OpenHMD doesn't support positional tracking, so just return the eye offset */
nuclear@0: 
nuclear@7: 	vec[0] = (eye == VR_EYE_LEFT ? -ipd : ipd) / 2.0;
nuclear@7: 	vec[1] = vec[2] = 0.0f;
nuclear@0: }
nuclear@0: 
nuclear@7: static void rotation(int eye, float *quat)
nuclear@0: {
nuclear@0: 	if(!dev) {
nuclear@0: 		quat[0] = quat[1] = quat[2] = 0.0f;
nuclear@0: 		quat[3] = 1.0f;
nuclear@7: 		return;
nuclear@0: 	}
nuclear@0: 
nuclear@0: 	ohmd_device_getf(dev, OHMD_ROTATION_QUAT, quat);
nuclear@0: }
nuclear@0: 
nuclear@0: 
nuclear@0: static void view_matrix(int eye, float *mat)
nuclear@0: {
nuclear@0: 	ohmd_device_getf(dev, OHMD_LEFT_EYE_GL_MODELVIEW_MATRIX + eye, mat);
nuclear@0: }
nuclear@0: 
nuclear@0: static void proj_matrix(int eye, float znear, float zfar, float *mat)
nuclear@0: {
nuclear@7: 	ohmd_device_setf(dev, OHMD_PROJECTION_ZNEAR, &znear);
nuclear@7: 	ohmd_device_setf(dev, OHMD_PROJECTION_ZFAR, &zfar);
nuclear@0: 	ohmd_device_getf(dev, OHMD_LEFT_EYE_GL_PROJECTION_MATRIX + eye, mat);
nuclear@0: }
nuclear@0: 
nuclear@0: static void begin(int eye)
nuclear@0: {
nuclear@0: 	if(new_frame) {
nuclear@0: 		ohmd_ctx_update(ctx);
nuclear@0: 		new_frame = 0;
nuclear@0: 	}
nuclear@0: }
nuclear@0: 
nuclear@0: static int present(void)
nuclear@0: {
nuclear@0: 	new_frame = 1;
nuclear@0: 	return 0;
nuclear@0: }
nuclear@0: 
nuclear@0: static void set_eye_texture(int eye, unsigned int tex, float umin, float vmin, float umax, float vmax)
nuclear@0: {
nuclear@0: 	eye_tex[eye].id = tex;
nuclear@0: 	eye_tex[eye].umin = umin;
nuclear@0: 	eye_tex[eye].umax = umax;
nuclear@0: 	eye_tex[eye].vmin = vmin;
nuclear@0: 	eye_tex[eye].vmax = vmax;
nuclear@0: }
nuclear@0: 
nuclear@0: static void recenter(void)
nuclear@0: {
nuclear@7: 	/* TODO grab the current rotation quat, invert it, and use it to
nuclear@7: 	 * multiply with the rotation quat query results
nuclear@7: 	 */
nuclear@0: }
nuclear@0: 
nuclear@0: 
nuclear@0: struct vr_module *vr_module_openhmd(void)
nuclear@0: {
nuclear@0: 	static struct vr_module m;
nuclear@0: 
nuclear@0: 	if(!m.init) {
nuclear@0: 		m.name = "openhmd";
nuclear@0: 		m.init = init;
nuclear@0: 		m.cleanup = cleanup;
nuclear@0: 		m.set_option = set_option;
nuclear@0: 		m.get_option = get_option;
nuclear@7: 		m.translation = translation;
nuclear@7: 		m.rotation = rotation;
nuclear@0: 		m.view_matrix = view_matrix;
nuclear@0: 		m.proj_matrix = proj_matrix;
nuclear@0: 		m.begin = begin;
nuclear@0: 		m.present = present;
nuclear@8: 		/*m.set_eye_texture = set_eye_texture;*/
nuclear@0: 		m.recenter = recenter;
nuclear@0: 	}
nuclear@7: 	return &m;
nuclear@0: }
nuclear@0: 
nuclear@0: #else	/* don't use OpenHMD */
nuclear@0: 
nuclear@0: static int init(void)
nuclear@0: {
nuclear@0: 	return -1;
nuclear@0: }
nuclear@0: 
nuclear@0: struct vr_module *vr_module_openhmd(void)
nuclear@0: {
nuclear@0: 	static struct vr_module m;
nuclear@0: 
nuclear@0: 	if(!m.init) {
nuclear@0: 		m.name = "openhmd";
nuclear@0: 		m.init = init;
nuclear@0: 	}
nuclear@0: 	return &m;
nuclear@0: }
nuclear@0: 
nuclear@0: #endif	/* USE_OPENHMD */