106 vrpn_float64 s1x, s1y, s1z;
107 vrpn_float64 s2x, s2y, s2z;
117 vrpn_float64 coef = (32.5 / 180.0) * Q_PI;
119 vrpn_float64 distance0 = 1.5 * (1 - s1z);
120 vrpn_float64 angleX0 = -s1x * coef;
121 vrpn_float64 angleY0 = -s1y * coef;
123 vrpn_float64 distance1 = 1.5 * (1 - s2z);
124 vrpn_float64 angleX1 = -s2x * coef;
125 vrpn_float64 angleY1 = -s2y * coef;
129 gametrak->
_sensor0[0] = sin(angleX0) * distance0 + 0.065;
130 gametrak->
_sensor0[1] = cos(angleX0) * sin(angleY0) * distance0;
131 gametrak->
_sensor0[2] = cos(angleX0) * cos(angleY0) * distance0;
133 gametrak->
_sensor1[0] = sin(angleX1) * distance1 - 0.065;
134 gametrak->
_sensor1[1] = cos(angleX1) * sin(angleY1) * distance1;
135 gametrak->
_sensor1[2] = cos(angleX1) * cos(angleY1) * distance1;