Searched refs:nav_quat (Results 1 – 4 of 4) sorted by relevance
/hardware/invensense/65xx/libsensors_iio/software/core/mllite/ |
D | results_holder.c | 33 long nav_quat[4]; member 242 inv_q29_mult(rh.nav_quat[1], rh.nav_quat[3]) - inv_q29_mult(rh.nav_quat[2], rh.nav_quat[0]); in inv_get_gravity() 244 inv_q29_mult(rh.nav_quat[2], rh.nav_quat[3]) + inv_q29_mult(rh.nav_quat[1], rh.nav_quat[0]); in inv_get_gravity() 246 … (inv_q29_mult(rh.nav_quat[3], rh.nav_quat[3]) + inv_q29_mult(rh.nav_quat[0], rh.nav_quat[0])) - in inv_get_gravity() 290 inv_q_mult(rh.compass_correction, rh.gam_quat, rh.nav_quat); in inv_get_quaternion() 293 memcpy(data, rh.nav_quat, sizeof(rh.nav_quat)); in inv_get_quaternion() 382 rh.nav_quat[0] = 1L<<30; in inv_init_results_holder()
|
D | hal_outputs.c | 54 long nav_quat[4]; member 238 if (hal_out.nav_quat[0] >= 0) { in inv_get_sensor_type_rotation_vector() 239 values[0] = hal_out.nav_quat[1] * INV_TWO_POWER_NEG_30; in inv_get_sensor_type_rotation_vector() 240 values[1] = hal_out.nav_quat[2] * INV_TWO_POWER_NEG_30; in inv_get_sensor_type_rotation_vector() 241 values[2] = hal_out.nav_quat[3] * INV_TWO_POWER_NEG_30; in inv_get_sensor_type_rotation_vector() 242 values[3] = hal_out.nav_quat[0] * INV_TWO_POWER_NEG_30; in inv_get_sensor_type_rotation_vector() 244 values[0] = -hal_out.nav_quat[1] * INV_TWO_POWER_NEG_30; in inv_get_sensor_type_rotation_vector() 245 values[1] = -hal_out.nav_quat[2] * INV_TWO_POWER_NEG_30; in inv_get_sensor_type_rotation_vector() 246 values[2] = -hal_out.nav_quat[3] * INV_TWO_POWER_NEG_30; in inv_get_sensor_type_rotation_vector() 247 values[3] = -hal_out.nav_quat[0] * INV_TWO_POWER_NEG_30; in inv_get_sensor_type_rotation_vector() [all …]
|
/hardware/invensense/6515/libsensors_iio/software/core/mllite/ |
D | results_holder.c | 28 float nav_quat[4]; member 81 memcpy(&rh.nav_quat, quat, sizeof(rh.nav_quat)); in inv_store_nav_quaternion() 311 data[0] = (long)MIN(MAX(rh.nav_quat[0] * ((float)(1L << 30)), -2147483648.), 2147483647.); in inv_get_quaternion() 312 data[1] = (long)MIN(MAX(rh.nav_quat[1] * ((float)(1L << 30)), -2147483648.), 2147483647.); in inv_get_quaternion() 313 data[2] = (long)MIN(MAX(rh.nav_quat[2] * ((float)(1L << 30)), -2147483648.), 2147483647.); in inv_get_quaternion() 314 data[3] = (long)MIN(MAX(rh.nav_quat[3] * ((float)(1L << 30)), -2147483648.), 2147483647.); in inv_get_quaternion() 399 memcpy(data, rh.nav_quat, sizeof(rh.nav_quat)); in inv_get_quaternion_float() 480 rh.nav_quat[0] = 1.; in inv_init_results_holder()
|
D | hal_outputs.c | 54 long nav_quat[4]; member 491 inv_quaternion_to_rotation(hal_out.nav_quat, rot); in inv_get_rotation() 585 inv_get_quaternion_set(hal_out.nav_quat, &hal_out.accuracy_quat, in inv_generate_hal_outputs()
|