c3_std5.c

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

/* Include files */
#include "std5_sfun.h"
#include "c3_std5.h"
#define CHARTINSTANCE_CHARTNUMBER       (chartInstance.chartNumber)
#define CHARTINSTANCE_INSTANCENUMBER    (chartInstance.instanceNumber)
#include "std5_sfun_debug_macros.h"

/* Type Definitions */

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

/* Variable Declarations */

/* Variable Definitions */
static SFc3_std5InstanceStruct chartInstance;

/* Function Declarations */
static void initialize_c3_std5(void);
static void initialize_params_c3_std5(void);
static void enable_c3_std5(void);
static void disable_c3_std5(void);
static void finalize_c3_std5(void);
static void sf_c3_std5(void);
static void c3_eML_blk_kernel(creal_T *c3_b_input_signal, creal_T
 c3_b_coarse_fre, creal_T *c3_b_syn, real_T *c3_b_dreal_syble, real_T
 *c3_b_dimag_syble, real_T *c3_b_fine_time_est, real_T *c3_b_fine_errfre,
 creal_T *c3_b_time_corr_long);
static real_T c3_abs(creal_T c3_x);
static real_T c3_eml_dlapy2(real_T c3_x1, real_T c3_x2);
static void c3_b_abs(creal_T *c3_x, real_T *c3_y);
static void c3_sum(real_T *c3_x, real_T *c3_y);
static void c3_max(real_T *c3_x, real_T *c3_maxval, real_T *c3_indx);
static creal_T c3_mrdivide(creal_T c3_A, real_T c3_B);
static void c3_exp(creal_T *c3_x, creal_T *c3_b_x);
static const mxArray *c3_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_b_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_c_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_d_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_e_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_f_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_g_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_h_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_i_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_j_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_k_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_l_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_m_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_n_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_o_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_p_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_q_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_r_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_s_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_t_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_u_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_v_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_w_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_x_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_y_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_ab_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_bb_sf_marshall(void *c3_chartInstance, void *c3_u);
static const mxArray *c3_cb_sf_marshall(void *c3_chartInstance, void *c3_u);
static creal_T *c3_syn(void);
static creal_T *c3_input_signal(void);
static real_T *c3_dreal_syble(void);
static real_T *c3_dimag_syble(void);
static real_T *c3_fine_time_est(void);
static real_T *c3_fine_errfre(void);
static creal_T *c3_coarse_fre(void);
static creal_T *c3_time_corr_long(void);
static void init_dsm_address_info(void);

/* Function Definitions */
static void initialize_c3_std5(void)
{
  _sfTime_ = (real_T)ssGetT(chartInstance.S);
  chartInstance.c3_is_active_c3_std5 = 0U;
}

static void initialize_params_c3_std5(void)
{
}

static void enable_c3_std5(void)
{
}

static void disable_c3_std5(void)
{
}

static void finalize_c3_std5(void)
{
}

static void sf_c3_std5(void)
{
  int32_T c3_i0;
  int32_T c3_i1;
  uint8_T c3_previousEvent;
  int32_T c3_i2;
  creal_T c3_dcv0[1000];
  _sfTime_ = (real_T)ssGetT(chartInstance.S);
  for(c3_i0 = 0; c3_i0 < 320; c3_i0 = c3_i0 + 1) {
    _SFD_DATA_RANGE_CHECK(c3_dreal_syble()[c3_i0], 7U);
  }
  for(c3_i1 = 0; c3_i1 < 320; c3_i1 = c3_i1 + 1) {
    _SFD_DATA_RANGE_CHECK(c3_dimag_syble()[c3_i1], 4U);
  }
  _SFD_DATA_RANGE_CHECK(*c3_fine_time_est(), 2U);
  _SFD_DATA_RANGE_CHECK(*c3_fine_errfre(), 5U);
  c3_previousEvent = _sfEvent_;
  _sfEvent_ = CALL_EVENT;
  _SFD_CC_CALL(CHART_ENTER_DURING_FUNCTION_TAG,2);
  for(c3_i2 = 0; c3_i2 < 1000; c3_i2 = c3_i2 + 1) {
    c3_dcv0[c3_i2].re = c3_input_signal()[c3_i2].re;
    c3_dcv0[c3_i2].im = c3_input_signal()[c3_i2].im;
  }
  c3_eML_blk_kernel((creal_T *)c3_dcv0, *c3_coarse_fre(), (creal_T *)c3_syn(),
   (real_T *)c3_dreal_syble(), (real_T *)c3_dimag_syble()
   , c3_fine_time_est(), c3_fine_errfre(), (creal_T *)c3_time_corr_long());
  _SFD_CC_CALL(EXIT_OUT_OF_FUNCTION_TAG,2);
  _sfEvent_ = c3_previousEvent;
  sf_debug_check_for_state_inconsistency(_std5MachineNumber_,
   chartInstance.chartNumber, chartInstance.instanceNumber);
}

static void c3_eML_blk_kernel(creal_T *c3_b_input_signal, creal_T
 c3_b_coarse_fre, creal_T *c3_b_syn, real_T *c3_b_dreal_syble,
 real_T *c3_b_dimag_syble, real_T *c3_b_fine_time_est, real_T *c3_b_fine_errfre,
 creal_T *c3_b_time_corr_long)
{
  real_T c3_fine_time_est1;
  real_T c3_imag_syble[320];
  real_T c3_real_syble[320];
  creal_T c3_offset_sig[1000];
  creal_T c3_phase_rotation2[1000];
  real_T c3_time_base2[1000];
  real_T c3_time_base1[1000];
  creal_T c3_freq_offset;
  creal_T c3_freq_est;
  real_T c3_iii;
  creal_T c3_phase;
  real_T c3_long_search_idx;
  real_T c3_max_peak_long;
  real_T c3_n;
  real_T c3_idx;
  creal_T c3_abscorr[128];
  creal_T c3_long_trs[64];
  creal_T c3_long_tr_symbols[64];
  real_T c3_end_search;
  real_T c3_start_search;
  int32_T c3_i3;
  static creal_T c3_dcv1[64] = { { 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 c3_i4;
  static creal_T c3_dcv2[64] = { { -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 c3_i5;
  int32_T c3_i6;
  int32_T c3_i7;
  int32_T c3_i8;
  real_T c3_b_idx;
  real_T c3_b_n;
  creal_T c3_b_long_trs;
  creal_T c3_c_input_signal;
  creal_T c3_c_time_corr_long;
  int32_T c3_i9;
  creal_T c3_dcv3[128];
  real_T c3_dv0[128];
  int32_T c3_i10;
  real_T c3_dv1[128];
  real_T c3_dv2[128];
  int32_T c3_i11;
  int32_T c3_i12;
  creal_T c3_dcv4[128];
  real_T c3_dv3[128];
  int32_T c3_i13;
  real_T c3_dv4[128];
  real_T c3_b_long_search_idx;
  real_T c3_b_max_peak_long;
  real_T c3_b_iii;
  creal_T c3_d_input_signal;
  creal_T c3_e_input_signal;
  creal_T c3_x;
  creal_T c3_b_x;
  real_T c3_Y;
  real_T c3_X;
  real_T c3_yk;
  real_T c3_xk;
  real_T c3_y;
  real_T c3_c_x;
  real_T c3_d_x;
  boolean_T c3_b;
  real_T c3_e_x;
  boolean_T c3_b_b;
  real_T c3_R;
  real_T c3_f_x;
  boolean_T c3_c_b;
  real_T c3_g_x;
  boolean_T c3_d_b;
  real_T c3_h_x;
  real_T c3_i_x;
  real_T c3_b_xk;
  real_T c3_j_x;
  boolean_T c3_e_b;
  real_T c3_k_x;
  real_T c3_l_x;
  real_T c3_c_xk;
  real_T c3_m_x;
  boolean_T c3_f_b;
  real_T c3_n_x;
  real_T c3_o_x;
  creal_T c3_p_x;
  creal_T c3_q_x;
  creal_T c3_dc0;
  int32_T c3_i14;
  real_T c3_A[1000];
  int32_T c3_i15;
  real_T c3_r_x[1000];
  int32_T c3_i16;
  int32_T c3_i17;
  real_T c3_dv5[1000];
  int32_T c3_i18;
  int32_T c3_i19;
  real_T c3_u[1000];
  const mxArray *c3_b_y = NULL;
  creal_T c3_dc1;
  int32_T c3_i20;
  creal_T c3_dcv5[1000];
  creal_T c3_dcv6[1000];
  int32_T c3_i21;
  int32_T c3_i22;
  int32_T c3_i23;
  int32_T c3_i24;
  int32_T c3_i25;
  real_T c3_s_x;
  real_T c3_c_iii;
  int32_T c3_i26;
  int32_T c3_i27;
  sf_debug_symbol_scope_push(28U, 0U);
  sf_debug_symbol_scope_add("fine_time_est1", &c3_fine_time_est1,
   c3_cb_sf_marshall);
  sf_debug_symbol_scope_add("imag_syble", &c3_imag_syble, c3_bb_sf_marshall);
  sf_debug_symbol_scope_add("real_syble", &c3_real_syble, c3_ab_sf_marshall);
  sf_debug_symbol_scope_add("offset_sig", &c3_offset_sig, c3_y_sf_marshall);
  sf_debug_symbol_scope_add("phase_rotation2", &c3_phase_rotation2,
   c3_x_sf_marshall);
  sf_debug_symbol_scope_add("time_base2", &c3_time_base2, c3_w_sf_marshall);
  sf_debug_symbol_scope_add("time_base1", &c3_time_base1, c3_v_sf_marshall);
  sf_debug_symbol_scope_add("freq_offset", &c3_freq_offset, c3_u_sf_marshall);
  sf_debug_symbol_scope_add("freq_est", &c3_freq_est, c3_t_sf_marshall);
  sf_debug_symbol_scope_add("iii", &c3_iii, c3_s_sf_marshall);
  sf_debug_symbol_scope_add("phase", &c3_phase, c3_r_sf_marshall);
  sf_debug_symbol_scope_add("long_search_idx", &c3_long_search_idx,
   c3_q_sf_marshall);
  sf_debug_symbol_scope_add("max_peak_long", &c3_max_peak_long,
   c3_p_sf_marshall);
  sf_debug_symbol_scope_add("n", &c3_n, c3_o_sf_marshall);
  sf_debug_symbol_scope_add("idx", &c3_idx, c3_n_sf_marshall);
  sf_debug_symbol_scope_add("abscorr", &c3_abscorr, c3_m_sf_marshall);
  sf_debug_symbol_scope_add("long_trs", &c3_long_trs, c3_l_sf_marshall);
  sf_debug_symbol_scope_add("long_tr_symbols", &c3_long_tr_symbols,
   c3_k_sf_marshall);
  sf_debug_symbol_scope_add("end_search", &c3_end_search, c3_j_sf_marshall);
  sf_debug_symbol_scope_add("start_search", &c3_start_search, c3_i_sf_marshall);
  sf_debug_symbol_scope_add("time_corr_long", c3_b_time_corr_long,
   c3_h_sf_marshall);
  sf_debug_symbol_scope_add("fine_errfre", c3_b_fine_errfre, c3_g_sf_marshall);
  sf_debug_symbol_scope_add("fine_time_est", c3_b_fine_time_est,
   c3_f_sf_marshall);
  sf_debug_symbol_scope_add("dimag_syble", c3_b_dimag_syble, c3_e_sf_marshall);
  sf_debug_symbol_scope_add("dreal_syble", c3_b_dreal_syble, c3_d_sf_marshall);
  sf_debug_symbol_scope_add("syn", c3_b_syn, c3_c_sf_marshall);
  sf_debug_symbol_scope_add("coarse_fre", &c3_b_coarse_fre, c3_b_sf_marshall);
  sf_debug_symbol_scope_add("input_signal", c3_b_input_signal, c3_sf_marshall);
  CV_EML_FCN(0, 0);
  /* timing search window size */