mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-03 16:48:52 +08:00
drivers don't print accel and gyro filter frequency
This commit is contained in:
committed by
Lorenz Meier
parent
f14125c160
commit
67f1e63362
@@ -520,8 +520,6 @@ FXAS21002C::init()
|
||||
float gyro_cut = FXAS21002C_DEFAULT_FILTER_FREQ;
|
||||
|
||||
if (gyro_cut_ph != PARAM_INVALID && param_get(gyro_cut_ph, &gyro_cut) == PX4_OK) {
|
||||
PX4_INFO("gyro cutoff set to %.2f Hz", double(gyro_cut));
|
||||
|
||||
set_sw_lowpass_filter(FXAS21002C_DEFAULT_RATE, gyro_cut);
|
||||
|
||||
} else {
|
||||
|
||||
@@ -602,8 +602,6 @@ FXOS8701CQ::init()
|
||||
float accel_cut = FXOS8701C_ACCEL_DEFAULT_DRIVER_FILTER_FREQ;
|
||||
|
||||
if (accel_cut_ph != PARAM_INVALID && param_get(accel_cut_ph, &accel_cut) == PX4_OK) {
|
||||
PX4_INFO("accel cutoff set to %.2f Hz", double(accel_cut));
|
||||
|
||||
accel_set_driver_lowpass_filter(FXOS8701C_ACCEL_DEFAULT_RATE, accel_cut);
|
||||
|
||||
} else {
|
||||
|
||||
@@ -676,8 +676,6 @@ MPU6000::init()
|
||||
float accel_cut = MPU6000_ACCEL_DEFAULT_DRIVER_FILTER_FREQ;
|
||||
|
||||
if (accel_cut_ph != PARAM_INVALID && param_get(accel_cut_ph, &accel_cut) == PX4_OK) {
|
||||
PX4_INFO("accel cutoff set to %.2f Hz", double(accel_cut));
|
||||
|
||||
_accel_filter_x.set_cutoff_frequency(MPU6000_ACCEL_DEFAULT_RATE, accel_cut);
|
||||
_accel_filter_y.set_cutoff_frequency(MPU6000_ACCEL_DEFAULT_RATE, accel_cut);
|
||||
_accel_filter_z.set_cutoff_frequency(MPU6000_ACCEL_DEFAULT_RATE, accel_cut);
|
||||
@@ -690,8 +688,6 @@ MPU6000::init()
|
||||
float gyro_cut = MPU6000_GYRO_DEFAULT_DRIVER_FILTER_FREQ;
|
||||
|
||||
if (gyro_cut_ph != PARAM_INVALID && param_get(gyro_cut_ph, &gyro_cut) == PX4_OK) {
|
||||
PX4_INFO("gyro cutoff set to %.2f Hz", double(gyro_cut));
|
||||
|
||||
_gyro_filter_x.set_cutoff_frequency(MPU6000_GYRO_DEFAULT_RATE, gyro_cut);
|
||||
_gyro_filter_y.set_cutoff_frequency(MPU6000_GYRO_DEFAULT_RATE, gyro_cut);
|
||||
_gyro_filter_z.set_cutoff_frequency(MPU6000_GYRO_DEFAULT_RATE, gyro_cut);
|
||||
@@ -2010,10 +2006,6 @@ MPU6000::print_info()
|
||||
}
|
||||
|
||||
::printf("temperature: %.1f\n", (double)_last_temperature);
|
||||
float accel_cut = _accel_filter_x.get_cutoff_freq();
|
||||
::printf("accel cutoff set to %10.2f Hz\n", double(accel_cut));
|
||||
float gyro_cut = _gyro_filter_x.get_cutoff_freq();
|
||||
::printf("gyro cutoff set to %10.2f Hz\n", double(gyro_cut));
|
||||
}
|
||||
|
||||
void
|
||||
|
||||
@@ -326,8 +326,6 @@ MPU9250::init()
|
||||
float accel_cut = MPU9250_ACCEL_DEFAULT_DRIVER_FILTER_FREQ;
|
||||
|
||||
if (accel_cut_ph != PARAM_INVALID && (param_get(accel_cut_ph, &accel_cut) == PX4_OK)) {
|
||||
PX4_INFO("accel cutoff set to %.2f Hz", double(accel_cut));
|
||||
|
||||
_accel_filter_x.set_cutoff_frequency(MPU9250_ACCEL_DEFAULT_RATE, accel_cut);
|
||||
_accel_filter_y.set_cutoff_frequency(MPU9250_ACCEL_DEFAULT_RATE, accel_cut);
|
||||
_accel_filter_z.set_cutoff_frequency(MPU9250_ACCEL_DEFAULT_RATE, accel_cut);
|
||||
@@ -340,8 +338,6 @@ MPU9250::init()
|
||||
float gyro_cut = MPU9250_GYRO_DEFAULT_DRIVER_FILTER_FREQ;
|
||||
|
||||
if (gyro_cut_ph != PARAM_INVALID && (param_get(gyro_cut_ph, &gyro_cut) == PX4_OK)) {
|
||||
PX4_INFO("gyro cutoff set to %.2f Hz", double(gyro_cut));
|
||||
|
||||
_gyro_filter_x.set_cutoff_frequency(MPU9250_GYRO_DEFAULT_RATE, gyro_cut);
|
||||
_gyro_filter_y.set_cutoff_frequency(MPU9250_GYRO_DEFAULT_RATE, gyro_cut);
|
||||
_gyro_filter_z.set_cutoff_frequency(MPU9250_GYRO_DEFAULT_RATE, gyro_cut);
|
||||
@@ -1474,11 +1470,6 @@ MPU9250::print_info()
|
||||
}
|
||||
}
|
||||
|
||||
::printf("temperature: %.1f\n", (double)_last_temperature);
|
||||
float accel_cut = _accel_filter_x.get_cutoff_freq();
|
||||
::printf("accel cutoff set to %10.2f Hz\n", double(accel_cut));
|
||||
float gyro_cut = _gyro_filter_x.get_cutoff_freq();
|
||||
::printf("gyro cutoff set to %10.2f Hz\n", double(gyro_cut));
|
||||
}
|
||||
|
||||
void
|
||||
|
||||
Reference in New Issue
Block a user