fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-11-06 21:11:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

changed freequency, reduced gyro cutoff for noise

Browse Source
This commit is contained in:
Marvin Harms
2022-06-24 19:42:11 +02:00
parent cced080e5b
commit 0d6d749a38
2 changed files with 3 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/fw_dyn_soar_control/FixedwingPositionINDIControl.cpp
+2 -2
View File
@@ -58,7 +58,7 @@ FixedwingPositionINDIControl::FixedwingPositionINDIControl() :
_loop_perf(perf_alloc(PC_ELAPSED, MODULE_NAME": cycle")) _loop_perf(perf_alloc(PC_ELAPSED, MODULE_NAME": cycle"))
{ {
// limit to 100 Hz // limit to 100 Hz
_vehicle_angular_velocity_sub.set_interval_ms(1000/_sample_frequency); _vehicle_angular_velocity_sub.set_interval_ms(1000.f/_sample_frequency);
/* fetch initial parameter values */ /* fetch initial parameter values */
@@ -606,7 +606,7 @@ FixedwingPositionINDIControl::Run()
wind(1) = _lp_filter_wind[1].apply(wind(1)); wind(1) = _lp_filter_wind[1].apply(wind(1));
wind(2) = _lp_filter_wind[2].apply(wind(2)); wind(2) = _lp_filter_wind[2].apply(wind(2));
_set_wind_estimate(wind); _set_wind_estimate(wind);
PX4_INFO("wind estimate:\t%.4f\t%.4f\t%.4f", (double)_wind_estimate(0),(double)_wind_estimate(1),(double)_wind_estimate(2)); //PX4_INFO("wind estimate:\t%.4f\t%.4f\t%.4f", (double)_wind_estimate(0),(double)_wind_estimate(1),(double)_wind_estimate(2));
// only run actuators poll, when our module is not publishing: // only run actuators poll, when our module is not publishing:
src/modules/sensors/vehicle_angular_velocity/imu_gyro_parameters.c
+1 -1
View File
@@ -80,7 +80,7 @@ PARAM_DEFINE_FLOAT(IMU_GYRO_NF_BW, 20.0f);
* @reboot_required true * @reboot_required true
* @group Sensors * @group Sensors
*/ */
PARAM_DEFINE_FLOAT(IMU_GYRO_CUTOFF, 30.0f); PARAM_DEFINE_FLOAT(IMU_GYRO_CUTOFF, 10.0f);
/** /**
* Gyro control data maximum publication rate * Gyro control data maximum publication rate