/hardware/invensense/60xx/mlsdk/mllite/ |
H A D | mlMathFunc.c | 227 * @param[in] quat 4-element quaternion in fixed point. One is 2^30. 234 void inv_quaternion_to_rotation(const long *quat, long *rot) argument 237 inv_q29_mult(quat[1], quat[1]) + inv_q29_mult(quat[0], 238 quat[0]) - 1073741824L; 239 rot[1] = inv_q29_mult(quat[1], quat[2]) - inv_q29_mult(quat[3], quat[ [all...] |
H A D | mlFIFO.c | 1699 long quat[4]; local 1713 result = inv_get_quaternion(quat); 1720 inv_q29_mult(quat[1], quat[3]) - inv_q29_mult(quat[2], quat[0]); 1722 inv_q29_mult(quat[2], quat[3]) + inv_q29_mult(quat[1], quat[ [all...] |
/hardware/invensense/6515/libsensors_iio/ |
H A D | MPLSupport.cpp | 176 void convert_long_to_hex_char(long* quat, unsigned char* hex, int numElement) argument 181 hex[bytePosition] = (int) ((quat[index] >> (4-1-i) * 8) & 0xFF); 182 //LOGI("e%d quat[%d]: %x", index, bytePosition, hex[bytePosition]);
|
/hardware/invensense/6515/libsensors_iio/software/simple_apps/playback/linux/ |
H A D | and_constructor.c | 183 long quat[4]; local 186 int32_to_long(buffer, quat, 4); 187 inv_build_quat(quat, INV_BIAS_APPLIED, ts);
|
H A D | datalogger_outputs.c | 31 long quat[4]; member in struct:datalogger_output_s 178 q00 = inv_q29_mult(dl_out.quat[0], dl_out.quat[0]); 179 q12 = inv_q29_mult(dl_out.quat[1], dl_out.quat[2]); 180 q22 = inv_q29_mult(dl_out.quat[2], dl_out.quat[2]); 181 q03 = inv_q29_mult(dl_out.quat[0], dl_out.quat[3]); 254 values[0] = dl_out.quat[ [all...] |
H A D | main.c | 456 float quat[4]; local 457 inv_get_quaternion_float(quat); 458 PRINT_4ELM_ARRAY_FLOAT(10, 5, quat); 468 float quat[4]; local 474 quat[j] = (float)temp[j] / (1 << 30); 475 PRINT_4ELM_ARRAY_FLOAT(10, 5, quat);
|
/hardware/invensense/65xx/libsensors_iio/ |
H A D | MPLSupport.cpp | 176 void convert_long_to_hex_char(long* quat, unsigned char* hex, int numElement) argument 181 hex[bytePosition] = (int) ((quat[index] >> (4-1-i) * 8) & 0xFF); 182 //LOGI("e%d quat[%d]: %x", index, bytePosition, hex[bytePosition]);
|
/hardware/invensense/60xx/libsensors_iio/software/core/mllite/ |
H A D | data_builder.h | 115 struct inv_quat_sensor_t quat; member in struct:inv_sensor_cal_t 187 inv_error_t inv_build_quat(const long *quat, int status, inv_time_t timestamp);
|
H A D | results_holder.c | 57 * @param[in] quat Length 4, Quaternion scaled by 2^30 59 void inv_store_gaming_quaternion(const long *quat, inv_time_t timestamp) argument 62 memcpy(&rh.gam_quat, quat, sizeof(rh.gam_quat));
|
H A D | ml_math_func.c | 36 * @param[in] quat Quaternion, Length 4 39 float inv_compass_angle(const long *compass, const long *grav, const float *quat) argument 51 inv_q_multf(quat, cgcross, q1); 52 inv_q_invertf(quat, qi); 234 double quaternion_to_rotation_angle(const long *quat) { argument 235 double quat0 = (double )quat[0] / 1073741824; 339 * @param[in] quat 4-element quaternion in fixed point. One is 2^30. 346 void inv_quaternion_to_rotation(const long *quat, long *rot) argument 349 inv_q29_mult(quat[1], quat[ 384 inv_quaternion_to_rotation_vector(const long *quat, long *rot) argument [all...] |
H A D | data_builder.c | 283 *ts = sensors.quat.timestamp; 285 if (sensors.quat.timestamp_prev != sensors.quat.timestamp) 324 if ((sensors.quat.status & (INV_QUAT_6AXIS | INV_SENSOR_ON)) == (INV_QUAT_6AXIS | INV_SENSOR_ON)) { 328 return 0; // Accel must be on or 6-axis quat must be on 331 // At this point, we know accel is on. Check if 3-axis quat is on 332 td[0] = sample_rate_us - sensors.quat.sample_rate_us; 334 if ((sensors.quat.status & (INV_QUAT_3AXIS | INV_SENSOR_ON)) == (INV_QUAT_3AXIS | INV_SENSOR_ON)) { 337 // 0 = quat, 3=accel 400 sensors.quat 853 inv_build_quat(const long *quat, int status, inv_time_t timestamp) argument [all...] |
/hardware/invensense/6515/libsensors_iio/software/core/mllite/ |
H A D | data_builder.h | 135 struct inv_quat_sensor_t quat; member in struct:inv_sensor_cal_t 249 inv_error_t inv_build_quat(const long *quat, int status, inv_time_t timestamp);
|
H A D | data_builder.c | 337 *ts = sensors.quat.timestamp; 339 if (sensors.quat.timestamp_prev != sensors.quat.timestamp) 370 * Priority is 9-axis quat, 6-axis quat, 3-axis quat, gyro, compass, accel on ties. 379 if ((sensors.quat.status & (INV_QUAT_9AXIS | INV_SENSOR_ON)) == (INV_QUAT_9AXIS | INV_SENSOR_ON)) { 381 *ts = sensors.quat.timestamp; 383 if (sensors.quat.timestamp_prev != sensors.quat 1150 inv_build_quat(const long *quat, int status, inv_time_t timestamp) argument [all...] |
H A D | ml_math_func.c | 36 * @param[in] quat Quaternion, Length 4 39 float inv_compass_angle(const long *compass, const long *grav, const float *quat) argument 51 inv_q_multf(quat, cgcross, q1); 52 inv_q_invertf(quat, qi); 234 double quaternion_to_rotation_angle(const long *quat) { argument 235 double quat0 = (double )quat[0] / 1073741824; 339 * @param[in] quat 4-element quaternion in fixed point. One is 2^30. 346 void inv_quaternion_to_rotation(const long *quat, long *rot) argument 349 inv_q29_mult(quat[1], quat[ 384 inv_quaternion_to_rotation_vector(const long *quat, long *rot) argument [all...] |
H A D | results_holder.c | 64 * @param[in] quat Length 4, Quaternion scaled by 2^30
67 void inv_store_gaming_quaternion(const long *quat, inv_time_t timestamp)
argument 70 memcpy(&rh.gam_quat, quat, sizeof(rh.gam_quat));
76 * @param[in] quat Length 4 in floating-point numbers
79 void inv_store_nav_quaternion(const float *quat, inv_time_t timestamp)
argument 81 memcpy(&rh.nav_quat, quat, sizeof(rh.nav_quat));
87 * @param[in] quat Length 4 in floating-point numbers
90 void inv_store_geomag_quaternion(const float *quat, inv_time_t timestamp)
argument 92 memcpy(&rh.geomag_quat, quat, sizeof(rh.geomag_quat));
98 * @param[in] quat Lengt 101 inv_store_game_quaternion(const float *quat, inv_time_t timestamp) argument 113 inv_store_accel_quaternion(const long *quat, inv_time_t timestamp) argument [all...] |
/hardware/invensense/65xx/libsensors_iio/software/core/mllite/ |
H A D | data_builder.h | 132 struct inv_quat_sensor_t quat; member in struct:inv_sensor_cal_t 246 inv_error_t inv_build_quat(const long *quat, int status, inv_time_t timestamp);
|
H A D | results_holder.c | 63 * @param[in] quat Length 4, Quaternion scaled by 2^30 65 void inv_store_gaming_quaternion(const long *quat, inv_time_t timestamp) argument 68 memcpy(&rh.gam_quat, quat, sizeof(rh.gam_quat)); 75 * @param[in] quat Length 4, Quaternion scaled by 2^30 77 void inv_store_accel_quaternion(const long *quat, inv_time_t timestamp) argument 80 memcpy(&rh.accel_quat, quat, sizeof(rh.accel_quat));
|
H A D | data_builder.c | 342 sensors.quat.sample_rate_us = sample_rate_us; 343 sensors.quat.sample_rate_ms = sample_rate_us / 1000; 419 if (sensors.quat.status & INV_SENSOR_ON) { 420 if (timestamp < sensors.quat.timestamp) 421 timestamp = sensors.quat.timestamp; 912 * @param[in] quat Quaternion data. 2^30 = 1.0 or 2^14=1 for 16-bit data. 924 inv_error_t inv_build_quat(const long *quat, int status, inv_time_t timestamp) argument 930 fwrite(quat, sizeof(quat[0]), 4, inv_data_builder.file); 938 MPL_LOGV("3q: %ld,%ld,%ld\n", quat[ [all...] |
H A D | ml_math_func.c | 36 * @param[in] quat Quaternion, Length 4 39 float inv_compass_angle(const long *compass, const long *grav, const float *quat) argument 51 inv_q_multf(quat, cgcross, q1); 52 inv_q_invertf(quat, qi); 234 double quaternion_to_rotation_angle(const long *quat) { argument 235 double quat0 = (double )quat[0] / 1073741824; 339 * @param[in] quat 4-element quaternion in fixed point. One is 2^30. 346 void inv_quaternion_to_rotation(const long *quat, long *rot) argument 349 inv_q29_mult(quat[1], quat[ 384 inv_quaternion_to_rotation_vector(const long *quat, long *rot) argument [all...] |
/hardware/invensense/60xx/libsensors/ |
H A D | MPLSensor.cpp | 662 float quat[4]; local 667 r = inv_get_float_array(INV_QUATERNION, quat); 676 norm = quat[1] * quat[1] + quat[2] * quat[2] + quat[3] * quat[3] 683 quat[1] = quat[ [all...] |