Lines Matching refs:i
115 int i, j; in MLUpdateCompassCalibration3DOF() local
151 for (i = 0; i < b; i++) { in MLUpdateCompassCalibration3DOF()
154 inv_matrix_det_inc(&m[0][0], &mTmp[0][0], &a, i, j); in MLUpdateCompassCalibration3DOF()
155 mInv[j][i] = SIGNM(i + j) * inv_matrix_det(&mTmp[0][0], &a); in MLUpdateCompassCalibration3DOF()
163 for (i = 0; i < 3; i++) { in MLUpdateCompassCalibration3DOF()
166 tmp += mInv[j][i] / d * xTransY[j]; in MLUpdateCompassCalibration3DOF()
168 inv_obj.compass_test_bias[i] = in MLUpdateCompassCalibration3DOF()
173 for (i = 0; i < 4; i++) { in MLUpdateCompassCalibration3DOF()
175 m[i][j] = 0; in MLUpdateCompassCalibration3DOF()
177 xTransY[i] = 0; in MLUpdateCompassCalibration3DOF()
208 int i; in MLSensorFusionSupervisor() local
231 for (i = 0; i < 3; i++) { in MLSensorFusionSupervisor()
232 magMax[i] = -1073741824L; in MLSensorFusionSupervisor()
233 magMin[i] = 1073741824L; in MLSensorFusionSupervisor()
234 prevCompassBias[i] = 0; in MLSensorFusionSupervisor()
242 for (i = 0; i < 3; i++) { 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()
254 for (i = 0; i < 3; i++) { in MLSensorFusionSupervisor()
255 if (magMax[i] - magMin[i] < in MLSensorFusionSupervisor()
267 for(i=0; i<3; i++) { in MLSensorFusionSupervisor()
268 inv_obj.compass_bias_error[i] = 35; in MLSensorFusionSupervisor()
276 for (i = 0; i < 3; i++) { in MLSensorFusionSupervisor()
277 magMax[i] = -1073741824L; in MLSensorFusionSupervisor()
278 magMin[i] = 1073741824L; in MLSensorFusionSupervisor()
279 prevCompassBias[i] = 0; in MLSensorFusionSupervisor()
291 for (i = 0; i < 3; i++) { in MLSensorFusionSupervisor()
292 magMax[i] = -1073741824L; in MLSensorFusionSupervisor()
293 magMin[i] = 1073741824L; in MLSensorFusionSupervisor()
294 prevCompassBias[i] = 0; in MLSensorFusionSupervisor()
377 int i, j; in inv_accel_compass_supervisor() local
407 for (i = 0; i < 3; i++) { in inv_accel_compass_supervisor()
408 inv_obj.init_compass_bias[i] = magSensorData[i]; in inv_accel_compass_supervisor()
411 for (i = 0; i < 3; i++) { in inv_accel_compass_supervisor()
412 inv_obj.compass_sensor_data[i] = (long)magSensorData[i]; in inv_accel_compass_supervisor()
413 inv_obj.compass_sensor_data[i] -= in inv_accel_compass_supervisor()
414 inv_obj.init_compass_bias[i]; in inv_accel_compass_supervisor()
415 tmp[i] = ((long long)inv_obj.compass_sensor_data[i]) in inv_accel_compass_supervisor()
417 tmp[i] -= inv_obj.compass_bias[i]; in inv_accel_compass_supervisor()
418 tmp[i] = (tmp[i] * inv_obj.compass_scale[i]) / 65536L; in inv_accel_compass_supervisor()
420 for (i = 0; i < 3; i++) { in inv_accel_compass_supervisor()
424 inv_obj.compass_cal[i * 3 + j]; in inv_accel_compass_supervisor()
426 inv_obj.compass_calibrated_data[i] = in inv_accel_compass_supervisor()