From 8303726c323331defd4df4ed06f2c8249c7e593b Mon Sep 17 00:00:00 2001
From: suikan <suikan@users.sourceforge.jp>
Date: Tue, 10 Mar 2015 22:36:04 +0900
Subject: [PATCH] =?utf8?q?=E3=81=84=E3=81=8F=E3=81=A4=E3=81=8B=E3=81=AE?=
 =?utf8?q?=E5=A4=89=E6=95=B0=E3=81=AE=E3=83=AA=E3=83=95=E3=82=A1=E3=82=AF?=
 =?utf8?q?=E3=82=BF=E3=83=AA=E3=83=B3=E3=82=B0=E3=81=A8=E3=80=81demodulato?=
 =?utf8?q?r=E3=83=95=E3=82=A1=E3=82=A4=E3=83=AB=E3=81=AE=E8=BF=BD=E5=8A=A0?=
MIME-Version: 1.0
Content-Type: text/plain; charset=utf8
Content-Transfer-Encoding: 8bit

---
 trx305/demodulator.c |  13 +++++
 trx305/demodulator.h |  13 +++++
 trx305/rx_if.c       | 139 ++++++++++++++++++++++++++++++++-------------------
 trx305/rx_if.h       |   5 ++
 4 files changed, 119 insertions(+), 51 deletions(-)
 create mode 100644 trx305/demodulator.c
 create mode 100644 trx305/demodulator.h

diff --git a/trx305/demodulator.c b/trx305/demodulator.c
new file mode 100644
index 0000000..99010cb
--- /dev/null
+++ b/trx305/demodulator.c
@@ -0,0 +1,13 @@
+/*
+ * demodulator.c
+ *
+ *  Created on: 2015/03/10
+ *      Author: takemasa
+ */
+
+#ifndef _DEMODULATOR_H_
+#define _DEMODULATOR_H_
+
+#include "demodulator.h"
+
+#endif /* _DEMODULATOR_H_ */
diff --git a/trx305/demodulator.h b/trx305/demodulator.h
new file mode 100644
index 0000000..c189a3b
--- /dev/null
+++ b/trx305/demodulator.h
@@ -0,0 +1,13 @@
+/*
+ * demodulator.h
+ *
+ *  Created on: 2015/03/10
+ *      Author: takemasa
+ */
+
+#ifndef DEMODULATOR_H_
+#define DEMODULATOR_H_
+
+
+
+#endif /* DEMODULATOR_H_ */
diff --git a/trx305/rx_if.c b/trx305/rx_if.c
index 038d3dd..5b481c7 100644
--- a/trx305/rx_if.c
+++ b/trx305/rx_if.c
@@ -7,11 +7,13 @@
 #include <cdefBF533.h>
 
 
+#define PARAMDATA_NUM 16
+
 static void init_sport0_rx(void);
 static void init_sport0_tx(void);
 static void pack_af_sample( short left, short right, int * pri_ch, int * sec_ch1);
-static void parse_wide_fm ( unsigned int pri_ch, unsigned int sec_ch, int* idata, int* qdata );
-static void parse_non_wide_fm(  unsigned int pri_ch, unsigned int sec_ch, int* idata, int* qdata, int* valid_iq );
+static void unpack_wide_fm ( unsigned int pri_ch, unsigned int sec_ch, int* idata, int* qdata );
+static void unpack_non_wide_fm(  unsigned int pri_ch, unsigned int sec_ch, int* idata, int* qdata, int* valid_iq );
 
 
 
@@ -29,13 +31,16 @@ static struct {
 
     unsigned int rxif_buffer[2][RXIF_BUFSIZE];
     unsigned int af_buffer[2][AF_BUFSIZE];
-} sport_ctl;
+    int index;             // パッカーが使う。現在のワードインデックスが0か1か
+} framework;
 
-static struct {
-    int index;
+ struct {
     unsigned short flags;
     unsigned short smeter;
-} af_ctl;
+    unsigned short comdata[PARAMDATA_NUM];
+} radio;
+
+
 
 /**
  * \brief RX_IF受信データの処理タスク
@@ -48,6 +53,7 @@ static struct {
  */
 void rx_if_task(VP_INT exinf)
 {
+    int i;
 
     vmsk_log(LOG_UPTO(LOG_INFO), LOG_UPTO(LOG_EMERG));
     syslog(LOG_NOTICE, "Sample program starts (exinf = %d).", (INT) exinf);
@@ -55,11 +61,16 @@ void rx_if_task(VP_INT exinf)
     syscall(serial_ctl_por(TASK_PORTID,
             (IOCTL_CRLF | IOCTL_FCSND | IOCTL_FCRCV)));
 
-    af_ctl.index = FALSE;
-    af_ctl.flags = 0;
-    af_ctl.smeter = 0;
+    framework.index = FALSE;       // パッカーのインデックスの初期値設定。実のところ、初期値はランダムでも構わない。
+
+        // 受信機パラメタの初期化
+    for ( i=0; i<PARAMDATA_NUM; i++)
+        radio.comdata[i] = 0;
+
+    radio.flags = 0;
+    radio.smeter = 0;
 
-        // SPORT0の送受割り込みを可能にする
+        // SPORT0の送受割り込み受付を可能にする
     syscall(ena_int(INTNO_SPORT0_RX));
     syscall(ena_int(INTNO_SPORT0_TX));
 
@@ -78,11 +89,11 @@ void rx_if_task(VP_INT exinf)
         // 頃合いなので送信DMA割り込みを開始する。
         // CPUロックするのは割り込みにより、タイミングがずれるのを嫌って。
     loc_cpu();
-    sport_ctl.tx_dma_dsc[0].config |= 1 << DI_EN_P;
-    sport_ctl.tx_dma_dsc[1].config |= 1 << DI_EN_P;
+    framework.tx_dma_dsc[0].config |= 1 << DI_EN_P;
+    framework.tx_dma_dsc[1].config |= 1 << DI_EN_P;
     unl_cpu();
 
-        // RX受信を開始する
+        // RX受信を開始する。転送と同時に割り込みが始まる
     *pDMA1_CONFIG |= DMAEN;     // RX SPORT DMA Enable
     *pSPORT0_RCR1 |= RSPEN;     // RX SPORT Enable
     ssync();
@@ -109,10 +120,10 @@ void rx_if_task(VP_INT exinf)
             count = 0;
                 // FIFOにデータがたまったはずである。
                 // FIFOデータを読みだして下位2bitのみ表示する
-            rx[0] = sport_ctl.rxif_buffer[1][0];    // 下位2bitのみ抽出
-            rx[1] = sport_ctl.rxif_buffer[1][1];    // 下位2bitのみ抽出
-            rx[2] = sport_ctl.rxif_buffer[1][2];    // 下位2bitのみ抽出
-            rx[3] = sport_ctl.rxif_buffer[1][3];    // 下位2bitのみ抽出
+            rx[0] = framework.rxif_buffer[1][0];    // 下位2bitのみ抽出
+            rx[1] = framework.rxif_buffer[1][1];    // 下位2bitのみ抽出
+            rx[2] = framework.rxif_buffer[1][2];    // 下位2bitのみ抽出
+            rx[3] = framework.rxif_buffer[1][3];    // 下位2bitのみ抽出
 
             syslog( LOG_NOTICE, "RX word : %08x,%08x,%08x,%08x", rx[0], rx[1], rx[2], rx[3] );
 
@@ -124,7 +135,7 @@ void rx_if_task(VP_INT exinf)
 
     } while (1);
 
-    syslog(LOG_NOTICE, "Sample program ends.");
+    syslog(LOG_NOTICE, "rx_if_task ends.");
     kernel_exit();
 }
 
@@ -185,7 +196,7 @@ static void pack_af_sample( short left, short right, int * pri_ch, int * sec_ch)
 
     left >>= 1;         //15bitに変換
 
-    if ( af_ctl.index )
+    if ( framework.index )
     {
         left |= 0x8000; // MSBを1にする
 
@@ -199,15 +210,15 @@ static void pack_af_sample( short left, short right, int * pri_ch, int * sec_ch)
 
             // indexが0のとき、セカンダリオーディオはDSPからSH2へのデータ回線である
         *sec_ch =
-                af_ctl.smeter << 16  |
-                af_ctl.flags;           // flagsのbit15は0なので、indexも0になる
+                radio.smeter << 16  |
+                radio.flags;           // flagsのbit15は0なので、indexも0になる
     }
 
         // プライマリ・チャンネルの組み立て
     *pri_ch = (right << 16) | left;
 
 
-    af_ctl.index = ! af_ctl.index;  // indexの論理反転
+    framework.index = ! framework.index;  // indexの論理反転
 }
 
 /**
@@ -218,9 +229,18 @@ static void pack_af_sample( short left, short right, int * pri_ch, int * sec_ch)
  * \param qdata 抽出したQデータ。[-1,1.0)の固定小数点形式
  * \detail
  */
-static void parse_wide_fm ( unsigned int pri_ch, unsigned int sec_ch, int* idata, int* qdata )
+static void unpack_wide_fm ( unsigned int pri_ch, unsigned int sec_ch, int* idata, int* qdata )
 {
 
+        // iデータとqデータを抽出する。両者とも16bitで、bit14からbit29に格納されている
+    *idata = ( pri_ch << 2 ) & 0xFFFF0000;
+    *qdata = ( sec_ch << 2 ) & 0xFFFF0000;
+
+        // パラメータ・データを配列に格納する。
+        // 配列インデックスは comaddr、データはcomdataから。comdataはpri/secに分散している。
+    radio.comdata[ ( pri_ch >> 6 ) & 0x0F ] =
+            (( pri_ch << 6 ) & 0xF000) |      //
+            (( sec_ch >> 2 ) & 0x0FFF);
 }
 
 /**
@@ -233,9 +253,26 @@ static void parse_wide_fm ( unsigned int pri_ch, unsigned int sec_ch, int* idata
  * \detail
  */
 
-static void parse_non_wide_fm(  unsigned int pri_ch, unsigned int sec_ch, int* idata, int* qdata, int* valid_iq )
+static void unpack_non_wide_fm(  unsigned int pri_ch, unsigned int sec_ch, int* idata, int* qdata, int* valid_iq )
 {
-
+        // インデックス分け
+    if ( sec_ch & 0x02 )    // bit1が1ならindex = 1
+    {
+            // IQデータはbit[29:2]に格納されている
+        *idata = (pri_ch << 2);                 // プライマリ・チャンネルの場合はマスク不要
+        *qdata = (sec_ch << 2) & 0xFFFFFFF0;
+            // IQデータが有効であると通知する
+        *valid_iq = TRUE;
+    }
+    else                    // index = 0
+    {
+            // パラメータ・データをrx_parameter.data配列に格納する。
+            // 配列インデックスは comaddr、データはcomdataから。
+        radio.comdata[ ( pri_ch >> 6 ) & 0x0F ] =
+                ( sec_ch >> 2 ) & 0xFFFF;
+            // IQデータが無効であると通知する
+        *valid_iq = FALSE;
+    }
 }
 
 
@@ -309,8 +346,8 @@ static void init_sport0_rx(void)
         // DMAバッファを明示的にクリアする
     for ( i = 0; i < RXIF_BUFSIZE; i++)
     {
-        sport_ctl.rxif_buffer[0][i] = 0;
-        sport_ctl.rxif_buffer[0][i] = 0;
+        framework.rxif_buffer[0][i] = 0;
+        framework.rxif_buffer[0][i] = 0;
     }
 
         // 受信SPORTの設定。WORD長は30bitで、アーリー同期信号。外部クロック入力。
@@ -334,11 +371,11 @@ static void init_sport0_rx(void)
 
 
         // 受信DMAデスクリプタを作る
-    sport_ctl.rx_dma_dsc[0].next_descripter = &sport_ctl.rx_dma_dsc[1];
-    sport_ctl.rx_dma_dsc[0].start_address = sport_ctl.rxif_buffer[0];
-    sport_ctl.rx_dma_dsc[0].x_count = RXIF_BUFSIZE;
-    sport_ctl.rx_dma_dsc[0].x_modify = sizeof(sport_ctl.rxif_buffer[0][0]);
-    sport_ctl.rx_dma_dsc[0].config =
+    framework.rx_dma_dsc[0].next_descripter = &framework.rx_dma_dsc[1];
+    framework.rx_dma_dsc[0].start_address = framework.rxif_buffer[0];
+    framework.rx_dma_dsc[0].x_count = RXIF_BUFSIZE;
+    framework.rx_dma_dsc[0].x_modify = sizeof(framework.rxif_buffer[0][0]);
+    framework.rx_dma_dsc[0].config =
             FLOW_LARGE      |   // FLOW,    0:Stop, 1:Auto buffer, 4:Desc array, 6:Desc List small, 7:Desc, List, Large
             NDSIZE_7        |   // NDSIZE,  the # of element of the next descripter to fetch
             1 << DI_EN_P    |   // DI_EN,   0:No interrupt at the end, 1:Interrupt at the end
@@ -349,11 +386,11 @@ static void init_sport0_rx(void)
             1 << WNR_P      |   // WNR,     0:Read from memory, 1:Write to Memory
             1 << 0          ;   // DMA_EN,  0:Disable DMA, 1:Enable DMA
 
-    sport_ctl.rx_dma_dsc[1].next_descripter = &sport_ctl.rx_dma_dsc[0];
-    sport_ctl.rx_dma_dsc[1].start_address = sport_ctl.rxif_buffer[1];
-    sport_ctl.rx_dma_dsc[1].x_count = RXIF_BUFSIZE;
-    sport_ctl.rx_dma_dsc[1].x_modify = sizeof(sport_ctl.rxif_buffer[1][0]);
-    sport_ctl.rx_dma_dsc[1].config =
+    framework.rx_dma_dsc[1].next_descripter = &framework.rx_dma_dsc[0];
+    framework.rx_dma_dsc[1].start_address = framework.rxif_buffer[1];
+    framework.rx_dma_dsc[1].x_count = RXIF_BUFSIZE;
+    framework.rx_dma_dsc[1].x_modify = sizeof(framework.rxif_buffer[1][0]);
+    framework.rx_dma_dsc[1].config =
             FLOW_LARGE      |   // FLOW,    0:Stop, 1:Auto buffer, 4:Desc array, 6:Desc List small, 7:Desc, List, Large
             NDSIZE_7        |   // NDSIZE,  the # of element of the next descripter to fetch
             1 << DI_EN_P    |   // DI_EN,   0:No interrupt at the end, 1:Interrupt at the end
@@ -376,7 +413,7 @@ static void init_sport0_rx(void)
             WDSIZE_32       |   // WDSIZE,  0:8bit, 1:16bit, 2:32bit,3:reserved
             1 << WNR_P      |   // WNR,     0:Read from memory, 1:Write to Memory
             0 << 0          ;   // DMA_EN,  0:Disable DMA, 1:Enable DMA
-    *pDMA1_NEXT_DESC_PTR = &sport_ctl.rx_dma_dsc[0];
+    *pDMA1_NEXT_DESC_PTR = &framework.rx_dma_dsc[0];
 
 
 }
@@ -394,8 +431,8 @@ static void init_sport0_tx(void)
         // DMAバッファを明示的にクリアする
     for ( i = 0; i < AF_BUFSIZE; i++)
     {
-        sport_ctl.af_buffer[0][i] = 0;
-        sport_ctl.af_buffer[0][i] = 0;
+        framework.af_buffer[0][i] = 0;
+        framework.af_buffer[0][i] = 0;
     }
 
 
@@ -425,11 +462,11 @@ static void init_sport0_tx(void)
         // 起きないようにするためである。ラッシュで送信されるのはダミーデータのみ
         // である。rx_if_taskの初期化部でSPORT受信部を起動する際に、送信部の割り込みも
         // 有効にする。
-    sport_ctl.tx_dma_dsc[0].next_descripter = &sport_ctl.tx_dma_dsc[1];
-    sport_ctl.tx_dma_dsc[0].start_address = sport_ctl.af_buffer[0];
-    sport_ctl.tx_dma_dsc[0].x_count = RXIF_BUFSIZE;
-    sport_ctl.tx_dma_dsc[0].x_modify = sizeof(sport_ctl.af_buffer[0][0]);
-    sport_ctl.tx_dma_dsc[0].config =
+    framework.tx_dma_dsc[0].next_descripter = &framework.tx_dma_dsc[1];
+    framework.tx_dma_dsc[0].start_address = framework.af_buffer[0];
+    framework.tx_dma_dsc[0].x_count = RXIF_BUFSIZE;
+    framework.tx_dma_dsc[0].x_modify = sizeof(framework.af_buffer[0][0]);
+    framework.tx_dma_dsc[0].config =
             FLOW_LARGE      |   // FLOW,    0:Stop, 1:Auto buffer, 4:Desc array, 6:Desc List small, 7:Desc, List, Large
             NDSIZE_7        |   // NDSIZE,  the # of element of the next descripter to fetch
             0 << DI_EN_P    |   // DI_EN,   0:No interrupt at the end, 1:Interrupt at the end
@@ -440,11 +477,11 @@ static void init_sport0_tx(void)
             0 << WNR_P      |   // WNR,     0:Read from memory, 1:Write to Memory
             1 << 0          ;   // DMA_EN,  0:Disable DMA, 1:Enable DMA
 
-    sport_ctl.tx_dma_dsc[1].next_descripter = &sport_ctl.tx_dma_dsc[0];
-    sport_ctl.tx_dma_dsc[1].start_address = sport_ctl.af_buffer[1];
-    sport_ctl.tx_dma_dsc[1].x_count = RXIF_BUFSIZE;
-    sport_ctl.tx_dma_dsc[1].x_modify = sizeof(sport_ctl.af_buffer[1][0]);
-    sport_ctl.tx_dma_dsc[1].config =
+    framework.tx_dma_dsc[1].next_descripter = &framework.tx_dma_dsc[0];
+    framework.tx_dma_dsc[1].start_address = framework.af_buffer[1];
+    framework.tx_dma_dsc[1].x_count = RXIF_BUFSIZE;
+    framework.tx_dma_dsc[1].x_modify = sizeof(framework.af_buffer[1][0]);
+    framework.tx_dma_dsc[1].config =
             FLOW_LARGE      |   // FLOW,    0:Stop, 1:Auto buffer, 4:Desc array, 6:Desc List small, 7:Desc, List, Large
             NDSIZE_7        |   // NDSIZE,  the # of element of the next descripter to fetch
             0 << DI_EN_P    |   // DI_EN,   0:No interrupt at the end, 1:Interrupt at the end
@@ -467,6 +504,6 @@ static void init_sport0_tx(void)
             WDSIZE_32       |   // WDSIZE,  0:8bit, 1:16bit, 2:32bit,3:reserved
             0 << WNR_P      |   // WNR,     0:Read from memory, 1:Write to Memory
             0 << 0          ;   // DMA_EN,  0:Disable DMA, 1:Enable DMA
-    *pDMA2_NEXT_DESC_PTR = &sport_ctl.tx_dma_dsc[0];
+    *pDMA2_NEXT_DESC_PTR = &framework.tx_dma_dsc[0];
 
 }
diff --git a/trx305/rx_if.h b/trx305/rx_if.h
index 6e9c362..43d1a52 100644
--- a/trx305/rx_if.h
+++ b/trx305/rx_if.h
@@ -38,6 +38,9 @@
  *  @(#) $Id: sample1.h,v 1.3 2009/05/13 13:10:13 suikan Exp $
  */
 
+#ifndef _RX_IF_H_
+#define _RX_IF_H_
+
 /*
  *  RX_IFアプリケーションのヘッダファイル
  */
@@ -138,3 +141,5 @@ void init_peripherals(VP_INT p);        /* ペリフェラルの初期化関数
 
 
 #endif /* _MACRO_ONLY */
+
+#endif /* _RX_IF_H */
-- 
2.11.0