c1_test2.c

mmo 信道估计算法 matlab 仿真 实现了无线信道环境下的信道估计

/* Include files */
#include "test2_sfun.h"
#include "c1_test2.h"
#define CHARTINSTANCE_CHARTNUMBER       (chartInstance.chartNumber)
#define CHARTINSTANCE_INSTANCENUMBER    (chartInstance.instanceNumber)
#include "test2_sfun_debug_macros.h"

/* Type Definitions */

/* Named Constants */
#define c1_IN_NO_ACTIVE_CHILD           (0)

/* Variable Declarations */

/* Variable Definitions */
static SFc1_test2InstanceStruct chartInstance;

/* Function Declarations */
static void initialize_c1_test2(void);
static void initialize_params_c1_test2(void);
static void enable_c1_test2(void);
static void disable_c1_test2(void);
static void finalize_c1_test2(void);
static void sf_c1_test2(void);
static creal_T c1_times(creal_T c1_x, creal_T c1_y);
static real_T c1_abs(creal_T c1_x);
static creal_T *c1_syn(void);
static creal_T *c1_input_signal(void);

/* Function Definitions */
static void initialize_c1_test2(void)
{
  chartInstance.c1_is_active_c1_test2 = 0U;
}

static void initialize_params_c1_test2(void)
{
}

static void enable_c1_test2(void)
{
}

static void disable_c1_test2(void)
{
}

static void finalize_c1_test2(void)
{
}

static void sf_c1_test2(void)
{
  uint8_T c1_previousEvent;
  int32_T c1_em_i0;
  creal_T c1_b_input_signal[1][480];
  real_T c1_n;
  real_T c1_idx;
  creal_T c1_abscorr[128][1];
  creal_T c1_time_corr_long[128][1];
  creal_T c1_long_trs[64][1];
  creal_T c1_long_tr_symbols[64][1];
  real_T c1_end_search;
  real_T c1_start_search;
  creal_T c1_b_syn[128];
  int32_T c1_em_i1;
  static creal_T c1_em_dcv0[64][1] = { { { 0.15625, 0.0 } },
    { { -0.0051213, -0.12033 } },
    { { 0.03975, -0.11116 } },
    { { 0.096832, 0.082798 } },
    { { 0.021112, 0.027886 } },
    { { 0.059824, -0.087707 } },
    { { -0.11513, -0.05518 } },
    { { -0.038316, -0.10617 } },
    { { 0.097541, -0.025888 } },
    { { 0.053338, 0.0040763 } },
    { { 0.00098898, -0.115 } },
    { { -0.1368, -0.04738 } },
    { { 0.024476, -0.058532 } },
    { { 0.058669, -0.014939 } },
    { { -0.022483, 0.16066 } },
    { { 0.11924, -0.0040956 } },
    { { 0.0625, -0.0625 } },
    { { 0.036918, 0.098344 } },
    { { -0.057206, 0.039299 } },
    { { -0.13126, 0.065227 } },
    { { 0.082218, 0.092357 } },
    { { 0.069557, 0.014122 } },
    { { -0.06031, 0.081286 } },
    { { -0.056455, -0.021804 } },
    { { -0.035041, -0.15089 } },
    { { -0.12189, -0.016566 } },
    { { -0.12732, -0.020501 } },
    { { 0.075074, -0.07404 } },
    { { -0.0028059, 0.053774 } },
    { { -0.091888, 0.11513 } },
    { { 0.091717, 0.10587 } },
    { { 0.012285, 0.0976 } },
    { { -0.15625, 0.0 } },
    { { 0.012285, -0.0976 } },
    { { 0.091717, -0.10587 } },
    { { -0.091888, -0.11513 } },
    { { -0.0028059, -0.053774 } },
    { { 0.075074, 0.07404 } },
    { { -0.12732, 0.020501 } },
    { { -0.12189, 0.016566 } },
    { { -0.035041, 0.15089 } },
    { { -0.056455, 0.021804 } },
    { { -0.06031, -0.081286 } },
    { { 0.069557, -0.014122 } },
    { { 0.082218, -0.092357 } },
    { { -0.13126, -0.065227 } },
    { { -0.057206, -0.039299 } },
    { { 0.036918, -0.098344 } },
    { { 0.0625, 0.0625 } },
    { { 0.11924, 0.0040956 } },
    { { -0.022483, -0.16066 } },
    { { 0.058669, 0.014939 } },
    { { 0.024476, 0.058532 } },
    { { -0.1368, 0.04738 } },
    { { 0.00098898, 0.115 } },
    { { 0.053338, -0.0040763 } },
    { { 0.097541, 0.025888 } },
    { { -0.038316, 0.10617 } },
    { { -0.11513, 0.05518 } },
    { { 0.059824, 0.087707 } },
    { { 0.021112, -0.027886 } },
    { { 0.096832, -0.082798 } },
    { { 0.03975, 0.11116 } },
    { { -0.0051213, 0.12033 } } };
  int32_T c1_em_i2;
  static creal_T c1_em_dcv1[64][1] = { { { -0.15625, 0.0 } },
    { { 0.012285, -0.0976 } },
    { { 0.091717, -0.10587 } },
    { { -0.091888, -0.11513 } },
    { { -0.0028059, -0.053774 } },
    { { 0.075074, 0.07404 } },
    { { -0.12732, 0.020501 } },
    { { -0.12189, 0.016566 } },
    { { -0.035041, 0.15089 } },
    { { -0.056455, 0.021804 } },
    { { -0.06031, -0.081286 } },
    { { 0.069557, -0.014122 } },
    { { 0.082218, -0.092357 } },
    { { -0.13126, -0.065227 } },
    { { -0.057206, -0.039299 } },
    { { 0.036918, -0.098344 } },
    { { 0.0625, 0.0625 } },
    { { 0.11924, 0.0040956 } },
    { { -0.022483, -0.16066 } },
    { { 0.058669, 0.014939 } },
    { { 0.024476, 0.058532 } },
    { { -0.1368, 0.04738 } },
    { { 0.00098898, 0.115 } },
    { { 0.053338, -0.0040763 } },
    { { 0.097541, 0.025888 } },
    { { -0.038316, 0.10617 } },
    { { -0.11513, 0.05518 } },
    { { 0.059824, 0.087707 } },
    { { 0.021112, -0.027886 } },
    { { 0.096832, -0.082798 } },
    { { 0.03975, 0.11116 } },
    { { -0.0051213, 0.12033 } },
    { { 0.15625, 0.0 } },
    { { -0.0051213, -0.12033 } },
    { { 0.03975, -0.11116 } },
    { { 0.096832, 0.082798 } },
    { { 0.021112, 0.027886 } },
    { { 0.059824, -0.087707 } },
    { { -0.11513, -0.05518 } },
    { { -0.038316, -0.10617 } },
    { { 0.097541, -0.025888 } },
    { { 0.053338, 0.0040763 } },
    { { 0.00098898, -0.115 } },
    { { -0.1368, -0.04738 } },
    { { 0.024476, -0.058532 } },
    { { 0.058669, -0.014939 } },
    { { -0.022483, 0.16066 } },
    { { 0.11924, -0.0040956 } },
    { { 0.0625, -0.0625 } },
    { { 0.036918, 0.098344 } },
    { { -0.057206, 0.039299 } },
    { { -0.13126, 0.065227 } },
    { { 0.082218, 0.092357 } },
    { { 0.069557, 0.014122 } },
    { { -0.06031, 0.081286 } },
    { { -0.056455, -0.021804 } },
    { { -0.035041, -0.15089 } },
    { { -0.12189, -0.016566 } },
    { { -0.12732, -0.020501 } },
    { { 0.075074, -0.07404 } },
    { { -0.0028059, 0.053774 } },
    { { -0.091888, 0.11513 } },
    { { 0.091717, 0.10587 } },
    { { 0.012285, 0.0976 } } };
  int32_T c1_em_i3;
  int32_T c1_em_i4;
  int32_T c1_em_i5;
  int32_T c1_em_i6;
  real_T c1_em_d0;
  real_T c1_b_idx;
  real_T c1_em_d1;
  real_T c1_b_n;
  creal_T c1_c_input_signal;
  creal_T c1_b_long_trs;
  creal_T c1_em_dc0;
  creal_T c1_b_time_corr_long;
  int32_T c1_em_i7;
  int32_T c1_em_i8;
  _sfTime_ = (real_T)ssGetT(chartInstance.S);
  c1_previousEvent = _sfEvent_;
  _sfEvent_ = CALL_EVENT;
  _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG,0);
  for(c1_em_i0 = 0; c1_em_i0 <= 479; c1_em_i0++) {
    c1_b_input_signal[0][c1_em_i0].re = c1_input_signal()[c1_em_i0].re;
    c1_b_input_signal[0][c1_em_i0].im = c1_input_signal()[c1_em_i0].im;
  }
  sf_debug_push_symbol_scope(10U);
  sf_debug_symbol_scope_add_symbol("n", 0, 0U, 0U, 0U, 0U, 1.0, 0, 0.0, 0U, 0,
   &c1_n);
  sf_debug_symbol_scope_add_symbol("idx", 0, 0U, 0U, 0U, 0U, 1.0, 0, 0.0, 0U, 0,
   &c1_idx);
  sf_debug_symbol_scope_add_symbol("abscorr", 0, 2U, 1U, 128U, 0U, 1.0, 0, 0.0,
   1U, 1, &c1_abscorr);
  sf_debug_symbol_scope_add_symbol("time_corr_long", 0, 2U, 1U, 128U, 0U, 1.0,
   0, 0.0, 1U, 1, &c1_time_corr_long);
  sf_debug_symbol_scope_add_symbol("long_trs", 0, 2U, 1U, 64U, 0U, 1.0, 0, 0.0,
   1U, 1, &c1_long_trs);
  sf_debug_symbol_scope_add_symbol("long_tr_symbols", 0, 2U, 1U, 64U, 0U, 1.0,
   0, 0.0, 1U, 1, &c1_long_tr_symbols);
  sf_debug_symbol_scope_add_symbol("end_search", 0, 0U, 0U, 0U, 0U, 1.0, 0, 0.0,
   0U, 0, &c1_end_search);
  sf_debug_symbol_scope_add_symbol("start_search", 0, 0U, 0U, 0U, 0U, 1.0, 0,
   0.0, 0U, 0, &c1_start_search);
  sf_debug_symbol_scope_add_symbol("syn", 0, 1U, 128U, 0U, 0U, 1.0, 0, 0.0, 1U,
   1, &c1_b_syn);
  sf_debug_symbol_scope_add_symbol("input_signal", 0, 2U, 480U, 1U, 0U, 1.0, 0,
   0.0, 1U, 1, &c1_b_input_signal);
  CV_EML_FCN(0, 0);
  /* timing search window size */
  _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,7);
  c1_start_search = 130.0;
  _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,8);
  c1_end_search = 200.0;
  /*  get time domain long training symbols */
  _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,11);
  for(c1_em_i1 = 0; c1_em_i1 <= 63; c1_em_i1++) {
    c1_long_tr_symbols[c1_em_i1][0].re = c1_em_dcv0[c1_em_i1][0].re;
    c1_long_tr_symbols[c1_em_i1][0].im = c1_em_dcv0[c1_em_i1][0].im;
  }
  /*     if sim_options.UseTxDiv */
  /*        long_trs = [long_tr_symbols(49:64) long_tr_symbols(1:48)]; */
  /*     else */
  _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,16);
  for(c1_em_i2 = 0; c1_em_i2 <= 63; c1_em_i2++) {
    c1_long_trs[c1_em_i2][0].re = c1_em_dcv1[c1_em_i2][0].re;
    c1_long_trs[c1_em_i2][0].im = c1_em_dcv1[c1_em_i2][0].im;
  }
  /*     end */
  _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,19);
  for(c1_em_i3 = 0; c1_em_i3 <= 63; c1_em_i3++) {
    c1_time_corr_long[c1_em_i3][0].re = c1_long_tr_symbols[c1_em_i3][0].re;
    c1_time_corr_long[c1_em_i3][0].im = c1_long_tr_symbols[c1_em_i3][0].im;
  }
  for(c1_em_i4 = 0; c1_em_i4 <= 63; c1_em_i4++) {
    c1_time_corr_long[64 + c1_em_i4][0].re = c1_long_tr_symbols[c1_em_i4][0].re;
    c1_time_corr_long[64 + c1_em_i4][0].im = c1_long_tr_symbols[c1_em_i4][0].im;
  }
  _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,20);
  for(c1_em_i5 = 0; c1_em_i5 <= 63; c1_em_i5++) {
    c1_abscorr[c1_em_i5][0].re = c1_long_tr_symbols[c1_em_i5][0].re;
    c1_abscorr[c1_em_i5][0].im = c1_long_tr_symbols[c1_em_i5][0].im;
  }
  for(c1_em_i6 = 0; c1_em_i6 <= 63; c1_em_i6++) {
    c1_abscorr[64 + c1_em_i6][0].re = c1_long_tr_symbols[c1_em_i6][0].re;
    c1_abscorr[64 + c1_em_i6][0].im = c1_long_tr_symbols[c1_em_i6][0].im;
  }
  /*  calculate cross correlation       */
  c1_em_d0 = 130.0;
  c1_idx = c1_em_d0;
  c1_b_idx = 130.0;
  while(c1_b_idx <= 200.0) {
    c1_idx = c1_b_idx;
    CV_EML_FOR(0, 0, 1);
    _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,24);
    (*(creal_T
      (*)[128])&c1_time_corr_long)[(int32_T)_SFD_EML_ARRAY_BOUNDS_CHECK("time_corr_long",
     (int32_T)_SFD_INTEGER_CHECK("", (
       c1_idx - c1_start_search) + 1.0), 1, 128, 1) - 1].re = 0.0;
    (*(creal_T
      (*)[128])&c1_time_corr_long)[(int32_T)_SFD_EML_ARRAY_BOUNDS_CHECK("time_corr_long",
     (int32_T)_SFD_INTEGER_CHECK("", (
       c1_idx - c1_start_search) + 1.0), 1, 128, 1) - 1].im = 0.0;
    c1_em_d1 = 1.0;
    c1_n = c1_em_d1;
    c1_b_n = 1.0;
    while(c1_b_n <= 64.0) {
      c1_n = c1_b_n;
      CV_EML_FOR(0, 1, 1);
      _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,26);
      c1_c_input_signal.re = (*(creal_T
        (*)[480])&c1_b_input_signal)[(int32_T)_SFD_EML_ARRAY_BOUNDS_CHECK("input_signal",
       (int32_T)
       _SFD_INTEGER_CHECK("", (c1_idx + c1_n) - 1.0), 1, 480, 1) - 1].re;
      c1_c_input_signal.im = (*(creal_T
        (*)[480])&c1_b_input_signal)[(int32_T)_SFD_EML_ARRAY_BOUNDS_CHECK("input_signal",
       (int32_T)
       _SFD_INTEGER_CHECK("", (c1_idx + c1_n) - 1.0), 1, 480, 1) - 1].im;
      c1_b_long_trs.re = (*(creal_T
        (*)[64])&c1_long_trs)[(int32_T)_SFD_EML_ARRAY_BOUNDS_CHECK("long_trs",
       (int32_T)_SFD_INTEGER_CHECK("n"
        , c1_n), 1, 64, 1) - 1].re;
      c1_b_long_trs.im = (real_T)-(*(creal_T
        (*)[64])&c1_long_trs)[(int32_T)_SFD_EML_ARRAY_BOUNDS_CHECK("long_trs",
       (int32_T)
       _SFD_INTEGER_CHECK("n", c1_n), 1, 64, 1) - 1].im;
      c1_em_dc0 = c1_times(c1_c_input_signal, c1_b_long_trs);
      (*(creal_T
        (*)[128])&c1_time_corr_long)[(int32_T)_SFD_EML_ARRAY_BOUNDS_CHECK("time_corr_long",
       (int32_T)_SFD_INTEGER_CHECK("", (
         c1_idx - c1_start_search) + 1.0), 1, 128, 1) - 1].re = (*(creal_T
        (*)[128])&c1_time_corr_long)[(int32_T)_SFD_EML_ARRAY_BOUNDS_CHECK(
        "time_corr_long", (int32_T)_SFD_INTEGER_CHECK("", (c1_idx -
         c1_start_search) + 1.0), 1, 128, 1) - 1].re + c1_em_dc0.re;
      (*(creal_T
        (*)[128])&c1_time_corr_long)[(int32_T)_SFD_EML_ARRAY_BOUNDS_CHECK("time_corr_long",
       (int32_T)_SFD_INTEGER_CHECK("", (
         c1_idx - c1_start_search) + 1.0), 1, 128, 1) - 1].im = (*(creal_T
        (*)[128])&c1_time_corr_long)[(int32_T)_SFD_EML_ARRAY_BOUNDS_CHECK(
        "time_corr_long", (int32_T)_SFD_INTEGER_CHECK("", (c1_idx -
         c1_start_search) + 1.0), 1, 128, 1) - 1].im + c1_em_dc0.im;
      c1_b_n++;
      sf_mex_listen_for_ctrl_c(chartInstance.S);
    }
    CV_EML_FOR(0, 1, 0);
    /*           time_corr_long(idx-start_search+1) = sum((input_signal(idx:idx+63).*conj(long_trs))); */
    _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,30);
    c1_b_time_corr_long.re = (*(creal_T
      (*)[128])&c1_time_corr_long)[(int32_T)_SFD_EML_ARRAY_BOUNDS_CHECK("time_corr_long",
     (int32_T)
     _SFD_INTEGER_CHECK("", (c1_idx - c1_start_search) + 1.0), 1, 128, 1) -
    1].re;
    c1_b_time_corr_long.im = (*(creal_T
      (*)[128])&c1_time_corr_long)[(int32_T)_SFD_EML_ARRAY_BOUNDS_CHECK("time_corr_long",
     (int32_T)
     _SFD_INTEGER_CHECK("", (c1_idx - c1_start_search) + 1.0), 1, 128, 1) -
    1].im;
    (*(creal_T
      (*)[128])&c1_abscorr)[(int32_T)_SFD_EML_ARRAY_BOUNDS_CHECK("abscorr",
     (int32_T)_SFD_INTEGER_CHECK("", (c1_idx -
       c1_start_search) + 1.0), 1, 128, 1) - 1].re = c1_abs(c1_b_time_corr_long);
    (*(creal_T
      (*)[128])&c1_abscorr)[(int32_T)_SFD_EML_ARRAY_BOUNDS_CHECK("abscorr",
     (int32_T)_SFD_INTEGER_CHECK("", (c1_idx -
       c1_start_search) + 1.0), 1, 128, 1) - 1].im = 0.0;
    c1_b_idx++;
    sf_mex_listen_for_ctrl_c(chartInstance.S);
  }
  CV_EML_FOR(0, 0, 0);
  /*     time_corr_long = sum(abs(time_corr_long),1); */
  /*     [max_peak_long,long_search_idx] = max(abs(time_corr_long)); */
  /*    [max_peak_long,long_search_idx] = max(abscorr); */
  /*        fine_time_est = start_search-1 + long_search_idx+32; */
  /*    syn=time_corr_long'; */
  _SFD_EML_CALL(STATE_DURING_DURING_ACTION_TAG,0,39);
  for(c1_em_i7 = 0; c1_em_i7 <= 127; c1_em_i7++) {
    c1_b_syn[c1_em_i7].re = c1_abscorr[c1_em_i7][0].re;
    c1_b_syn[c1_em_i7].im = (real_T)-c1_abscorr[c1_em_i7][0].im;
  }
  /*  search_win = 320; */
  /*  D = 16; */
  /*  delay_xcorr=rx_signal; */
  /*  ma_M=rx_signal; */
  /*  for i=1:search_win */
  /*    delay_xcorr(i)=rx_signal(i)*conj(rx_signal(D+i)); */
  /*  end */
  /*   */
  /*  for n=1:search_win */
  /*   */
  /*  sum_delay_xcorr=complex(0); */
  /*  for ii=1:2*D */
  /*    sum_delay_xcorr=sum_delay_xcorr+delay_xcorr(ii+n-1);   */
  /*  end */
  /*   sum_delay_xcorr2=abs(sum_delay_xcorr)^2; */
  /*    */
  /*    */
  /*   p=0; */
  /*   for iii=1:2*D */
  /*      pwr=abs(rx_signal(n+iii+D-1))^2; */
  /*      p=p+pwr; */
  /*   end */
  /*  p2=p^2; */
  /*   */
  /*  ma_M(n)=sum_delay_xcorr2/p2; */
  /*   */
  /*  end */
  /*  detected_packet = ma_M; */
  /*     rx_len = length(rx_signal); */
  /*      */
  /*     % Calculate the delayd correlation */
  /*     delay_xcorr = rx_signal(:,1:search_win+2*D).*conj(rx_signal(:,1*D+1:search_win+3*D)); */
  /*         */
  /*     % Moving average of the delayed correlation */
  /*     ma_delay_xcorr = abs(filter(ones(1,2*D), 1, delay_xcorr, [], 2)); */
  /*      */
  /*     % Moving average of received power */
  /*     ma_rx_pwr = filter(ones(1,2*D), 1, abs(rx_signal(:,1*D+1:search_win+3*D)).^2,[], 2); */
  /*      */
  /*     % The decision variable */