/* Function Definitions */ static void b_eml_lusolve(const emlrtStack *sp, const emxArray_real_T *A, emxArray_real_T *B) { emxArray_real_T *b_A; int32_T i58; int32_T iy; emxArray_int32_T *ipiv; int32_T info; int32_T i59; int32_T b; int32_T j; int32_T mmj; int32_T c; ptrdiff_t n_t; ptrdiff_t incx_t; double * xix0_t; int32_T ix; boolean_T overflow; int32_T k; real_T temp; int32_T i60; boolean_T b_c; ptrdiff_t m_t; ptrdiff_t incy_t; ptrdiff_t lda_t; double * alpha1_t; double * Aia0_t; double * Aiy0_t; char_T DIAGA; char_T TRANSA; char_T UPLO; char_T SIDE; emlrtStack st; emlrtStack b_st; emlrtStack c_st; emlrtStack d_st; emlrtStack e_st; emlrtStack f_st; emlrtStack g_st; emlrtStack h_st; emlrtStack i_st; st.prev = sp; st.tls = sp->tls; b_st.prev = &st; b_st.tls = st.tls; c_st.prev = &b_st; c_st.tls = b_st.tls; d_st.prev = &c_st; d_st.tls = c_st.tls; e_st.prev = &d_st; e_st.tls = d_st.tls; f_st.prev = &e_st; f_st.tls = e_st.tls; g_st.prev = &f_st; g_st.tls = f_st.tls; h_st.prev = &g_st; h_st.tls = g_st.tls; i_st.prev = &h_st; i_st.tls = h_st.tls; emlrtHeapReferenceStackEnterFcnR2012b(sp); emxInit_real_T(sp, &b_A, 2, &ob_emlrtRTEI, true); st.site = &ib_emlrtRSI; b_st.site = &lb_emlrtRSI; c_st.site = &nb_emlrtRSI; d_st.site = &ob_emlrtRSI; i58 = b_A->size[0] * b_A->size[1]; b_A->size[0] = A->size[0]; b_A->size[1] = A->size[1]; emxEnsureCapacity(&d_st, (emxArray__common *)b_A, i58, (int32_T)sizeof(real_T), &ob_emlrtRTEI); iy = A->size[0] * A->size[1]; for (i58 = 0; i58 < iy; i58++) { b_A->data[i58] = A->data[i58]; } b_emxInit_int32_T(&d_st, &ipiv, 2, &ob_emlrtRTEI, true); e_st.site = &qb_emlrtRSI; f_st.site = &rb_emlrtRSI; g_st.site = &sb_emlrtRSI; h_st.site = &tb_emlrtRSI; eml_signed_integer_colon(&h_st, muIntScalarMin_sint32(A->size[1], A->size[1]), ipiv); info = 0; if (A->size[1] < 1) { } else { i59 = A->size[1] - 1; b = muIntScalarMin_sint32(i59, A->size[1]); e_st.site = &pb_emlrtRSI; for (j = 1; j <= b; j++) { mmj = A->size[1] - j; c = (j - 1) * (A->size[1] + 1) + 1; e_st.site = &if_emlrtRSI; f_st.site = &yb_emlrtRSI; if (mmj + 1 < 1) { iy = -1; } else { g_st.site = &ac_emlrtRSI; h_st.site = &ac_emlrtRSI; n_t = (ptrdiff_t)(mmj + 1); h_st.site = &ac_emlrtRSI; incx_t = (ptrdiff_t)(1); i58 = b_A->size[0] * b_A->size[1]; xix0_t = (double *)(&b_A->data[emlrtDynamicBoundsCheckFastR2012b(c, 1, i58, &je_emlrtBCI, &g_st) - 1]); incx_t = idamax(&n_t, xix0_t, &incx_t); iy = (int32_T)incx_t - 1; } if (b_A->data[(c + iy) - 1] != 0.0) { if (iy != 0) { ipiv->data[j - 1] = j + iy; e_st.site = &jf_emlrtRSI; f_st.site = &bc_emlrtRSI; g_st.site = &cc_emlrtRSI; ix = j; iy += j; h_st.site = &dc_emlrtRSI; overflow = (A->size[1] > 2147483646); if (overflow) { i_st.site = &db_emlrtRSI; check_forloop_overflow_error(&i_st); } for (k = 1; k <= A->size[1]; k++) { i58 = b_A->size[0] * b_A->size[1]; temp = b_A->data[emlrtDynamicBoundsCheckFastR2012b(ix, 1, i58, &le_emlrtBCI, &g_st) - 1]; i58 = b_A->size[0] * b_A->size[1]; i60 = b_A->size[0] * b_A->size[1]; b_A->data[emlrtDynamicBoundsCheckFastR2012b(ix, 1, i58, &le_emlrtBCI, &g_st) - 1] = b_A->data[emlrtDynamicBoundsCheckFastR2012b(iy, 1, i60, &le_emlrtBCI, &g_st) - 1]; i58 = b_A->size[0] * b_A->size[1]; b_A->data[emlrtDynamicBoundsCheckFastR2012b(iy, 1, i58, &le_emlrtBCI, &g_st) - 1] = temp; ix += A->size[1]; iy += A->size[1]; } } iy = c + mmj; e_st.site = &kf_emlrtRSI; if (c + 1 > iy) { b_c = false; } else { b_c = (iy > 2147483646); } if (b_c) { f_st.site = &db_emlrtRSI; check_forloop_overflow_error(&f_st); } for (k = c; k + 1 <= iy; k++) { b_A->data[k] /= b_A->data[c - 1]; } } else { info = j; } iy = A->size[1] - j; e_st.site = &lf_emlrtRSI; f_st.site = &ec_emlrtRSI; g_st.site = &fc_emlrtRSI; if ((mmj < 1) || (iy < 1)) { } else { h_st.site = &gc_emlrtRSI; temp = -1.0; m_t = (ptrdiff_t)(mmj); n_t = (ptrdiff_t)(iy); incx_t = (ptrdiff_t)(1); incy_t = (ptrdiff_t)(A->size[1]); lda_t = (ptrdiff_t)(A->size[1]); alpha1_t = (double *)(&temp); i58 = b_A->size[0] * b_A->size[1]; i60 = (c + A->size[1]) + 1; Aia0_t = (double *)(&b_A->data[emlrtDynamicBoundsCheckFastR2012b(i60, 1, i58, &ke_emlrtBCI, &h_st) - 1]); i58 = b_A->size[0] * b_A->size[1]; xix0_t = (double *)(&b_A->data[emlrtDynamicBoundsCheckFastR2012b(c + 1, 1, i58, &ke_emlrtBCI, &h_st) - 1]); i58 = b_A->size[0] * b_A->size[1]; i60 = c + A->size[1]; Aiy0_t = (double *)(&b_A->data[emlrtDynamicBoundsCheckFastR2012b(i60, 1, i58, &ke_emlrtBCI, &h_st) - 1]); dger(&m_t, &n_t, alpha1_t, xix0_t, &incx_t, Aiy0_t, &incy_t, Aia0_t, &lda_t); } } if ((info == 0) && (!(b_A->data[(A->size[1] + b_A->size[0] * (A->size[1] - 1)) - 1] != 0.0))) { info = A->size[1]; } } if (info > 0) { b_st.site = &mb_emlrtRSI; warn_singular(&b_st); } b_st.site = &yf_emlrtRSI; for (iy = 0; iy + 1 < A->size[1]; iy++) { if (ipiv->data[iy] != iy + 1) { temp = B->data[iy]; B->data[iy] = B->data[ipiv->data[iy] - 1]; B->data[ipiv->data[iy] - 1] = temp; } } emxFree_int32_T(&ipiv); b_st.site = &ag_emlrtRSI; c_st.site = &ic_emlrtRSI; if (A->size[1] < 1) { } else { d_st.site = &jc_emlrtRSI; temp = 1.0; DIAGA = 'U'; TRANSA = 'N'; UPLO = 'L'; SIDE = 'L'; e_st.site = &jc_emlrtRSI; m_t = (ptrdiff_t)(A->size[1]); e_st.site = &jc_emlrtRSI; n_t = (ptrdiff_t)(1); e_st.site = &jc_emlrtRSI; lda_t = (ptrdiff_t)(A->size[1]); e_st.site = &jc_emlrtRSI; incx_t = (ptrdiff_t)(A->size[1]); i58 = b_A->size[0] * b_A->size[1]; emlrtDynamicBoundsCheckFastR2012b(1, 1, i58, &ie_emlrtBCI, &d_st); Aia0_t = (double *)(&b_A->data[0]); xix0_t = (double *)(&B->data[0]); alpha1_t = (double *)(&temp); dtrsm(&SIDE, &UPLO, &TRANSA, &DIAGA, &m_t, &n_t, alpha1_t, Aia0_t, &lda_t, xix0_t, &incx_t); } b_st.site = &bg_emlrtRSI; c_st.site = &ic_emlrtRSI; if (A->size[1] < 1) { } else { d_st.site = &jc_emlrtRSI; temp = 1.0; DIAGA = 'N'; TRANSA = 'N'; UPLO = 'U'; SIDE = 'L'; e_st.site = &jc_emlrtRSI; m_t = (ptrdiff_t)(A->size[1]); e_st.site = &jc_emlrtRSI; n_t = (ptrdiff_t)(1); e_st.site = &jc_emlrtRSI; lda_t = (ptrdiff_t)(A->size[1]); e_st.site = &jc_emlrtRSI; incx_t = (ptrdiff_t)(A->size[1]); i58 = b_A->size[0] * b_A->size[1]; emlrtDynamicBoundsCheckFastR2012b(1, 1, i58, &ie_emlrtBCI, &d_st); Aia0_t = (double *)(&b_A->data[0]); xix0_t = (double *)(&B->data[0]); alpha1_t = (double *)(&temp); dtrsm(&SIDE, &UPLO, &TRANSA, &DIAGA, &m_t, &n_t, alpha1_t, Aia0_t, &lda_t, xix0_t, &incx_t); } emxFree_real_T(&b_A); emlrtHeapReferenceStackLeaveFcnR2012b(sp); }
/* * function offsetcost = equateoffsetcost(pathqi) */ void equateoffsetcost(const emxArray_real_T *pathqi, emxArray_real_T *offsetcost) { emxArray_real_T *b_pathqi; int32_T n; int32_T c_pathqi; int32_T ixstart; uint32_T uv0[2]; int32_T k; emxArray_int32_T *r75; int32_T exitg3; real_T mtmp; real_T b_mtmp; boolean_T exitg2; boolean_T exitg1; b_emxInit_real_T(&b_pathqi, 2); /* UNTITLED2 Summary of this function goes here */ /* Detailed explanation goes here */ /* 'equateoffsetcost:6' pathoffsetcost = abs(pathqi(end,:)); */ n = pathqi->size[1]; c_pathqi = pathqi->size[0]; ixstart = b_pathqi->size[0] * b_pathqi->size[1]; b_pathqi->size[0] = 1; b_pathqi->size[1] = n; emxEnsureCapacity((emxArray__common *)b_pathqi, ixstart, (int32_T)sizeof (real_T)); ixstart = n - 1; for (n = 0; n <= ixstart; n++) { b_pathqi->data[b_pathqi->size[0] * n] = pathqi->data[(c_pathqi + pathqi->size[0] * n) - 1]; } for (n = 0; n < 2; n++) { uv0[n] = (uint32_T)b_pathqi->size[n]; } emxFree_real_T(&b_pathqi); n = offsetcost->size[0] * offsetcost->size[1]; offsetcost->size[0] = 1; offsetcost->size[1] = (int32_T)uv0[1]; emxEnsureCapacity((emxArray__common *)offsetcost, n, (int32_T)sizeof(real_T)); k = 0; b_emxInit_int32_T(&r75, 1); do { exitg3 = 0; n = pathqi->size[1]; ixstart = r75->size[0]; r75->size[0] = n; emxEnsureCapacity((emxArray__common *)r75, ixstart, (int32_T)sizeof(int32_T)); ixstart = n - 1; for (n = 0; n <= ixstart; n++) { r75->data[n] = 1 + n; } if (k <= r75->size[0] - 1) { c_pathqi = pathqi->size[0]; mtmp = pathqi->data[(c_pathqi + pathqi->size[0] * k) - 1]; offsetcost->data[k] = fabs(mtmp); k++; } else { exitg3 = 1; } } while (exitg3 == 0U); emxFree_int32_T(&r75); /* 'equateoffsetcost:8' minoffsetcost = min(pathoffsetcost); */ ixstart = 1; n = offsetcost->size[1]; b_mtmp = offsetcost->data[0]; if (n > 1) { if (rtIsNaN(offsetcost->data[0])) { c_pathqi = 2; exitg2 = FALSE; while ((exitg2 == 0U) && (c_pathqi <= n)) { ixstart = c_pathqi; if (!rtIsNaN(offsetcost->data[c_pathqi - 1])) { b_mtmp = offsetcost->data[c_pathqi - 1]; exitg2 = TRUE; } else { c_pathqi++; } } } if (ixstart < n) { while (ixstart + 1 <= n) { if (offsetcost->data[ixstart] < b_mtmp) { b_mtmp = offsetcost->data[ixstart]; } ixstart++; } } } /* 'equateoffsetcost:9' maxoffsetcost = max(pathoffsetcost); */ ixstart = 1; n = offsetcost->size[1]; mtmp = offsetcost->data[0]; if (n > 1) { if (rtIsNaN(offsetcost->data[0])) { c_pathqi = 2; exitg1 = FALSE; while ((exitg1 == 0U) && (c_pathqi <= n)) { ixstart = c_pathqi; if (!rtIsNaN(offsetcost->data[c_pathqi - 1])) { mtmp = offsetcost->data[c_pathqi - 1]; exitg1 = TRUE; } else { c_pathqi++; } } } if (ixstart < n) { while (ixstart + 1 <= n) { if (offsetcost->data[ixstart] > mtmp) { mtmp = offsetcost->data[ixstart]; } ixstart++; } } } /* 'equateoffsetcost:10' offsetcost = (pathoffsetcost-minoffsetcost)*(1/(maxoffsetcost - minoffsetcost)); */ mtmp = 1.0 / (mtmp - b_mtmp); n = offsetcost->size[0] * offsetcost->size[1]; offsetcost->size[0] = 1; offsetcost->size[1] = offsetcost->size[1]; emxEnsureCapacity((emxArray__common *)offsetcost, n, (int32_T)sizeof(real_T)); ixstart = offsetcost->size[0]; n = offsetcost->size[1]; ixstart = ixstart * n - 1; for (n = 0; n <= ixstart; n++) { offsetcost->data[n] = (offsetcost->data[n] - b_mtmp) * mtmp; } }
static void c_eml_qrsolve(const emlrtStack *sp, const emxArray_real_T *A, emxArray_real_T *B, emxArray_real_T *Y) { emxArray_real_T *b_A; emxArray_real_T *work; int32_T mn; int32_T i51; int32_T ix; emxArray_real_T *tau; emxArray_int32_T *jpvt; int32_T m; int32_T n; int32_T b_mn; emxArray_real_T *vn1; emxArray_real_T *vn2; int32_T k; boolean_T overflow; boolean_T b12; int32_T i; int32_T i_i; int32_T nmi; int32_T mmi; int32_T pvt; int32_T iy; boolean_T b13; real_T xnorm; int32_T i52; real_T atmp; real_T d16; boolean_T b14; boolean_T b_i; ptrdiff_t n_t; ptrdiff_t incx_t; double * xix0_t; boolean_T exitg1; const mxArray *y; static const int32_T iv78[2] = { 1, 8 }; const mxArray *m14; char_T cv76[8]; static const char_T cv77[8] = { '%', '%', '%', 'd', '.', '%', 'd', 'e' }; char_T cv78[14]; uint32_T unnamed_idx_0; emlrtStack st; emlrtStack b_st; emlrtStack c_st; emlrtStack d_st; emlrtStack e_st; emlrtStack f_st; emlrtStack g_st; emlrtStack h_st; st.prev = sp; st.tls = sp->tls; b_st.prev = &st; b_st.tls = st.tls; c_st.prev = &b_st; c_st.tls = b_st.tls; d_st.prev = &c_st; d_st.tls = c_st.tls; e_st.prev = &d_st; e_st.tls = d_st.tls; f_st.prev = &e_st; f_st.tls = e_st.tls; g_st.prev = &f_st; g_st.tls = f_st.tls; h_st.prev = &g_st; h_st.tls = g_st.tls; emlrtHeapReferenceStackEnterFcnR2012b(sp); emxInit_real_T(sp, &b_A, 2, &m_emlrtRTEI, true); b_emxInit_real_T(sp, &work, 1, &rb_emlrtRTEI, true); mn = (int32_T)muDoubleScalarMin(A->size[0], A->size[1]); st.site = &mc_emlrtRSI; b_st.site = &nc_emlrtRSI; c_st.site = &oc_emlrtRSI; i51 = b_A->size[0] * b_A->size[1]; b_A->size[0] = A->size[0]; b_A->size[1] = A->size[1]; emxEnsureCapacity(&c_st, (emxArray__common *)b_A, i51, (int32_T)sizeof(real_T), &m_emlrtRTEI); ix = A->size[0] * A->size[1]; for (i51 = 0; i51 < ix; i51++) { b_A->data[i51] = A->data[i51]; } b_emxInit_real_T(&c_st, &tau, 1, &m_emlrtRTEI, true); b_emxInit_int32_T(&c_st, &jpvt, 2, &m_emlrtRTEI, true); m = b_A->size[0]; n = b_A->size[1]; b_mn = muIntScalarMin_sint32(b_A->size[0], b_A->size[1]); i51 = tau->size[0]; tau->size[0] = b_mn; emxEnsureCapacity(&c_st, (emxArray__common *)tau, i51, (int32_T)sizeof(real_T), &n_emlrtRTEI); d_st.site = &mf_emlrtRSI; e_st.site = &rb_emlrtRSI; f_st.site = &sb_emlrtRSI; g_st.site = &tb_emlrtRSI; eml_signed_integer_colon(&g_st, b_A->size[1], jpvt); if ((b_A->size[0] == 0) || (b_A->size[1] == 0)) { } else { ix = b_A->size[1]; i51 = work->size[0]; work->size[0] = ix; emxEnsureCapacity(&c_st, (emxArray__common *)work, i51, (int32_T)sizeof (real_T), &m_emlrtRTEI); for (i51 = 0; i51 < ix; i51++) { work->data[i51] = 0.0; } b_emxInit_real_T(&c_st, &vn1, 1, &pb_emlrtRTEI, true); b_emxInit_real_T(&c_st, &vn2, 1, &qb_emlrtRTEI, true); d_st.site = &tc_emlrtRSI; ix = b_A->size[1]; i51 = vn1->size[0]; vn1->size[0] = ix; emxEnsureCapacity(&c_st, (emxArray__common *)vn1, i51, (int32_T)sizeof (real_T), &pb_emlrtRTEI); i51 = vn2->size[0]; vn2->size[0] = ix; emxEnsureCapacity(&c_st, (emxArray__common *)vn2, i51, (int32_T)sizeof (real_T), &qb_emlrtRTEI); k = 1; d_st.site = &nf_emlrtRSI; overflow = (b_A->size[1] > 2147483646); if (overflow) { e_st.site = &db_emlrtRSI; check_forloop_overflow_error(&e_st); } for (ix = 0; ix + 1 <= b_A->size[1]; ix++) { d_st.site = &sc_emlrtRSI; vn1->data[ix] = b_eml_xnrm2(&d_st, b_A->size[0], b_A, k); vn2->data[ix] = vn1->data[ix]; k += b_A->size[0]; } d_st.site = &rc_emlrtRSI; if (1 > b_mn) { b12 = false; } else { b12 = (b_mn > 2147483646); } if (b12) { e_st.site = &db_emlrtRSI; check_forloop_overflow_error(&e_st); } for (i = 1; i <= b_mn; i++) { i_i = (i + (i - 1) * m) - 1; nmi = n - i; mmi = m - i; d_st.site = &of_emlrtRSI; ix = eml_ixamax(&d_st, 1 + nmi, vn1, i); pvt = (i + ix) - 2; if (pvt + 1 != i) { d_st.site = &pf_emlrtRSI; e_st.site = &bc_emlrtRSI; f_st.site = &cc_emlrtRSI; ix = 1 + m * pvt; iy = 1 + m * (i - 1); g_st.site = &dc_emlrtRSI; if (1 > m) { b13 = false; } else { b13 = (m > 2147483646); } if (b13) { h_st.site = &db_emlrtRSI; check_forloop_overflow_error(&h_st); } for (k = 1; k <= m; k++) { i51 = b_A->size[0] * b_A->size[1]; xnorm = b_A->data[emlrtDynamicBoundsCheckFastR2012b(ix, 1, i51, &le_emlrtBCI, &f_st) - 1]; i51 = b_A->size[0] * b_A->size[1]; i52 = b_A->size[0] * b_A->size[1]; b_A->data[emlrtDynamicBoundsCheckFastR2012b(ix, 1, i51, &le_emlrtBCI, &f_st) - 1] = b_A->data[emlrtDynamicBoundsCheckFastR2012b(iy, 1, i52, &le_emlrtBCI, &f_st) - 1]; i51 = b_A->size[0] * b_A->size[1]; b_A->data[emlrtDynamicBoundsCheckFastR2012b(iy, 1, i51, &le_emlrtBCI, &f_st) - 1] = xnorm; ix++; iy++; } ix = jpvt->data[pvt]; jpvt->data[pvt] = jpvt->data[i - 1]; jpvt->data[i - 1] = ix; vn1->data[pvt] = vn1->data[i - 1]; vn2->data[pvt] = vn2->data[i - 1]; } if (i < m) { d_st.site = &qc_emlrtRSI; atmp = b_A->data[i_i]; d16 = 0.0; if (1 + mmi <= 0) { } else { e_st.site = &wc_emlrtRSI; xnorm = b_eml_xnrm2(&e_st, mmi, b_A, i_i + 2); if (xnorm != 0.0) { xnorm = muDoubleScalarHypot(b_A->data[i_i], xnorm); if (b_A->data[i_i] >= 0.0) { xnorm = -xnorm; } if (muDoubleScalarAbs(xnorm) < 1.0020841800044864E-292) { ix = 0; do { ix++; e_st.site = &xc_emlrtRSI; b_eml_xscal(&e_st, mmi, 9.9792015476736E+291, b_A, i_i + 2); xnorm *= 9.9792015476736E+291; atmp *= 9.9792015476736E+291; } while (!(muDoubleScalarAbs(xnorm) >= 1.0020841800044864E-292)); e_st.site = &yc_emlrtRSI; xnorm = b_eml_xnrm2(&e_st, mmi, b_A, i_i + 2); xnorm = muDoubleScalarHypot(atmp, xnorm); if (atmp >= 0.0) { xnorm = -xnorm; } d16 = (xnorm - atmp) / xnorm; e_st.site = &ad_emlrtRSI; b_eml_xscal(&e_st, mmi, 1.0 / (atmp - xnorm), b_A, i_i + 2); e_st.site = &bd_emlrtRSI; if (1 > ix) { b14 = false; } else { b14 = (ix > 2147483646); } if (b14) { f_st.site = &db_emlrtRSI; check_forloop_overflow_error(&f_st); } for (k = 1; k <= ix; k++) { xnorm *= 1.0020841800044864E-292; } atmp = xnorm; } else { d16 = (xnorm - b_A->data[i_i]) / xnorm; atmp = 1.0 / (b_A->data[i_i] - xnorm); e_st.site = &cd_emlrtRSI; b_eml_xscal(&e_st, mmi, atmp, b_A, i_i + 2); atmp = xnorm; } } } tau->data[i - 1] = d16; } else { atmp = b_A->data[i_i]; d_st.site = &pc_emlrtRSI; tau->data[i - 1] = eml_matlab_zlarfg(); } b_A->data[i_i] = atmp; if (i < n) { atmp = b_A->data[i_i]; b_A->data[i_i] = 1.0; d_st.site = &qf_emlrtRSI; eml_matlab_zlarf(&d_st, mmi + 1, nmi, i_i + 1, tau->data[i - 1], b_A, i + i * m, m, work); b_A->data[i_i] = atmp; } d_st.site = &rf_emlrtRSI; if (i + 1 > n) { b_i = false; } else { b_i = (n > 2147483646); } if (b_i) { e_st.site = &db_emlrtRSI; check_forloop_overflow_error(&e_st); } for (ix = i; ix + 1 <= n; ix++) { if (vn1->data[ix] != 0.0) { xnorm = muDoubleScalarAbs(b_A->data[(i + b_A->size[0] * ix) - 1]) / vn1->data[ix]; xnorm = 1.0 - xnorm * xnorm; if (xnorm < 0.0) { xnorm = 0.0; } atmp = vn1->data[ix] / vn2->data[ix]; atmp = xnorm * (atmp * atmp); if (atmp <= 1.4901161193847656E-8) { if (i < m) { d_st.site = &sf_emlrtRSI; e_st.site = &uc_emlrtRSI; if (mmi < 1) { xnorm = 0.0; } else { f_st.site = &vc_emlrtRSI; g_st.site = &vc_emlrtRSI; n_t = (ptrdiff_t)(mmi); g_st.site = &vc_emlrtRSI; incx_t = (ptrdiff_t)(1); i51 = b_A->size[0] * b_A->size[1]; i52 = (i + m * ix) + 1; xix0_t = (double *)(&b_A->data[emlrtDynamicBoundsCheckFastR2012b (i52, 1, i51, &vb_emlrtBCI, &f_st) - 1]); xnorm = dnrm2(&n_t, xix0_t, &incx_t); } vn1->data[ix] = xnorm; vn2->data[ix] = vn1->data[ix]; } else { vn1->data[ix] = 0.0; vn2->data[ix] = 0.0; } } else { d_st.site = &tf_emlrtRSI; vn1->data[ix] *= muDoubleScalarSqrt(xnorm); } } } } emxFree_real_T(&vn2); emxFree_real_T(&vn1); } atmp = 0.0; if (mn > 0) { xnorm = muDoubleScalarMax(A->size[0], A->size[1]) * muDoubleScalarAbs (b_A->data[0]) * 2.2204460492503131E-16; k = 0; exitg1 = false; while ((!exitg1) && (k <= mn - 1)) { if (muDoubleScalarAbs(b_A->data[k + b_A->size[0] * k]) <= xnorm) { st.site = &lc_emlrtRSI; y = NULL; m14 = emlrtCreateCharArray(2, iv78); for (i = 0; i < 8; i++) { cv76[i] = cv77[i]; } emlrtInitCharArrayR2013a(&st, 8, m14, cv76); emlrtAssign(&y, m14); b_st.site = &tg_emlrtRSI; emlrt_marshallIn(&b_st, c_sprintf(&b_st, b_sprintf(&b_st, y, emlrt_marshallOut(14.0), emlrt_marshallOut(6.0), &o_emlrtMCI), emlrt_marshallOut(xnorm), &p_emlrtMCI), "sprintf", cv78); st.site = &kc_emlrtRSI; b_eml_warning(&st, atmp, cv78); exitg1 = true; } else { atmp++; k++; } } } unnamed_idx_0 = (uint32_T)A->size[1]; i51 = Y->size[0]; Y->size[0] = (int32_T)unnamed_idx_0; emxEnsureCapacity(sp, (emxArray__common *)Y, i51, (int32_T)sizeof(real_T), &m_emlrtRTEI); ix = (int32_T)unnamed_idx_0; for (i51 = 0; i51 < ix; i51++) { Y->data[i51] = 0.0; } for (ix = 0; ix < mn; ix++) { if (tau->data[ix] != 0.0) { xnorm = B->data[ix]; i51 = A->size[0] + (int32_T)(1.0 - ((1.0 + (real_T)ix) + 1.0)); emlrtForLoopVectorCheckR2012b((1.0 + (real_T)ix) + 1.0, 1.0, A->size[0], mxDOUBLE_CLASS, i51, &ac_emlrtRTEI, sp); for (i = 0; i < i51; i++) { unnamed_idx_0 = ((uint32_T)ix + i) + 2U; xnorm += b_A->data[((int32_T)unnamed_idx_0 + b_A->size[0] * ix) - 1] * B->data[(int32_T)unnamed_idx_0 - 1]; } xnorm *= tau->data[ix]; if (xnorm != 0.0) { B->data[ix] -= xnorm; i51 = A->size[0] + (int32_T)(1.0 - ((1.0 + (real_T)ix) + 1.0)); emlrtForLoopVectorCheckR2012b((1.0 + (real_T)ix) + 1.0, 1.0, A->size[0], mxDOUBLE_CLASS, i51, &yb_emlrtRTEI, sp); for (i = 0; i < i51; i++) { unnamed_idx_0 = ((uint32_T)ix + i) + 2U; B->data[(int32_T)unnamed_idx_0 - 1] -= b_A->data[((int32_T) unnamed_idx_0 + b_A->size[0] * ix) - 1] * xnorm; } } } } emxFree_real_T(&tau); emlrtForLoopVectorCheckR2012b(1.0, 1.0, atmp, mxDOUBLE_CLASS, (int32_T)atmp, &xb_emlrtRTEI, sp); for (i = 0; i < (int32_T)atmp; i++) { Y->data[jpvt->data[i] - 1] = B->data[i]; } emlrtForLoopVectorCheckR2012b(atmp, -1.0, 1.0, mxDOUBLE_CLASS, (int32_T)-(1.0 + (-1.0 - atmp)), &wb_emlrtRTEI, sp); for (ix = 0; ix < (int32_T)-(1.0 + (-1.0 - atmp)); ix++) { xnorm = atmp + -(real_T)ix; Y->data[jpvt->data[(int32_T)xnorm - 1] - 1] = eml_div(Y->data[jpvt->data [(int32_T)xnorm - 1] - 1], b_A->data[((int32_T)xnorm + b_A->size[0] * ((int32_T)xnorm - 1)) - 1]); for (i = 0; i < (int32_T)(xnorm - 1.0); i++) { Y->data[jpvt->data[i] - 1] -= Y->data[jpvt->data[(int32_T)xnorm - 1] - 1] * b_A->data[i + b_A->size[0] * ((int32_T)xnorm - 1)]; } } emxFree_int32_T(&jpvt); emxFree_real_T(&work); emxFree_real_T(&b_A); emlrtHeapReferenceStackLeaveFcnR2012b(sp); }
void a_melcepst(const real_T s[512], real_T fs, int32_T nc, emxArray_real_T *c) { real_T b_s[512]; int32_T i; static const real_T dv0[512] = { 0.080000000000000016, 0.080034772851092173, 0.080139086147189731, 0.080312924117550422, 0.0805562604802531, 0.08086905844617126, 0.081251270724534919, 0.0817028395300804, 0.082223696591786744, 0.082813763163197218, 0.083472950034324755, 0.084201157545139238, 0.084998275600634943, 0.085864183687475115, 0.086798750892212118, 0.0878018359210796, 0.0888732871213544, 0.0900129425042841, 0.091220629769577732, 0.092496166331455187, 0.093839359346251483, 0.095250005741572386, 0.09672789224699585, 0.09827279542631584, 0.099884481711322914, 0.10156270743711604, 0.10330721887894206, 0.10511775229055487, 0.10699403394409035, 0.10893578017145067, 0.11094269740719032, 0.11301448223289995, 0.11515082142307836, 0.11735139199248851, 0.11961586124498802, 0.12194388682382867, 0.12433511676341558, 0.12678918954252011, 0.12930573413893637, 0.1318843700855753, 0.13452470752798562, 0.13722634728329447, 0.13998888090055894, 0.1428118907225176, 0.14569494994873494, 0.14863762270012759, 0.1516394640848634, 0.15470002026562302, 0.15781882852821355, 0.16099541735152506, 0.16422930647881784, 0.16752000699033076, 0.17086702137719906, 0.17426984361667108, 0.177727959248612, 0.181240845453283, 0.18480797113038444, 0.18842879697935122, 0.19210277558088723, 0.19582935147972808, 0.19960796126861807, 0.20343803367348967, 0.20731898963983236, 0.211250242420238, 0.21523119766310839, 0.2192612535025138, 0.2233398006491864, 0.22746622248263659, 0.23163989514437766, 0.23586018763224437, 0.24012646189579223, 0.24443807293276187, 0.24879436888659412, 0.25319469114498255, 0.25763837443944609, 0.26212474694590859, 0.26665313038626953, 0.27122284013095055, 0.27583318530240147, 0.28048346887955239, 0.28517298780319289, 0.2899010330822655, 0.29466688990105527, 0.29946983772726005, 0.30430915042092521, 0.30918409634422606, 0.31409393847208128, 0.31903793450358153, 0.32401533697421447, 0.32902539336887182, 0.33406734623561868, 0.33914043330021065, 0.34424388758133867, 0.34937693750658638, 0.35453880702908114, 0.35972871574482179, 0.36494587901066489, 0.3701895080629527, 0.37545881013676219, 0.38075298858576168, 0.38607124300265128, 0.39141276934017522, 0.39677676003268147, 0.40216240411821519, 0.40756888736112512, 0.41299539237516436, 0.41844109874706864, 0.42390518316059117, 0.4293868195209769, 0.43488517907985663, 0.44039943056054276, 0.44592874028370622, 0.45147227229341824, 0.45702918848353491, 0.46259864872440754, 0.46817981098989864, 0.47377183148468471, 0.47937386477182686, 0.48498506390058893, 0.490604580534485, 0.49623156507953636, 0.50186516681271842, 0.50750453401057793, 0.51314881407800261, 0.51879715367712187, 0.524448698856319, 0.53010259517933778, 0.53575798785446094, 0.54141402186374354, 0.5470698420922796, 0.55272459345748381, 0.55837742103836852, 0.5640274702047956, 0.56967388674668551, 0.57531581700316159, 0.58095240799161241, 0.58658280753665026, 0.59220616439894935, 0.59782162840394082, 0.60342835057034794, 0.60902548323854022, 0.61461218019868813, 0.62018759681869828, 0.62575089017190988, 0.63130121916453474, 0.63683774466281806, 0.64235962961990467, 0.64786603920238861, 0.65335614091652849, 0.65882910473410994, 0.66428410321793319, 0.6697203116469117, 0.67513690814075755, 0.68053307378423888, 0.68590799275098879, 0.69126085242684687, 0.69659084353271583, 0.70189716024691284, 0.70717900032699887, 0.7124355652310671, 0.717666060238471, 0.72286969456997574, 0.72804568150731275, 0.73319323851212115, 0.73831158734425673, 0.74339995417945037, 0.74845756972630173, 0.75348366934258248, 0.75847749315084323, 0.76343828615329357, 0.7683652983459498, 0.77325778483202323, 0.77811500593454008, 0.78293622730816892, 0.78772072005024552, 0.7924677608109707, 0.79717663190277332, 0.80184662140881269, 0.80647702329061177, 0.81106713749480042, 0.8156162700589541, 0.82012373321651044, 0.82458884550075162, 0.82901093184783137, 0.83338932369883667, 0.83772335910086348, 0.84201238280709623, 0.84625574637587087, 0.85045280826871128, 0.8546029339473209, 0.85870549596951617, 0.86275987408408694, 0.86676545532457061, 0.8707216341019236, 0.87462781229607822, 0.87848339934637087, 0.88228781234082576, 0.88604047610428438, 0.88974082328536275, 0.89338829444222823, 0.89698233812717909, 0.90052241097001584, 0.90400797776019148, 0.90743851152772792, 0.91081349362288644, 0.91413241379458121, 0.91739477026752081, 0.92060006981807141, 0.92374782784882448, 0.92683756846186127, 0.9298688245307023, 0.93284113777093092, 0.93575405880947859, 0.938607147252565, 0.94139997175227874, 0.94413211007179187, 0.94680314914919594, 0.94941268515995136, 0.95196032357793992, 0.95444567923511281, 0.95686837637972111, 0.9592280487331255, 0.96152433954517225, 0.96375690164812866, 0.965925397509171, 0.96802949928141335, 0.970068888853475, 0.97204325789757351, 0.97395230791614062, 0.97579575028695, 0.97757330630675354, 0.97928470723341743, 0.98092969432655219, 0.98250801888663064, 0.98401944229258809, 0.98546373603789827, 0.98684068176512052, 0.98815007129891252, 0.98939170667750365, 0.99056540018262351, 0.99167097436788332, 0.99270826208560237, 0.99367710651207919, 0.99457736117130091, 0.99540888995708832, 0.9961715671536735, 0.99686527745470577, 0.99748991598068559, 0.99804538829481926, 0.9985316104172981, 0.99894850883799369, 0.99929602052757294, 0.99957409294702582, 0.99978268405560977, 0.99992176231720475, 0.99999130670508207, 0.99999130670508207, 0.99992176231720475, 0.99978268405560977, 0.99957409294702582, 0.99929602052757294, 0.99894850883799369, 0.9985316104172981, 0.99804538829481926, 0.99748991598068559, 0.99686527745470577, 0.9961715671536735, 0.99540888995708832, 0.99457736117130091, 0.99367710651207919, 0.99270826208560237, 0.99167097436788332, 0.99056540018262351, 0.98939170667750365, 0.98815007129891264, 0.98684068176512052, 0.98546373603789827, 0.9840194422925882, 0.98250801888663064, 0.98092969432655219, 0.97928470723341743, 0.97757330630675365, 0.97579575028695009, 0.97395230791614062, 0.97204325789757351, 0.970068888853475, 0.96802949928141335, 0.96592539750917106, 0.96375690164812866, 0.96152433954517225, 0.9592280487331255, 0.95686837637972122, 0.95444567923511281, 0.95196032357794014, 0.94941268515995125, 0.94680314914919594, 0.94413211007179187, 0.94139997175227885, 0.938607147252565, 0.93575405880947871, 0.93284113777093114, 0.92986882453070241, 0.92683756846186127, 0.92374782784882448, 0.92060006981807163, 0.91739477026752092, 0.91413241379458121, 0.91081349362288655, 0.90743851152772792, 0.90400797776019148, 0.900522410970016, 0.89698233812717909, 0.89338829444222834, 0.88974082328536275, 0.8860404761042846, 0.88228781234082587, 0.878483399346371, 0.87462781229607822, 0.87072163410192371, 0.86676545532457072, 0.86275987408408716, 0.85870549596951617, 0.854602933947321, 0.85045280826871128, 0.84625574637587087, 0.84201238280709623, 0.83772335910086393, 0.83338932369883678, 0.82901093184783159, 0.82458884550075162, 0.82012373321651089, 0.81561627005895421, 0.81106713749480042, 0.80647702329061177, 0.80184662140881269, 0.79717663190277355, 0.79246776081097081, 0.78772072005024563, 0.78293622730816925, 0.7781150059345403, 0.77325778483202334, 0.76836529834594991, 0.7634382861532939, 0.75847749315084312, 0.7534836693425826, 0.7484575697263014, 0.74339995417945093, 0.73831158734425684, 0.73319323851212148, 0.72804568150731264, 0.72286969456997607, 0.717666060238471, 0.71243556523106721, 0.70717900032699887, 0.701897160246913, 0.696590843532716, 0.69126085242684687, 0.68590799275098913, 0.680533073784239, 0.67513690814075789, 0.66972031164691181, 0.66428410321793374, 0.65882910473411, 0.65335614091652838, 0.6478660392023885, 0.64235962961990478, 0.63683774466281828, 0.63130121916453463, 0.62575089017190988, 0.62018759681869828, 0.61461218019868846, 0.60902548323854022, 0.603428350570348, 0.597821628403941, 0.59220616439894924, 0.58658280753665026, 0.58095240799161219, 0.57531581700316192, 0.56967388674668551, 0.56402747020479571, 0.55837742103836829, 0.55272459345748415, 0.54706984209227971, 0.54141402186374377, 0.53575798785446127, 0.53010259517933778, 0.52444869885631917, 0.51879715367712176, 0.51314881407800306, 0.50750453401057793, 0.50186516681271853, 0.49623156507953631, 0.49060458053448541, 0.48498506390058904, 0.47937386477182709, 0.47377183148468466, 0.46817981098989869, 0.46259864872440776, 0.45702918848353485, 0.45147227229341824, 0.44592874028370633, 0.440399430560543, 0.43488517907985663, 0.429386819520977, 0.42390518316059139, 0.41844109874706892, 0.41299539237516436, 0.40756888736112484, 0.40216240411821547, 0.39677676003268147, 0.39141276934017533, 0.3860712430026515, 0.3807529885857619, 0.3754588101367623, 0.37018950806295287, 0.36494587901066522, 0.35972871574482168, 0.35453880702908119, 0.34937693750658616, 0.34424388758133895, 0.33914043330021071, 0.33406734623561879, 0.3290253933688716, 0.32401533697421481, 0.31903793450358164, 0.31409393847208145, 0.30918409634422594, 0.30430915042092521, 0.29946983772726016, 0.29466688990105516, 0.2899010330822655, 0.285172987803193, 0.28048346887955261, 0.27583318530240147, 0.2712228401309506, 0.2666531303862697, 0.26212474694590882, 0.25763837443944609, 0.25319469114498266, 0.24879436888659429, 0.24443807293276176, 0.24012646189579229, 0.23586018763224448, 0.23163989514437777, 0.22746622248263659, 0.22333980064918652, 0.21926125350251396, 0.21523119766310861, 0.21125024242023804, 0.20731898963983225, 0.20343803367348989, 0.19960796126861807, 0.19582935147972819, 0.19210277558088712, 0.18842879697935144, 0.1848079711303845, 0.18124084545328312, 0.17772795924861196, 0.17426984361667136, 0.17086702137719911, 0.16752000699033065, 0.16422930647881784, 0.16099541735152512, 0.15781882852821361, 0.15470002026562296, 0.15163946408486367, 0.14863762270012765, 0.14569494994873505, 0.1428118907225176, 0.13998888090055922, 0.13722634728329458, 0.13452470752798557, 0.1318843700855753, 0.12930573413893648, 0.12678918954252016, 0.12433511676341558, 0.12194388682382873, 0.11961586124498813, 0.11735139199248862, 0.11515082142307836, 0.1130144822329, 0.11094269740719043, 0.10893578017145061, 0.10699403394409041, 0.10511775229055476, 0.10330721887894218, 0.10156270743711604, 0.09988448171132297, 0.09827279542631584, 0.0967278922469959, 0.095250005741572386, 0.093839359346251427, 0.092496166331455243, 0.091220629769577788, 0.0900129425042841, 0.088873287121354339, 0.087801835921079707, 0.086798750892212118, 0.085864183687475171, 0.084998275600634943, 0.084201157545139349, 0.083472950034324811, 0.082813763163197218, 0.082223696591786744, 0.081702839530080451, 0.081251270724534919, 0.08086905844617126, 0.0805562604802531, 0.080312924117550422, 0.080139086147189731, 0.080034772851092173, 0.080000000000000016 }; emxArray_creal_T *f; emxArray_real_T *m; int32_T ia; int32_T a; int32_T i0; int32_T i1; int32_T br; emxArray_creal_T *pw; int32_T b_f[2]; int32_T c_f[2]; int32_T ar; emxArray_creal_T d_f; emxArray_creal_T e_f; real_T b_a; real_T b; real_T f_re; real_T f_im; creal_T ath; boolean_T exitg1; creal_T b_pw; emxArray_creal_T *f_f; int32_T g_f[2]; emxArray_real_T *b_b; emxArray_real_T *y; int32_T c_k; uint32_T unnamed_idx_0; int32_T b_m; int32_T ic; int64_T i2; emxArray_int32_T *r0; emxArray_int32_T *idx; emxArray_boolean_T *c_b; emxArray_real_T *b_c; emxArray_real_T *c_c; /* MELCEPST Calculate the mel cepstrum of a signal C=(S,FS,W,NC,P,N,INC,FL,FH) */ /* */ /* */ /* Simple use: c=melcepst(s,fs) % calculate mel cepstrum with 12 coefs, 256 sample frames */ /* c=melcepst(s,fs,'e0dD') % include log energy, 0th cepstral coef, delta and delta-delta coefs */ /* */ /* Inputs: */ /* s speech signal */ /* fs sample rate in Hz (default 11025) */ /* nc number of cepstral coefficients excluding 0'th coefficient (default 12) */ /* n length of frame in samples (default power of 2 < (0.03*fs)) */ /* p number of filters in filterbank (default: floor(3*log(fs)) = approx 2.1 per ocatave) */ /* inc frame increment (default n/2) */ /* fl low end of the lowest filter as a fraction of fs (default = 0) */ /* fh high end of highest filter as a fraction of fs (default = 0.5) */ /* */ /* w any sensible combination of the following: */ /* */ /* 'R' rectangular window in time domain */ /* 'N' Hanning window in time domain */ /* 'M' Hamming window in time domain (default) */ /* */ /* 't' triangular shaped filters in mel domain (default) */ /* 'n' hanning shaped filters in mel domain */ /* 'm' hamming shaped filters in mel domain */ /* */ /* 'p' filters act in the power domain */ /* 'a' filters act in the absolute magnitude domain (default) */ /* */ /* '0' include 0'th order cepstral coefficient */ /* 'E' include log energy */ /* 'd' include delta coefficients (dc/dt) */ /* 'D' include delta-delta coefficients (d^2c/dt^2) */ /* */ /* 'z' highest and lowest filters taper down to zero (default) */ /* 'y' lowest filter remains at 1 down to 0 frequency and */ /* highest filter remains at 1 up to nyquist freqency */ /* */ /* If 'ty' or 'ny' is specified, the total power in the fft is preserved. */ /* */ /* Outputs: c mel cepstrum output: one frame per row. Log energy, if requested, is the */ /* first element of each row followed by the delta and then the delta-delta */ /* coefficients. */ /* */ /* BUGS: (1) should have power limit as 1e-16 rather than 1e-6 (or possibly a better way of choosing this) */ /* and put into VOICEBOX */ /* (2) get rdct to change the data length (properly) instead of doing it explicitly (wrongly) */ /* Copyright (C) Mike Brookes 1997 */ /* Version: $Id: melcepst.m,v 1.8 2011/09/02 16:24:14 dmb Exp $ */ /* */ /* VOICEBOX is a MATLAB toolbox for speech processing. */ /* Home page: http://www.ee.ic.ac.uk/hp/staff/dmb/voicebox/voicebox.html */ /* */ /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */ /* This program is free software; you can redistribute it and/or modify */ /* it under the terms of the GNU General Public License as published by */ /* the Free Software Foundation; either version 2 of the License, or */ /* (at your option) any later version. */ /* */ /* This program is distributed in the hope that it will be useful, */ /* but WITHOUT ANY WARRANTY; without even the implied warranty of */ /* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the */ /* GNU General Public License for more details. */ /* */ /* You can obtain a copy of the GNU General Public License from */ /* http://www.gnu.org/copyleft/gpl.html or by writing to */ /* Free Software Foundation, Inc.,675 Mass Ave, Cambridge, MA 02139, USA. */ /* %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% */ /* floor(3*log(fs)); */ /* 256; %20 / 1000 * fs; % 10 ms window */ /* nc = 20; */ /* z=a_enframe(s,a_hamming(n),inc); */ /* HAMMING.M */ /* */ /* COPYRIGHT : (c) NUHAG, Dept.Math., University of Vienna, AUSTRIA */ /* http://nuhag.eu/ */ /* Permission is granted to modify and re-distribute this */ /* code in any manner as long as this notice is preserved. */ /* All standard disclaimers apply. */ /* */ /* HAMMING.M - returns the N-point Hamming window. */ /* */ /* Input : n = number */ /* */ /* Output : w = vector */ /* */ /* Usage : w = hamming (n) */ /* */ /* Comments : allows also the call: hamming(xx), taking only format from signal xx */ /* */ /* See also : HAMMING2 */ /* modification of original MATLAB (3.5) file */ /* HGFei, 1990 */ /* z=enframe(s,hamming(n),inc); */ for (i = 0; i < 512; i++) { b_s[i] = s[i] * dv0[i]; } emxInit_creal_T(&f, 1); emxInit_real_T(&m, 2); a_rfft(b_s, f); a_melbankm(m, &a, &ia); /* [m,a,b]=melbankm(p,n,fs,fl,fh, 'M'); */ if (a > ia) { i0 = 0; i1 = 0; } else { i0 = a - 1; i1 = ia; } if (a > ia) { br = 0; } else { br = a - 1; } emxInit_creal_T(&pw, 1); b_f[0] = f->size[0]; b_f[1] = 1; c_f[0] = f->size[0]; c_f[1] = 1; i = pw->size[0]; pw->size[0] = i1 - i0; emxEnsureCapacity((emxArray__common *)pw, i, (int32_T)sizeof(creal_T)); ar = (i1 - i0) - 1; for (i1 = 0; i1 <= ar; i1++) { d_f = *f; d_f.size = (int32_T *)&b_f; d_f.numDimensions = 1; e_f = *f; e_f.size = (int32_T *)&c_f; e_f.numDimensions = 1; b_a = e_f.data[br + i1].re; b = -e_f.data[br + i1].im; f_re = d_f.data[i0 + i1].re; f_im = d_f.data[i0 + i1].im; pw->data[i1].re = f_re * b_a - f_im * b; pw->data[i1].im = f_re * b + f_im * b_a; } i = 1; br = pw->size[0]; ath = pw->data[0]; if (br > 1) { if (rtIsNaN(pw->data[0].re) || rtIsNaN(pw->data[0].im)) { ar = 1; exitg1 = 0U; while ((exitg1 == 0U) && (ar + 1 <= br)) { i = ar + 1; if (!(rtIsNaN(pw->data[ar].re) || rtIsNaN(pw->data[ar].im))) { ath = pw->data[ar]; exitg1 = 1U; } else { ar++; } } } if (i < br) { while (i + 1 <= br) { b_pw = pw->data[i]; if (eml_relop(b_pw, ath, TRUE)) { ath = pw->data[i]; } i++; } } } ath.re *= 1.0E-20; ath.im *= 1.0E-20; b_sqrt(&ath); if (a > ia) { i0 = 0; ia = 0; } else { i0 = a - 1; } emxInit_creal_T(&f_f, 1); g_f[0] = f->size[0]; g_f[1] = 1; i1 = f_f->size[0]; f_f->size[0] = ia - i0; emxEnsureCapacity((emxArray__common *)f_f, i1, (int32_T)sizeof(creal_T)); ar = (ia - i0) - 1; for (i1 = 0; i1 <= ar; i1++) { d_f = *f; d_f.size = (int32_T *)&g_f; d_f.numDimensions = 1; f_f->data[i1] = d_f.data[i0 + i1]; } b_emxInit_real_T(&b_b, 1); b_abs(f_f, b_b); emxFree_creal_T(&f_f); b_emxInit_real_T(&y, 1); if ((m->size[1] == 1) || (b_b->size[0] == 1)) { i0 = y->size[0]; y->size[0] = m->size[0]; emxEnsureCapacity((emxArray__common *)y, i0, (int32_T)sizeof(real_T)); ar = m->size[0] - 1; for (i0 = 0; i0 <= ar; i0++) { y->data[i0] = 0.0; i = b_b->size[0] - 1; for (i1 = 0; i1 <= i; i1++) { y->data[i0] += m->data[i0 + m->size[0] * i1] * b_b->data[i1]; } } } else { c_k = m->size[1]; unnamed_idx_0 = (uint32_T)m->size[0]; i0 = y->size[0]; y->size[0] = (int32_T)unnamed_idx_0; emxEnsureCapacity((emxArray__common *)y, i0, (int32_T)sizeof(real_T)); b_m = m->size[0]; i = y->size[0]; i0 = y->size[0]; y->size[0] = i; emxEnsureCapacity((emxArray__common *)y, i0, (int32_T)sizeof(real_T)); ar = i - 1; for (i0 = 0; i0 <= ar; i0++) { y->data[i0] = 0.0; } if (b_m == 0) { } else { for (i = 0; i <= 0; i += b_m) { i0 = i + b_m; for (ic = i; ic + 1 <= i0; ic++) { y->data[ic] = 0.0; } } br = 0; for (i = 0; i <= 0; i += b_m) { ar = 0; i0 = br + c_k; for (a = br; a + 1 <= i0; a++) { if (b_b->data[a] != 0.0) { ia = ar; i1 = i + b_m; for (ic = i; ic + 1 <= i1; ic++) { ia++; y->data[ic] += b_b->data[a] * m->data[ia - 1]; } } ar += b_m; } br += c_k; } } } emxFree_real_T(&m); unnamed_idx_0 = (uint32_T)y->size[0]; i0 = f->size[0]; f->size[0] = (int32_T)unnamed_idx_0; emxEnsureCapacity((emxArray__common *)f, i0, (int32_T)sizeof(creal_T)); i0 = f->size[0]; for (c_k = 0; c_k + 1 <= i0; c_k++) { if (b_eml_relop(y->data[c_k], ath, TRUE) || rtIsNaN(y->data[c_k])) { b_a = ath.re; b = ath.im; } else { b_a = y->data[c_k]; b = 0.0; } f->data[c_k].re = b_a; f->data[c_k].im = b; } emxFree_real_T(&y); i0 = pw->size[0]; pw->size[0] = f->size[0]; emxEnsureCapacity((emxArray__common *)pw, i0, (int32_T)sizeof(creal_T)); ar = f->size[0] - 1; for (i0 = 0; i0 <= ar; i0++) { pw->data[i0] = f->data[i0]; } for (c_k = 0; c_k <= f->size[0] - 1; c_k++) { ath = pw->data[c_k]; if ((pw->data[c_k].im == 0.0) && rtIsNaN(pw->data[c_k].re)) { } else if ((fabs(pw->data[c_k].re) > 8.9884656743115785E+307) || (fabs (pw->data[c_k].im) > 8.9884656743115785E+307)) { b_a = fabs(pw->data[c_k].re / 2.0); b = fabs(pw->data[c_k].im / 2.0); if (b_a < b) { b_a /= b; b *= sqrt(b_a * b_a + 1.0); } else if (b_a > b) { b /= b_a; b = sqrt(b * b + 1.0) * b_a; } else if (rtIsNaN(b)) { } else { b = b_a * 1.4142135623730951; } ath.re = log(b) + 0.69314718055994529; ath.im = rt_atan2d_snf(pw->data[c_k].im, pw->data[c_k].re); } else { b_a = fabs(pw->data[c_k].re); b = fabs(pw->data[c_k].im); if (b_a < b) { b_a /= b; b *= sqrt(b_a * b_a + 1.0); } else if (b_a > b) { b /= b_a; b = sqrt(b * b + 1.0) * b_a; } else if (rtIsNaN(b)) { } else { b = b_a * 1.4142135623730951; } ath.re = log(b); ath.im = rt_atan2d_snf(pw->data[c_k].im, pw->data[c_k].re); } pw->data[c_k] = ath; } emxFree_creal_T(&f); a_rdct(pw, b_b); i0 = c->size[0] * c->size[1]; c->size[0] = 1; emxEnsureCapacity((emxArray__common *)c, i0, (int32_T)sizeof(real_T)); i = b_b->size[0]; i0 = c->size[0] * c->size[1]; c->size[1] = i; emxEnsureCapacity((emxArray__common *)c, i0, (int32_T)sizeof(real_T)); emxFree_creal_T(&pw); ar = b_b->size[0] - 1; for (i0 = 0; i0 <= ar; i0++) { c->data[i0] = b_b->data[i0]; } emxFree_real_T(&b_b); i2 = (int64_T)nc + 1L; if (i2 > 2147483647L) { i2 = 2147483647L; } else { if (i2 < -2147483648L) { i2 = -2147483648L; } } nc = (int32_T)i2; if (32 > nc) { b_emxInit_int32_T(&r0, 1); i0 = c->size[1]; i1 = r0->size[0]; r0->size[0] = i0 - nc; emxEnsureCapacity((emxArray__common *)r0, i1, (int32_T)sizeof(int32_T)); ar = (i0 - nc) - 1; for (i0 = 0; i0 <= ar; i0++) { r0->data[i0] = (nc + i0) + 1; } emxInit_int32_T(&idx, 2); i0 = idx->size[0] * idx->size[1]; idx->size[0] = 1; emxEnsureCapacity((emxArray__common *)idx, i0, (int32_T)sizeof(int32_T)); i = r0->size[0]; i0 = idx->size[0] * idx->size[1]; idx->size[1] = i; emxEnsureCapacity((emxArray__common *)idx, i0, (int32_T)sizeof(int32_T)); ar = r0->size[0] - 1; for (i0 = 0; i0 <= ar; i0++) { idx->data[i0] = r0->data[i0]; } emxFree_int32_T(&r0); if (idx->size[1] == 1) { i = c->size[1] - 1; for (ar = idx->data[0]; ar <= i; ar++) { c->data[c->size[0] * (ar - 1)] = c->data[c->size[0] * ar]; } } else { emxInit_boolean_T(&c_b, 2); i0 = c_b->size[0] * c_b->size[1]; c_b->size[0] = 1; emxEnsureCapacity((emxArray__common *)c_b, i0, (int32_T)sizeof(boolean_T)); i = c->size[1]; i0 = c_b->size[0] * c_b->size[1]; c_b->size[1] = i; emxEnsureCapacity((emxArray__common *)c_b, i0, (int32_T)sizeof(boolean_T)); ar = c->size[1] - 1; for (i0 = 0; i0 <= ar; i0++) { c_b->data[i0] = FALSE; } for (c_k = 1; c_k <= idx->size[1]; c_k++) { c_b->data[idx->data[c_k - 1] - 1] = TRUE; } i = 0; for (c_k = 1; c_k <= c_b->size[1]; c_k++) { ia = c_b->data[c_k - 1]; i += ia; } i = c->size[1] - i; br = c_b->size[1]; ar = 0; i0 = c->size[1]; for (c_k = 1; c_k <= i0; c_k++) { if ((c_k > br) || (!c_b->data[c_k - 1])) { c->data[c->size[0] * ar] = c->data[c->size[0] * (c_k - 1)]; ar++; } } emxFree_boolean_T(&c_b); } emxFree_int32_T(&idx); if (1 > i) { i = 0; } emxInit_real_T(&b_c, 2); i0 = b_c->size[0] * b_c->size[1]; b_c->size[0] = 1; b_c->size[1] = i; emxEnsureCapacity((emxArray__common *)b_c, i0, (int32_T)sizeof(real_T)); ar = i - 1; for (i0 = 0; i0 <= ar; i0++) { b_c->data[b_c->size[0] * i0] = c->data[c->size[0] * i0]; } i0 = c->size[0] * c->size[1]; c->size[0] = 1; c->size[1] = b_c->size[1]; emxEnsureCapacity((emxArray__common *)c, i0, (int32_T)sizeof(real_T)); ar = b_c->size[1] - 1; for (i0 = 0; i0 <= ar; i0++) { c->data[c->size[0] * i0] = b_c->data[b_c->size[0] * i0]; } emxFree_real_T(&b_c); } else { if (32 < nc) { emxInit_real_T(&b_c, 2); i = nc - 32; i0 = b_c->size[0] * b_c->size[1]; b_c->size[0] = 1; b_c->size[1] = c->size[1] + i; emxEnsureCapacity((emxArray__common *)b_c, i0, (int32_T)sizeof(real_T)); ar = c->size[1] - 1; for (i0 = 0; i0 <= ar; i0++) { b_c->data[b_c->size[0] * i0] = c->data[c->size[0] * i0]; } ar = i - 1; for (i0 = 0; i0 <= ar; i0++) { b_c->data[b_c->size[0] * (i0 + c->size[1])] = 0.0; } i0 = c->size[0] * c->size[1]; c->size[0] = 1; c->size[1] = b_c->size[1]; emxEnsureCapacity((emxArray__common *)c, i0, (int32_T)sizeof(real_T)); ar = b_c->size[1] - 1; for (i0 = 0; i0 <= ar; i0++) { c->data[c->size[0] * i0] = b_c->data[b_c->size[0] * i0]; } emxFree_real_T(&b_c); } } i = c->size[1] - 1; for (ar = 1; ar <= i; ar++) { c->data[c->size[0] * (ar - 1)] = c->data[c->size[0] * ar]; } if (1 > i) { i = 0; } emxInit_real_T(&c_c, 2); i0 = c_c->size[0] * c_c->size[1]; c_c->size[0] = 1; c_c->size[1] = i; emxEnsureCapacity((emxArray__common *)c_c, i0, (int32_T)sizeof(real_T)); ar = i - 1; for (i0 = 0; i0 <= ar; i0++) { c_c->data[c_c->size[0] * i0] = c->data[c->size[0] * i0]; } i0 = c->size[0] * c->size[1]; c->size[0] = 1; c->size[1] = c_c->size[1]; emxEnsureCapacity((emxArray__common *)c, i0, (int32_T)sizeof(real_T)); ar = c_c->size[1] - 1; for (i0 = 0; i0 <= ar; i0++) { c->data[c->size[0] * i0] = c_c->data[c_c->size[0] * i0]; } emxFree_real_T(&c_c); }