1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
|
//<>< (C) 2016 C. N. Lohr, MOSTLY Under MIT/x11 License.
//
//Based off of https://github.com/collabora/OSVR-Vive-Libre
// Originally Copyright 2016 Philipp Zabel
// Originally Copyright 2016 Lubosz Sarnecki <lubosz.sarnecki@collabora.co.uk>
// Originally Copyright (C) 2013 Fredrik Hultin
// Originally Copyright (C) 2013 Jakob Bornecrantz
//
//But, re-written as best as I can to get it put under an open souce license instead of a forced-source license.
//If there are portions of the code too similar to the original, I would like to know so they can be re-written.
//All MIT/x11 Licensed Code in this file may be relicensed freely under the GPL or LGPL licenses.
#ifndef _SURVIVE_INTERNAL_H
#define _SURVIVE_INTERNAL_H
#include <stdlib.h>
#include <stdio.h>
#include <stdint.h>
#include <libusb-1.0/libusb.h>
#include <zlib.h>
#define SV_INFO( x... ) { char stbuff[1024]; sprintf( stbuff, x ); ctx->notefunction( ctx, stbuff ); }
#define SV_ERROR( x... ) { char stbuff[1024]; sprintf( stbuff, x ); ctx->faultfunction( ctx, stbuff ); }
//XXX TODO This one needs to be rewritten.
#define SV_KILL() exit(0)
#define SV_FLOAT double
#define USB_DEV_HMD 0
#define USB_DEV_LIGHTHOUSE 1
#define USB_DEV_WATCHMAN1 2
#define USB_DEV_WATCHMAN2 3
#define MAX_USB_DEVS 4
#define USB_IF_HMD 0
#define USB_IF_LIGHTHOUSE 1
#define USB_IF_WATCHMAN1 2
#define USB_IF_WATCHMAN2 3
#define USB_IF_LIGHTCAP 4
#define MAX_INTERFACES 5
#define INTBUFFSIZE 64
#define SENSORS_PER_OBJECT 32
struct SurviveContext;
struct SurviveUSBInterface;
typedef void (*usb_callback)( struct SurviveUSBInterface * ti );
struct SurviveUSBInterface
{
struct libusb_transfer * transfer;
struct SurviveContext * ctx;
int actual_len;
uint8_t buffer[INTBUFFSIZE];
usb_callback cb;
int which_interface_am_i; //for indexing into uiface
const char * hname; //human-readable names
};
struct SurviveObject
{
struct SurviveContext * ctx;
char codename[4];
int16_t buttonmask;
int16_t axis1;
int16_t axis2;
int16_t axis3;
int8_t charge;
int8_t charging:1;
int8_t ison:1;
int sensors;
int nr_locations;
SV_FLOAT * sensor_locations;
};
struct SurviveContext
{
//USB Subsystem
struct libusb_context* usbctx;
void(*faultfunction)( struct SurviveContext * ctx, const char * fault );
void(*notefunction)( struct SurviveContext * ctx, const char * fault );
struct libusb_device_handle * udev[MAX_USB_DEVS];
struct SurviveUSBInterface uiface[MAX_INTERFACES];
//Flood info, for calculating which laser is currently sweeping.
int8_t oldcode;
int32_t last_photo_time;
short total_photos;
int32_t total_photo_time;
int32_t total_pulsecode_time;
//Data Subsystem
struct SurviveObject headset;
struct SurviveObject watchman[2];
// struct SurvivePhoto
};
//USB Subsystem
void survive_usb_close( struct SurviveContext * t );
int survive_usb_init( struct SurviveContext * t );
int survive_usb_poll( struct SurviveContext * ctx );
int survive_get_config( char ** config, struct SurviveContext * ctx, int devno, int interface );
//Accept Data from backend.
void survive_data_cb( struct SurviveUSBInterface * si );
//Accept higher-level data.
void survive_light_process( struct SurviveObject * so, int sensor_id, int acode, int timeinsweep, uint32_t timecode, uint32_t length );
void survive_imu_process( struct SurviveObject * so, int16_t * accelgyro, uint32_t timecode, int id );
//Util
int survive_simple_inflate( struct SurviveContext * ctx, const char * input, int inlen, char * output, int outlen );
#endif
|
