nuclear@10: #include "vr_impl.h"
nuclear@10: 
nuclear@10: #ifdef USE_OPENHMD
nuclear@10: #include <stdio.h>
nuclear@10: #include <stdlib.h>
nuclear@10: #include <openhmd/openhmd.h>
nuclear@10: #include "opt.h"
nuclear@10: 
nuclear@10: /* a noble spirit embiggens the framebuffer to avoid aliasing in the middle */
nuclear@10: #define EMBIGGEN	1.5
nuclear@10: 
nuclear@10: static ohmd_context *ctx;
nuclear@10: static ohmd_device *dev;
nuclear@10: static void *optdb;
nuclear@10: static int new_frame = 1;
nuclear@10: 
nuclear@10: static int disp_width, disp_height;
nuclear@10: static float ipd;
nuclear@10: 
nuclear@10: static struct {
nuclear@10: 	unsigned int id;
nuclear@10: 	float umin, umax;
nuclear@10: 	float vmin, vmax;
nuclear@10: } eye_tex[2];
nuclear@10: 
nuclear@10: 
nuclear@10: static int init(void)
nuclear@10: {
nuclear@10: 	int i, num_hmds;
nuclear@10: 
nuclear@10: 	if(!(ctx = ohmd_ctx_create())) {
nuclear@10: 		fprintf(stderr, "failed to create OpenHMD context\n");
nuclear@10: 		ohmd_ctx_destroy(ctx);
nuclear@10: 		return -1;
nuclear@10: 	}
nuclear@10: 	if(!(num_hmds = ohmd_ctx_probe(ctx))) {
nuclear@10: 		fprintf(stderr, "no HMDs detected\n");
nuclear@10: 		return -1;
nuclear@10: 	}
nuclear@10: 
nuclear@10: 	for(i=0; i<num_hmds; i++) {
nuclear@10: 		const char *vendor = ohmd_list_gets(ctx, i, OHMD_VENDOR);
nuclear@10: 		const char *product = ohmd_list_gets(ctx, i, OHMD_PRODUCT);
nuclear@10: 		const char *devpath = ohmd_list_gets(ctx, i, OHMD_PATH);
nuclear@10: 
nuclear@10: 		printf("[%d] %s - %s (path: %s)\n", i, vendor, product, devpath);
nuclear@10: 	}
nuclear@10: 
nuclear@10: 	printf("opening device 0\n");
nuclear@10: 
nuclear@10: 	if(!(dev = ohmd_list_open_device(ctx, 0))) {
nuclear@10: 		fprintf(stderr, "failed to open device 0: %s\n", ohmd_ctx_get_error(ctx));
nuclear@10: 		return -1;
nuclear@10: 	}
nuclear@10: 
nuclear@10: 	ohmd_device_geti(dev, OHMD_SCREEN_HORIZONTAL_SIZE, &disp_width);
nuclear@10: 	ohmd_device_geti(dev, OHMD_SCREEN_VERTICAL_SIZE, &disp_height);
nuclear@10: 	ohmd_device_getf(dev, OHMD_EYE_IPD, &ipd);
nuclear@10: 
nuclear@10: 	if((optdb = create_options())) {
nuclear@10: 		set_option_int(optdb, VR_OPT_DISPLAY_WIDTH, disp_width);
nuclear@10: 		set_option_int(optdb, VR_OPT_DISPLAY_HEIGHT, disp_height);
nuclear@10: 		set_option_float(optdb, VR_OPT_IPD, ipd);
nuclear@10: 
nuclear@10: 		set_option_int(optdb, VR_OPT_LEYE_XRES, (int)(disp_width / 2.0 * FB_EMBIGGEN));
nuclear@10: 		set_option_int(optdb, VR_OPT_LEYE_YRES, (int)(disp_height * FB_EMBIGGEN));
nuclear@10: 		set_option_int(optdb, VR_OPT_REYE_XRES, (int)(disp_width / 2.0 * FB_EMBIGGEN));
nuclear@10: 		set_option_int(optdb, VR_OPT_REYE_YRES, (int)(disp_height * FB_EMBIGGEN));
nuclear@10: 	}
nuclear@10: 
nuclear@10: 	return 0;
nuclear@10: }
nuclear@10: 
nuclear@10: static void cleanup(void)
nuclear@10: {
nuclear@10: 	if(ctx) {
nuclear@10: 		ohmd_ctx_destroy(ctx);
nuclear@10: 	}
nuclear@10: }
nuclear@10: 
nuclear@10: 
nuclear@10: static int set_option(const char *opt, enum opt_type type, void *valp)
nuclear@10: {
nuclear@10: 	switch(type) {
nuclear@10: 	case OTYPE_INT:
nuclear@10: 		set_option_int(optdb, opt, *(int*)valp);
nuclear@10: 		break;
nuclear@10: 
nuclear@10: 	case OTYPE_FLOAT:
nuclear@10: 		set_option_float(optdb, opt, *(float*)valp);
nuclear@10: 		break;
nuclear@10: 	}
nuclear@10: 	return 0;
nuclear@10: }
nuclear@10: 
nuclear@10: static int get_option(const char *opt, enum opt_type type, void *valp)
nuclear@10: {
nuclear@10: 	switch(type) {
nuclear@10: 	case OTYPE_INT:
nuclear@10: 		return get_option_int(optdb, opt, valp);
nuclear@10: 	case OTYPE_FLOAT:
nuclear@10: 		return get_option_float(optdb, opt, valp);
nuclear@10: 	}
nuclear@10: 	return -1;
nuclear@10: }
nuclear@10: 
nuclear@10: static int translation(int eye, float *vec)
nuclear@10: {
nuclear@10: 	float xform[16];
nuclear@10: 
nuclear@10: 	view_matrix(eye, xform);
nuclear@10: 
nuclear@10: 	vec[0] = xform[3];
nuclear@10: 	vec[1] = xform[7];
nuclear@10: 	vec[2] = xform[11];
nuclear@10: 	return 0;
nuclear@10: }
nuclear@10: 
nuclear@10: static int rotation(int eye, float *quat)
nuclear@10: {
nuclear@10: 	if(!dev) {
nuclear@10: 		quat[0] = quat[1] = quat[2] = 0.0f;
nuclear@10: 		quat[3] = 1.0f;
nuclear@10: 		return -1;
nuclear@10: 	}
nuclear@10: 
nuclear@10: 	ohmd_device_getf(dev, OHMD_ROTATION_QUAT, quat);
nuclear@10: 	return 0;
nuclear@10: }
nuclear@10: 
nuclear@10: 
nuclear@10: static void view_matrix(int eye, float *mat)
nuclear@10: {
nuclear@10: 	ohmd_device_getf(dev, OHMD_LEFT_EYE_GL_MODELVIEW_MATRIX + eye, mat);
nuclear@10: }
nuclear@10: 
nuclear@10: static void proj_matrix(int eye, float znear, float zfar, float *mat)
nuclear@10: {
nuclear@10: 	ohmd_device_setf(dev, OHMD_PROJECTION_ZNEAR, znear);
nuclear@10: 	ohmd_device_setf(dev, OHMD_PROJECTION_ZFAR, zfar);
nuclear@10: 	ohmd_device_getf(dev, OHMD_LEFT_EYE_GL_PROJECTION_MATRIX + eye, mat);
nuclear@10: }
nuclear@10: 
nuclear@10: static void begin(int eye)
nuclear@10: {
nuclear@10: 	if(new_frame) {
nuclear@10: 		ohmd_ctx_update(ctx);
nuclear@10: 		new_frame = 0;
nuclear@10: 	}
nuclear@10: }
nuclear@10: 
nuclear@10: static int present(void)
nuclear@10: {
nuclear@10: 	new_frame = 1;
nuclear@10: 	return 0;
nuclear@10: }
nuclear@10: 
nuclear@10: static void set_eye_texture(int eye, unsigned int tex, float umin, float vmin, float umax, float vmax)
nuclear@10: {
nuclear@10: 	eye_tex[eye].id = tex;
nuclear@10: 	eye_tex[eye].umin = umin;
nuclear@10: 	eye_tex[eye].umax = umax;
nuclear@10: 	eye_tex[eye].vmin = vmin;
nuclear@10: 	eye_tex[eye].vmax = vmax;
nuclear@10: }
nuclear@10: 
nuclear@10: static void recenter(void)
nuclear@10: {
nuclear@10: 	/* TODO does OHMD support the magnetometer? */
nuclear@10: }
nuclear@10: 
nuclear@10: 
nuclear@10: struct vr_module *vr_module_openhmd(void)
nuclear@10: {
nuclear@10: 	static struct vr_module m;
nuclear@10: 
nuclear@10: 	if(!m.init) {
nuclear@10: 		m.name = "openhmd";
nuclear@10: 		m.init = init;
nuclear@10: 		m.cleanup = cleanup;
nuclear@10: 		m.set_option = set_option;
nuclear@10: 		m.get_option = get_option;
nuclear@10: 		m.view_matrix = view_matrix;
nuclear@10: 		m.proj_matrix = proj_matrix;
nuclear@10: 		m.begin = begin;
nuclear@10: 		m.present = present;
nuclear@10: 		m.set_eye_texture = set_eye_texture;
nuclear@10: 		m.recenter = recenter;
nuclear@10: 	}
nuclear@10: }
nuclear@10: 
nuclear@10: #else	/* don't use OpenHMD */
nuclear@10: 
nuclear@10: static int init(void)
nuclear@10: {
nuclear@10: 	return -1;
nuclear@10: }
nuclear@10: 
nuclear@10: struct vr_module *vr_module_openhmd(void)
nuclear@10: {
nuclear@10: 	static struct vr_module m;
nuclear@10: 
nuclear@10: 	if(!m.init) {
nuclear@10: 		m.name = "openhmd";
nuclear@10: 		m.init = init;
nuclear@10: 	}
nuclear@10: 	return &m;
nuclear@10: }
nuclear@10: 
nuclear@10: #endif	/* USE_OPENHMD */