TUMBL firmware: make reserve in current DQ filter for longer measurement period.

Signed-off-by: Pavel Pisa <ppisa@pikron.com>

diff --git a/hw/lx-rocon_firmware/firmware.c b/hw/lx-rocon_firmware/firmware.c
index 96d9f04b8e3ce3eb27b70be9119afad84a29e743..e15a2ef423e87f28e0ea47d335835d2e1a1b7514 100644 (file)
--- a/hw/lx-rocon_firmware/firmware.c
+++ b/hw/lx-rocon_firmware/firmware.c
@@ -459,9 +459,9 @@ void main(void)
 
       pxmcc->cur_dq = (cur_d & 0xffff0000) | ((cur_q >> 16) & 0xffff);
 
-      pxmcc->cur_d_cum = ((pxmcc->cur_d_cum + cur_d) & ~0xff) |
+      pxmcc->cur_d_cum = ((pxmcc->cur_d_cum + (cur_d >> 4)) & ~0x3f) |
                          (last_rx_done_sqn & 0x1f);
-      pxmcc->cur_q_cum = ((pxmcc->cur_q_cum + cur_q) & ~0xff) |
+      pxmcc->cur_q_cum = ((pxmcc->cur_q_cum + (cur_q >> 4)) & ~0x3f) |
                          (last_rx_done_sqn & 0x1f);
 
     }