| /hardware/invensense/mlsdk/mllite/ |
| mlBiasNoMotion.c | 188 inv_q30_mult(((1L << 30) - gain), inv_obj->accel_lpf[kk]);
189 inv_obj->accel_lpf[kk] += inv_q30_mult(gain, accel[kk]);
339 inv_q30_mult(biasTmp2[0],
341 inv_q30_mult(biasTmp2[1],
343 inv_q30_mult(biasTmp2[2], inv_obj->gyro_orient[i + 6]);
345 inv_obj->gyro_bias[0] = inv_q30_mult(biasTmp[0], 1501974482L);
346 inv_obj->gyro_bias[1] = inv_q30_mult(biasTmp[1], 1501974482L);
347 inv_obj->gyro_bias[2] = inv_q30_mult(biasTmp[2], 1501974482L);
|
| mlSetGyroBias.c | 69 biasTmp[i] = inv_q30_mult(biasTmp2[0], inv_obj.gyro_orient[i]) +
70 inv_q30_mult(biasTmp2[1], inv_obj.gyro_orient[i + 3]) +
71 inv_q30_mult(biasTmp2[2], inv_obj.gyro_orient[i + 6]);
|
| mlMathFunc.h | 44 long inv_q30_mult(long a, long b);
|
| compass.c | 350 data[0] = inv_q30_mult(data[0], inv_obj.compass_asa[0]);
351 data[1] = inv_q30_mult(data[1], inv_obj.compass_asa[1]);
352 data[2] = inv_q30_mult(data[2], inv_obj.compass_asa[2]);
|
| mlFIFO.c | 643 inv_q30_mult((data[kk] << 16),
646 inv_q30_mult((data[kk] << 15), fifo_scale[REF_ACCEL + kk]);
751 inv_q30_mult(fifo_obj.decoded[kk], fifo_scale[kk]);
770 return 2906830L + inv_q30_mult((long)tempReg << 16, 3294697L);
774 return 2462307L + inv_q30_mult((long)tempReg << 16, 2977653L);
778 return 5383314L + inv_q30_mult((long)tempReg << 16, 3834792L);
910 inv_q30_mult(fifo_obj.decoded[REF_RAW + 1],
913 inv_q30_mult(fifo_obj.decoded[REF_RAW + 2],
916 inv_q30_mult(fifo_obj.decoded[REF_RAW + 3],
[all...] |
| mlMathFunc.c | 88 long inv_q30_mult(long a, long b) function
|
| /hardware/invensense/libsensors_iio/software/core/mllite/ |
| ml_math_func.c | 113 long inv_q30_mult(long a, long b) function
167 qProd[0] = inv_q30_mult(q1[0], q2[0]) - inv_q30_mult(q1[1], q2[1]) -
168 inv_q30_mult(q1[2], q2[2]) - inv_q30_mult(q1[3], q2[3]);
170 qProd[1] = inv_q30_mult(q1[0], q2[1]) + inv_q30_mult(q1[1], q2[0]) +
171 inv_q30_mult(q1[2], q2[3]) - inv_q30_mult(q1[3], q2[2]);
173 qProd[2] = inv_q30_mult(q1[0], q2[2]) - inv_q30_mult(q1[1], q2[3])
[all...] |
| data_builder.c | 414 y[0] = inv_q30_mult(A[0], x[0]) + inv_q30_mult(A[1], x[1]) + inv_q30_mult(A[2], x[2]);
415 y[1] = inv_q30_mult(A[3], x[0]) + inv_q30_mult(A[4], x[1]) + inv_q30_mult(A[5], x[2]);
416 y[2] = inv_q30_mult(A[6], x[0]) + inv_q30_mult(A[7], x[1]) + inv_q30_mult(A[8], x[2]);
[all...] |
| ml_math_func.h | 58 long inv_q30_mult(long a, long b);
|
