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
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
|
#ifndef __CPHIDGETSPATIAL
#define __CPHIDGETSPATIAL
#include "cphidget.h"
/** \defgroup phidspatial Phidget Spatial
* \ingroup phidgets
* These calls are specific to the Phidget Spatial object. See your device's User Guide for more specific API details, technical information, and revision details. The User Guide, along with other resources, can be found on the product page for your device.
* @{
*/
DPHANDLE(Spatial)
CHDRSTANDARD(Spatial)
/**
* Timestamped position data returned by the \ref CPhidgetSpatial_set_OnSpatialData_Handler event.
*/
typedef struct _CPhidgetSpatial_SpatialEventData
{
double acceleration[3]; /**< Acceleration data for up to 3 axes. */
double angularRate[3]; /**< Angular rate data (Gyroscope) for up to 3 axes */
double magneticField[3]; /**< Magnetic field data (Compass) for up to 3 axes */
CPhidget_Timestamp timestamp; /**< Hardware timestamp */
} CPhidgetSpatial_SpatialEventData, *CPhidgetSpatial_SpatialEventDataHandle;
/**
* Gets the number of acceleration axes supplied by this board.
* @param phid An attached phidget spatial handle.
* @param count The number of acceleration axes.
*/
CHDRGET(Spatial,AccelerationAxisCount,int *count)
/**
* Gets the number of gyroscope axes supplied by this board.
* @param phid An attached phidget spatial handle.
* @param count The number of gyro axes.
*/
CHDRGET(Spatial,GyroAxisCount,int *count)
/**
* Gets the number of compass axes supplied by this board.
* @param phid An attached phidget spatial handle.
* @param count The number of compass axes.
*/
CHDRGET(Spatial,CompassAxisCount,int *count)
/**
* Gets the current acceleration of an axis.
* @param phid An attached phidget spatial handle.
* @param index The acceleration index.
* @param acceleration The acceleration in gs.
*/
CHDRGETINDEX(Spatial,Acceleration,double *acceleration)
/**
* Gets the maximum accleration supported by an axis.
* @param phid An attached phidget spatial handle.
* @param index The acceleration index
* @param max The maximum acceleration
*/
CHDRGETINDEX(Spatial,AccelerationMax,double *max)
/**
* Gets the minimum acceleration supported by an axis.
* @param phid An attached phidget spatial handle.
* @param index The acceleration index
* @param min The minimum acceleration
*/
CHDRGETINDEX(Spatial,AccelerationMin,double *min)
/**
* Gets the current angular rate of an axis.
* @param phid An attached phidget spatial handle.
* @param index The angular rate index.
* @param angularRate The angular rate in degrees/second.
*/
CHDRGETINDEX(Spatial,AngularRate,double *angularRate)
/**
* Gets the maximum angular rate supported by an axis.
* @param phid An attached phidget spatial handle.
* @param index The angular rate index
* @param max The maximum angular rate
*/
CHDRGETINDEX(Spatial,AngularRateMax,double *max)
/**
* Gets the minimum angular rate supported by an axis.
* @param phid An attached phidget spatial handle.
* @param index The angular rate index
* @param min The minimum angular rate
*/
CHDRGETINDEX(Spatial,AngularRateMin,double *min)
/**
* Gets the current magnetic field stregth of an axis.
* @param phid An attached phidget spatial handle.
* @param index The magnetic field index.
* @param magneticField The magnetic field strength in Gauss.
*/
CHDRGETINDEX(Spatial,MagneticField,double *magneticField)
/**
* Gets the maximum magnetic field stregth supported by an axis.
* @param phid An attached phidget spatial handle.
* @param index The magnetic field index
* @param max The maximum magnetic field stregth
*/
CHDRGETINDEX(Spatial,MagneticFieldMax,double *max)
/**
* Gets the minimum magnetic field stregth supported by an axis.
* @param phid An attached phidget spatial handle.
* @param index The magnetic field index
* @param min The minimum magnetic field stregth
*/
CHDRGETINDEX(Spatial,MagneticFieldMin,double *min)
/**
* Zeroes the gyroscope. This takes about two seconds and the gyro zxes will report 0 during the process.
* This should only be called when the board is not moving.
* @param phid An attached phidget spatial handle.
*/
PHIDGET21_API int CCONV CPhidgetSpatial_zeroGyro(CPhidgetSpatialHandle phid);
/**
* Get the data rate.
* @param phid An attached phidget spatial handle.
* @param milliseconds The data rate in milliseconds.
*/
CHDRGET(Spatial, DataRate, int *milliseconds)
/**
* Sets the data rate. Note that data at rates faster then 8ms will be delivered to events as an array of data.
* @param phid An attached phidget spatial handle.
* @param milliseconds The data rate in milliseconds.
*/
CHDRSET(Spatial, DataRate, int milliseconds)
/**
* Gets the maximum supported data rate.
* @param phid An attached phidget spatial handle.
* @param max Data rate in ms.
*/
CHDRGET(Spatial, DataRateMax, int *max)
/**
* Gets the minimum supported data rate.
* @param phid An attached phidget spatial handle.
* @param min Data rate in ms.
*/
CHDRGET(Spatial, DataRateMin, int *min)
/**
* Sets the compass correction factors. This can be used to correcting any sensor errors, including hard and soft iron offsets and sensor error factors.
* @param phid An attached phidget spatial handle.
* @param magField Local magnetic field strength.
* @param offset0 Axis 0 offset correction.
* @param offset1 Axis 1 offset correction.
* @param offset2 Axis 2 offset correction.
* @param gain0 Axis 0 gain correction.
* @param gain1 Axis 1 gain correction.
* @param gain2 Axis 2 gain correction.
* @param T0 Non-orthogonality correction factor 0.
* @param T1 Non-orthogonality correction factor 1.
* @param T2 Non-orthogonality correction factor 2.
* @param T3 Non-orthogonality correction factor 3.
* @param T4 Non-orthogonality correction factor 4.
* @param T5 Non-orthogonality correction factor 5.
*/
CHDRSET(Spatial, CompassCorrectionParameters, double magField, double offset0, double offset1, double offset2, double gain0, double gain1, double gain2, double T0, double T1, double T2, double T3, double T4, double T5)
/**
* Resets the compass correction factors. Magnetic field data will be presented directly as reported by the sensor.
* @param phid An attached phidget spatial handle.
*/
PHIDGET21_API int CCONV CPhidgetSpatial_resetCompassCorrectionParameters(CPhidgetSpatialHandle phid);
/**
* Set a Data event handler. This is called at /ref CPhidgetSpatial_getDataRate, up to 8ms, for faster then 8ms data, multiple
* sets of data are supplied in a single event.
* @param phid An attached phidget spatial handle.
* @param fptr Callback function pointer.
* @param userPtr A pointer for use by the user - this value is passed back into the callback function.
*/
CHDREVENT(Spatial,SpatialData,CPhidgetSpatial_SpatialEventDataHandle *data, int dataCount)
//These are for a prototype device - hide until it's released
#if !defined(EXTERNALPROTO) || defined(DEBUG)
#define SPATIAL_ANALOG_AND_DIGITAL 0x00
#define SPATIAL_ANALOG 0x01
#define SPATIAL_DIGITAL 0x02
typedef enum {
PHIDGET_SPATIAL_ANALOG_AND_DIGITAL = 0, /**< Analog failover to digital */
PHIDGET_SPATIAL_ANALOG, /**< Analog only */
PHIDGET_SPATIAL_DIGITAL, /**< Digital only */
} CPhidgetSpatial_AnalogDigitalMode;
CHDRSET(Spatial, AnalogDigitalMode, CPhidgetSpatial_AnalogDigitalMode mode)
PHIDGET21_API int CCONV CPhidgetSpatial_unZeroGyro(CPhidgetSpatialHandle phid);
PHIDGET21_API int CCONV CPhidgetSpatial_setDigitalGyroCalibrationValues(CPhidgetSpatialHandle phid,
double gainPositive[3], double gainNegative[3], double offset[3], double factor1[3], double factor2[3]);
PHIDGET21_API int CCONV CPhidgetSpatial_setAnalogGyroCalibrationValues(CPhidgetSpatialHandle phid,
double gainPositive[3], double gainNegative[3], double offset[3], double factor1[3], double factor2[3]);
PHIDGET21_API int CCONV CPhidgetSpatial_setDigitalAccelCalibrationValues(CPhidgetSpatialHandle phid,
double gainPositive[3], double gainNegative[3], double offset[3], double factor1[3], double factor2[3]);
PHIDGET21_API int CCONV CPhidgetSpatial_setAnalogAccelCalibrationValues(CPhidgetSpatialHandle phid,
double gainPositive[3], double gainNegative[3], double offset[3], double factor1[3], double factor2[3]);
#endif
#ifndef EXTERNALPROTO
#define SPATIAL_MAX_ACCELAXES 3
#define SPATIAL_MAX_GYROAXES 3
#define SPATIAL_MAX_COMPASSAXES 3
//in milliseconds - this is the fastest hardware rate of any device
#define SPATIAL_MAX_DATA_RATE 1
//1 second is the longest between events that we support
#define SPATIAL_MIN_DATA_RATE 1000
//add 200ms for timing differences (late events, etc) - should be plenty
#define SPATIAL_DATA_BUFFER_SIZE ((SPATIAL_MIN_DATA_RATE * 2 + 200)/SPATIAL_MAX_DATA_RATE)
//2 seconds of data to zero the gyro - make sure DATA_BUFFER_SIZE is big enough to hold this much data
#define SPATIAL_ZERO_GYRO_TIME 2000
//packet types
//IN
#define SPATIAL_PACKET_DATA 0x00
#define SPATIAL_PACKET_CALIB 0x80
//OUT
#define SPATIAL_READCALIB 0x01
#define SPATIAL_SET_POLLING_TYPE 0x02
#define SPATIAL_ZERO_GYRO 0x03
#define SPATIAL_UNZERO_GYRO 0x04
//M3 Spatial calibration table indexes
#define SPATIAL_DIGITAL_ACCEL_CALIB_TABLE_INDEX 0
#define SPATIAL_ANALOG_ACCEL_CALIB_TABLE_INDEX 1
#define SPATIAL_DIGITAL_GYRO_CALIB_TABLE_INDEX 2
#define SPATIAL_ANALOG_GYRO_CALIB_TABLE_INDEX 3
#define SPATIAL_COMPASS_CALIB_TABLE_INDEX 4
#define SPATIAL_COMPASS_TEMP_CALIB_TABLE_INDEX 5
#define SPATIAL_ACCEL_GYRO_CALIB_TABLE_LENGTH 64
#define SPATIAL_COMPASS_CALIB_TABLE_LENGTH 56
#define SPATIAL_GyroCalibTable_ID 1000
#define SPATIAL_AccelCalibTable_ID 1001
/**
* M3 Spatial constants (1041, 1042, 1043, 1044)
* -Values are transmitted as signed integers with a unit of 'bits'
* -Values are calibrated in-firmware
* -Values are centered at zero
*
* Precision Voltage Ref is 3.3 V
* AD7689 ADC is 16-bit
*
* LPR410AL x,y Analog Gyro is 2.5 mV/dps and +-400 dps
* LY330ALH z-axis Analog Gyro is 3.752 mV/dps and +-300 dps
* L3GD20 Digital Gyro is 70 mdps/bit and +-2000 dps
*
* KXR94-2050 Analog Accelerometer is 660 mV/g and +-2g
* MMA8451Q Digital Accelerometer is 1024 bits/g and +-8g
*
* HMC5883L Digital Compass is 3.03 mG/bit and +-5.6 Gauss
**/
#define SPATIAL_VOLTAGE_REF 3.3
#define SPATIAL_AD7689_BITS_PER_VOLT (0x10000 / SPATIAL_VOLTAGE_REF)
#define SPATIAL_LPR410AL_VOLTS_PER_DPS 0.0025
#define SPATIAL_LRP410AL_w_AD7689_BITS_PER_DPS (SPATIAL_LPR410AL_VOLTS_PER_DPS * SPATIAL_AD7689_BITS_PER_VOLT)
#define SPATIAL_LY330ALH_VOLTS_PER_DPS 0.003752
#define SPATIAL_LY330ALH_w_AD7689_BITS_PER_DPS (SPATIAL_LY330ALH_VOLTS_PER_DPS * SPATIAL_AD7689_BITS_PER_VOLT)
#define SPATIAL_L3GD20_DPS_PER_BIT 0.07
#define SPATIAL_L3GD20_BITS_PER_DPS (1 / SPATIAL_L3GD20_DPS_PER_BIT)
#define SPATIAL_KXR94_2050_VOLTS_PER_G 0.660
#define SPATIAL_KXR94_2050_w_AD7689_BITS_PER_G (SPATIAL_KXR94_2050_VOLTS_PER_G * SPATIAL_AD7689_BITS_PER_VOLT)
#define SPATIAL_MMA8451Q_BITS_PER_G 1024
#define SPATIAL_HMC5883L_GAUSS_PER_BIT 0.00303
#define SPATIAL_HMC5883L_BITS_PER_GAUSS (1 / SPATIAL_HMC5883L_GAUSS_PER_BIT)
struct _CPhidgetSpatial {
CPhidget phid;
int (CCONV *fptrSpatialData)(CPhidgetSpatialHandle, void *, CPhidgetSpatial_SpatialEventDataHandle *, int);
void *fptrSpatialDataptr;
double accelAxis[SPATIAL_MAX_ACCELAXES];
double gyroAxis[SPATIAL_MAX_GYROAXES];
double compassAxis[SPATIAL_MAX_COMPASSAXES];
double gryoCorrection[SPATIAL_MAX_GYROAXES];
unsigned char doZeroGyro;
int gyroZeroReadPtr;
CPhidgetSpatial_SpatialEventData dataBuffer[SPATIAL_DATA_BUFFER_SIZE];
int bufferReadPtr, bufferWritePtr;
double accelerationMax, accelerationMin;
double angularRateMax, angularRateMin;
double magneticFieldMax, magneticFieldMin;
unsigned char calDataValid;
double accelGain1[SPATIAL_MAX_ACCELAXES];
double accelGain2[SPATIAL_MAX_ACCELAXES];
double accelOffset[SPATIAL_MAX_ACCELAXES];
double accelFactor1[SPATIAL_MAX_ACCELAXES];
double accelFactor2[SPATIAL_MAX_ACCELAXES];
double gyroGain1[SPATIAL_MAX_GYROAXES];
double gyroGain2[SPATIAL_MAX_GYROAXES];
double gyroOffset[SPATIAL_MAX_GYROAXES];
double gyroFactor1[SPATIAL_MAX_GYROAXES];
double gyroFactor2[SPATIAL_MAX_GYROAXES];
int compassGain[SPATIAL_MAX_COMPASSAXES];
int compassOffset[SPATIAL_MAX_COMPASSAXES];
double userMagField;
double userCompassGain[SPATIAL_MAX_COMPASSAXES];
double userCompassOffset[SPATIAL_MAX_COMPASSAXES];
double userCompassTransform[SPATIAL_MAX_COMPASSAXES*(SPATIAL_MAX_COMPASSAXES-1)];
CPhidget_Timestamp timestamp, lastEventTime, latestDataTime;
unsigned char lastTimeCounterValid;
int lastTimeCounter;
int flip;
char *compassCorrectionParamsString;
unsigned char spatialDataNetwork;
int dataRate, interruptRate;
int dataRateMax, dataRateMin;
} typedef CPhidgetSpatialInfo;
#endif
/** @} */
#endif
|