Home
last modified time | relevance | path

Searched refs:inv_obj (Results 1 – 12 of 12) sorted by relevance

/hardware/invensense/mlsdk/mllite/
Dmlarray.c461 data[0] = (long)(inv_obj.x_gyro_coef[1] * 65536.0f); in inv_get_gyro_temp_slope()
462 data[1] = (long)(inv_obj.y_gyro_coef[1] * 65536.0f); in inv_get_gyro_temp_slope()
463 data[2] = (long)(inv_obj.z_gyro_coef[1] * 65536.0f); in inv_get_gyro_temp_slope()
465 data[0] = inv_obj.temp_slope[0]; in inv_get_gyro_temp_slope()
466 data[1] = inv_obj.temp_slope[1]; in inv_get_gyro_temp_slope()
467 data[2] = inv_obj.temp_slope[2]; in inv_get_gyro_temp_slope()
495 data[0] = inv_obj.gyro_bias[0]; in inv_get_gyro_bias()
496 data[1] = inv_obj.gyro_bias[1]; in inv_get_gyro_bias()
497 data[2] = inv_obj.gyro_bias[2]; in inv_get_gyro_bias()
525 data[0] = inv_obj.accel_bias[0]; in inv_get_accel_bias()
[all …]
Dmlsupervisor.c81 inv_obj.acc_state = SF_STARTUP_SETTLE; in inv_init_sensor_fusion_supervisor()
168 inv_obj.compass_test_bias[i] = in MLUpdateCompassCalibration3DOF()
169 -(long)(tmp * inv_obj.compass_sens / 16384.0f); in MLUpdateCompassCalibration3DOF()
230 if (inv_obj.resetting_compass == 1) { in MLSensorFusionSupervisor()
238 inv_obj.resetting_compass = 0; in MLSensorFusionSupervisor()
243 if (inv_obj.compass_sensor_data[i] > magMax[i]) { in MLSensorFusionSupervisor()
244 magMax[i] = inv_obj.compass_sensor_data[i]; in MLSensorFusionSupervisor()
246 if (inv_obj.compass_sensor_data[i] < magMin[i]) { in MLSensorFusionSupervisor()
247 magMin[i] = inv_obj.compass_sensor_data[i]; in MLSensorFusionSupervisor()
251 inv_obj.compass_sensor_data, in MLSensorFusionSupervisor()
[all …]
Dml_stored_data.c61 extern struct inv_obj_t inv_obj;
188 inv_obj.temp_data[bin][inv_obj.temp_ptrs[bin]] = newTemp; in inv_load_cal_V0()
190 bin, inv_obj.temp_ptrs[bin], in inv_load_cal_V0()
191 inv_obj.temp_data[bin][inv_obj.temp_ptrs[bin]]); in inv_load_cal_V0()
192 inv_obj.x_gyro_temp_data[bin][inv_obj.temp_ptrs[bin]] = in inv_load_cal_V0()
195 bin, inv_obj.temp_ptrs[bin], in inv_load_cal_V0()
196 inv_obj.x_gyro_temp_data[bin][inv_obj.temp_ptrs[bin]]); in inv_load_cal_V0()
197 inv_obj.y_gyro_temp_data[bin][inv_obj.temp_ptrs[bin]] = in inv_load_cal_V0()
200 bin, inv_obj.temp_ptrs[bin], in inv_load_cal_V0()
201 inv_obj.y_gyro_temp_data[bin][inv_obj.temp_ptrs[bin]]); in inv_load_cal_V0()
[all …]
DmlBiasNoMotion.c149 inv_obj.got_no_motion_bias = TRUE; in inv_update_bias()
154 inv_error_t MLAccelMotionDetection(struct inv_obj_t *inv_obj) in MLAccelMotionDetection() argument
182 gain = inv_obj->accel_lpf_gain * rate; in MLAccelMotionDetection()
187 inv_obj->accel_lpf[kk] = in MLAccelMotionDetection()
188 inv_q30_mult(((1L << 30) - gain), inv_obj->accel_lpf[kk]); in MLAccelMotionDetection()
189 inv_obj->accel_lpf[kk] += inv_q30_mult(gain, accel[kk]); in MLAccelMotionDetection()
190 temp = accel[0] - inv_obj->accel_lpf[0]; in MLAccelMotionDetection()
194 if (accelMag > inv_obj->no_motion_accel_threshold) { in MLAccelMotionDetection()
195 inv_obj->no_motion_accel_time = currentTime; in MLAccelMotionDetection()
201 } else if ((currentTime - inv_obj->no_motion_accel_time) > in MLAccelMotionDetection()
[all …]
Dml.c93 struct inv_obj_t inv_obj; variable
229 inv_obj.accel_sens = (long)(accelScale * 65536L); in inv_apply_calibration()
233 inv_obj.accel_sens /= 32768 / mldl_cfg->accel_sens_trim; in inv_apply_calibration()
235 inv_obj.accel_sens /= 2; in inv_apply_calibration()
239 inv_obj.compass_sens = (long)(magScale * 32768); in inv_apply_calibration()
306 memset(&inv_obj, 0, sizeof(struct inv_obj_t)); in inv_init_ml()
309 inv_obj.compass_correction[0] = 1073741824L; in inv_init_ml()
310 inv_obj.compass_correction_relative[0] = 1073741824L; in inv_init_ml()
311 inv_obj.compass_disturb_correction[0] = 1073741824L; in inv_init_ml()
312 inv_obj.compass_correction_offset[0] = 1073741824L; in inv_init_ml()
[all …]
DmlSetGyroBias.c69 biasTmp[i] = inv_q30_mult(biasTmp2[0], inv_obj.gyro_orient[i]) + in inv_convert_bias()
70 inv_q30_mult(biasTmp2[1], inv_obj.gyro_orient[i + 3]) + in inv_convert_bias()
71 inv_q30_mult(biasTmp2[2], inv_obj.gyro_orient[i + 6]); in inv_convert_bias()
143 inv_error_t MLSetGyroBiasCB(struct inv_obj_t * inv_obj) in MLSetGyroBiasCB() argument
154 if (inv_obj->motion_state == INV_NO_MOTION) { in MLSetGyroBiasCB()
156 inv_obj->motion_state = INV_MOTION; in MLSetGyroBiasCB()
157 inv_obj->flags[INV_MOTION_STATE_CHANGE] = INV_MOTION; in MLSetGyroBiasCB()
164 if (inv_obj->motion_state == INV_MOTION) { in MLSetGyroBiasCB()
166 inv_obj->motion_state = INV_NO_MOTION; in MLSetGyroBiasCB()
167 inv_obj->got_no_motion_bias = TRUE; in MLSetGyroBiasCB()
[all …]
Dcompass.c270 unsigned char *tmp = inv_obj.compass_raw_data; in inv_get_compass_data()
272 if (mldl_cfg->compass->read_len > sizeof(inv_obj.compass_raw_data)) { in inv_get_compass_data()
304 inv_obj.compass_overunder = (int)tmp[6]; in inv_get_compass_data()
350 data[0] = inv_q30_mult(data[0], inv_obj.compass_asa[0]); in inv_get_compass_data()
351 data[1] = inv_q30_mult(data[1], inv_obj.compass_asa[1]); in inv_get_compass_data()
352 data[2] = inv_q30_mult(data[2], inv_obj.compass_asa[2]); in inv_get_compass_data()
370 inv_obj.compass_bias[0] = bias[0]; in inv_set_compass_bias()
371 inv_obj.compass_bias[1] = bias[1]; in inv_set_compass_bias()
372 inv_obj.compass_bias[2] = bias[2]; in inv_set_compass_bias()
376 (long)(bias[0] * (1LL << 30) / inv_obj.compass_sens) + in inv_set_compass_bias()
[all …]
Dmlcontrol.h210 inv_error_t inv_update_control(struct inv_obj_t *inv_obj);
DmlFIFO.c648 inv_obj.scaled_accel_bias[kk]; in inv_read_and_process_fifo()
757 inv_obj.flags[INV_PROCESSED_DATA_READY] = 1; in inv_process_fifo_packet()
1008 fifo_scale[REF_ACCEL + kk] = 2 * inv_obj.accel_sens; in inv_send_accel()
1660 data[0] = inv_obj.relative_quat[0]; in inv_get_relative_quaternion()
1661 data[1] = inv_obj.relative_quat[1]; in inv_get_relative_quaternion()
1662 data[2] = inv_obj.relative_quat[2]; in inv_get_relative_quaternion()
1663 data[3] = inv_obj.relative_quat[3]; in inv_get_relative_quaternion()
2255 result2 = fifo_rate_obj.fifo_process_cb[kk] (&inv_obj); in inv_run_fifo_rate_processes()
Dml.h412 extern struct inv_obj_t inv_obj;
Dmlcontrol.c679 inv_error_t inv_update_control(struct inv_obj_t * inv_obj) in inv_update_control() argument
Dmldl.c694 inv_obj.gyro_bias[ii] = -offset[ii] * sf; in inv_set_offset()