trx305/demodulator.c

   1 /*
   2  * demodulator.c
   3  *
   4  *  Created on: 2015/03/10
   5  *      Author: takemasa
   6  */
   7
   8 #ifndef _DEMODULATOR_H_
   9 #define _DEMODULATOR_H_
  10
  11 #include "demodulator.h"
  12 #include <math.h>
  13
  14 void init_demodulator(void)
  15 {
  16
  17 }
  18
  19 void radio_demodulate_wide_FM( short idata[], short qdata[], short* left, short* right )
  20 {
  21
  22 }
  23
  24 void radio_demodulate_non_wide_FM( int idata, int qdata, short* left, short* right )
  25 {
  26
  27     float f;
  28     static short phase = 0;
  29
  30     f = sinf( 2 * 3.14 * phase / 32768 ) * 32767 * 0.5;
  31     phase += 880 ;
  32
  33     * right = *left = f;
  34
  35
  36 }
  37
  38
  39 #endif /* _DEMODULATOR_H_ */