Filter: optimize hot parts of notch filter updates

libraries/Filter/HarmonicNotchFilter.cpp

@@ -13,6 +13,11 @@
    along with this program.  If not, see <http://www.gnu.org/licenses/>.
  */
 
+#ifndef HAL_DEBUG_BUILD
+#define AP_INLINE_VECTOR_OPS
+#pragma GCC optimize("O2")
+#endif
+
 #include "HarmonicNotchFilter.h"
 #include <GCS_MAVLink/GCS.h>
 

libraries/Filter/LowPassFilter.cpp

@@ -4,7 +4,10 @@
 ///         the downside being that it's a little slower as it internally uses a float
 ///         and it consumes an extra 4 bytes of memory to hold the constant gain
 
-
+#ifndef HAL_DEBUG_BUILD
+#define AP_INLINE_VECTOR_OPS
+#pragma GCC optimize("O2")
+#endif
 #include "LowPassFilter.h"
 
 ////////////////////////////////////////////////////////////////////////////////////////////

libraries/Filter/LowPassFilter2p.cpp

@@ -1,3 +1,7 @@
+#ifndef HAL_DEBUG_BUILD
+#define AP_INLINE_VECTOR_OPS
+#pragma GCC optimize("O2")
+#endif
 #include "LowPassFilter2p.h"
 
 

libraries/Filter/NotchFilter.cpp

@@ -13,6 +13,11 @@
    along with this program.  If not, see <http://www.gnu.org/licenses/>.
  */
 
+#ifndef HAL_DEBUG_BUILD
+#define AP_INLINE_VECTOR_OPS
+#pragma GCC optimize("O2")
+#endif
+
 #include "NotchFilter.h"
 
 /*