Skip to content

Commit

Permalink
accel and gyro calibration refactor and cleanup
Browse files Browse the repository at this point in the history
 - remove all remaining IOCTLs for accel and gyro
 - move accel/gyro calibration entirely to sensors module
 - calibration no longer needs to clear existing before starting
 - temperature calibration (TC) remove all scale (SCL) parameters
 - gyro and baro scale are completely unused
 - regular accel calibration scale can be used (CAL_ACC*_xSCALE)
  • Loading branch information
dagar committed Jun 1, 2020
1 parent b368453 commit 8c23b7f
Show file tree
Hide file tree
Showing 99 changed files with 924 additions and 2,212 deletions.
4 changes: 4 additions & 0 deletions .ci/Jenkinsfile-hardware
Original file line number Diff line number Diff line change
Expand Up @@ -759,6 +759,8 @@ void statusFTDI() {
sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-FTDI_*` --cmd "adc test"'
sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-FTDI_*` --cmd "commander check"'
sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-FTDI_*` --cmd "commander status"'
sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-FTDI_*` --cmd "commander calibrate gyro; sleep 2; param show CAL_GYRO*"'
sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-FTDI_*` --cmd "commander calibrate level; sleep 2; param show SENS_BOARD*"'
sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-FTDI_*` --cmd "dataman status"'
sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-FTDI_*` --cmd "df"'
sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-FTDI_*` --cmd "dmesg"'
Expand Down Expand Up @@ -818,6 +820,8 @@ void statusSEGGER() {
sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-SEGGER_*` --cmd "adc test"'
sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-SEGGER_*` --cmd "commander check"'
sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-SEGGER_*` --cmd "commander status"'
sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-SEGGER_*` --cmd "commander calibrate gyro; sleep 2; param show CAL_GYRO*"'
sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-SEGGER_*` --cmd "commander calibrate level; sleep 2; param show SENS_BOARD*"'
sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-SEGGER_*` --cmd "dataman status"'
sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-SEGGER_*` --cmd "df -h"'
sh './Tools/HIL/run_nsh_cmd.py --device `find /dev/serial -name *usb-SEGGER_*` --cmd "dmesg"'
Expand Down
34 changes: 7 additions & 27 deletions Tools/process_sensor_caldata.py
Original file line number Diff line number Diff line change
Expand Up @@ -122,10 +122,7 @@ def is_valid_directory(parser, arg):
'TC_G0_X0_2':0.0,
'TC_G0_X1_2':0.0,
'TC_G0_X2_2':0.0,
'TC_G0_X3_2':0.0,
'TC_G0_SCL_0':1.0,
'TC_G0_SCL_1':1.0,
'TC_G0_SCL_2':1.0
'TC_G0_X3_2':0.0
}

# curve fit the data for gyro 0 corrections
Expand Down Expand Up @@ -218,10 +215,7 @@ def is_valid_directory(parser, arg):
'TC_G1_X0_2':0.0,
'TC_G1_X1_2':0.0,
'TC_G1_X2_2':0.0,
'TC_G1_X3_2':0.0,
'TC_G1_SCL_0':1.0,
'TC_G1_SCL_1':1.0,
'TC_G1_SCL_2':1.0
'TC_G1_X3_2':0.0
}

# curve fit the data for gyro 1 corrections
Expand Down Expand Up @@ -314,10 +308,7 @@ def is_valid_directory(parser, arg):
'TC_G2_X0_2':0.0,
'TC_G2_X1_2':0.0,
'TC_G2_X2_2':0.0,
'TC_G2_X3_2':0.0,
'TC_G2_SCL_0':1.0,
'TC_G2_SCL_1':1.0,
'TC_G2_SCL_2':1.0
'TC_G2_X3_2':0.0
}

# curve fit the data for gyro 2 corrections
Expand Down Expand Up @@ -410,10 +401,7 @@ def is_valid_directory(parser, arg):
'TC_A0_X0_2':0.0,
'TC_A0_X1_2':0.0,
'TC_A0_X2_2':0.0,
'TC_A0_X3_2':0.0,
'TC_A0_SCL_0':1.0,
'TC_A0_SCL_1':1.0,
'TC_A0_SCL_2':1.0
'TC_A0_X3_2':0.0
}

# curve fit the data for accel 0 corrections
Expand Down Expand Up @@ -509,10 +497,7 @@ def is_valid_directory(parser, arg):
'TC_A1_X0_2':0.0,
'TC_A1_X1_2':0.0,
'TC_A1_X2_2':0.0,
'TC_A1_X3_2':0.0,
'TC_A1_SCL_0':1.0,
'TC_A1_SCL_1':1.0,
'TC_A1_SCL_2':1.0
'TC_A1_X3_2':0.0
}

# curve fit the data for accel 1 corrections
Expand Down Expand Up @@ -608,10 +593,7 @@ def is_valid_directory(parser, arg):
'TC_A2_X0_2':0.0,
'TC_A2_X1_2':0.0,
'TC_A2_X2_2':0.0,
'TC_A2_X3_2':0.0,
'TC_A2_SCL_0':1.0,
'TC_A2_SCL_1':1.0,
'TC_A2_SCL_2':1.0
'TC_A2_X3_2':0.0
}

# curve fit the data for accel 2 corrections
Expand Down Expand Up @@ -701,8 +683,7 @@ def is_valid_directory(parser, arg):
'TC_B0_X2':0.0,
'TC_B0_X3':0.0,
'TC_B0_X4':0.0,
'TC_B0_X5':0.0,
'TC_B0_SCL':1.0,
'TC_B0_X5':0.0
}

# curve fit the data for baro 0 corrections
Expand Down Expand Up @@ -753,7 +734,6 @@ def is_valid_directory(parser, arg):
'TC_B1_X3':0.0,
'TC_B1_X4':0.0,
'TC_B1_X5':0.0,
'TC_B1_SCL':1.0,
}

if num_baros >= 2:
Expand Down
2 changes: 2 additions & 0 deletions msg/sensor_accel_fifo.msg
Original file line number Diff line number Diff line change
Expand Up @@ -11,3 +11,5 @@ uint8 samples # number of valid samples
int16[32] x # acceleration in the NED X board axis in m/s/s
int16[32] y # acceleration in the NED Y board axis in m/s/s
int16[32] z # acceleration in the NED Z board axis in m/s/s

uint8 rotation # Direction the sensor faces (see Rotation enum)
53 changes: 11 additions & 42 deletions msg/sensor_correction.msg
Original file line number Diff line number Diff line change
Expand Up @@ -6,52 +6,21 @@ uint64 timestamp # time since system start (microseconds)

# Corrections for gyro angular rate outputs where corrected_rate = raw_rate * gyro_scale + gyro_offset
# Note the corrections are in the sensor frame and must be applied before the sensor data is rotated into body frame
# corrections for uORB instance 0
float32[3] gyro_offset_0 # gyro XYZ offsets in the sensor frame in rad/s
float32[3] gyro_scale_0 # gyro XYZ scale factors in the sensor frame

# corrections for uORB instance 1
float32[3] gyro_offset_1 # gyro XYZ offsets in the sensor frame in rad/s
float32[3] gyro_scale_1 # gyro XYZ scale factors in the sensor frame

# corrections for uORB instance 2
float32[3] gyro_offset_2 # gyro XYZ offsets in the sensor frame in rad/s
float32[3] gyro_scale_2 # gyro XYZ scale factors in the sensor frame
uint32[3] gyro_device_ids
float32[3] gyro_offset_0 # gyro 0 XYZ offsets in the sensor frame in rad/s
float32[3] gyro_offset_1 # gyro 1 XYZ offsets in the sensor frame in rad/s
float32[3] gyro_offset_2 # gyro 2 XYZ offsets in the sensor frame in rad/s

# Corrections for acceleromter acceleration outputs where corrected_accel = raw_accel * accel_scale + accel_offset
# Note the corrections are in the sensor frame and must be applied before the sensor data is rotated into body frame
# corrections for uORB instance 0
float32[3] accel_offset_0 # accelerometer XYZ offsets in the sensor frame in m/s/s
float32[3] accel_scale_0 # accelerometer XYZ scale factors in the sensor frame

# corrections for uORB instance 1
float32[3] accel_offset_1 # accelerometer XYZ offsets in the sensor frame in m/s/s
float32[3] accel_scale_1 # accelerometer XYZ scale factors in the sensor frame

# corrections for uORB instance 2
float32[3] accel_offset_2 # accelerometer XYZ offsets in the sensor frame in m/s/s
float32[3] accel_scale_2 # accelerometer XYZ scale factors in the sensor frame
uint32[3] accel_device_ids
float32[3] accel_offset_0 # accelerometer 0 XYZ offsets in the sensor frame in m/s/s
float32[3] accel_offset_1 # accelerometer 1 XYZ offsets in the sensor frame in m/s/s
float32[3] accel_offset_2 # accelerometer 2 XYZ offsets in the sensor frame in m/s/s

# Corrections for barometric pressure outputs where corrected_pressure = raw_pressure * pressure_scale + pressure_offset
# Note the corrections are in the sensor frame and must be applied before the sensor data is rotated into body frame
# corrections for uORB instance 0
float32 baro_offset_0 # barometric pressure offsets in the sensor frame in m/s/s
float32 baro_scale_0 # barometric pressure scale factors in the sensor frame

# corrections for uORB instance 1
float32 baro_offset_1 # barometric pressure offsets in the sensor frame in m/s/s
float32 baro_scale_1 # barometric pressure scale factors in the sensor frame

# corrections for uORB instance 2
float32 baro_offset_2 # barometric pressure offsets in the sensor frame in m/s/s
float32 baro_scale_2 # barometric pressure scale factors in the sensor frame

# Mapping from uORB index to parameter index for each sensor type. For example accel_mapping[1] contains the
# compensation parameter system index for the sensor_accel uORB index 1 data.
uint8[3] gyro_mapping
uint8[3] accel_mapping
uint8[3] baro_mapping

uint32[3] gyro_device_ids
uint32[3] accel_device_ids
uint32[3] baro_device_ids
float32 baro_offset_0 # barometric pressure 0 offsets in the sensor frame in m/s/s
float32 baro_offset_1 # barometric pressure 1 offsets in the sensor frame in m/s/s
float32 baro_offset_2 # barometric pressure 2 offsets in the sensor frame in m/s/s
2 changes: 2 additions & 0 deletions msg/sensor_gyro_fifo.msg
Original file line number Diff line number Diff line change
Expand Up @@ -11,3 +11,5 @@ uint8 samples # number of valid samples
int16[32] x # angular velocity in the NED X board axis in rad/s
int16[32] y # angular velocity in the NED Y board axis in rad/s
int16[32] z # angular velocity in the NED Z board axis in rad/s

uint8 rotation # Direction the sensor faces (see Rotation enum)
2 changes: 0 additions & 2 deletions src/drivers/barometer/bmp280/BMP280.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -191,6 +191,4 @@ BMP280::print_status()
perf_print_counter(_sample_perf);
perf_print_counter(_measure_perf);
perf_print_counter(_comms_errors);

_px4_baro.print_status();
}
2 changes: 0 additions & 2 deletions src/drivers/barometer/bmp388/bmp388.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -105,8 +105,6 @@ BMP388::print_status()
perf_print_counter(_measure_perf);
perf_print_counter(_comms_errors);
printf("measurement interval: %u us \n", _measure_interval);

_px4_baro.print_status();
}

void
Expand Down
2 changes: 0 additions & 2 deletions src/drivers/barometer/dps310/DPS310.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -284,8 +284,6 @@ DPS310::print_status()
I2CSPIDriverBase::print_status();
perf_print_counter(_sample_perf);
perf_print_counter(_comms_errors);

_px4_barometer.print_status();
}

} // namespace dps310
1 change: 0 additions & 1 deletion src/drivers/barometer/lps22hb/LPS22HB.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -184,5 +184,4 @@ void LPS22HB::print_status()
I2CSPIDriverBase::print_status();
perf_print_counter(_sample_perf);
perf_print_counter(_comms_errors);
_px4_baro.print_status();
}
2 changes: 0 additions & 2 deletions src/drivers/barometer/lps25h/LPS25H.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -199,6 +199,4 @@ void LPS25H::print_status()
I2CSPIDriverBase::print_status();
perf_print_counter(_sample_perf);
perf_print_counter(_comms_errors);

_px4_barometer.print_status();
}
2 changes: 0 additions & 2 deletions src/drivers/barometer/mpl3115a2/MPL3115A2.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -284,6 +284,4 @@ void MPL3115A2::print_status()
I2CSPIDriverBase::print_status();
perf_print_counter(_sample_perf);
perf_print_counter(_comms_errors);

_px4_barometer.print_status();
}
2 changes: 0 additions & 2 deletions src/drivers/barometer/ms5611/ms5611.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -340,8 +340,6 @@ void MS5611::print_status()
perf_print_counter(_comms_errors);

printf("device: %s\n", _device_type == MS5611_DEVICE ? "ms5611" : "ms5607");

_px4_barometer.print_status();
}

namespace ms5611
Expand Down
2 changes: 0 additions & 2 deletions src/drivers/distance_sensor/cm8jl65/CM8JL65.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -327,8 +327,6 @@ CM8JL65::print_info()
{
perf_print_counter(_sample_perf);
perf_print_counter(_comms_errors);

_px4_rangefinder.print_status();
}

void
Expand Down
2 changes: 0 additions & 2 deletions src/drivers/distance_sensor/leddar_one/LeddarOne.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -267,8 +267,6 @@ LeddarOne::print_info()
{
perf_print_counter(_comms_error);
perf_print_counter(_sample_perf);

_px4_rangefinder.print_status();
}

void
Expand Down
2 changes: 0 additions & 2 deletions src/drivers/distance_sensor/sf0x/SF0X.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -297,6 +297,4 @@ void SF0X::print_info()
{
perf_print_counter(_sample_perf);
perf_print_counter(_comms_errors);

_px4_rangefinder.print_status();
}
1 change: 0 additions & 1 deletion src/drivers/distance_sensor/sf1xx/sf1xx.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -278,7 +278,6 @@ void SF1XX::print_status()
I2CSPIDriverBase::print_status();
perf_print_counter(_sample_perf);
perf_print_counter(_comms_errors);
_px4_rangefinder.print_status();
}

void SF1XX::print_usage()
Expand Down
2 changes: 0 additions & 2 deletions src/drivers/distance_sensor/srf02/SRF02.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -147,6 +147,4 @@ void SRF02::print_status()
I2CSPIDriverBase::print_status();
perf_print_counter(_sample_perf);
perf_print_counter(_comms_errors);

_px4_rangefinder.print_status();
}
2 changes: 0 additions & 2 deletions src/drivers/distance_sensor/teraranger/TERARANGER.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -268,6 +268,4 @@ void TERARANGER::print_status()
I2CSPIDriverBase::print_status();
perf_print_counter(_sample_perf);
perf_print_counter(_comms_errors);

_px4_rangefinder.print_status();
}
2 changes: 0 additions & 2 deletions src/drivers/distance_sensor/tfmini/TFMINI.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -264,6 +264,4 @@ TFMINI::print_info()
printf("Using port '%s'\n", _port);
perf_print_counter(_sample_perf);
perf_print_counter(_comms_errors);

_px4_rangefinder.print_status();
}
Original file line number Diff line number Diff line change
Expand Up @@ -221,6 +221,4 @@ void AerotennaULanding::print_info()
{
perf_print_counter(_sample_perf);
perf_print_counter(_comms_errors);

_px4_rangefinder.print_status();
}
1 change: 0 additions & 1 deletion src/drivers/distance_sensor/vl53l0x/VL53L0X.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -177,7 +177,6 @@ void VL53L0X::print_status()
I2CSPIDriverBase::print_status();
perf_print_counter(_comms_errors);
perf_print_counter(_sample_perf);
_px4_rangefinder.print_status();
}

int VL53L0X::probe()
Expand Down
75 changes: 0 additions & 75 deletions src/drivers/drv_accel.h

This file was deleted.

Loading

0 comments on commit 8c23b7f

Please sign in to comment.