Searched defs:quat (Results 1 - 20 of 20) sorted by relevance

/hardware/invensense/60xx/mlsdk/mllite/
H A DmlMathFunc.c227 * @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 DmlFIFO.c1699 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 DMPLSupport.cpp176 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 Dand_constructor.c183 long quat[4]; local
186 int32_to_long(buffer, quat, 4);
187 inv_build_quat(quat, INV_BIAS_APPLIED, ts);
H A Ddatalogger_outputs.c31 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 Dmain.c456 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 DMPLSupport.cpp176 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 Ddata_builder.h115 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 Dresults_holder.c57 * @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 Dml_math_func.c36 * @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 Ddata_builder.c283 *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 Ddata_builder.h135 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 Ddata_builder.c337 *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 Dml_math_func.c36 * @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 Dresults_holder.c64 * @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 Ddata_builder.h132 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 Dresults_holder.c63 * @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 Ddata_builder.c342 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 Dml_math_func.c36 * @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 DMPLSensor.cpp662 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...]

Completed in 1087 milliseconds