Showing with 3 additions and 7 deletions.
  1. +1 −1 conf/modules/rot_wing_automation.xml
  2. +2 −6 sw/airborne/modules/rot_wing_drone/rot_wing_automation.c
2 changes: 1 addition & 1 deletion conf/modules/rot_wing_automation.xml
View file
@@ -1,7 +1,7 @@
<!DOCTYPE module SYSTEM "module.dtd">
<module name="rot_wing_automation" dir="rot_wing_drone">
<doc>
<description>Fucntions to automate the navigation and guidance of the rotating wing drone</description>
<description>Functions to automate the navigation and guidance of the rotating wing drone</description>
</doc>
<settings>
<dl_settings>
Expand Down
8 changes: 2 additions & 6 deletions sw/airborne/modules/rot_wing_drone/rot_wing_automation.c
View file
Expand Up @@ -129,12 +129,8 @@ void update_wind_vector(void)
VECT2_DIFF(rot_wing_a.windvect, *groundspeed, airspeed_v);

// Filter the wind
update_butterworth_2_low_pass(&rot_wing_automation_wind_filter[0], rot_wing_a.windvect.x);
update_butterworth_2_low_pass(&rot_wing_automation_wind_filter[1], rot_wing_a.windvect.y);

// Update the filtered wind vector
rot_wing_a.windvect_f.x = rot_wing_automation_wind_filter[0].o[0];
rot_wing_a.windvect_f.y = rot_wing_automation_wind_filter[1].o[0];
rot_wing_a.windvect_f.x = update_butterworth_2_low_pass(&rot_wing_automation_wind_filter[0], rot_wing_a.windvect.x);
rot_wing_a.windvect_f.x = update_butterworth_2_low_pass(&rot_wing_automation_wind_filter[1], rot_wing_a.windvect.y);
}

// Function to visualize from flightplan, call repeadely
Expand Down