From 83d07967b9f26aa2d881570cf4b8b38f7dc4715a Mon Sep 17 00:00:00 2001
From: bkleiner <benedikt.kleiner@gmail.com>
Date: Sun, 4 Aug 2024 13:26:29 +0200
Subject: [PATCH] sdft: record all peaks

---
 src/flight/sixaxis.c | 4 +---
 1 file changed, 1 insertion(+), 3 deletions(-)

diff --git a/src/flight/sixaxis.c b/src/flight/sixaxis.c
index 0218a1cae..3b7c46eee 100644
--- a/src/flight/sixaxis.c
+++ b/src/flight/sixaxis.c
@@ -183,9 +183,7 @@ void sixaxis_read() {
 
     if (profile.filter.gyro_dynamic_notch_enable) {
       for (uint32_t p = 0; p < SDFT_PEAKS; p++) {
-        if (p == 1) {
-          blackbox_set_debug(i, gyro_sdft[i].notch_hz[p]);
-        }
+        blackbox_set_debug(i * SDFT_PEAKS + p, gyro_sdft[i].notch_hz[p]);
         state.gyro.axis[i] = filter_biquad_notch_step(&notch_filter[i][p], &notch_filter_state[i][p], state.gyro.axis[i]);
       }
     }