Overview
Comment:static mxArrays and void update_ functions replace mxArray* get_ functions.
Rates still don't update, but simulation doesn't crash now.
Downloads: Tarball | ZIP archive | SQL archive
Timelines: family | ancestors | descendants | both | origin/master | trunk
Files: files | file ages | folders
SHA3-256: a6899b8f34ccea67abb1059a0daeac7daedd3165f4b0ebfc21b0c64223555962
User & Date: geraint@users.sourceforge.net on 2002-05-10 15:18:29
Other Links: branch diff | manifest | tags
Context
2002-05-10
15:50:53
Rates and outputs now update correctly. Debugging print statements removed.
'mtt rc sfun mexglx' creates a valid S-function "rc_sfun.mexglx" which
runs correctly in Simulink.
Algebraic solver code has not yet been added.
Inertial switches still don't work.
check-in: a9fd8a87b9 user: geraint@users.sourceforge.net tags: origin/master, trunk
15:18:29
static mxArrays and void update_ functions replace mxArray* get_ functions.
Rates still don't update, but simulation doesn't crash now.
check-in: a6899b8f34 user: geraint@users.sourceforge.net tags: origin/master, trunk
14:07:16
Preserve .cc files. check-in: 4c3c5e361c user: geraint@users.sourceforge.net tags: origin/master, trunk
Changes

Modified mttroot/mtt/lib/rep/sfun_rep/sfun.cc.tmpl from [7920284121] to [012442f825].

1
2
3
4
5
6
7
8
9
10
11
12






13
14










15
16
17
18
19
20
21
22

23
24
25
26
27


28
29
30
31
32
33


34
35
36

37
38
39

40
41
42


43
44
45
46
47
48
49


50
51
52
53
54
55
56


57
58
59
60
61
62
63


64
65
66
67
68


69
70
71
72
73
74
75
76
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18


19
20
21
22
23
24
25
26
27
28
29




30
31

32





33
34
35

36
37


38
39
40


41

42

43
44


45
46
47
48

49
50


51
52
53


54
55


56
57
58
59

60
61


62
63
64




65
66

67
68
69
70
71
72
73












+
+
+
+
+
+
-
-
+
+
+
+
+
+
+
+
+
+

-
-
-
-


-
+
-
-
-
-
-
+
+

-


-
-
+
+

-
-
+
-

-
+

-
-
+
+


-


-
-
+
+

-
-


-
-
+
+


-


-
-
+
+

-
-
-
-
+
+
-







// -*-c++-*-
// <mtt_model_name>_sfun.cc:
// Matlab S-function simulation of <mtt_model_name>

#define S_FUNCTION_NAME <mtt_model_name>_sfun
#define S_FUNCTION_LEVEL 2

#include "simstruc.h"
#include <iostream>
#include <string>
#include "<mtt_model_name>_def.h"

static mxArray *dX		= mxCreateDoubleMatrix (MTTNX	, 1, mxREAL);
static mxArray *P		= mxCreateDoubleMatrix (MTTNPAR	, 1, mxREAL);
static mxArray *T		= mxCreateDoubleMatrix (1	, 1, mxREAL);
static mxArray *U		= mxCreateDoubleMatrix (MTTNU	, 1, mxREAL);
static mxArray *X		= mxCreateDoubleMatrix (MTTNX	, 1, mxREAL);
static mxArray *Y		= mxCreateDoubleMatrix (MTTNY	, 1, mxREAL);
mxArray *
get_parameters_from_simulink (SimStruct *S)

static double *inputs		= mxGetPr (U);
static double *outputs		= mxGetPr (Y);
static double *parameters	= mxGetPr (P);
static double *rates		= mxGetPr (dX);
static double *states		= mxGetPr (X);
static double *simtime		= mxGetPr (T);

void
update_parameters_from_simulink (SimStruct *S)
{
  static const mxArray *constpar = mxCreateDoubleMatrix (MTTNPAR, 1, mxREAL);
  static       mxArray *     par = mxCreateDoubleMatrix (MTTNPAR, 1, mxREAL);
  double *constptr;
  double *ptr;
  std::cerr << "Parameters:\t";
  for (int i = 0; i < MTTNPAR; i++) {
    constpar = ssGetSFcnParam (S, i);
    parameters [i] = *mxGetPr (ssGetSFcnParam (S, i));
    constptr = mxGetPr (constpar);
    ptr      = mxGetPr (     par);
    *ptr     = *constptr;
    std::cerr << *ptr << ' ';
  }
    std::cerr << parameters [i] << ' ';
  }
  std::cerr << std::endl;
  return par;
}

mxArray *
get_states_from_simulink (SimStruct *S)
void
update_states_from_simulink (SimStruct *S)
{
  static mxArray *x = mxCreateDoubleMatrix (MTTNX, 1, mxREAL);
  static double *states;
  static double *x;
  static double *ptr = mxGetPr (x);
  std::cerr << "States:\t\t";
  states = ssGetContStates (S);
  x = ssGetContStates (S);
  for (int i = 0; i < MTTNX; i++) {
    ptr [i] = states [i];
    std::cerr << ptr [i] << ' ';
    states [i] = x [i];
    std::cerr << states [i] << ' ';
  }
  std::cerr << std::endl;
  return x;
}

mxArray *
get_inputs_from_simulink (SimStruct *S)
void
update_inputs_from_simulink (SimStruct *S)
{
  static mxArray *u = mxCreateDoubleMatrix (MTTNU, 1, mxREAL);
  static double *ptr = mxGetPr (u);
  std::cerr << "Inputs:\t\t";
  for (int i = 0; i < MTTNU; i++) {
    ptr [i] = *ssGetInputPortRealSignalPtrs (S, i)[0];
    std::cerr << ptr [i] << ' ';
    inputs [i] = *ssGetInputPortRealSignalPtrs (S, i)[0];
    std::cerr << inputs [i] << ' ';
  }
  std::cerr << std::endl;
  return u;
}

mxArray *
get_time_from_simulink (SimStruct *S)
void
update_simtime_from_simulink (SimStruct *S)
{
  static mxArray *t = mxCreateDoubleMatrix (1, 1, mxREAL);
  double *ptr = mxGetPr (t);
  ptr [0] = ssGetT (S);
  std::cerr << "Time:\t\t" << ptr [0] << std::endl;
  simtime [0] = ssGetT (S);
  std::cerr << "Time:\t\t" << simtime [0] << std::endl;
  return t;
}

// S-function methods

static void mdlInitializeSizes(SimStruct *S)
{
    ssSetNumSFcnParams(S, MTTNPAR); 
107
108
109
110
111
112
113
114
115


116
117

118
119
120

121
122

123
124
125
126
127
128
129
130


131
132
133
134
135
136
137
138


139
140
141




142
143

144
145
146
147
148




149
150
151
152
153
154
155
156
157
158


159
160
161
162
163
164
165
166
167
168
169
170


171
172




173

174
175
176
177




178
179
180
181
182
183
184
185


186
187
188
189
190
191
192
104
105
106
107
108
109
110


111
112
113

114

115

116


117
118
119

120
121
122


123
124
125
126
127
128
129
130


131
132
133


134
135
136
137
138

139





140
141
142
143
144
145
146
147

148
149
150


151
152
153
154
155
156
157
158
159





160
161
162

163
164
165
166
167
168




169
170
171
172
173
174

175
176
177


178
179
180
181
182
183
184
185
186







-
-
+
+

-
+
-

-
+
-
-
+


-



-
-
+
+






-
-
+
+

-
-
+
+
+
+

-
+
-
-
-
-
-
+
+
+
+




-



-
-
+
+







-
-
-
-
-
+
+

-
+
+
+
+

+
-
-
-
-
+
+
+
+


-



-
-
+
+







    ssSetSampleTime(S, 0, CONTINUOUS_SAMPLE_TIME);
    ssSetOffsetTime(S, 0, 0.0);
}

#define MDL_INITIALIZE_CONDITIONS
static void mdlInitializeConditions(SimStruct *S)
{
  static mxArray *states = mxCreateDoubleMatrix (MTTNX, 1, mxREAL);
  static double *ptr;
  static mxArray *plhs[1];
  static mxArray *prhs[1];

  mxArray *plhs[1];
  update_parameters_from_simulink (S);
  mxArray *prhs[1];

  plhs[0] = states;
  plhs[0] = X;  
  
  prhs[0] = get_parameters_from_simulink (S);
  prhs[0] = P;
  
  mexCallMATLAB (1, plhs, 1, prhs, "<mtt_model_name>_state");  
  ptr = mxGetPr (plhs[0]);

  std::cerr << "Initial states;\t";
  for (int i = 0; i < MTTNX; i++) {
    ssGetContStates (S)[i] = ptr [i];
    std::cerr << ptr [i] << ' ';
    ssGetContStates (S)[i] = states [i];
    std::cerr << states [i] << ' ';
  }
  std::cerr << std::endl;
}

static void mdlOutputs(SimStruct *S, int_T tid)
{
  static mxArray *outputs = mxCreateDoubleMatrix (MTTNY, 1, mxREAL);
  static double *ptr;
  static mxArray *plhs[1];
  static mxArray *prhs[4];

  mxArray *plhs[1];
  mxArray *prhs[4];
  update_states_from_simulink (S);
  update_inputs_from_simulink (S);
  update_simtime_from_simulink (S);
  update_parameters_from_simulink (S);

  plhs[0] = outputs;
  plhs[0] = Y;

  prhs[0] = get_states_from_simulink (S);
  prhs[1] = get_inputs_from_simulink (S);
  prhs[2] = get_time_from_simulink (S);
  prhs[3] = get_parameters_from_simulink (S);
  prhs[0] = X;
  prhs[1] = U;
  prhs[2] = T;
  prhs[3] = P;
 
  UNUSED_ARG(tid); // not used in single tasking mode

  mexCallMATLAB (1, plhs, 4, prhs, "<mtt_model_name>_odeo");
  ptr = mxGetPr (plhs [0]);

  std::cerr << "Outputs:\t";
  for (int i = 0; i < MTTNY; i++) {
      ssGetOutputPortRealSignal (S,i)[0] = ptr [i];
      std::cerr << ptr [i] << ' ';
      ssGetOutputPortRealSignal (S,i)[0] = outputs [i];
      std::cerr << outputs [i] << ' ';
  }
  std::cerr << std::endl;
}

#define MDL_DERIVATIVES
static void mdlDerivatives(SimStruct *S)
{
  static mxArray *rates = mxCreateDoubleMatrix (MTTNX, 1, mxREAL);
  static double *ptr;

  mxArray *plhs[1];
  mxArray *prhs[4];
  static mxArray *plhs[1];
  static mxArray *prhs[4];

  plhs[0] = rates;
  update_states_from_simulink (S);
  update_inputs_from_simulink (S);
  update_simtime_from_simulink (S);
  update_parameters_from_simulink (S);

  plhs[0] = dX;
  prhs[0] = get_states_from_simulink (S);
  prhs[1] = get_inputs_from_simulink (S);
  prhs[2] = get_time_from_simulink (S);
  prhs[3] = get_parameters_from_simulink (S);
  prhs[0] = X;
  prhs[1] = U;
  prhs[2] = T;
  prhs[3] = P;

  mexCallMATLAB (1, plhs, 4, prhs, "<mtt_model_name>_ode");
  ptr = mxGetPr (plhs[0]);

  std::cerr << "Rates:\t\t";
  for (int i = 0; i < MTTNX; i++) {
    ssGetdX (S)[i] = ptr [i];
    std::cerr << ptr[i] << ' ';
    ssGetdX (S)[i] = rates [i];
    std::cerr << rates [i] << ' ';
  }
  std::cerr << std::endl;
}

static void mdlTerminate(SimStruct *S)
{
    UNUSED_ARG(S);


MTT: Model Transformation Tools
GitHub | SourceHut | Sourceforge | Fossil RSS ]