FmuGenerator.xtend 12 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424
  1. package be.uantwerpen.ansymo.semanticadaptation.cg.cpp.generation
  2. class FmuGenerator {
  3. def static String genFmuCppFile(String adapClassName)
  4. {
  5. '''
  6. #include <stdio.h>
  7. #include "fmi2Functions.h"
  8. #include <string>
  9. #include "«adapClassName».h"
  10. #include "uri.h"
  11. using namespace std;
  12. const fmi2CallbackFunctions *g_functions;
  13. std::string* name;
  14. shared_ptr<adaptation::«adapClassName»> g_adaptation;
  15. template<class T>
  16. static void log(const fmi2CallbackFunctions *functions, fmi2ComponentEnvironment componentEnvironment,
  17. fmi2String instanceName, fmi2Status status, fmi2String category, fmi2String message, T arg)
  18. {
  19. if (functions != NULL && functions->logger != NULL)
  20. {
  21. functions->logger(componentEnvironment, instanceName, status, category, message, arg);
  22. }
  23. }
  24. static void notimplemented(fmi2Component c, fmi2String message)
  25. {
  26. std::string base("Not implemented: %s");
  27. std::string m(message);
  28. if (g_functions != NULL)
  29. {
  30. log(g_functions, g_functions->componentEnvironment, "", fmi2Error, "error", (base + m).c_str(), "");
  31. }
  32. }
  33. template<class T>
  34. static void fmiprintf(fmi2String message, T arg)
  35. {
  36. if (g_functions != NULL)
  37. {
  38. log(g_functions, g_functions->componentEnvironment, name->c_str(), fmi2OK, "logAll", message, arg);
  39. }
  40. }
  41. // ---------------------------------------------------------------------------
  42. // FMI functions
  43. // ---------------------------------------------------------------------------
  44. extern "C" fmi2Component fmi2Instantiate(fmi2String instanceName, fmi2Type fmuType, fmi2String fmuGUID,
  45. fmi2String fmuResourceLocation, const fmi2CallbackFunctions *functions, fmi2Boolean visible,
  46. fmi2Boolean loggingOn)
  47. {
  48. name = new std::string(instanceName);
  49. g_functions = functions;
  50. fmiprintf("instantiating %s\n", instanceName);
  51. auto resourceLoc = make_shared<std::string>(URIToNativePath(fmuResourceLocation));
  52. auto name = make_shared<std::string>(instanceName);
  53. g_adaptation = make_shared<adaptation::«adapClassName»>(name, resourceLoc, functions);
  54. try
  55. {
  56. g_adaptation->initialize(loggingOn);
  57. } catch (adaptation::SemanticAdaptationFmiException& e)
  58. {
  59. return NULL;
  60. }
  61. if (g_adaptation->getLastErrorState() != fmi2OK)
  62. return NULL;
  63. return g_adaptation->getComponent();
  64. }
  65. extern "C" fmi2Status fmi2SetupExperiment(fmi2Component c, fmi2Boolean toleranceDefined, fmi2Real tolerance,
  66. fmi2Real startTime, fmi2Boolean stopTimeDefined, fmi2Real stopTime)
  67. {
  68. try
  69. {
  70. return g_adaptation->fmi2SetupExperiment(toleranceDefined, tolerance, startTime, stopTimeDefined, stopTime);
  71. } catch (adaptation::SemanticAdaptationFmiException& e)
  72. {
  73. return e.status;
  74. }
  75. }
  76. extern "C" fmi2Status fmi2EnterInitializationMode(fmi2Component c)
  77. {
  78. try
  79. {
  80. return g_adaptation->fmi2EnterInitializationMode();
  81. } catch (adaptation::SemanticAdaptationFmiException& e)
  82. {
  83. return e.status;
  84. }
  85. }
  86. extern "C" fmi2Status fmi2ExitInitializationMode(fmi2Component c)
  87. {
  88. try
  89. {
  90. return g_adaptation->fmi2ExitInitializationMode();
  91. } catch (adaptation::SemanticAdaptationFmiException& e)
  92. {
  93. return e.status;
  94. }
  95. }
  96. extern "C" fmi2Status fmi2Terminate(fmi2Component c)
  97. {
  98. try
  99. {
  100. return g_adaptation->fmi2Terminate();
  101. } catch (adaptation::SemanticAdaptationFmiException& e)
  102. {
  103. return e.status;
  104. }
  105. }
  106. extern "C" fmi2Status fmi2Reset(fmi2Component c)
  107. {
  108. return fmi2OK;
  109. }
  110. extern "C" void fmi2FreeInstance(fmi2Component c)
  111. {
  112. }
  113. // ---------------------------------------------------------------------------
  114. // FMI functions: class methods not depending of a specific model instance
  115. // ---------------------------------------------------------------------------
  116. extern "C" const char* fmi2GetVersion()
  117. {
  118. return fmi2Version;
  119. }
  120. extern "C" const char* fmi2GetTypesPlatform()
  121. {
  122. return fmi2TypesPlatform;
  123. }
  124. // ---------------------------------------------------------------------------
  125. // FMI functions: logging control, setters and getters for Real, Integer,
  126. // Boolean, String
  127. // ---------------------------------------------------------------------------
  128. extern "C" fmi2Status fmi2SetDebugLogging(fmi2Component c, fmi2Boolean loggingOn, size_t nCategories,
  129. const fmi2String categories[])
  130. {
  131. return fmi2OK;
  132. }
  133. template<class T>
  134. fmi2Status getX(const fmi2ValueReference vr[], size_t nvr, T value[],
  135. T (adaptation::«adapClassName»::*getter)(fmi2ValueReference vr))
  136. {
  137. try
  138. {
  139. fmi2Status status = g_adaptation->executeOutRules();
  140. if (status != fmi2OK)
  141. return status;
  142. for (int i = 0; i < nvr; i++)
  143. {
  144. value[i] = ((*g_adaptation).*getter)(vr[i]);
  145. status = g_adaptation->getLastErrorState();
  146. if (status != fmi2OK)
  147. return status;
  148. }
  149. return fmi2OK;
  150. } catch (adaptation::SemanticAdaptationFmiException& e)
  151. {
  152. return e.status;
  153. }
  154. }
  155. extern "C" fmi2Status fmi2GetReal(fmi2Component c, const fmi2ValueReference vr[], size_t nvr, fmi2Real value[])
  156. {
  157. return getX(vr, nvr, value, &adaptation::«adapClassName»::getFmiValueReal);
  158. }
  159. extern "C" fmi2Status fmi2GetInteger(fmi2Component c, const fmi2ValueReference vr[], size_t nvr, fmi2Integer value[])
  160. {
  161. return getX(vr, nvr, value, &adaptation::«adapClassName»::getFmiValueInteger);
  162. }
  163. extern "C" fmi2Status fmi2GetBoolean(fmi2Component c, const fmi2ValueReference vr[], size_t nvr, fmi2Boolean value[])
  164. {
  165. typedef bool (adaptation::«adapClassName»::*GB)(fmi2ValueReference);
  166. typedef int (adaptation::«adapClassName»::*GI)(fmi2ValueReference);
  167. GB g = &adaptation::«adapClassName»::getFmiValueBoolean;
  168. GI i = reinterpret_cast<GI>(g);
  169. return getX(vr, nvr, value, i);
  170. }
  171. extern "C" fmi2Status fmi2GetString(fmi2Component c, const fmi2ValueReference vr[], size_t nvr, fmi2String value[])
  172. {
  173. return fmi2Discard;
  174. }
  175. template<class T>
  176. fmi2Status setX(const fmi2ValueReference vr[], size_t nvr, T value[])
  177. {
  178. try
  179. {
  180. fmi2Status status = fmi2OK;
  181. for (int i = 0; i < nvr; i++)
  182. {
  183. g_adaptation->setFmiValue(vr[i], value[i]);
  184. status = g_adaptation->getLastErrorState();
  185. if (status != fmi2OK)
  186. return status;
  187. }
  188. status = g_adaptation->executeInRules();
  189. return status;
  190. } catch (adaptation::SemanticAdaptationFmiException& e)
  191. {
  192. return e.status;
  193. }
  194. }
  195. extern "C" fmi2Status fmi2SetReal(fmi2Component c, const fmi2ValueReference vr[], size_t nvr, const fmi2Real value[])
  196. {
  197. return setX(vr, nvr, value);
  198. }
  199. extern "C" fmi2Status fmi2SetInteger(fmi2Component c, const fmi2ValueReference vr[], size_t nvr,
  200. const fmi2Integer value[])
  201. {
  202. return setX(vr, nvr, value);
  203. }
  204. extern "C" fmi2Status fmi2SetBoolean(fmi2Component c, const fmi2ValueReference vr[], size_t nvr,
  205. const fmi2Boolean value[])
  206. {
  207. return setX(vr, nvr, value);
  208. }
  209. extern "C" fmi2Status fmi2SetString(fmi2Component c, const fmi2ValueReference vr[], size_t nvr,
  210. const fmi2String value[])
  211. {
  212. return fmi2Discard;
  213. }
  214. extern "C" fmi2Status fmi2GetFMUstate(fmi2Component c, fmi2FMUstate* FMUstate)
  215. {
  216. return g_adaptation->fmi2GetFMUstate(FMUstate);
  217. }
  218. extern "C" fmi2Status fmi2SetFMUstate(fmi2Component c, fmi2FMUstate FMUstate)
  219. {
  220. return g_adaptation->fmi2SetFMUstate(FMUstate);
  221. }
  222. extern "C" fmi2Status fmi2FreeFMUstate(fmi2Component c, fmi2FMUstate* FMUstate)
  223. {
  224. return g_adaptation->fmi2FreeFMUstate(FMUstate);
  225. }
  226. extern "C" fmi2Status fmi2SerializedFMUstateSize(fmi2Component c, fmi2FMUstate FMUstate, size_t *size)
  227. {
  228. notimplemented(c, "fmi2SerializedFMUstateSize");
  229. return fmi2Error;
  230. }
  231. extern "C" fmi2Status fmi2SerializeFMUstate(fmi2Component c, fmi2FMUstate FMUstate, fmi2Byte serializedState[],
  232. size_t size)
  233. {
  234. notimplemented(c, "fmi2SerializeFMUstate");
  235. return fmi2Error;
  236. }
  237. extern "C" fmi2Status fmi2DeSerializeFMUstate(fmi2Component c, const fmi2Byte serializedState[], size_t size,
  238. fmi2FMUstate* FMUstate)
  239. {
  240. notimplemented(c, "fmi2DeSerializeFMUstate");
  241. return fmi2Error;
  242. }
  243. extern "C" fmi2Status fmi2GetDirectionalDerivative(fmi2Component c, const fmi2ValueReference vUnknown_ref[],
  244. size_t nUnknown, const fmi2ValueReference vKnown_ref[], size_t nKnown, const fmi2Real dvKnown[],
  245. fmi2Real dvUnknown[])
  246. {
  247. notimplemented(c, "fmi2GetDirectionalDerivative");
  248. return fmi2Error;
  249. }
  250. // ---------------------------------------------------------------------------
  251. // Functions for FMI for Co-Simulation
  252. // ---------------------------------------------------------------------------
  253. #ifdef FMI_COSIMULATION
  254. /* Simulating the slave */
  255. extern "C" fmi2Status fmi2SetRealInputDerivatives(fmi2Component c, const fmi2ValueReference vr[], size_t nvr,
  256. const fmi2Integer order[], const fmi2Real value[])
  257. {
  258. notimplemented(c, "fmi2SetRealInputDerivatives");
  259. return fmi2Error;
  260. }
  261. extern "C" fmi2Status fmi2GetRealOutputDerivatives(fmi2Component c, const fmi2ValueReference vr[], size_t nvr,
  262. const fmi2Integer order[], fmi2Real value[])
  263. {
  264. notimplemented(c, "fmi2GetRealOutputDerivatives");
  265. return fmi2Error;
  266. }
  267. extern "C" fmi2Status fmi2CancelStep(fmi2Component c)
  268. {
  269. notimplemented(c, "fmi2CancelStep");
  270. return fmi2Error;
  271. }
  272. extern "C" fmi2Status fmi2DoStep(fmi2Component c, fmi2Real currentCommunicationPoint, fmi2Real communicationStepSize,
  273. fmi2Boolean noSetFMUStatePriorToCurrentPoint)
  274. {
  275. try
  276. {
  277. g_adaptation->executeControlFlow(currentCommunicationPoint, communicationStepSize);
  278. return fmi2OK;
  279. } catch (adaptation::SemanticAdaptationFmiException& e)
  280. {
  281. return e.status;
  282. }
  283. }
  284. extern "C" fmi2Status fmi2GetStatus(fmi2Component c, const fmi2StatusKind s, fmi2Status *value)
  285. {
  286. return fmi2OK;
  287. }
  288. extern "C" fmi2Status fmi2GetRealStatus(fmi2Component c, const fmi2StatusKind s, fmi2Real *value)
  289. {
  290. return fmi2OK;
  291. }
  292. extern "C" fmi2Status fmi2GetIntegerStatus(fmi2Component c, const fmi2StatusKind s, fmi2Integer *value)
  293. {
  294. return fmi2OK;
  295. }
  296. extern "C" fmi2Status fmi2GetBooleanStatus(fmi2Component c, const fmi2StatusKind s, fmi2Boolean *value)
  297. {
  298. return fmi2OK;
  299. }
  300. extern "C" fmi2Status fmi2GetStringStatus(fmi2Component c, const fmi2StatusKind s, fmi2String *value)
  301. {
  302. return fmi2OK;
  303. }
  304. /* INTO cps specific*/
  305. /*extern "C" fmi2Status fmi2GetMaxStepsize(fmi2Component c, fmi2Real* size)
  306. {
  307. return fmi2OK;
  308. }*/
  309. // ---------------------------------------------------------------------------
  310. // Functions for FMI2 for Model Exchange
  311. // ---------------------------------------------------------------------------
  312. #else
  313. /* Enter and exit the different modes */
  314. fmi2Status fmi2EnterEventMode(fmi2Component c)
  315. {
  316. return fmi2Error;
  317. }
  318. fmi2Status fmi2NewDiscreteStates(fmi2Component c, fmi2EventInfo *eventInfo)
  319. {
  320. return fmi2Error;
  321. }
  322. fmi2Status fmi2EnterContinuousTimeMode(fmi2Component c)
  323. {
  324. return fmi2Error;
  325. }
  326. fmi2Status fmi2CompletedIntegratorStep(fmi2Component c, fmi2Boolean noSetFMUStatePriorToCurrentPoint,
  327. fmi2Boolean *enterEventMode, fmi2Boolean *terminateSimulation)
  328. {
  329. return fmi2Error;
  330. }
  331. /* Providing independent variables and re-initialization of caching */
  332. fmi2Status fmi2SetTime(fmi2Component c, fmi2Real time)
  333. {
  334. return fmi2Error;
  335. }
  336. fmi2Status fmi2SetContinuousStates(fmi2Component c, const fmi2Real x[], size_t nx)
  337. {
  338. return fmi2Error;
  339. }
  340. /* Evaluation of the model equations */
  341. fmi2Status fmi2GetDerivatives(fmi2Component c, fmi2Real derivatives[], size_t nx)
  342. {
  343. return fmi2Error;
  344. }
  345. fmi2Status fmi2GetEventIndicators(fmi2Component c, fmi2Real eventIndicators[], size_t ni)
  346. {
  347. return fmi2Error;
  348. }
  349. fmi2Status fmi2GetContinuousStates(fmi2Component c, fmi2Real states[], size_t nx)
  350. {
  351. return fmi2Error;
  352. }
  353. fmi2Status fmi2GetNominalsOfContinuousStates(fmi2Component c, fmi2Real x_nominal[], size_t nx)
  354. {
  355. return fmi2Error;
  356. }
  357. #endif // Model Exchange
  358. '''
  359. }
  360. }