/hardware/invensense/60xx/libsensors_iio/software/core/mllite/ |
results_holder.c | 32 long nav_quat[4]; member in struct:results_t 202 inv_q29_mult(rh.nav_quat[1], rh.nav_quat[3]) - inv_q29_mult(rh.nav_quat[2], rh.nav_quat[0]); 204 inv_q29_mult(rh.nav_quat[2], rh.nav_quat[3]) + inv_q29_mult(rh.nav_quat[1], rh.nav_quat[0]); 206 (inv_q29_mult(rh.nav_quat[3], rh.nav_quat[3]) + inv_q29_mult(rh.nav_quat[0], rh.nav_quat[0])) [all...] |
hal_outputs.c | 38 long nav_quat[4];
member in struct:hal_output_t 216 if (hal_out.nav_quat[0] >= 0) {
217 values[0] = hal_out.nav_quat[1] * INV_TWO_POWER_NEG_30;
218 values[1] = hal_out.nav_quat[2] * INV_TWO_POWER_NEG_30;
219 values[2] = hal_out.nav_quat[3] * INV_TWO_POWER_NEG_30;
220 values[3] = hal_out.nav_quat[0] * INV_TWO_POWER_NEG_30;
222 values[0] = -hal_out.nav_quat[1] * INV_TWO_POWER_NEG_30;
223 values[1] = -hal_out.nav_quat[2] * INV_TWO_POWER_NEG_30;
224 values[2] = -hal_out.nav_quat[3] * INV_TWO_POWER_NEG_30;
225 values[3] = -hal_out.nav_quat[0] * INV_TWO_POWER_NEG_30; [all...] |
/hardware/invensense/65xx/libsensors_iio/software/core/mllite/ |
results_holder.c | 33 long nav_quat[4]; member in struct:results_t 242 inv_q29_mult(rh.nav_quat[1], rh.nav_quat[3]) - inv_q29_mult(rh.nav_quat[2], rh.nav_quat[0]); 244 inv_q29_mult(rh.nav_quat[2], rh.nav_quat[3]) + inv_q29_mult(rh.nav_quat[1], rh.nav_quat[0]); 246 (inv_q29_mult(rh.nav_quat[3], rh.nav_quat[3]) + inv_q29_mult(rh.nav_quat[0], rh.nav_quat[0])) [all...] |
hal_outputs.c | 54 long nav_quat[4];
member in struct:hal_output_t 238 if (hal_out.nav_quat[0] >= 0) {
239 values[0] = hal_out.nav_quat[1] * INV_TWO_POWER_NEG_30;
240 values[1] = hal_out.nav_quat[2] * INV_TWO_POWER_NEG_30;
241 values[2] = hal_out.nav_quat[3] * INV_TWO_POWER_NEG_30;
242 values[3] = hal_out.nav_quat[0] * INV_TWO_POWER_NEG_30;
244 values[0] = -hal_out.nav_quat[1] * INV_TWO_POWER_NEG_30;
245 values[1] = -hal_out.nav_quat[2] * INV_TWO_POWER_NEG_30;
246 values[2] = -hal_out.nav_quat[3] * INV_TWO_POWER_NEG_30;
247 values[3] = -hal_out.nav_quat[0] * INV_TWO_POWER_NEG_30; [all...] |
/hardware/invensense/6515/libsensors_iio/software/core/mllite/ |
results_holder.c | 28 float nav_quat[4];
member in struct:results_t 81 memcpy(&rh.nav_quat, quat, sizeof(rh.nav_quat));
311 data[0] = (long)MIN(MAX(rh.nav_quat[0] * ((float)(1L << 30)), -2147483648.), 2147483647.);
312 data[1] = (long)MIN(MAX(rh.nav_quat[1] * ((float)(1L << 30)), -2147483648.), 2147483647.);
313 data[2] = (long)MIN(MAX(rh.nav_quat[2] * ((float)(1L << 30)), -2147483648.), 2147483647.);
314 data[3] = (long)MIN(MAX(rh.nav_quat[3] * ((float)(1L << 30)), -2147483648.), 2147483647.);
399 memcpy(data, rh.nav_quat, sizeof(rh.nav_quat));
480 rh.nav_quat[0] = 1.; [all...] |
hal_outputs.c | 54 long nav_quat[4]; member in struct:hal_output_t 491 inv_quaternion_to_rotation(hal_out.nav_quat, rot); 585 inv_get_quaternion_set(hal_out.nav_quat, &hal_out.accuracy_quat,
|