FMI_loop_sa.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676
  1. /* ---------------------------------------------------------------------------*
  2. * Sample implementation of an generic master FMU -
  3. * ---------------------------------------------------------------------------*/
  4. /*
  5. Template for a FMU
  6. */
  7. #define MODEL_IDENTIFIER GM
  8. #define MODEL_GUID "{41f87101-edf2-4eef-90f3-42db56d4565f}"
  9. #define FMI2_FUNCTION_PREFIX LOOP_SA
  10. #include <stdio.h>
  11. #include "string.h"
  12. #include "fmi2Functions.h"
  13. #include <float.h>
  14. #include "FMI_loop_sa.h"
  15. #include <math.h>
  16. #include "fmi2.h"
  17. #include "sim_support.h"
  18. #define MAX 100000
  19. #define NUMBER_OF_REALS 3
  20. #define NUMBER_OF_STRINGS 0
  21. #define NUMBER_OF_BOOLEANS 0
  22. #define NUMBER_OF_INTEGERS 0
  23. #define MAXITER 10
  24. #define REL_TOL 1e-05
  25. #define ABS_TOL 1e-05
  26. #define _out_tau 0
  27. #define _in_speed 1
  28. #define _in_displacement 2
  29. #define _window_sa 0
  30. #define _obstacle 1
  31. double relativeError(double a, double b){
  32. if (a == 0){
  33. return 0;
  34. }
  35. return fabs((a - b) / a);
  36. }
  37. /*
  38. * Helper function for absolute error
  39. */
  40. double absoluteError(double a, double b){
  41. return fabs(a - b);
  42. }
  43. /*
  44. * is_close function for double comparison
  45. */
  46. int is_close(double a, double b, double rel_tol, double abs_tol){
  47. return ((absoluteError(a,b)<abs_tol) && (relativeError(a,b)<rel_tol));
  48. }
  49. fmi2Status fmi2SetDebugLogging(fmi2Component fc, fmi2Boolean loggingOn, size_t nCategories, const fmi2String categories[])
  50. {
  51. return fmi2OK;
  52. }
  53. fmi2Status fmi2SetString(fmi2Component fc, const fmi2ValueReference vr[], size_t nvr, const fmi2String value[])
  54. {
  55. FMUInstance* comp = (FMUInstance *)fc;
  56. memset(comp->out_conditions_executed,0,sizeof(fmi2Boolean)*_NR_OF_OUT_CONDITIONS);
  57. return fmi2Error;
  58. }
  59. fmi2Status fmi2GetString(fmi2Component fc, const fmi2ValueReference vr[], size_t nvr, fmi2String value[])
  60. {
  61. return fmi2Error;
  62. }
  63. fmi2Status fmi2SetReal(fmi2Component fc, const fmi2ValueReference vr[], size_t nvr, const fmi2Real value[])
  64. {
  65. FMUInstance* comp = (FMUInstance *)fc;
  66. int i;
  67. for (i = 0; i < nvr; i++)
  68. {
  69. comp->r[vr[i]] = value[i];
  70. }
  71. //out_condition_executed := empty map
  72. memset(comp->out_conditions_executed,0,sizeof(fmi2Boolean)*_NR_OF_OUT_CONDITIONS);
  73. return fmi2OK;
  74. }
  75. fmi2Status fmi2GetReal(fmi2Component fc, const fmi2ValueReference vr[], size_t nvr, fmi2Real value[])
  76. {
  77. FMUInstance* comp = (FMUInstance *)fc;
  78. int isEmpty = 1;
  79. for (int i=0; i<_NR_OF_OUT_CONDITIONS;i++){
  80. if(comp->out_conditions_executed[i] !=0){
  81. isEmpty = 0;
  82. break;
  83. }
  84. }
  85. /*Eval conditions:*/
  86. if(1){
  87. comp->out_conditions_executed[0] = 1;
  88. }
  89. if (isEmpty){
  90. for(int i=0; i<_NR_OF_OUT_CONDITIONS;i++){
  91. if(comp->out_conditions_executed[i]){
  92. }
  93. }
  94. }
  95. for (int i = 0; i < nvr; i++)
  96. {
  97. value[i] = comp->r[(vr[i])];
  98. }
  99. return fmi2OK;
  100. }
  101. fmi2Status fmi2SetBoolean(fmi2Component fc, const fmi2ValueReference vr[], size_t nvr, const fmi2Boolean value[])
  102. {
  103. FMUInstance* comp = (FMUInstance *)fc;
  104. int i;
  105. for (i = 0; i < nvr; i++)
  106. {
  107. comp->b[vr[i]] = value[i];
  108. }
  109. /*Generated: */
  110. fmi2Boolean in_condition[_NR_OF_IN_CONDITIONS];
  111. /*Condition checking:*/
  112. // true
  113. in_condition[0] = 1;
  114. if(in_condition[0]){
  115. /* If mealy do update_in and recursive call */
  116. }
  117. return fmi2OK;
  118. //out_condition_executed := empty map
  119. memset(comp->out_conditions_executed,0,sizeof(fmi2Boolean)*_NR_OF_OUT_CONDITIONS);
  120. return fmi2OK;
  121. }
  122. fmi2Status fmi2GetBoolean(fmi2Component fc, const fmi2ValueReference vr[], size_t nvr, fmi2Boolean value[])
  123. {
  124. FMUInstance* comp = (FMUInstance *)fc;
  125. int i;
  126. for (i = 0; i < nvr; i++)
  127. {
  128. value[i] = comp->b[vr[i]];
  129. }
  130. return fmi2OK;
  131. }
  132. fmi2Component fmi2Instantiate(fmi2String instanceName, fmi2Type fmuType, fmi2String fmuGUID, fmi2String fmuLocation, const fmi2CallbackFunctions* functions, fmi2Boolean visible, fmi2Boolean loggingOn)
  133. {
  134. //Declare data structure for fmu instance
  135. FMUInstance* fi;
  136. printf("%s in fmiInstantiate\n",instanceName);
  137. //Perform checks on passed callback functions
  138. if (loggingOn) {
  139. if (!functions->logger);
  140. //return NULL;
  141. }
  142. //Check for instanceName
  143. if (!instanceName || strlen(instanceName)==0) {
  144. // print (and/or log) instanceName is missing
  145. //return NULL;
  146. }
  147. //Check passed GUID to defined model GUID
  148. if (strcmp(fmuGUID, MODEL_GUID))
  149. {
  150. // print (and/or log) GUID doesn't match
  151. //return NULL;
  152. }
  153. //Allocate fmu instance Memory
  154. // TODO check if "canNotUseMemoryManagementFunctions == true/false". If false memory allocation not possible
  155. fi = (FMUInstance *)functions->allocateMemory(1, sizeof(FMUInstance));
  156. if (fi) {
  157. // Think about what to do with variable values. Using these structs and pointers slows down simulation computations. Maybe only necessary for input, output and tunable parameters??
  158. fi->r = functions->allocateMemory(NUMBER_OF_REALS, sizeof(fmi2Real));
  159. fi->i = functions->allocateMemory(NUMBER_OF_INTEGERS, sizeof(fmi2Integer));
  160. fi->b = functions->allocateMemory(NUMBER_OF_BOOLEANS, sizeof(fmi2Boolean));
  161. fi->s = functions->allocateMemory(NUMBER_OF_STRINGS, sizeof(fmi2String));
  162. } // variables in predefined arrays (performance issue) --> makes multiple instances of fmu impossible
  163. fi->instanceName = functions->allocateMemory(1 + strlen(instanceName), sizeof(char));
  164. fi->GUID = functions->allocateMemory(1 + strlen(fmuGUID), sizeof(char));
  165. strcpy((char*)fi->instanceName, instanceName);
  166. strcpy((char*)fi->GUID, fmuGUID);
  167. fi->functions = functions;
  168. fi->loggingOn = loggingOn;
  169. fi->isVisible = visible;
  170. fi->state = fmuInstantiated;
  171. /* Load the inner FMUs:*/
  172. loadDll("libFMI_Window_sa.dll", &(fi->fmu[_window_sa]), "WINDOW_SA");
  173. fi->fmuResourceLocation[_window_sa] = "libFMI_Window_sa";
  174. loadDll("Obstacle.dll", &(fi->fmu[_obstacle]),"");
  175. fi->fmuResourceLocation[_obstacle] = "Obstacle.dll";
  176. fi->fmu_guid[_window_sa]= functions->allocateMemory(1 + strlen("1"), sizeof(char));
  177. fi->fmu_guid[_obstacle] = functions->allocateMemory(1 + strlen("{547938fa-ae1c-44b9-971b-64c1c3344c33}"), sizeof(char));
  178. strcpy(fi->fmu_guid[_window_sa], "1");
  179. strcpy(fi->fmu_guid[_obstacle], "{8de5bd74-8d30-4a72-9170-0e4bf874b6a8}");
  180. /*Instantiate inner components*/
  181. fi->c_fmu[_window_sa] = fi->fmu[_window_sa].instantiate("window_sa", fmi2CoSimulation, fi->fmu_guid[_window_sa], fi->fmuResourceLocation[_window_sa] , fi->functions, visible, 0);
  182. fi->c_fmu[_obstacle] = fi->fmu[_obstacle].instantiate("obstacle", fmi2CoSimulation, fi->fmu_guid[_obstacle], fi->fmuResourceLocation[_obstacle] , fi->functions, visible, 0);
  183. return fi;
  184. }
  185. fmi2Status fmi2SetupExperiment(fmi2Component fc, fmi2Boolean toleranceDefined, fmi2Real tolerance,
  186. fmi2Real startTime, fmi2Boolean stopTimeDefined, fmi2Real stopTime) {
  187. FMUInstance* fi = (FMUInstance*) fc;
  188. printf("%s in fmiSetupExperiment\n",fi->instanceName);
  189. if (fi->state != fmuInstantiated)
  190. {
  191. printf("fmu: %s was not instatiated before calling fmiSetupExperiment\n", fi->instanceName);
  192. return fmi2Error;
  193. }
  194. fi->currentTime = startTime;
  195. fi->stopTimeDefined = stopTimeDefined;
  196. fi->toleranceDefined = toleranceDefined;
  197. if (stopTimeDefined)
  198. {
  199. fi->stopTime = stopTime;
  200. }
  201. /*
  202. * setup inner
  203. */
  204. fmi2Status fmi2Flag = fmi2OK;
  205. fi->state = fmuExperimentSettedUp;
  206. for(int i=0; i<_NR_OF_FMUS; i++){
  207. fmi2Flag = fi->fmu[i].setupExperiment(fi->c_fmu[i], toleranceDefined, tolerance, startTime, fmi2True, stopTime);
  208. if (fmi2Flag == fmi2Error){
  209. fi->state = fmuError;
  210. }
  211. }
  212. fi->prev_disp = 0;
  213. return fmi2Flag;
  214. }
  215. fmi2Status fmi2EnterInitializationMode(fmi2Component fc)
  216. {
  217. FMUInstance* fi = (FMUInstance*) fc;
  218. printf("%s in fmiEnterInitializationMode\n",fi->instanceName);
  219. if (fi->state != fmuExperimentSettedUp)
  220. {
  221. printf("fmu: %s experiment was not set-up before calling fmiEnterInitializationMode\n", fi->instanceName);
  222. return fmi2Error;
  223. }
  224. fi->state = fmuInitMode;
  225. fmi2Status fmi2Flag = fmi2OK;
  226. for(int i=0; i<_NR_OF_FMUS; i++){
  227. fmi2Flag = fi->fmu[i].enterInitializationMode(fi->c_fmu[i]);
  228. if (fmi2Flag == fmi2Error){
  229. return fi->state = fmuError;
  230. }
  231. }
  232. return fmi2Flag;
  233. }
  234. fmi2Status fmi2ExitInitializationMode(fmi2Component fc)
  235. {
  236. FMUInstance* fi = (FMUInstance*) fc;
  237. printf("%s in fmiExitInitializationMode\n",fi->instanceName);
  238. if (fi->state != fmuInitMode)
  239. {
  240. printf("fmu: %s did not enter Initialization Mode before calling fmiExitInitializationMode\n", fi->instanceName);
  241. return fmi2Error;
  242. }
  243. // TODO
  244. //initStatus = calculateInitialUnknownValues();
  245. //initialize();
  246. fi->state = fmuInitialized;
  247. fmi2Status fmi2Flag = fmi2OK;
  248. for(int i=0; i<_NR_OF_FMUS;i++){
  249. fmi2Flag = fi->fmu[i].exitInitializationMode(fi->c_fmu[i]);
  250. if (fmi2Flag == fmi2Error){
  251. return fi->state = fmuError;
  252. }
  253. }
  254. return fmi2Flag;
  255. }
  256. static fmi2Status DoInnerStep(fmi2Component fc, int index, fmi2Real currentCommPoint, fmi2Real commStepSize){
  257. fmi2Status status = fmi2OK;
  258. FMUInstance* fi = (FMUInstance *)fc;
  259. fmi2Real dt =currentCommPoint - fi->time_last_fmu[index];
  260. fmi2Real h = commStepSize + dt;
  261. int repeat = 0;
  262. fmi2Component obstacle_temp, window_sa_temp;
  263. fmi2ValueReference vr_to_window_sa[3]={2,3,4};
  264. fmi2ValueReference vr_disp[1] = {2};
  265. fmi2ValueReference vr_F_obstacle[1] = {0};
  266. fmi2ValueReference vr_from_window[2] = {0,1};
  267. fmi2Real toWindowSA[3];
  268. fmi2Real fromWindow[2];
  269. for (int iter= 0; iter< MAXITER; iter++) {
  270. fi->fmu[_obstacle].getFMUstate(fi->c_fmu[_obstacle], &obstacle_temp);
  271. fi->fmu[_window_sa].getFMUstate(fi->c_fmu[_window_sa], &window_sa_temp);
  272. fi->fmu[_obstacle].setReal(fi->c_fmu[_obstacle], vr_disp,1, &fi->prev_disp);
  273. fi->fmu[_obstacle].doStep(fi->c_fmu[_obstacle], currentCommPoint, h, fmi2False);
  274. fi->fmu[_obstacle].getReal(fi->c_fmu[_obstacle],vr_F_obstacle,1,&toWindowSA[0]);
  275. printf("from obstacle = %f\n", toWindowSA[0]);
  276. toWindowSA[1] = fi->r[_in_displacement];
  277. printf("to window displacement = %f\n", fi->r[_in_displacement]);
  278. toWindowSA[2] = fi->r[_in_speed];
  279. printf("to window speed = %f\n", fi->r[_in_speed]);
  280. fi->fmu[_window_sa].setReal(fi->c_fmu[_window_sa], vr_to_window_sa, 3, &toWindowSA[0]);
  281. fi->fmu[_window_sa].doStep(fi->c_fmu[_window_sa], currentCommPoint, h, fmi2False);
  282. fi->fmu[_window_sa].getReal(fi->c_fmu[_window_sa], vr_from_window, 2, &fromWindow[0]);
  283. repeat = is_close(fi->prev_disp, fromWindow[1], REL_TOL, ABS_TOL);
  284. fi->prev_disp = fromWindow[1];\
  285. if (repeat) {
  286. fi->fmu[_obstacle].setFMUstate(fi->c_fmu[_obstacle], obstacle_temp);
  287. fi->fmu[_window_sa].setFMUstate(fi->c_fmu[_window_sa], window_sa_temp);
  288. fi->fmu[_obstacle].doStep(fi->c_fmu[_obstacle], currentCommPoint, h, fmi2True);
  289. fi->fmu[_window_sa].doStep(fi->c_fmu[_window_sa], currentCommPoint, h, fmi2True);
  290. // fi->fmu[_obstacle].freeInstance(obstacle_temp);
  291. // fi->fmu[_window_sa].freeInstance(window_sa_temp);
  292. break;
  293. } else {
  294. //rollback(obstacle);
  295. fi->fmu[_obstacle].setFMUstate(fi->c_fmu[_obstacle], obstacle_temp);
  296. fi->fmu[_window_sa].setFMUstate(fi->c_fmu[_window_sa], window_sa_temp);
  297. // fi->fmu[_obstacle].freeInstance(obstacle_temp);
  298. // fi->fmu[_window_sa].freeInstance(window_sa_temp);
  299. //rollback(window_sa);
  300. }
  301. }
  302. if(1){
  303. fi->r[_out_tau] = fromWindow[0];
  304. }
  305. return status;
  306. }
  307. fmi2Status fmi2DoStep(fmi2Component fc , fmi2Real currentCommPoint, fmi2Real commStepSize, fmi2Boolean noPrevFMUState)
  308. {
  309. FMUInstance* fi = (FMUInstance *)fc;
  310. fmi2Status simStatus = fmi2OK;
  311. printf("%s in fmiDoStep(), ct:%f, h:%f\n",fi->instanceName,currentCommPoint,commStepSize);
  312. memset(fi->out_conditions_executed,0,sizeof(fmi2Boolean)*_NR_OF_OUT_CONDITIONS);
  313. /*
  314. Calculate the elapsed time since the last transition
  315. */
  316. fmi2Real e = MAX;
  317. fmi2Real elapsed_fmu[_NR_OF_FMUS];
  318. for (int i=0; i<_NR_OF_FMUS; i++){
  319. elapsed_fmu[i] = currentCommPoint - fi->time_last_fmu[i];
  320. e = (elapsed_fmu[i]<e)? elapsed_fmu[i]:e;
  321. }
  322. if(1){
  323. simStatus= DoInnerStep(fc,0,currentCommPoint,commStepSize);
  324. if (simStatus == fmi2OK){
  325. fi->time_last_fmu[0] = currentCommPoint + commStepSize;
  326. fi->time_last_fmu[1] = currentCommPoint + commStepSize;
  327. }
  328. }
  329. memset(fi->in_condition_executed, 0, sizeof(fmi2Boolean)*_NR_OF_IN_CONDITIONS);
  330. return simStatus;
  331. }
  332. fmi2Status fmi2Terminate(fmi2Component fc)
  333. {
  334. FMUInstance* fi = (FMUInstance *)fc;
  335. printf("%s in fmiTerminate\n",fi->instanceName);
  336. // do check if fi may be terminated
  337. for (int i=0;i<1;i++){
  338. fi->fmu[i].terminate(fi->c_fmu[i]);
  339. }
  340. fi->state = fmuTerminated;
  341. return fmi2OK;
  342. }
  343. void fmi2FreeInstance(fmi2Component fc)
  344. {
  345. FMUInstance* fi = (FMUInstance*) fc;
  346. printf("%s in fmiFreeInstance\n",fi->instanceName);
  347. for(int i=0;i<1;i++){
  348. fi->fmu[i].freeInstance(fi->c_fmu[i]);
  349. }
  350. if (fi) {
  351. fi->functions->freeMemory(fi->r);
  352. fi->functions->freeMemory(fi->i);
  353. fi->functions->freeMemory(fi->b);
  354. fi->functions->freeMemory(fi->s);// TODO has to be done with loop
  355. fi->functions->freeMemory((void*)fi->instanceName);
  356. fi->functions->freeMemory((void*)fi->GUID);
  357. fi->functions->freeMemory((void*)fi);
  358. }
  359. }
  360. //To be implemented
  361. const char* fmi2GetVersion() {
  362. printf("Function fmiGetVersion not supported\n");
  363. return NULL;
  364. }
  365. const char* fmi2GetTypesPlatform() {
  366. printf("Function fmiGetTypesPlatform not supported\n");
  367. return NULL;
  368. }
  369. fmi2Status fmi2Reset(fmi2Component fc)
  370. {
  371. printf("Function fmiReset not supported\n");
  372. return fmi2Error;
  373. }
  374. fmi2Status fmi2SetInteger(fmi2Component fc, const fmi2ValueReference vr[], size_t nvr, const fmi2Integer value[])
  375. {
  376. FMUInstance * comp = (FMUInstance*) fc;
  377. printf("Function fmiSetInteger not supported\n");
  378. memset(comp->out_conditions_executed,0,sizeof(fmi2Boolean)*_NR_OF_OUT_CONDITIONS);
  379. return fmi2Error;
  380. }
  381. fmi2Status fmi2GetInteger(fmi2Component fc, const fmi2ValueReference vr[], size_t nvr, fmi2Integer value[])
  382. {
  383. printf("Function fmiGetInteger not supported\n");
  384. return fmi2Error;
  385. }
  386. /*******OWN IMPLEMENTATION OF Get/Set FMU state*******/
  387. fmi2Status fmi2GetFMUstate (fmi2Component c, fmi2FMUstate* FMUstate) {
  388. FMUInstance* orig = (FMUInstance*)c;
  389. FMUInstance* fi = (FMUInstance *)FMUstate;
  390. *FMUstate = fi;
  391. fi = orig->functions->allocateMemory(1, sizeof(FMUInstance));
  392. *FMUstate = fi;
  393. fi->functions = orig->functions;
  394. if (fi) {
  395. // Think about what to do with variable values. Using these structs and pointers slows down simulation computations. Maybe only necessary for input, output and tunable parameters??
  396. fi->r = fi->functions->allocateMemory(NUMBER_OF_REALS, sizeof(fmi2Real));
  397. fi->i = fi->functions->allocateMemory(NUMBER_OF_INTEGERS, sizeof(fmi2Integer));
  398. fi->b = fi->functions->allocateMemory(NUMBER_OF_BOOLEANS, sizeof(fmi2Boolean));
  399. fi->s = fi->functions->allocateMemory(NUMBER_OF_STRINGS, sizeof(fmi2String));
  400. } // variables in predefined arrays (performance issue) --> makes multiple instances of fmu impossible
  401. fi->instanceName = orig->functions->allocateMemory(1 + strlen(orig->instanceName), sizeof(char));
  402. fi->GUID = orig->functions->allocateMemory(1 + strlen(orig->GUID), sizeof(char));
  403. strcpy((char *)fi->instanceName, (char *)orig->instanceName);
  404. strcpy((char *)fi->GUID, (char *)orig->GUID);
  405. fi->functions = orig->functions;
  406. fi->loggingOn = orig->loggingOn;
  407. fi->isVisible = orig->isVisible;
  408. fi->state = orig->state;
  409. fi->startTime = orig->startTime;
  410. fi->stopTime = orig->stopTime;
  411. fi->currentTime = orig->currentTime;
  412. /* TODO: Store all the rest here.*/
  413. fi->fmu[0] = orig->fmu[0];
  414. fi->c_fmu[0] = orig->c_fmu[0];
  415. for(int i=0; i<_NR_OF_IN_CONDITIONS;i++){
  416. fi->in_condition_executed[i] = orig->in_condition_executed[i];
  417. }
  418. for(int i=0; i<_NR_OF_OUT_CONDITIONS;i++){
  419. fi->out_conditions_executed[i] = orig->out_conditions_executed[i];
  420. }
  421. for(int i=0;i<_NR_OF_FMUS;i++){
  422. fi->time_last_fmu[i] = orig->time_last_fmu[i];
  423. }
  424. /* Generated */
  425. fi->prev_disp = orig->prev_disp;
  426. fi->toleranceDefined = orig->toleranceDefined;
  427. /*
  428. * This is a hierarchical call. First let the lower FMUs do their state saving
  429. * We will store the saved fmu state in the fi->c_order[i]
  430. */
  431. for(int i=0;i<1;i++){
  432. fi->fmu[i]=orig->fmu[i];
  433. orig->fmu[i].getFMUstate(orig->c_fmu[i],fi->c_fmu[i]);
  434. fi->fmuResourceLocation[i] = fi->functions->allocateMemory(1+strlen(orig->fmuResourceLocation[i]), sizeof(char));
  435. strcpy((char *)fi->fmuResourceLocation[i],(char *)orig->fmuResourceLocation[i]);
  436. /*make shallow copies of the stored fmus*/
  437. }
  438. //copy r
  439. int i=0;
  440. for (i=0; i< NUMBER_OF_REALS;i++){
  441. fi->r[i] = orig->r[i];
  442. }
  443. //copy s
  444. for (i=0; i< NUMBER_OF_STRINGS;i++){
  445. //fi->s[i] = orig->s[i]; // why are this not deep copies?
  446. fi->s[i] = fi->functions->allocateMemory(1+strlen(orig->s[i]),sizeof(char));
  447. strcpy((char *)fi->s[i],(char *)orig->s[i]);
  448. }
  449. //copy i
  450. for (i=0; i< NUMBER_OF_INTEGERS;i++){
  451. fi->i[i] = orig->i[i];
  452. }
  453. //copy b
  454. for (i=0; i< NUMBER_OF_BOOLEANS;i++){
  455. fi->b[i] = orig->b[i];
  456. }
  457. return fmi2OK;
  458. }
  459. fmi2Status fmi2SetFMUstate (fmi2Component c, fmi2FMUstate FMUstate) {
  460. FMUInstance* orig = (FMUInstance*)FMUstate;
  461. FMUInstance* fi = (FMUInstance*)c;
  462. /*
  463. * First restore the hierarchical fmus.
  464. */
  465. for(int i=0;i<1;i++){
  466. fi->fmu[i].setFMUstate(fi->c_fmu[i],orig->c_fmu[i]);
  467. fi->fmuResourceLocation[i] = orig->functions->allocateMemory(1+strlen(orig->fmuResourceLocation[i]), sizeof(char));
  468. strcpy((char *)fi->fmuResourceLocation[i],(char *)orig->fmuResourceLocation[i]);
  469. }
  470. //set time etc correct, name and GUID should still be ok ;-)
  471. printf("setting time values from %f to %f\n", fi->currentTime, orig->currentTime);
  472. fi->state = orig->state;
  473. fi->startTime = orig->startTime;
  474. fi->stopTime = orig->stopTime;
  475. fi->currentTime = orig->currentTime;
  476. fi->fmu[0] = orig->fmu[0];
  477. fi->c_fmu[0] = orig->c_fmu[0];
  478. for(int i=0; i<_NR_OF_IN_CONDITIONS;i++){
  479. fi->in_condition_executed[i] = orig->in_condition_executed[i];
  480. }
  481. for(int i=0; i<_NR_OF_OUT_CONDITIONS;i++){
  482. fi->out_conditions_executed[i] = orig->out_conditions_executed[i];
  483. }
  484. for(int i=0;i<_NR_OF_FMUS;i++){
  485. fi->time_last_fmu[i] = orig->time_last_fmu[i];
  486. }
  487. /* Generated */
  488. fi->prev_disp = orig->prev_disp;
  489. fi->toleranceDefined = orig->toleranceDefined;
  490. fi->toleranceDefined = orig->toleranceDefined;
  491. printf("setting real values\n");
  492. //copy r
  493. int i=0;
  494. for (i=0; i< NUMBER_OF_REALS;i++){
  495. fi->r[i] = orig->r[i];
  496. }
  497. printf("setting string values\n");
  498. //copy s
  499. for (i=0; i< NUMBER_OF_STRINGS;i++){
  500. fi->s[i] = orig->s[i];
  501. }
  502. //copy i
  503. for (i=0; i< NUMBER_OF_INTEGERS;i++){
  504. fi->i[i] = orig->i[i];
  505. }
  506. //copy b
  507. for (i=0; i< NUMBER_OF_BOOLEANS;i++){
  508. fi->b[i] = orig->b[i];
  509. }
  510. return fmi2OK;
  511. }
  512. /****************************************************/
  513. fmi2Status fmi2FreeFMUstate(fmi2Component c, fmi2FMUstate* FMUstate) {
  514. printf("Function fmiFreeFMUstate not supported\n");
  515. return fmi2Error;
  516. }
  517. fmi2Status fmi2SerializedFMUstateSize(fmi2Component c, fmi2FMUstate FMUstate, size_t *size) {
  518. printf("Function fmiSerializedFMUstateSize not supported\n");
  519. return fmi2Error;
  520. }
  521. fmi2Status fmi2SerializeFMUstate (fmi2Component c, fmi2FMUstate FMUstate, fmi2Byte serializedState[], size_t size) {
  522. printf("Function fmiSerializeFMUstate not supported\n");
  523. return fmi2Error;
  524. }
  525. fmi2Status fmi2DeSerializeFMUstate (fmi2Component c, const fmi2Byte serializedState[], size_t size, fmi2FMUstate* FMUstate) {
  526. printf("Function fmiDeSerializeFMUstate not supported\n");
  527. return fmi2Error;
  528. }
  529. fmi2Status fmi2GetDirectionalDerivative(fmi2Component c, const fmi2ValueReference vUnknown_ref[], size_t nUnknown,
  530. const fmi2ValueReference vKnown_ref[] , size_t nKnown, const fmi2Real dvKnown[], fmi2Real dvUnknown[]) {
  531. printf("Function fmiGetDirectionalDerivative not supported\n");
  532. return fmi2Error;
  533. }
  534. fmi2Status fmi2SetRealInputDerivatives(fmi2Component c, const fmi2ValueReference vr[], size_t nvr,
  535. const fmi2Integer order[], const fmi2Real value[]) {
  536. printf("Function fmiGetDirectionalDerivative not supported\n");
  537. return fmi2Error;
  538. }
  539. fmi2Status fmi2GetRealOutputDerivatives(fmi2Component c, const fmi2ValueReference vr[], size_t nvr,
  540. const fmi2Integer order[], fmi2Real value[]) {
  541. printf("Function fmiGetDirectionalDerivative not supported\n");
  542. return fmi2Error;
  543. }
  544. fmi2Status fmi2CancelStep(fmi2Component c) {
  545. printf("Function fmiGetDirectionalDerivative not supported\n");
  546. return fmi2Error;
  547. }
  548. fmi2Status fmi2GetStatus(fmi2Component c, const fmi2StatusKind s, fmi2Status *value) {
  549. printf("Function fmiGetStatus not supported\n");
  550. return fmi2Error;
  551. }
  552. fmi2Status fmi2GetRealStatus(fmi2Component c, const fmi2StatusKind s, fmi2Real *value) {
  553. if(s == fmi2LastSuccessfulTime){
  554. FMUInstance* comp = (FMUInstance*) c;
  555. *value = comp->currentTime;
  556. return fmi2OK;
  557. }
  558. printf("Function fmiGetRealStatus not supported\n");
  559. return fmi2Error;
  560. }
  561. fmi2Status fmi2GetIntegerStatus(fmi2Component c, const fmi2StatusKind s, fmi2Integer *value) {
  562. printf("Function fmiGetIntegerStatus not supported\n");
  563. return fmi2Error;
  564. }
  565. fmi2Status fmi2GetBooleanStatus(fmi2Component c, const fmi2StatusKind s, fmi2Boolean *value) {
  566. printf("Function fmiGetBooleanStatus not supported\n");
  567. return fmi2Error;
  568. }
  569. fmi2Status fmi2GetStringStatus(fmi2Component c, const fmi2StatusKind s, fmi2String *value) {
  570. printf("Function fmiGetStringStatus not supported\n");
  571. return fmi2Error;
  572. }