抽出したidata qdataの符号ビットの数を計測

[trx-305dsp/dsp.git] / trx305 / framework.c

diff --git a/trx305/framework.c b/trx305/framework.c
index 8a2b3ec..93877f6 100644 (file)
--- a/trx305/framework.c
+++ b/trx305/framework.c
@@ -416,12 +416,17 @@ static void unpack_non_wide_fm(  unsigned int pri_ch, unsigned int sec_ch, int*
         // インデックス分け
     if ( sec_ch & 0x02 )    // bit1が1ならindex = 1
     {
+            // IQデータはbit[29:2]に格納されている
+        *idata = (pri_ch << 2) & 0xFFFFFFF0;
+        *qdata = (sec_ch << 2) & 0xFFFFFFF0;
+            // IQデータが有効であると通知する
+        *valid_iq = TRUE;
         if ( debug_count < 1000 )
         {
             debug_count++;
-            if ( pri_ch & 1 << 29 )
+            if ( *idata & 1 << 31 )
                 debug_izero++;
-            if ( sec_ch & 1 << 29 )
+            if ( *qdata & 1 << 31 )
                 debug_qzero++;
         }
         else
@@ -431,11 +436,6 @@ static void unpack_non_wide_fm(  unsigned int pri_ch, unsigned int sec_ch, int*
             debug_izero = 0;
             debug_qzero = 0;
         }
-            // IQデータはbit[29:2]に格納されている
-        *idata = (pri_ch << 2) & 0xFFFFFFF0;
-        *qdata = (sec_ch << 2) & 0xFFFFFFF0;
-            // IQデータが有効であると通知する
-        *valid_iq = TRUE;
     }
     else                    // index = 0
     {