/* Function: mdlOutputs =======================================================
* Abstract:
* In this function, you compute the outputs of your S-function
* block.
*/
static void mdlOutputs(SimStruct *S, int_T tid) {
// get Objects
void** vecPWork = ssGetPWork(S);
// get Pointers
// accessing inputs
const uint32_T *idx = (const uint32_T*) ssGetInputPortSignal(S, 0);
const real_T *pts = (const real_T*) ssGetInputPortSignal(S, 1);
if (ssGetInputPortNumDimensions(S, 0) != 2 || ssGetInputPortNumDimensions(S, 1) != 2) {
ssSetErrorStatus(S,
"Wrong number of dimensions. This should never happen!.");
return;
}
#if defined(MATLAB_MEX_FILE)
const int_T nTriangles = ssGetCurrentInputPortDimensions(S, 0, 1);
const int_T nPts = ssGetCurrentInputPortDimensions(S, 1, 1);
#else
const int_T nTriangles = ssGetInputPortDimensions(S, 0)[1];
const int_T nPts = ssGetInputPortDimensions(S, 1)[1];
#endif
GenericPublisher<shape_msgs::Mesh>* pub =
(GenericPublisher<shape_msgs::Mesh>*) vecPWork[0];
const std::string* topic = (const std::string*) vecPWork[1];
shape_msgs::Mesh msg;
msg.triangles.resize(nTriangles);
msg.vertices.resize(nPts);
for (int_T i = 0; i < 3; ++i) {
for (int_T j = 0; j < nTriangles; ++j) {
msg.triangles[j].vertex_indices[i] = idx[3 * j + i];
}
}
for (int_T j = 0; j < nPts; ++j) {
msg.vertices[j].x = pts[3 * j + 0];
msg.vertices[j].y = pts[3 * j + 1];
msg.vertices[j].z = pts[3 * j + 2];
}
pub->publish(msg);
}
static void mdlOutputs(SimStruct *S, int_T tid)
{
/*--------Define Parameters-------*/
const real_T s_T_Nc = *mxGetPr(s_T_Nc_p(S));
const real_T s_T_PR = *mxGetPr(s_T_PR_p(S));
const real_T s_T_Wc = *mxGetPr(s_T_Wc_p(S));
const real_T s_T_Eff = *mxGetPr(s_T_Eff_p(S));
const real_T NcDes = *mxGetPr(NcDes_p(S));
const real_T PRmapDes = *mxGetPr(PRmapDes_p(S));
const real_T EffDes = *mxGetPr(EffDes_p(S));
const real_T NDes = *mxGetPr(NDes_p(S));
const real_T IDes = *mxGetPr(IDesign_p(S));
const real_T s_T_hi = *mxGetPr(s_T_hi_p(S));
const real_T gamma_T = *mxGetPr(gamma_T_p(S));
const real_T Rt_T = *mxGetPr(Rt_T_p(S));
const int_T BldPosLeng = *mxGetPr(BldPosLeng_p(S));
const int_T CoolFlwEn = *mxGetPr(CoolFlwEn_p(S));
/* vector & array data */
const real_T *Y_T_NcpsiVec = mxGetPr(Y_T_NcpsiVec_p(S));
const real_T *X_T_PRpsiVec = mxGetPr(X_T_PRpsiVec_p(S));
const real_T *Y_T_NcwowVec = mxGetPr(Y_T_NcwowVec_p(S));
const real_T *X_T_PRwowVec = mxGetPr(X_T_PRwowVec_p(S));
const real_T *T_T_Map_WoWArray = mxGetPr(T_T_Map_WoWArray_p(S));
const real_T *T_T_Map_psiArray = mxGetPr(T_T_Map_psiArray_p(S));
const real_T *T_BldPos = mxGetPr(T_BldPos_p(S));
/*------get dimensions of parameter arrays-------*/
const int_T A = mxGetNumberOfElements(Y_T_NcpsiVec_p(S));
const int_T B = mxGetNumberOfElements(X_T_PRpsiVec_p(S));
const int_T C = mxGetNumberOfElements(Y_T_NcwowVec_p(S));
const int_T D = mxGetNumberOfElements(X_T_PRwowVec_p(S));
/*---------Define Inputs--------*/
const real_T *u = (const real_T*) ssGetInputPortSignal(S,0);
double WIn = u[0]; /* Input Flow [pps] */
double htIn = u[1]; /* input enthalpy [BTU/lbm]*/
double TtIn = u[2]; /* Temperature Input [degR] */
double PtIn = u[3]; /* Pressure Input [psia] */
double FARcIn = u[4]; /* Compusted Fuel to Air Ratio [frac] */
double Nmech = u[5]; /* Mechancial Shaft Speed [rpm]*/
double psiMapIn = u[6]; /* PSI map [NA] */
/*---------Define Inputs for input port 2--------*/
/* N 5x1 vectors consisting of W, ht, Tt, Pt and FAR, where N is the number of cooling flows */
const real_T *CoolFlow = ssGetInputPortRealSignal(S, 1);
int cfWidth = ssGetCurrentInputPortDimensions(S, 1, 0);
real_T *y = (real_T *)ssGetOutputPortRealSignal(S,0); /* Output Array */
/*--------Define Constants-------*/
double WOut, htOut, TtOut, PtOut, FARcOut, TorqueOut, NErrorOut;
double WcCalcin, WcMap, theta,delta, Pwrout, PRin, htin;
double TtIdealout, Test, htIdealout, Sout, NcMap, Nc, EffMap, Eff;
double dHcools1, dHcoolout, Wfcools1, Wfcoolout, Ws1in,hts1in, Tts1in, Pts1in, FARs1in;
double Ss1in, dHout, Wcoolout, Wcools1, PRmapRead;
double C_Eff, C_PR, C_Nc, C_Wc, TtOutIdeal;
double WMap, psiMapI, delHtIdealMap, erT, erT_old, Ptoutg, Ptoutg_old;
double TtOutIdealg, WpqAcrit, WoWMap, Ptoutg_new;
int interpErr = 0;
double Wcool[100];
double htcool[100];
double Ttcool[100];
double Ptcool[100];
double FARcool[100];
int Vtest, i;
/* ------- get strings -------------- */
char * BlkNm;
int_T buflen;
int_T status;
/* Get name of block from dialog parameter (string) */
buflen = mxGetN(BN_p(S))*sizeof(mxChar)+1;
BlkNm = mxMalloc(buflen);
status = mxGetString(BN_p(S), BlkNm, buflen);
/* Verify input bleed vector is a multiple of 5 */
Vtest = cfWidth/5;
if(5*Vtest != cfWidth && CoolFlwEn > 0.5 && ssGetIWork(S)[0]==0){
printf("Error in %s, one or more of the cooling flow input vector eleements is missing(Vector form; 5x1: W,ht,Tt,Pt,FAR)\n",BlkNm);
ssSetIWorkValue(S,0,1);
}
else if(BldPosLeng != cfWidth/5 && CoolFlwEn > 0.5 && ssGetIWork(S)[1]==0){
printf("Errorin %s, number of cooling flow inputs does not match the length of the Cooling flow postion vector in the mask\n",BlkNm);
ssSetIWorkValue(S,1,1);
}
/* unpack CoolFlow vector */
for (i = 0; i < cfWidth/5; i++)
{
if (CoolFlwEn < 0.5){
Wcool[i] = 0;
htcool[i] = 0;
Ttcool[i] = 0;
Ptcool[i] = 0;
FARcool[i] = 0;
}
else {
Wcool[i] = CoolFlow[5*i];
Ttcool[i] = CoolFlow[5*i+2];
Ptcool[i] = CoolFlow[5*i+3];
FARcool[i] = CoolFlow[5*i+4];
htcool[i] = t2hc(Ttcool[i],FARcool[i]);
}
}
/* Initialize cooling flow sum constants */
dHcools1 = 0; /* enthalpy * mass cooling flow rate at stage 1 of turbine */
dHcoolout = 0; /* enthalpy * mass cooling flow rate at exit of turbine */
Wcools1 = 0; /* total cooling flow at stage 1 of turbine*/
Wcoolout = 0; /* total cooling flow at output of turbine */
Wfcools1 = 0; /* combusted fuel flow in cooling at stage 1 of turbine */
Wfcoolout = 0; /* combusted fuel flow in cooling at exit of turbine */
/* calc cooling flow constants for stage 1 and output of the turbine */
for (i = 0; i < cfWidth/5; i++)
{
if ((T_BldPos[i] > 1 || T_BldPos[i] < 0) && CoolFlwEn > 0.5 && ssGetIWork(S)[2]==0){
printf(" Error in %s, cooling flow postion element %i needs to be defined as a 0 or 1\n",BlkNm,i+1);
ssSetIWorkValue(S,2,1);
}
/* calc mass flow for cooling flows */
Wcools1 = Wcools1 + Wcool[i]*(1-T_BldPos[i]);
Wcoolout = Wcoolout + Wcool[i];
/* calc fuel mass flow for cooling flows*/
Wfcools1 = Wfcools1 + FARcool[i]*Wcool[i]*(1-T_BldPos[i])/(1+FARcool[i]);
Wfcoolout = Wfcoolout + FARcool[i]*Wcool[i]/(1+FARcool[i]);
}
/*-- Compute Total Flow --------*/
Ws1in = WIn + Wcools1; /* mass flow at station 1 */
WOut = WIn + Wcoolout; /* mass flow at turbine exit */
/*-- Compute Fuel to Air Ratios ---*/
FARs1in = (FARcIn* WIn/(1+FARcIn) + Wfcools1)/(WIn/(1+FARcIn) + Wcools1- Wfcools1);
FARcOut = (FARcIn* WIn/(1+FARcIn)+ Wfcoolout)/(WIn/(1+FARcIn) + Wcoolout- Wfcoolout);
/* calc input enthalpy of cooling flow for stage 1 */
for (i = 0; i < cfWidth/5; i++)
{
/* Compute cooling flow dH at stage 1 */
dHcools1 = dHcools1 + htcool[i]*Wcool[i]*(1-T_BldPos[i]);
/* Compute cooling flow dH for the exit of the turbine assuming input htcool = htcoolout for turbine rear bleeds */
dHcoolout = dHcoolout + htcool[i]*Wcool[i]*T_BldPos[i];
}
/*-- Compute avg enthalpy at stage 1 --------*/
htin = t2hc(TtIn,FARcIn);
hts1in = (htin* WIn + dHcools1)/Ws1in;
/*-- Compute stage 1 total temp--------*/
Tts1in = h2tc(hts1in,FARs1in);
/*-- Compute Stage 1 entropy, assuming PtIn = Pts1in --------*/
Ss1in = pt2sc(PtIn,Tts1in,FARs1in);
/*---- calculate misc. fluid condition related variables --------*/
delta = PtIn / C_PSTD;
theta = TtIn / C_TSTD;
/*------ Calculate corrected speed ---------*/
Nc = Nmech/sqrt(theta);
if(IDes < 0.5)
C_Nc = Nc / NcDes;
else
C_Nc = s_T_Nc;
NcMap = Nc / C_Nc;
/* ---- Calculate output entropy ----*/
Sout = Ss1in;
/*-- Compute Turbine Efficiency (from Turbine map) --------*/
psiMapI = interp2Ac(X_T_PRpsiVec,Y_T_NcpsiVec,T_T_Map_psiArray,psiMapIn,NcMap,B,A,&interpErr);
if (interpErr == 1 && ssGetIWork(S)[3]==0){
printf("Warning in %s, Error calculating psiMapI. Vector definitions may need to be expanded.\n", BlkNm);
ssSetIWorkValue(S,3,1);
}
EffMap = psiMapIn/psiMapI;
if(IDes < 0.5)
C_Eff = EffDes / EffMap;
else
C_Eff = s_T_Eff;
Eff = EffMap * C_Eff;
/* ---- Ideal enthalpy ----*/
delHtIdealMap = psiMapI * (Nmech / 60)*(Nmech / 60);
htIdealout = hts1in - delHtIdealMap * s_T_hi;
/* ensure enthalpy is >= 0 */
if(htIdealout < 0)
{
htIdealout = 0;
}
/* Determine Ideal exit temp */
TtOutIdeal = h2tc(htIdealout,FARs1in);
/* Determine starting point for iteration to find PR */
Ptoutg = PtIn*pow((TtOutIdeal/TtIn),(gamma_T/(gamma_T-1)));
TtOutIdealg = sp2tc(Sout,Ptoutg,FARs1in);
erT = 100*abs_D(TtOutIdealg - TtOutIdeal)/TtOutIdeal;
Ptoutg_new = Ptoutg;
/* iterate to find Ptout when TtOutIdeal guess = TtOutIdeal */
while (abs_D(erT) > 0.05) {
erT_old = erT;
Ptoutg_old = Ptoutg;
if(abs_D(Ptoutg - Ptoutg_new) < 0.02)
Ptoutg = Ptoutg + 0.05;
else
Ptoutg = Ptoutg_new;
Ptoutg = Ptoutg + 0.05;
TtOutIdealg = sp2tc(Sout,Ptoutg,FARs1in);
erT = 100*(TtOutIdealg - TtOutIdeal)/TtOutIdeal;
if (abs_D(erT) > 0.05) {
/* determine next guess pressure by secant algorithm */
Ptoutg_new = Ptoutg - erT *(Ptoutg - Ptoutg_old)/(erT - erT_old);
}
}
PRin = PtIn/Ptoutg;
/*------ Compute pressure output --------*/
if(IDes < 0.5)
C_PR = (PRin - 1)/(PRmapDes -1);
else
C_PR = s_T_PR;
PRmapRead = (PRin -1)/C_PR + 1;
PtOut = PtIn/PRin;
/*-- Compute Total Flow input (from Turbine map) --------*/
WoWMap = interp2Ac(X_T_PRwowVec,Y_T_NcwowVec,T_T_Map_WoWArray,PRmapRead,NcMap,D,C,&interpErr);
if (interpErr == 1 && ssGetIWork(S)[4]==0){
printf("Warning in %s, Error calculating WoWMap. Vector definitions may need to be expanded.\n", BlkNm);
ssSetIWorkValue(S,4,1);
}
WpqAcrit = sqrt((gamma_T*C_GRAVITY)/(Rt_T*JOULES_CONST))/pow((1+(gamma_T-1)/2),((gamma_T+1)/(2*(gamma_T-1))));
WMap = WoWMap * WpqAcrit * (PtIn/sqrt(Tts1in));
WcMap = WMap * sqrt(theta)/delta;
if(IDes < 0.5)
C_Wc = Ws1in*sqrt(theta)/delta / WcMap;
else
C_Wc = s_T_Wc;
WcCalcin = WcMap * C_Wc;
/*-Compute power output only takes into account cooling flow that enters at front of engine (stage 1)-*/
Pwrout = ((hts1in - htIdealout)*Eff)*Ws1in * C_BTU_PER_SECtoHP;
/* ---- enthalpy output ----*/
htOut = ((((htIdealout - hts1in)*Eff) + hts1in)*Ws1in + dHcoolout)/WOut;
/*------ Compute Temperature output (empirical) ---------*/
TtOut = h2tc(htOut,FARcOut);
/*----- Compute output Torque to shaft ----*/
TorqueOut = C_HP_PER_RPMtoFT_LBF * Pwrout/Nmech;
/* ----- Compute Normalized Flow Error ----- */
if (IDes < 0.5 && NDes == 0)
NErrorOut = 100;
else if (IDes < 0.5)
NErrorOut = (Nmech - NDes)/NDes;
else if (Ws1in == 0) {
NErrorOut = 100;
}
else {
NErrorOut = (Ws1in*sqrt(theta)/delta-WcCalcin)/(Ws1in*sqrt(theta)/delta) ;
}
Test = Wcool[0];
/*------Assign output values------------ */
y[0] = WOut; /* Outlet Total Flow [pps] */
y[1] = htOut; /* Outlet Enthalpy [BTU/lbm]*/
y[2] = TtOut; /* Outlet Temperature [degR] */
y[3] = PtOut; /* Outlet Pressure [psia] */
y[4] = FARcOut; /* Outlet Fuel to Air Ratio [NA] */
y[5] = TorqueOut; /* Torque Output [lbf*ft] */
y[6] = NErrorOut; /* Normalized turbine Error [frac]*/
y[7] = C_Nc; /* Corrected Shaft Speed Scalar */
y[8] = C_Wc; /* Corrected Flow Scalar */
y[9] = C_PR; /* Pressure Ratio Scalar */
y[10] = C_Eff; /* Efficiency Scalar */
y[11] = Test;
}
