Lines Matching refs:inv_obj
461 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()
526 data[1] = inv_obj.accel_bias[1]; in inv_get_accel_bias()
527 data[2] = inv_obj.accel_bias[2]; in inv_get_accel_bias()
557 inv_obj.compass_bias[0] + in inv_get_mag_bias()
558 (long)((long long)inv_obj.init_compass_bias[0] * inv_obj.compass_sens / in inv_get_mag_bias()
561 inv_obj.compass_bias[1] + in inv_get_mag_bias()
562 (long)((long long)inv_obj.init_compass_bias[1] * inv_obj.compass_sens / in inv_get_mag_bias()
565 inv_obj.compass_bias[2] + in inv_get_mag_bias()
566 (long)((long long)inv_obj.init_compass_bias[2] * inv_obj.compass_sens / in inv_get_mag_bias()
619 data[0] = inv_obj.compass_sensor_data[0]; in inv_get_mag_raw_data()
620 data[1] = inv_obj.compass_sensor_data[1]; in inv_get_mag_raw_data()
621 data[2] = inv_obj.compass_sensor_data[2]; in inv_get_mag_raw_data()
651 data[0] = inv_obj.compass_sensor_data[0] + inv_obj.init_compass_bias[0]; in inv_get_magnetometer()
652 data[1] = inv_obj.compass_sensor_data[1] + inv_obj.init_compass_bias[1]; in inv_get_magnetometer()
653 data[2] = inv_obj.compass_sensor_data[2] + inv_obj.init_compass_bias[2]; in inv_get_magnetometer()
682 data[0] = inv_obj.pressure; in inv_get_pressure()
761 data[0] = inv_obj.gyro_cal[0]; in inv_get_gyro_cal_matrix()
762 data[1] = inv_obj.gyro_cal[1]; in inv_get_gyro_cal_matrix()
763 data[2] = inv_obj.gyro_cal[2]; in inv_get_gyro_cal_matrix()
764 data[3] = inv_obj.gyro_cal[3]; in inv_get_gyro_cal_matrix()
765 data[4] = inv_obj.gyro_cal[4]; in inv_get_gyro_cal_matrix()
766 data[5] = inv_obj.gyro_cal[5]; in inv_get_gyro_cal_matrix()
767 data[6] = inv_obj.gyro_cal[6]; in inv_get_gyro_cal_matrix()
768 data[7] = inv_obj.gyro_cal[7]; in inv_get_gyro_cal_matrix()
769 data[8] = inv_obj.gyro_cal[8]; in inv_get_gyro_cal_matrix()
806 data[0] = inv_obj.accel_cal[0]; in inv_get_accel_cal_matrix()
807 data[1] = inv_obj.accel_cal[1]; in inv_get_accel_cal_matrix()
808 data[2] = inv_obj.accel_cal[2]; in inv_get_accel_cal_matrix()
809 data[3] = inv_obj.accel_cal[3]; in inv_get_accel_cal_matrix()
810 data[4] = inv_obj.accel_cal[4]; in inv_get_accel_cal_matrix()
811 data[5] = inv_obj.accel_cal[5]; in inv_get_accel_cal_matrix()
812 data[6] = inv_obj.accel_cal[6]; in inv_get_accel_cal_matrix()
813 data[7] = inv_obj.accel_cal[7]; in inv_get_accel_cal_matrix()
814 data[8] = inv_obj.accel_cal[8]; in inv_get_accel_cal_matrix()
844 data[0] = inv_obj.compass_cal[0]; in inv_get_mag_cal_matrix()
845 data[1] = inv_obj.compass_cal[1]; in inv_get_mag_cal_matrix()
846 data[2] = inv_obj.compass_cal[2]; in inv_get_mag_cal_matrix()
847 data[3] = inv_obj.compass_cal[3]; in inv_get_mag_cal_matrix()
848 data[4] = inv_obj.compass_cal[4]; in inv_get_mag_cal_matrix()
849 data[5] = inv_obj.compass_cal[5]; in inv_get_mag_cal_matrix()
850 data[6] = inv_obj.compass_cal[6]; in inv_get_mag_cal_matrix()
851 data[7] = inv_obj.compass_cal[7]; in inv_get_mag_cal_matrix()
852 data[8] = inv_obj.compass_cal[8]; in inv_get_mag_cal_matrix()
881 if (inv_obj.large_field == 0) { in inv_get_mag_bias_error()
882 data[0] = inv_obj.compass_bias_error[0]; in inv_get_mag_bias_error()
883 data[1] = inv_obj.compass_bias_error[1]; in inv_get_mag_bias_error()
884 data[2] = inv_obj.compass_bias_error[2]; in inv_get_mag_bias_error()
919 data[0] = inv_obj.compass_scale[0]; in inv_get_mag_scale()
920 data[1] = inv_obj.compass_scale[1]; in inv_get_mag_scale()
921 data[2] = inv_obj.compass_scale[2]; in inv_get_mag_scale()
951 data[0] = inv_obj.local_field[0]; in inv_get_local_field()
952 data[1] = inv_obj.local_field[1]; in inv_get_local_field()
953 data[2] = inv_obj.local_field[2]; in inv_get_local_field()
1291 data[0] = (float)inv_obj.gyro_cal[0] / 1073741824.0f; in inv_get_gyro_cal_matrix_float()
1292 data[1] = (float)inv_obj.gyro_cal[1] / 1073741824.0f; in inv_get_gyro_cal_matrix_float()
1293 data[2] = (float)inv_obj.gyro_cal[2] / 1073741824.0f; in inv_get_gyro_cal_matrix_float()
1294 data[3] = (float)inv_obj.gyro_cal[3] / 1073741824.0f; in inv_get_gyro_cal_matrix_float()
1295 data[4] = (float)inv_obj.gyro_cal[4] / 1073741824.0f; in inv_get_gyro_cal_matrix_float()
1296 data[5] = (float)inv_obj.gyro_cal[5] / 1073741824.0f; in inv_get_gyro_cal_matrix_float()
1297 data[6] = (float)inv_obj.gyro_cal[6] / 1073741824.0f; in inv_get_gyro_cal_matrix_float()
1298 data[7] = (float)inv_obj.gyro_cal[7] / 1073741824.0f; in inv_get_gyro_cal_matrix_float()
1299 data[8] = (float)inv_obj.gyro_cal[8] / 1073741824.0f; in inv_get_gyro_cal_matrix_float()
1337 data[0] = (float)inv_obj.accel_cal[0] / 1073741824.0f; in inv_get_accel_cal_matrix_float()
1338 data[1] = (float)inv_obj.accel_cal[1] / 1073741824.0f; in inv_get_accel_cal_matrix_float()
1339 data[2] = (float)inv_obj.accel_cal[2] / 1073741824.0f; in inv_get_accel_cal_matrix_float()
1340 data[3] = (float)inv_obj.accel_cal[3] / 1073741824.0f; in inv_get_accel_cal_matrix_float()
1341 data[4] = (float)inv_obj.accel_cal[4] / 1073741824.0f; in inv_get_accel_cal_matrix_float()
1342 data[5] = (float)inv_obj.accel_cal[5] / 1073741824.0f; in inv_get_accel_cal_matrix_float()
1343 data[6] = (float)inv_obj.accel_cal[6] / 1073741824.0f; in inv_get_accel_cal_matrix_float()
1344 data[7] = (float)inv_obj.accel_cal[7] / 1073741824.0f; in inv_get_accel_cal_matrix_float()
1345 data[8] = (float)inv_obj.accel_cal[8] / 1073741824.0f; in inv_get_accel_cal_matrix_float()
1381 data[0] = (float)inv_obj.compass_cal[0] / 1073741824.0f; in inv_get_mag_cal_matrix_float()
1382 data[1] = (float)inv_obj.compass_cal[1] / 1073741824.0f; in inv_get_mag_cal_matrix_float()
1383 data[2] = (float)inv_obj.compass_cal[2] / 1073741824.0f; in inv_get_mag_cal_matrix_float()
1384 data[3] = (float)inv_obj.compass_cal[3] / 1073741824.0f; in inv_get_mag_cal_matrix_float()
1385 data[4] = (float)inv_obj.compass_cal[4] / 1073741824.0f; in inv_get_mag_cal_matrix_float()
1386 data[5] = (float)inv_obj.compass_cal[5] / 1073741824.0f; in inv_get_mag_cal_matrix_float()
1387 data[6] = (float)inv_obj.compass_cal[6] / 1073741824.0f; in inv_get_mag_cal_matrix_float()
1388 data[7] = (float)inv_obj.compass_cal[7] / 1073741824.0f; in inv_get_mag_cal_matrix_float()
1389 data[8] = (float)inv_obj.compass_cal[8] / 1073741824.0f; in inv_get_mag_cal_matrix_float()
1426 data[0] = inv_obj.x_gyro_coef[1]; in inv_get_gyro_temp_slope_float()
1427 data[1] = inv_obj.y_gyro_coef[1]; in inv_get_gyro_temp_slope_float()
1428 data[2] = inv_obj.z_gyro_coef[1]; in inv_get_gyro_temp_slope_float()
1430 data[0] = (float)inv_obj.temp_slope[0] / 65536.0f; in inv_get_gyro_temp_slope_float()
1431 data[1] = (float)inv_obj.temp_slope[1] / 65536.0f; in inv_get_gyro_temp_slope_float()
1432 data[2] = (float)inv_obj.temp_slope[2] / 65536.0f; in inv_get_gyro_temp_slope_float()
1465 data[0] = (float)inv_obj.gyro_bias[0] / 65536.0f; in inv_get_gyro_bias_float()
1466 data[1] = (float)inv_obj.gyro_bias[1] / 65536.0f; in inv_get_gyro_bias_float()
1467 data[2] = (float)inv_obj.gyro_bias[2] / 65536.0f; in inv_get_gyro_bias_float()
1499 data[0] = (float)inv_obj.accel_bias[0] / 65536.0f; in inv_get_accel_bias_float()
1500 data[1] = (float)inv_obj.accel_bias[1] / 65536.0f; in inv_get_accel_bias_float()
1501 data[2] = (float)inv_obj.accel_bias[2] / 65536.0f; in inv_get_accel_bias_float()
1535 (inv_obj.compass_bias[0] + in inv_get_mag_bias_float()
1536 (long)((long long)inv_obj.init_compass_bias[0] * in inv_get_mag_bias_float()
1537 inv_obj.compass_sens / 16384))) / 65536.0f; in inv_get_mag_bias_float()
1540 (inv_obj.compass_bias[1] + in inv_get_mag_bias_float()
1541 (long)((long long)inv_obj.init_compass_bias[1] * in inv_get_mag_bias_float()
1542 inv_obj.compass_sens / 16384))) / 65536.0f; in inv_get_mag_bias_float()
1545 (inv_obj.compass_bias[2] + in inv_get_mag_bias_float()
1546 (long)((long long)inv_obj.init_compass_bias[2] * in inv_get_mag_bias_float()
1547 inv_obj.compass_sens / 16384))) / 65536.0f; in inv_get_mag_bias_float()
1593 data[6] = (float)inv_obj.compass_sensor_data[0]; in inv_get_gyro_and_accel_sensor_float()
1594 data[7] = (float)inv_obj.compass_sensor_data[1]; in inv_get_gyro_and_accel_sensor_float()
1595 data[8] = (float)inv_obj.compass_sensor_data[2]; in inv_get_gyro_and_accel_sensor_float()
1822 (float)(inv_obj.compass_sensor_data[0] + inv_obj.init_compass_bias[0]); in inv_get_mag_raw_data_float()
1824 (float)(inv_obj.compass_sensor_data[1] + inv_obj.init_compass_bias[1]); in inv_get_mag_raw_data_float()
1826 (float)(inv_obj.compass_sensor_data[2] + inv_obj.init_compass_bias[2]); in inv_get_mag_raw_data_float()
1858 data[0] = (float)inv_obj.compass_calibrated_data[0] / 65536.0f; in inv_get_magnetometer_float()
1859 data[1] = (float)inv_obj.compass_calibrated_data[1] / 65536.0f; in inv_get_magnetometer_float()
1860 data[2] = (float)inv_obj.compass_calibrated_data[2] / 65536.0f; in inv_get_magnetometer_float()
1891 data[0] = (float)inv_obj.pressure; in inv_get_pressure_float()
1976 if (inv_obj.large_field == 0) { in inv_get_mag_bias_error_float()
1977 data[0] = (float)inv_obj.compass_bias_error[0]; in inv_get_mag_bias_error_float()
1978 data[1] = (float)inv_obj.compass_bias_error[1]; in inv_get_mag_bias_error_float()
1979 data[2] = (float)inv_obj.compass_bias_error[2]; in inv_get_mag_bias_error_float()
2016 data[0] = (float)inv_obj.compass_scale[0] / 65536.0f; in inv_get_mag_scale_float()
2017 data[1] = (float)inv_obj.compass_scale[1] / 65536.0f; in inv_get_mag_scale_float()
2018 data[2] = (float)inv_obj.compass_scale[2] / 65536.0f; in inv_get_mag_scale_float()
2050 data[0] = (float)inv_obj.local_field[0] / 65536.0f; in inv_get_local_field_float()
2051 data[1] = (float)inv_obj.local_field[1] / 65536.0f; in inv_get_local_field_float()
2052 data[2] = (float)inv_obj.local_field[2] / 65536.0f; in inv_get_local_field_float()
2084 data[0] = (float)inv_obj.relative_quat[0] / 1073741824.0f; in inv_get_relative_quaternion_float()
2085 data[1] = (float)inv_obj.relative_quat[1] / 1073741824.0f; in inv_get_relative_quaternion_float()
2086 data[2] = (float)inv_obj.relative_quat[2] / 1073741824.0f; in inv_get_relative_quaternion_float()
2087 data[3] = (float)inv_obj.relative_quat[3] / 1073741824.0f; in inv_get_relative_quaternion_float()
2109 *accuracy = inv_obj.compass_accuracy; in inv_get_compass_accuracy()
2144 inv_obj.gyro_bias[i] = data[i]; in inv_set_gyro_bias()
2145 biasTmp = -inv_obj.gyro_bias[i] / sf; in inv_set_gyro_bias()
2185 inv_obj.accel_bias[i] = data[i]; in inv_set_accel_bias()
2186 if (inv_obj.accel_sens != 0 && mldl_cfg && mldl_cfg->pdata) { in inv_set_accel_bias()
2188 inv_obj.scaled_accel_bias[i] = 0; in inv_set_accel_bias()
2190 inv_obj.scaled_accel_bias[i] += in inv_set_accel_bias()
2194 tmp64 = (long long)inv_obj.scaled_accel_bias[i] << 13; in inv_set_accel_bias()
2195 biasTmp = (long)(tmp64 / inv_obj.accel_sens); in inv_set_accel_bias()
2245 inv_obj.init_compass_bias[0] = 0; in inv_set_mag_bias()
2246 inv_obj.init_compass_bias[1] = 0; in inv_set_mag_bias()
2247 inv_obj.init_compass_bias[2] = 0; in inv_set_mag_bias()
2248 inv_obj.got_compass_bias = 1; in inv_set_mag_bias()
2249 inv_obj.got_init_compass_bias = 1; in inv_set_mag_bias()
2250 inv_obj.compass_state = SF_STARTUP_SETTLE; in inv_set_mag_bias()
2287 inv_obj.factory_temp_comp = 1; in inv_set_gyro_temp_slope()
2288 inv_obj.temp_slope[0] = data[0]; in inv_set_gyro_temp_slope()
2289 inv_obj.temp_slope[1] = data[1]; in inv_set_gyro_temp_slope()
2290 inv_obj.temp_slope[2] = data[2]; in inv_set_gyro_temp_slope()
2292 sf = -inv_obj.temp_slope[i] / 1118; in inv_set_gyro_temp_slope()
2328 inv_obj.local_field[0] = data[0]; in inv_set_local_field()
2329 inv_obj.local_field[1] = data[1]; in inv_set_local_field()
2330 inv_obj.local_field[2] = data[2]; in inv_set_local_field()
2331 inv_obj.new_local_field = 1; in inv_set_local_field()
2361 inv_obj.compass_scale[0] = data[0]; in inv_set_mag_scale()
2362 inv_obj.compass_scale[1] = data[1]; in inv_set_mag_scale()
2363 inv_obj.compass_scale[2] = data[2]; in inv_set_mag_scale()