|
|
|
@ -1043,7 +1043,8 @@ int get_tlm_fox() {
|
|
|
|
int posXv = 0, negXv = 0, posYv = 0, negYv = 0, posZv = 0, negZv = 0;
|
|
|
|
int posXv = 0, negXv = 0, posYv = 0, negYv = 0, posZv = 0, negZv = 0;
|
|
|
|
int posXi = 0, negXi = 0, posYi = 0, negYi = 0, posZi = 0, negZi = 0;
|
|
|
|
int posXi = 0, negXi = 0, posYi = 0, negYi = 0, posZi = 0, negZi = 0;
|
|
|
|
int head_offset = 0;
|
|
|
|
int head_offset = 0;
|
|
|
|
int xAngularVelocity = 1000, yAngularVelocity = 2000, zAngularVelocity = 3000; // XAxisAngularVelocity
|
|
|
|
// AngularVelocity = 43.3 dps + 1960
|
|
|
|
|
|
|
|
int xAngularVelocity = 43.3 * (-10) + 1960, yAngularVelocity = 43.3 * (-6) + 196, zAngularVelocity = 43.3 * (6) + 196; // XAxisAngularVelocity
|
|
|
|
|
|
|
|
|
|
|
|
short int buffer_test[bufLen];
|
|
|
|
short int buffer_test[bufLen];
|
|
|
|
int buffSize;
|
|
|
|
int buffSize;
|
|
|
|
|