| /hardware/invensense/60xx/mlsdk/mllite/ |
| mlsupervisor.c | 81 inv_obj.acc_state = SF_STARTUP_SETTLE;
168 inv_obj.compass_test_bias[i] =
169 -(long)(tmp * inv_obj.compass_sens / 16384.0f);
230 if (inv_obj.resetting_compass == 1) {
238 inv_obj.resetting_compass = 0;
243 if (inv_obj.compass_sensor_data[i] > magMax[i]) {
244 magMax[i] = inv_obj.compass_sensor_data[i];
246 if (inv_obj.compass_sensor_data[i] < magMin[i]) {
247 magMin[i] = inv_obj.compass_sensor_data[i];
251 inv_obj.compass_sensor_data
[all...] |
| mlarray.c | 228 data[0] = inv_obj.ang_v_body[0];
229 data[1] = inv_obj.ang_v_body[1];
230 data[2] = inv_obj.ang_v_body[2];
461 data[0] = (long)(inv_obj.x_gyro_coef[1] * 65536.0f);
462 data[1] = (long)(inv_obj.y_gyro_coef[1] * 65536.0f);
463 data[2] = (long)(inv_obj.z_gyro_coef[1] * 65536.0f);
465 data[0] = inv_obj.temp_slope[0];
466 data[1] = inv_obj.temp_slope[1];
467 data[2] = inv_obj.temp_slope[2];
495 data[0] = inv_obj.gyro_bias[0]
[all...] |
| ml_stored_data.c | 61 extern struct inv_obj_t inv_obj;
188 inv_obj.temp_data[bin][inv_obj.temp_ptrs[bin]] = newTemp;
190 bin, inv_obj.temp_ptrs[bin],
191 inv_obj.temp_data[bin][inv_obj.temp_ptrs[bin]]);
192 inv_obj.x_gyro_temp_data[bin][inv_obj.temp_ptrs[bin]] =
195 bin, inv_obj.temp_ptrs[bin],
196 inv_obj.x_gyro_temp_data[bin][inv_obj.temp_ptrs[bin]])
[all...] |
| mlBiasNoMotion.c | 149 inv_obj.got_no_motion_bias = TRUE;
154 inv_error_t MLAccelMotionDetection(struct inv_obj_t *inv_obj)
182 gain = inv_obj->accel_lpf_gain * rate;
187 inv_obj->accel_lpf[kk] =
188 inv_q30_mult(((1L << 30) - gain), inv_obj->accel_lpf[kk]);
189 inv_obj->accel_lpf[kk] += inv_q30_mult(gain, accel[kk]);
190 temp = accel[0] - inv_obj->accel_lpf[0];
194 if (accelMag > inv_obj->no_motion_accel_threshold) {
195 inv_obj->no_motion_accel_time = currentTime;
201 } else if ((currentTime - inv_obj->no_motion_accel_time)
[all...] |
| ml.c | 93 struct inv_obj_t inv_obj; variable in typeref:struct:inv_obj_t
234 inv_obj.accel_sens = (long)(accelScale * 65536L);
238 inv_obj.accel_sens /= 32768 / mldl_cfg->accel_sens_trim;
240 inv_obj.accel_sens /= 2;
245 inv_obj.compass_sens = (long)(magScale * 32768);
317 memset(&inv_obj, 0, sizeof(struct inv_obj_t));
320 inv_obj.compass_correction[0] = 1073741824L;
321 inv_obj.compass_correction_relative[0] = 1073741824L;
322 inv_obj.compass_disturb_correction[0] = 1073741824L;
323 inv_obj.compass_correction_offset[0] = 1073741824L
[all...] |
| 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]);
143 inv_error_t MLSetGyroBiasCB(struct inv_obj_t * inv_obj)
154 if (inv_obj->motion_state == INV_NO_MOTION) {
156 inv_obj->motion_state = INV_MOTION;
157 inv_obj->flags[INV_MOTION_STATE_CHANGE] = INV_MOTION;
164 if (inv_obj->motion_state == INV_MOTION) {
166 inv_obj->motion_state = INV_NO_MOTION;
167 inv_obj->got_no_motion_bias = TRUE
[all...] |
| compass.c | 270 unsigned char *tmp = inv_obj.compass_raw_data;
272 if (mldl_cfg->compass->read_len > sizeof(inv_obj.compass_raw_data)) {
304 inv_obj.compass_overunder = (int)tmp[6];
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]);
370 inv_obj.compass_bias[0] = bias[0];
371 inv_obj.compass_bias[1] = bias[1];
372 inv_obj.compass_bias[2] = bias[2];
376 (long)(bias[0] * (1LL << 30) / inv_obj.compass_sens)
[all...] |
| mlcontrol.h | 210 inv_error_t inv_update_control(struct inv_obj_t *inv_obj);
|
| mlFIFO.c | 648 inv_obj.scaled_accel_bias[kk];
757 inv_obj.flags[INV_PROCESSED_DATA_READY] = 1;
[all...] |
| ml.h | 412 extern struct inv_obj_t inv_obj;
|
| mlcontrol.c | 679 inv_error_t inv_update_control(struct inv_obj_t * inv_obj)
|
| mldl.c | 694 inv_obj.gyro_bias[ii] = -offset[ii] * sf;
[all...] |
