Home
last modified time | relevance | path

Searched refs:quat (Results 1 – 4 of 4) sorted by relevance

/hardware/invensense/mlsdk/mllite/
DmlMathFunc.c234 void inv_quaternion_to_rotation(const long *quat, long *rot) in inv_quaternion_to_rotation() argument
237 inv_q29_mult(quat[1], quat[1]) + inv_q29_mult(quat[0], in inv_quaternion_to_rotation()
238 quat[0]) - 1073741824L; in inv_quaternion_to_rotation()
239 rot[1] = inv_q29_mult(quat[1], quat[2]) - inv_q29_mult(quat[3], quat[0]); in inv_quaternion_to_rotation()
240 rot[2] = inv_q29_mult(quat[1], quat[3]) + inv_q29_mult(quat[2], quat[0]); in inv_quaternion_to_rotation()
241 rot[3] = inv_q29_mult(quat[1], quat[2]) + inv_q29_mult(quat[3], quat[0]); in inv_quaternion_to_rotation()
243 inv_q29_mult(quat[2], quat[2]) + inv_q29_mult(quat[0], in inv_quaternion_to_rotation()
244 quat[0]) - 1073741824L; in inv_quaternion_to_rotation()
245 rot[5] = inv_q29_mult(quat[2], quat[3]) - inv_q29_mult(quat[1], quat[0]); in inv_quaternion_to_rotation()
246 rot[6] = inv_q29_mult(quat[1], quat[3]) - inv_q29_mult(quat[2], quat[0]); in inv_quaternion_to_rotation()
[all …]
DmlFIFO.c1699 long quat[4]; in inv_get_gravity() local
1713 result = inv_get_quaternion(quat); in inv_get_gravity()
1720 inv_q29_mult(quat[1], quat[3]) - inv_q29_mult(quat[2], quat[0]); in inv_get_gravity()
1722 inv_q29_mult(quat[2], quat[3]) + inv_q29_mult(quat[1], quat[0]); in inv_get_gravity()
1724 (inv_q29_mult(quat[3], quat[3]) + inv_q29_mult(quat[0], quat[0])) - in inv_get_gravity()
DmlMathFunc.h54 void inv_quaternion_to_rotation(const long *quat, long *rot);
/hardware/invensense/libsensors/
DMPLSensor.cpp674 float quat[4]; in rvHandler() local
679 r = inv_get_float_array(INV_QUATERNION, quat); in rvHandler()
688 norm = quat[1] * quat[1] + quat[2] * quat[2] + quat[3] * quat[3] in rvHandler()
695 quat[1] = quat[1] * inv_norm; in rvHandler()
696 quat[2] = quat[2] * inv_norm; in rvHandler()
697 quat[3] = quat[3] * inv_norm; in rvHandler()
700 if (quat[0] < 0.0) { in rvHandler()
701 quat[1] = -quat[1]; in rvHandler()
702 quat[2] = -quat[2]; in rvHandler()
703 quat[3] = -quat[3]; in rvHandler()
[all …]