matrixop.c 118 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420342134223423342434253426342734283429343034313432343334343435343634373438343934403441344234433444344534463447344834493450345134523453345434553456345734583459346034613462346334643465346634673468346934703471347234733474347534763477347834793480348134823483348434853486348734883489349034913492349334943495349634973498349935003501350235033504350535063507350835093510351135123513351435153516351735183519352035213522352335243525352635273528352935303531353235333534353535363537353835393540354135423543354435453546354735483549355035513552355335543555355635573558355935603561356235633564356535663567356835693570357135723573357435753576357735783579358035813582358335843585358635873588358935903591359235933594359535963597359835993600360136023603360436053606360736083609361036113612361336143615361636173618361936203621362236233624362536263627362836293630363136323633363436353636363736383639364036413642364336443645364636473648364936503651365236533654365536563657365836593660366136623663366436653666366736683669367036713672367336743675367636773678367936803681368236833684368536863687368836893690369136923693369436953696369736983699370037013702370337043705370637073708370937103711371237133714371537163717371837193720372137223723372437253726372737283729373037313732373337343735373637373738373937403741374237433744374537463747374837493750375137523753375437553756375737583759
  1. /* * Code for matrix functions in Dymola
  2. *
  3. * Copyright (C) 1997-2001 Dynasim AB.
  4. * All rights reserved.
  5. *
  6. * Author: Hans Olsson Dynasim AB, 1999
  7. * Version: 1.2, 1999-07-16*/
  8. /* */
  9. #ifndef MATRIX_OP_C
  10. #define MATRIX_OP_C
  11. #if defined(_MSC_VER)
  12. #if (!DymolaGlobalOptimizations_) || (DymolaGlobalOptimizations_ == 2)
  13. #pragma optimize( "g", on )
  14. #endif
  15. #endif
  16. #if (!defined(LIBDSDLL_EXPORTS)) || defined(DYMOSIM_DLL_EXPORTS)
  17. #include "matrixop1.h"
  18. #include <stddef.h>
  19. #include <limits.h>
  20. #include <float.h>
  21. struct TaggedIndexStack {
  22. enum Subtag tag;
  23. union {
  24. Integer index;
  25. Integer range[3];
  26. IntegerArray vector;
  27. } u;
  28. };
  29. #undef Assert
  30. #define Assert(b,x) if (!(b)) AssertModelicaF(b,#b,x)
  31. DYMOLA_STATIC struct TaggedIndexStack*HandleVaList(va_list ap, struct TaggedIndexStack*VA_handler,int num_VA_handler) {
  32. int i;
  33. struct TaggedIndexStack*VA_handler_p=VA_handler;
  34. for(i=0;i<num_VA_handler;++i,++VA_handler_p) {
  35. enum Subtag tag=va_arg(ap,int);
  36. Assert(i+4<num_VA_handler,"Out of memory for va_list");
  37. VA_handler_p->tag=(enum Subtag)(tag);
  38. if (tag==EndMark)
  39. break;
  40. switch(tag) {
  41. case Colon:
  42. break;
  43. case Range:case RangeRange:
  44. {
  45. Integer start,stop,stride=1;
  46. start=va_arg(ap,Integer);
  47. if (tag==RangeRange) stride=va_arg(ap,Integer);
  48. stop=va_arg(ap,Integer);
  49. VA_handler_p->u.range[0]=start;
  50. VA_handler_p->u.range[1]=stride;
  51. VA_handler_p->u.range[2]=stop;
  52. }
  53. break;
  54. case Index:
  55. {
  56. VA_handler_p->u.index=va_arg(ap,Integer);
  57. break;
  58. }
  59. case Vector:
  60. {
  61. VA_handler_p->u.vector=va_arg(ap,IntegerArray);
  62. break;
  63. }
  64. case EndMark:
  65. {
  66. /* shouldn't happen*/
  67. break;
  68. }
  69. }
  70. }
  71. return VA_handler;
  72. }
  73. /* Buffers and keeping track of them by Mark and Release */
  74. /* The idea is that each function has two marks:
  75. RealArray f(...) {
  76. RealArray res=RealTemporaryMatrix(...);
  77. MarkObject returnMark=PushMark();
  78. RealArray temp=RealTemporaryMatrix(...);
  79. ...
  80. MarkObject functionMark=PushMark();
  81. ...
  82. for(...) {
  83. ...
  84. Release(); // Destroy everything except local variables and return-value
  85. {
  86. RealArray v_=RealScalarArray(...);
  87. Integer index_;
  88. MarkObject for_mark=PushMark();
  89. for(index_=0;index_<v_.dims[0];index_++) {
  90. v=v_.data[index_];
  91. ...
  92. Release();
  93. };
  94. PopMark(for_mark);
  95. }
  96. ...
  97. Release();
  98. ...
  99. PopMark(returnMark); // Destroy everything except the return-value
  100. return res;
  101. }
  102. */
  103. DYMOLA_STATIC MarkObject currentMarkNon={{RealbufferNon,IntegerbufferNon,SizebufferNon,StringbufferNon},{RealbufferNon,IntegerbufferNon,SizebufferNon,StringbufferNon}};
  104. DYMOLA_STATIC char*startstringmarkNon=simplestringNon;
  105. #if defined(DYN_MULTINSTANCE)
  106. #define startMark (DYN_GetThreadData()->m_start)
  107. #define currentMark (DYN_GetThreadData()->m_current)
  108. #define stringmark (DYN_GetThreadData()->m_stringmark)
  109. #define startstringmark (DYN_GetThreadData()->m_startstringmark)
  110. #define EndRealbuffer (DYN_GetThreadData()->m_endreal)
  111. #define EndIntegerbuffer (DYN_GetThreadData()->m_endinteger)
  112. #define EndSizebuffer (DYN_GetThreadData()->m_endsize)
  113. #define EndStringbuffer (DYN_GetThreadData()->m_endstring)
  114. #define Endsimplestring (DYN_GetThreadData()->m_endsimplestring)
  115. DYMOLA_STATIC void EnsureMarkInitializedFunction() {
  116. struct DYN_ThreadData*threadData=0;
  117. threadData=DYN_GetThreadData();
  118. if (threadData && 0==threadData->m_endreal) {
  119. const int numReal=
  120. #ifndef DYNREALBUFFER
  121. 500000
  122. #else
  123. DYNREALBUFFER
  124. #endif
  125. ;
  126. threadData->m_current.place.Realbuffer=(Real*)calloc(numReal,sizeof(Real));
  127. threadData->m_endreal=threadData->m_current.place.Realbuffer+numReal;
  128. threadData->m_current.place.Integerbuffer=(Integer*)calloc(50000,sizeof(Integer));
  129. threadData->m_endinteger=threadData->m_current.place.Integerbuffer+50000;
  130. threadData->m_current.place.Sizebuffer=(SizeType*)calloc(50000,sizeof(SizeType));
  131. threadData->m_endsize=threadData->m_current.place.Sizebuffer+50000;
  132. threadData->m_current.place.Stringbuffer=(String*)calloc(10000,sizeof(String));
  133. threadData->m_endstring=threadData->m_current.place.Stringbuffer+10000;
  134. threadData->m_current.mark=threadData->m_current.place;
  135. threadData->m_start=threadData->m_current;
  136. threadData->m_stringmark=threadData->m_startstringmark=calloc(10000,1);
  137. threadData->m_endsimplestring=threadData->m_stringmark+10000;
  138. }
  139. }
  140. DYMOLA_STATIC void EnsureMarkFree(struct DYN_ThreadData*threadData) {
  141. if (threadData && 0!=threadData->m_endreal) {
  142. free(threadData->m_start.place.Realbuffer);
  143. free(threadData->m_start.place.Integerbuffer);
  144. free(threadData->m_start.place.Sizebuffer);
  145. free(threadData->m_start.place.Stringbuffer);
  146. free((void*)threadData->m_startstringmark);
  147. threadData->m_start.place.Realbuffer=0;
  148. threadData->m_endreal=0;
  149. threadData->m_start.place.Integerbuffer=0;
  150. threadData->m_endinteger=0;
  151. threadData->m_start.place.Sizebuffer=0;
  152. threadData->m_endsize=0;
  153. threadData->m_start.place.Stringbuffer=0;
  154. threadData->m_endstring=0;
  155. threadData->m_start.mark=threadData->m_start.place;
  156. threadData->m_current=threadData->m_start;
  157. threadData->m_stringmark=threadData->m_startstringmark=0;
  158. threadData->m_endsimplestring=0;
  159. }
  160. }
  161. DYMOLA_STATIC void EnsureMarkFree2() {
  162. EnsureMarkFree(DYN_GetThreadData());
  163. }
  164. #define EnsureMarkInitialized() if (EndRealbuffer==0) EnsureMarkInitializedFunction();
  165. #else
  166. DYMOLA_STATIC MarkObject startMark={{Realbuffer,Integerbuffer,Sizebuffer,Stringbuffer},{Realbuffer,Integerbuffer,Sizebuffer,Stringbuffer}};
  167. #if (defined(_OPENMP) && !defined(DISABLE_DYMOLA_OPENMP))
  168. #pragma omp threadprivate(startMark)
  169. #endif
  170. DYMOLA_STATIC MarkObject currentMark={{Realbuffer,Integerbuffer,Sizebuffer,Stringbuffer},{Realbuffer,Integerbuffer,Sizebuffer,Stringbuffer}};
  171. #if (defined(_OPENMP) && !defined(DISABLE_DYMOLA_OPENMP))
  172. #pragma omp threadprivate(currentMark)
  173. #endif
  174. extern char simplestring[];
  175. DYMOLA_STATIC char*stringmark=simplestring;
  176. #if (defined(_OPENMP) && !defined(DISABLE_DYMOLA_OPENMP))
  177. #pragma omp threadprivate(stringmark)
  178. #endif
  179. DYMOLA_STATIC char*startstringmark=simplestring;
  180. #if (defined(_OPENMP) && !defined(DISABLE_DYMOLA_OPENMP))
  181. #pragma omp threadprivate(startstringmark)
  182. #endif
  183. #if (defined(_OPENMP) && !defined(DISABLE_DYMOLA_OPENMP))
  184. #include <omp.h>
  185. DYMOLA_STATIC void EnsureMarkInitializedFunction() {
  186. int i=omp_get_thread_num();
  187. int n=0;
  188. int num;
  189. if (0==n) {
  190. n=omp_get_max_threads();
  191. if (n<omp_get_num_procs()) n=omp_get_num_procs();
  192. if (n<omp_get_num_threads()) n=omp_get_num_threads();
  193. }
  194. num=sizeof(Realbuffer)/sizeof(*Realbuffer);
  195. currentMark.place.Realbuffer=Realbuffer+(i*num)/n;
  196. EndRealbuffer=Realbuffer+((i+1)*num)/n;
  197. num=sizeof(Integerbuffer)/sizeof(*Integerbuffer);
  198. currentMark.place.Integerbuffer=Integerbuffer+(i*num)/n;
  199. EndIntegerbuffer=Integerbuffer+((i+1)*num)/n;
  200. num=sizeof(Sizebuffer)/sizeof(*Sizebuffer);
  201. currentMark.place.Sizebuffer=Sizebuffer+(i*num)/n;
  202. EndSizebuffer=Sizebuffer+((i+1)*num)/n;
  203. num=sizeof(Stringbuffer)/sizeof(*Stringbuffer);
  204. currentMark.place.Stringbuffer=Stringbuffer+(i*num)/n;
  205. EndStringbuffer=Stringbuffer+((i+1)*num)/n;
  206. currentMark.mark=currentMark.place;
  207. startMark=currentMark;
  208. num=sizeof(simplestring)/sizeof(*simplestring);
  209. stringmark=startstringmark=simplestring+(i*num)/n;
  210. Endsimplestring=simplestring+((i+1)*num)/n;
  211. }
  212. #define EnsureMarkInitialized() if (EndRealbuffer==0) EnsureMarkInitializedFunction();
  213. #else
  214. #define EnsureMarkInitialized()
  215. #endif
  216. #endif
  217. DYMOLA_STATIC MarkObject PushMark(void) {
  218. MarkObject oldMark;
  219. EnsureMarkInitialized();
  220. oldMark=currentMark;
  221. currentMark.mark=currentMark.place;
  222. return oldMark;
  223. }
  224. DYMOLA_STATIC void RePushMark(MarkObject*oldMark) {
  225. MarkObject newMark;
  226. EnsureMarkInitialized();
  227. newMark=PushMark();
  228. if (oldMark) oldMark->place=newMark.place;
  229. }
  230. /* Release: used after each matrix assignment in the function */
  231. DYMOLA_STATIC void Release() {EnsureMarkInitialized();currentMark.place=currentMark.mark;}
  232. /* At the end of the function */
  233. DYMOLA_STATIC void PopMark(MarkObject oldMark) {EnsureMarkInitialized();currentMark=oldMark;}
  234. /* Raw allocation of r temporaries and return a pointer to the start*/
  235. DYMOLA_STATIC Real *RealTemp(SizeType r) {
  236. Real *d=0;
  237. EnsureMarkInitialized();
  238. d=currentMark.place.Realbuffer;
  239. currentMark.place.Realbuffer+=r;
  240. Assert(currentMark.place.Realbuffer<EndRealbuffer,"Out of memory for reals\nIt could due to too large matrices, infinite recursion, or uninitialized variables.\nYou can change the memory size by setting the variable Advanced.RealBufferSize.");
  241. return d;
  242. }
  243. DYMOLA_STATIC Integer *IntegerTemp(SizeType r) {
  244. Integer *i=0;
  245. EnsureMarkInitialized();
  246. i=currentMark.place.Integerbuffer;
  247. currentMark.place.Integerbuffer+=r;
  248. Assert(currentMark.place.Integerbuffer<EndIntegerbuffer,"Out of memory for integers\nIt could due to too large matrices, infinite recursion, or uninitialized variables.\nYou can increase the size of 'Integerbuffer' in dymola/source/matrixop.h.");
  249. return i;
  250. }
  251. DYMOLA_STATIC SizeType *SizeTemp(SizeType r) {
  252. SizeType *s=0;
  253. EnsureMarkInitialized();
  254. s=currentMark.place.Sizebuffer;
  255. currentMark.place.Sizebuffer+=r;
  256. Assert(currentMark.place.Sizebuffer<EndSizebuffer,"Out of memory for array dimensions\nIt could due to too many matrices, infinite recursion, or uninitialized variables.\nYou can increase the size of 'Sizebuffer' in dymola/source/matrixop.h.");
  257. return s;
  258. }
  259. DYMOLA_STATIC String * StringTemp(SizeType r) {
  260. String *s=0;
  261. EnsureMarkInitialized();
  262. s=currentMark.place.Stringbuffer;
  263. currentMark.place.Stringbuffer+=r;
  264. Assert(currentMark.place.Stringbuffer<EndStringbuffer,"Out of memory for strings\nIt could due to too large matrices, infinite recursion, or uninitialized variables.\nYou can increase the size of 'Stringbuffer' in dymola/source/matrixop.h.");
  265. return s;
  266. }
  267. DYMOLA_STATIC Real *RealNonTemp(SizeType r) {
  268. Real *d=0;
  269. d=currentMarkNon.place.Realbuffer;
  270. currentMarkNon.place.Realbuffer+=r;
  271. Assert(currentMarkNon.place.Realbuffer<EndRealbufferNon,"Out of memory for reals\nIt could due to too large matrices, infinite recursion, or uninitialized variables.\nYou can change the memory size by setting the variable Advanced.RealBufferSize.");
  272. return d;
  273. }
  274. DYMOLA_STATIC Integer *IntegerNonTemp(SizeType r) {
  275. Integer *i=0;
  276. i=currentMarkNon.place.Integerbuffer;
  277. currentMarkNon.place.Integerbuffer+=r;
  278. Assert(currentMarkNon.place.Integerbuffer<EndIntegerbufferNon,"Out of memory for integers\nIt could due to too large matrices, infinite recursion, or uninitialized variables.\nYou can increase the size of 'Integerbuffer' in dymola/source/matrixop.h.");
  279. return i;
  280. }
  281. DYMOLA_STATIC SizeType *SizeNonTemp(SizeType r) {
  282. SizeType *s=0;
  283. s=currentMarkNon.place.Sizebuffer;
  284. currentMarkNon.place.Sizebuffer+=r;
  285. Assert(currentMarkNon.place.Sizebuffer<EndSizebufferNon,"Out of memory for array dimensions\nIt could due to too many matrices, infinite recursion, or uninitialized variables.\nYou can increase the size of 'Sizebuffer' in dymola/source/matrixop.h.");
  286. return s;
  287. }
  288. DYMOLA_STATIC String * StringNonTemp(SizeType r) {
  289. String *s=0;
  290. s=currentMarkNon.place.Stringbuffer;
  291. currentMarkNon.place.Stringbuffer+=r;
  292. Assert(currentMarkNon.place.Stringbuffer<EndStringbufferNon,"Out of memory for strings\nIt could due to too large matrices, infinite recursion, or uninitialized variables.\nYou can increase the size of 'Stringbuffer' in dymola/source/matrixop.h.");
  293. return s;
  294. }
  295. /* Helper to find index of element */
  296. DYMOLA_STATIC SizeType FindIndex(SizeType ndims,SizeType*dims,va_list ap) {
  297. SizeType i,index;
  298. index=0;
  299. for(i=0;i<ndims;i++) {
  300. SizeType j=va_arg(ap,SizeType);
  301. SizeType dim=dims[i];
  302. Assert((j>=1)&&(j<=dim),"Index out of bounds");
  303. index=index*dim+(j-1);
  304. }
  305. return index;
  306. }
  307. /* Start of common routines */
  308. /* Test for size compatibility, used in assertions */
  309. DYMOLA_STATIC Integer RealMatchingSizes(const RealArray a,const RealArray b) {
  310. SizeType i;
  311. if (a.ndims!=b.ndims) return 0;
  312. for(i=0;i<a.ndims;i++) {if(a.dims[i]!=b.dims[i]) return 0;}
  313. return 1;
  314. }
  315. /* Return total number of elements */
  316. DYMOLA_STATIC SizeType RealNrElements(const RealArray a) {
  317. SizeType prodsize=1;
  318. SizeType i;
  319. for(i=0;i<a.ndims;i++) prodsize*=a.dims[i];
  320. return prodsize;
  321. }
  322. /* Create Array-temporaries given the dimensions */
  323. /* Internal: Use an existing va_list */
  324. DYMOLA_STATIC RealArray RealVaTemporarySize(SizeType ndims,va_list ap) {
  325. RealArray temp;
  326. SizeType i;
  327. temp.ndims=ndims;
  328. temp.dims=SizeTemp(ndims);
  329. for(i=0;i<ndims;i++) temp.dims[i]=va_arg(ap,SizeType);
  330. return temp;
  331. }
  332. DYMOLA_STATIC RealArray RealVaTemporary(SizeType ndims,va_list ap) {
  333. RealArray temp=RealVaTemporarySize(ndims,ap);
  334. temp.data=RealTemp(RealNrElements(temp));
  335. return temp;
  336. }
  337. DYMOLA_STATIC RealArray RealVaNonTemporarySize(SizeType ndims,va_list ap) {
  338. RealArray temp;
  339. SizeType i;
  340. temp.ndims=ndims;
  341. temp.dims=SizeNonTemp(ndims);
  342. for(i=0;i<ndims;i++) temp.dims[i]=va_arg(ap,SizeType);
  343. return temp;
  344. }
  345. DYMOLA_STATIC RealArray RealVaNonTemporary(SizeType ndims,va_list ap) {
  346. RealArray temp=RealVaNonTemporarySize(ndims,ap);
  347. temp.data=RealNonTemp(RealNrElements(temp));
  348. return temp;
  349. }
  350. DYMOLA_STATIC IntegerArray IntegerVaNonTemporarySize(SizeType ndims,va_list ap) {
  351. IntegerArray temp;
  352. SizeType i;
  353. temp.ndims=ndims;
  354. temp.dims=SizeNonTemp(ndims);
  355. for(i=0;i<ndims;i++) temp.dims[i]=va_arg(ap,SizeType);
  356. return temp;
  357. }
  358. DYMOLA_STATIC IntegerArray IntegerVaNonTemporary(SizeType ndims,va_list ap) {
  359. IntegerArray temp=IntegerVaNonTemporarySize(ndims,ap);
  360. temp.data=IntegerNonTemp(IntegerNrElements(temp));
  361. return temp;
  362. }
  363. DYMOLA_STATIC StringArray StringVaNonTemporarySize(SizeType ndims,va_list ap) {
  364. StringArray temp;
  365. SizeType i;
  366. temp.ndims=ndims;
  367. temp.dims=SizeNonTemp(ndims);
  368. for(i=0;i<ndims;i++) temp.dims[i]=va_arg(ap,SizeType);
  369. return temp;
  370. }
  371. DYMOLA_STATIC StringArray StringVaNonTemporary(SizeType ndims,va_list ap) {
  372. StringArray temp=StringVaNonTemporarySize(ndims,ap);
  373. temp.data=StringNonTemp(StringNrElements(temp));
  374. return temp;
  375. }
  376. /* Construct a temporary of the same size as a */
  377. DYMOLA_STATIC RealArray RealMatch(const RealArray a) {
  378. RealArray temp;
  379. SizeType i;
  380. temp.ndims=a.ndims;
  381. temp.dims=SizeTemp(a.ndims);
  382. for(i=0;i<a.ndims;i++) temp.dims[i]=a.dims[i];
  383. temp.data=RealTemp(RealNrElements(a));
  384. return temp;
  385. }
  386. /* Construct array from sizes, using variable number of arguments */
  387. DYMOLA_STATIC RealArray RealTemporary(SizeType ndims,...) {
  388. RealArray temp;
  389. va_list ap;
  390. va_start(ap,ndims);
  391. temp=RealVaTemporary(ndims,ap);
  392. va_end(ap);
  393. return temp;
  394. }
  395. /* Construct array from sizes, using variable number of arguments */
  396. DYMOLA_STATIC RealArray RealNonTemporary(SizeType ndims,...) {
  397. RealArray temp;
  398. va_list ap;
  399. va_start(ap,ndims);
  400. temp=RealVaNonTemporary(ndims,ap);
  401. va_end(ap);
  402. return temp;
  403. }
  404. DYMOLA_STATIC IntegerArray IntegerNonTemporary(SizeType ndims,...) {
  405. IntegerArray temp;
  406. va_list ap;
  407. va_start(ap,ndims);
  408. temp=IntegerVaNonTemporary(ndims,ap);
  409. va_end(ap);
  410. return temp;
  411. }
  412. DYMOLA_STATIC StringArray StringNonTemporary(SizeType ndims,...) {
  413. StringArray temp;
  414. va_list ap;
  415. va_start(ap,ndims);
  416. temp=StringVaNonTemporary(ndims,ap);
  417. va_end(ap);
  418. return temp;
  419. }
  420. /* Special cases for vectors and matrices (most often used) */
  421. DYMOLA_STATIC RealArray RealTemporaryMatrix(SizeType r,SizeType c) {
  422. RealArray temp;
  423. temp.ndims=2;
  424. temp.dims=SizeTemp(2);
  425. temp.dims[0]=r;temp.dims[1]=c;
  426. temp.data=RealTemp(r*c);
  427. return temp;
  428. }
  429. DYMOLA_STATIC RealArray RealTemporaryVector(SizeType r) {
  430. RealArray temp;
  431. temp.ndims=1;
  432. temp.dims=SizeTemp(1);
  433. temp.dims[0]=r;
  434. temp.data=RealTemp(r);
  435. return temp;
  436. }
  437. /* Assignment */
  438. DYMOLA_STATIC void RealAssign(RealArray a,const RealArray b) {
  439. SizeType prodsize=RealNrElements(a);
  440. SizeType i;
  441. Assert(RealMatchingSizes(a,b),"Array dimensions did not match");
  442. for(i=0;i<prodsize;i++) a.data[i]=b.data[i];
  443. }
  444. /* Indexing to set/get elements */
  445. DYMOLA_STATIC Real RealElement(const RealArray a,...) {
  446. SizeType index;
  447. va_list ap;
  448. va_start(ap,a);
  449. index=FindIndex(a.ndims,a.dims,ap);
  450. va_end(ap);
  451. return a.data[index];
  452. }
  453. /* Sizes */
  454. DYMOLA_STATIC Integer RealSize(const RealArray a,SizeType i) {
  455. Assert((i>=1)&&(i<=a.ndims),"Size must be between 1 and ndims of array");
  456. return a.dims[i-1];
  457. }
  458. DYMOLA_STATIC IntegerArray RealSizes(const RealArray a) {
  459. IntegerArray res;
  460. Integer i;
  461. res.ndims=1;
  462. res.dims=SizeTemp(1);
  463. res.dims[0]=a.ndims;
  464. res.data=IntegerTemp(a.ndims);
  465. for(i=0;i<a.ndims;i++) res.data[i]=a.dims[i];
  466. return res;
  467. }
  468. /* Set element, note that val is prior to the index list. */
  469. DYMOLA_STATIC void SetRealElement(Real val,RealArray a,...) {
  470. SizeType index;
  471. va_list ap;
  472. va_start(ap,a);
  473. index=FindIndex(a.ndims,a.dims,ap);
  474. a.data[index]=val;
  475. va_end(ap);
  476. }
  477. /* For debug write out */
  478. DYMOLA_STATIC void RealWrite(const RealArray a) {
  479. SizeType i;
  480. DymosimMessageInt("Dims: ",a.ndims);
  481. for(i=0;i<a.ndims;i++) DymosimMessageInt(" ",a.dims[i]);
  482. for(i=0;i<RealNrElements(a);i++) DymosimMessageMatrixElement("",i,1,a.data[i]);
  483. }
  484. /* Construct Arrays from other arrays */
  485. DYMOLA_STATIC RealArray RealArrayArray(SizeType narg,RealArray first,...) {
  486. RealArray res;
  487. SizeType i,j,prodsize;
  488. va_list ap;
  489. res.ndims=first.ndims+1;
  490. res.dims=SizeTemp(res.ndims);
  491. res.dims[0]=narg;
  492. for(i=1;i<res.ndims;i++) res.dims[i]=first.dims[i-1];
  493. prodsize=RealNrElements(first);
  494. res.data=RealTemp(prodsize*narg);
  495. va_start(ap,first);
  496. for(i=0;i<narg;i++) {
  497. RealArray next;
  498. next=(i!=0)?va_arg(ap,RealArray):first;
  499. Assert(RealMatchingSizes(first,next),"Arrays in array must be of equal sizes");
  500. for(j=0;j<prodsize;j++)
  501. res.data[i*prodsize+j]=next.data[j];
  502. }
  503. va_end(ap);
  504. return res;
  505. }
  506. /* Construct arrays from scalars */
  507. DYMOLA_STATIC RealArray RealScalarArray(SizeType narg,...) {
  508. RealArray res;
  509. SizeType i;
  510. va_list ap;
  511. res=RealTemporaryVector(narg);
  512. va_start(ap,narg);
  513. for(i=0;i<narg;i++) {
  514. res.data[i]=va_arg(ap,Real);
  515. }
  516. va_end(ap);
  517. return res;
  518. }
  519. /* Get/Put of submatrices, i.e. a[i,:,v,1:4] */
  520. /* Actual get of a submatrix */
  521. DYMOLA_STATIC void RealFromSub(RealArray to,SizeType to_offset,SizeType to_dim,
  522. const RealArray from,SizeType from_offset,SizeType from_dim,
  523. SizeType trailingsize,
  524. struct TaggedIndexStack*ap) {
  525. Integer tag;
  526. if (!ap) return; /* Error */
  527. tag=ap->tag;
  528. switch(tag) {
  529. case Colon:
  530. {
  531. SizeType newdim=from.dims[from_dim];
  532. SizeType i;
  533. for(i=0;i<newdim;i++) RealFromSub(to,to_offset*newdim+i,
  534. to_dim+1,from,from_offset*newdim+i,from_dim+1,
  535. trailingsize,ap+1);
  536. break;
  537. }
  538. case Range:case RangeRange:
  539. {
  540. Integer start,stop,stride=1,i,from_newdim,to_newdim;
  541. start=ap->u.range[0];
  542. if (tag==RangeRange) stride=ap->u.range[1];
  543. stop=ap->u.range[2];
  544. from_newdim=from.dims[from_dim];
  545. to_newdim=to.dims[to_dim];
  546. for(i=0;i<to_newdim;i++)
  547. RealFromSub(to,to_offset*to_newdim+i,to_dim+1,
  548. from,from_offset*from_newdim+(start+stride*i-1),from_dim+1,
  549. trailingsize,ap+1);
  550. break;
  551. }
  552. case Index:
  553. {
  554. Integer i=ap->u.index;
  555. RealFromSub(to,to_offset,to_dim,
  556. from,from_offset*from.dims[from_dim]+i-1,from_dim+1,trailingsize,ap+1);
  557. break;
  558. }
  559. case Vector:
  560. {
  561. IntegerArray v=ap->u.vector;
  562. Integer from_newdim,to_newdim,i;
  563. from_newdim=from.dims[from_dim];
  564. to_newdim=to.dims[to_dim];
  565. for(i=0;i<v.dims[0];i++)
  566. RealFromSub(to,to_offset*to_newdim+i,to_dim+1,
  567. from,from_offset*from_newdim+v.data[i]-1,from_dim+1,
  568. trailingsize,ap+1);
  569. break;
  570. }
  571. case EndMark:
  572. {
  573. SizeType i;
  574. Real *to_p=to.data+to_offset;
  575. Real *from_p=from.data+from_offset;
  576. for(i=0;i<trailingsize;i++,to_p+=1,from_p+=1) *to_p=*from_p;
  577. break;
  578. }
  579. }
  580. }
  581. /* Concatenate along dimensions 'along' (1..ndims) and given nargs arguments */
  582. DYMOLA_STATIC RealArray RealCat(SizeType along,SizeType nargs,RealArray first,...) {
  583. RealArray res;
  584. va_list ap;
  585. SizeType i,j;
  586. res.ndims=first.ndims;
  587. res.dims=SizeTemp(res.ndims);
  588. along--; /* Adapt to C usage */
  589. {
  590. /* Pass 1: determine size of output */
  591. for(j=0;j<first.ndims;j++) res.dims[j]=first.dims[j]; /* Starting values */
  592. va_start(ap,first);
  593. for(i=1;i<nargs;i++) {
  594. RealArray a;
  595. a=va_arg(ap,RealArray);
  596. Assert(a.ndims==first.ndims,"Number of dimensions must match for cat");
  597. #ifndef NDEBUG
  598. for(j=0;j<a.ndims;j++) if (j!=along) {Assert(first.dims[j]==a.dims[j],"Sizes must match for cat");}
  599. #endif
  600. res.dims[along]+=a.dims[along];
  601. }
  602. va_end(ap);
  603. }
  604. res.data=RealTemp(RealNrElements(res));
  605. {
  606. /* Pass 2: copy data */
  607. SizeType presize=1; /* Blocks */
  608. SizeType trailingsize=1; /* Elements in each block */
  609. SizeType marker=0; /* How far are in res along dimension along */
  610. for(i=0;i<along;i++) presize*=res.dims[i];
  611. for(i=along+1;i<res.ndims;i++) trailingsize*=res.dims[i];
  612. va_start(ap,first);
  613. for(i=0;i<nargs;i++) {
  614. SizeType pre,current,trailing;
  615. RealArray a;
  616. if (i!=0) a=va_arg(ap,RealArray); else a=first;
  617. for(pre=0;pre<presize;pre++)
  618. for(current=0;current<a.dims[along];current++)
  619. for(trailing=0;trailing<trailingsize;trailing++)
  620. res.data[(pre*res.dims[along]+(current+marker))*trailingsize+trailing]=
  621. a.data[(pre*a.dims[along]+current)*trailingsize+trailing];
  622. marker+=a.dims[along];
  623. }
  624. va_end(ap);
  625. }
  626. return res;
  627. }
  628. /* The helper in Modelica */
  629. DYMOLA_STATIC RealArray RealPromote(const RealArray a,SizeType n) {
  630. RealArray res;
  631. SizeType i;
  632. Assert(n>=a.ndims,"Promote cannot decrease number of dimensions");
  633. res.ndims=n;
  634. res.data=a.data; /* No need to copy */
  635. res.dims=SizeTemp(n);
  636. for(i=0;i<a.ndims;i++) res.dims[i]=a.dims[i];
  637. for(i=a.ndims;i<n;i++) res.dims[i]=1;
  638. return res;
  639. }
  640. DYMOLA_STATIC RealArray RealPromoteScalar(const Real x,SizeType n) {
  641. RealArray res;
  642. Integer i;
  643. res.ndims=n;
  644. res.data=RealTemp(1);
  645. res.data[0]=x;
  646. res.dims=SizeTemp(n);
  647. for(i=0;i<n;i++) res.dims[i]=1;
  648. return res;
  649. }
  650. /* Actual put of submatrix */
  651. DYMOLA_STATIC void RealToSub(RealArray to,SizeType to_offset,SizeType to_dim,
  652. const RealArray from,SizeType from_offset,SizeType from_dim,
  653. SizeType trailingsize,
  654. struct TaggedIndexStack*ap) {
  655. Integer tag;
  656. if (!ap) return; /* Error */
  657. tag=ap->tag;
  658. switch(tag) {
  659. case Colon:
  660. {
  661. SizeType newdim=from.dims[from_dim];
  662. SizeType i;
  663. for(i=0;i<newdim;i++) RealToSub(to,to_offset*newdim+i,
  664. to_dim+1,from,from_offset*newdim+i,from_dim+1,
  665. trailingsize,ap+1);
  666. break;
  667. }
  668. case Range:case RangeRange:
  669. {
  670. Integer start,stop,stride=1,i,from_newdim,to_newdim;
  671. start=ap->u.range[0];
  672. if (tag==RangeRange) stride=ap->u.range[1];
  673. stop=ap->u.range[2];
  674. from_newdim=from.dims[from_dim];
  675. to_newdim=to.dims[to_dim];
  676. for(i=0;i<from_newdim;i++)
  677. RealToSub(to,to_offset*to_newdim+(start+stride*i-1),to_dim+1,
  678. from,from_offset*from_newdim+i,from_dim+1,
  679. trailingsize,ap+1);
  680. break;
  681. }
  682. case Index:
  683. {
  684. Integer i=ap->u.index;
  685. RealToSub(to,to_offset*to.dims[to_dim]+(i-1),to_dim+1,
  686. from,from_offset,from_dim,trailingsize,ap+1);
  687. break;
  688. }
  689. case Vector:
  690. {
  691. IntegerArray v=ap->u.vector;
  692. Integer from_newdim,to_newdim,i;
  693. from_newdim=from.dims[from_dim];
  694. to_newdim=to.dims[to_dim];
  695. for(i=0;i<v.dims[0];i++)
  696. RealToSub(to,to_offset*to_newdim+(v.data[i]-1),to_dim+1,
  697. from,from_offset*from_newdim+i,from_dim+1,
  698. trailingsize,ap+1);
  699. break;
  700. }
  701. case EndMark:
  702. {
  703. SizeType i;
  704. Real *to_p=to.data+to_offset;
  705. Real *from_p=from.data+from_offset;
  706. for(i=0;i<trailingsize;i++,to_p+=1,from_p+=1) *to_p=*from_p;
  707. break;
  708. }
  709. }
  710. }
  711. /* Use as: RealGetSub(a,Colon,Index,3,Range,3,4,EndMark)=a[:,3,3:4] */
  712. DYMOLA_STATIC RealArray RealGetSub(const RealArray a,...) {
  713. RealArray temp;
  714. va_list ap;
  715. SizeType ndims=a.ndims,trailingsize=1,nargs=0;
  716. /* Pass 1. Determine nr. dimensions of output */
  717. {
  718. Integer over=0;
  719. va_start(ap,a);
  720. for(;!over;) {
  721. enum Subtag tag=va_arg(ap,int);
  722. switch (tag) {
  723. case Colon:nargs++;break;
  724. case RangeRange:va_arg(ap,Integer); /* Fallthru*/
  725. case Range:va_arg(ap,Integer),va_arg(ap,Integer);nargs++;break;
  726. case Vector:va_arg(ap,RealArray);nargs++;break;
  727. case Index:va_arg(ap,Integer);Assert(ndims>0,"Internal error in subscriptring of array");ndims--;nargs++;break;
  728. case EndMark:over=1;break;
  729. }
  730. }
  731. va_end(ap);
  732. Assert(nargs<=a.ndims,"Too many subscripts for array");
  733. }
  734. temp.ndims=ndims;
  735. temp.dims=SizeTemp(ndims);
  736. /* Pass 2. Determine size of output */
  737. {
  738. Integer over=0;
  739. SizeType temp_dim=0,a_dim=0;
  740. va_start(ap,a);
  741. for(;!over;) {
  742. enum Subtag tag=va_arg(ap,int);
  743. switch (tag) {
  744. case Colon:temp.dims[temp_dim]=a.dims[a_dim];temp_dim++;break;
  745. case RangeRange:case Range:
  746. {
  747. Integer start,stop,stride=1,num;
  748. start=va_arg(ap,Integer);
  749. if (tag==RangeRange) stride=va_arg(ap,Integer);
  750. stop=va_arg(ap,Integer);
  751. num=1+(stop-start)/stride;
  752. if (num<=0) num=0;
  753. else {
  754. Assert((start>=1)&&(start<=a.dims[a_dim]),"Range subscripting: start out of range");
  755. Assert((stop >=1)&&(stop <=a.dims[a_dim]),"Range subscripting: end out of range");
  756. }
  757. temp.dims[temp_dim]=num;
  758. temp_dim++;
  759. break;
  760. }
  761. case Vector:
  762. {
  763. IntegerArray v=va_arg(ap,IntegerArray);
  764. SizeType i;
  765. Assert(v.ndims==1,"Array subscripting: only vectors (and scalars) allowed as indicies");
  766. temp.dims[temp_dim]=v.dims[0];
  767. for(i=0;i<v.dims[0];i++) {
  768. Assert((v.data[i]>=1)&&(v.data[i]<=a.dims[a_dim]),"Array subscripting: vector index out of range");
  769. }
  770. temp_dim++;
  771. break;
  772. }
  773. case Index:
  774. {
  775. Integer i=va_arg(ap,Integer);
  776. Assert((i>=1)&&(i<=a.dims[a_dim]),"Array subscripting: scalar index out of range");
  777. break;
  778. }
  779. case EndMark:over=1;break;
  780. }
  781. a_dim++;
  782. }
  783. va_end(ap);
  784. {
  785. SizeType i;
  786. for(i=nargs;i<a.ndims;i++) {
  787. temp.dims[temp_dim++]=a.dims[i];
  788. trailingsize*=a.dims[i];
  789. }
  790. }
  791. }
  792. temp.data=RealTemp(RealNrElements(temp));
  793. /* Pass 3. Copy output */
  794. {
  795. Real *data=temp.data;
  796. struct TaggedIndexStack*apt=0;
  797. struct TaggedIndexStack VA_handler[100];
  798. va_start(ap,a);
  799. apt=HandleVaList(ap, VA_handler, sizeof(VA_handler)/sizeof(*VA_handler));
  800. va_end(ap);
  801. RealFromSub(temp,0,0,a,0,0,trailingsize,apt);
  802. }
  803. return temp;
  804. }
  805. /* Use as RealPutSub(a, out,Index,3,Colon,Range,3,4) yields out[3,:,3:4]=a; */
  806. DYMOLA_STATIC RealArray RealCopy(const RealArray a) {
  807. int i,imax;
  808. RealArray temp;
  809. temp.ndims=a.ndims;
  810. temp.dims=SizeTemp(a.ndims);
  811. for(i=0;i<a.ndims;++i) temp.dims[i]=a.dims[i];
  812. imax=RealNrElements(a);
  813. temp.data=RealTemp(imax);
  814. for(i=0;i<imax;++i) temp.data[i]=a.data[i];
  815. return temp;
  816. }
  817. DYMOLA_STATIC void RealPutSub(const RealArray ain,RealArray out,...) {
  818. RealArray a;
  819. va_list ap;
  820. SizeType out_dim=0,a_dim=0,trailingsize=1,nargs=0;
  821. a=RealCopy(ain);
  822. /* Pass 1. Determine nr. dimensions of output */
  823. {
  824. Integer over=0;
  825. va_start(ap,out);
  826. for(;!over;) {
  827. enum Subtag tag=va_arg(ap,int);
  828. switch (tag) {
  829. case Colon:
  830. Assert(out_dim<out.ndims,"Internal error in subscripting (:)");
  831. Assert(a_dim<a.ndims,"Internal error in subscripting (:)");
  832. Assert(out.dims[out_dim]==a.dims[a_dim],"Assignment array subscripting: A[:]=B must have identical sizes");
  833. out_dim++;
  834. a_dim++;
  835. break;
  836. case RangeRange:case Range:
  837. {
  838. Integer start,stop,stride=1,num;
  839. Assert(out_dim<out.ndims,"Internal error in subscripting: range");
  840. Assert(a_dim<a.ndims,"Internal error in subscripting: range ");
  841. start=va_arg(ap,Integer);
  842. if (tag==RangeRange) stride=va_arg(ap,Integer);
  843. stop=va_arg(ap,Integer);
  844. num=(stop-start+stride)/stride;
  845. if (num<=0) num=0;
  846. else {
  847. Assert((start>=1)&&(start<=out.dims[out_dim]),"Assignment array subscripting: start of range out of bounds");
  848. Assert((stop>=1)&&(stop<=out.dims[out_dim]),"Assignment array subscripting: end of range out of bounds");
  849. }
  850. Assert(a.dims[a_dim]==num,"Assignment array subscripting: A[a:b]=B must have identical sizes");
  851. out_dim++;
  852. a_dim++;
  853. break;
  854. }
  855. case Vector:
  856. {
  857. IntegerArray v=va_arg(ap,IntegerArray);
  858. SizeType i;
  859. Assert(out_dim<out.ndims,"Internal error in vector subscripting");
  860. Assert(a_dim<a.ndims,"Internal error in vector subscripting");
  861. Assert(v.ndims==1,"Assignment array subscripting: array index must be a vector");
  862. Assert(a.dims[a_dim]==v.dims[0],"Assignment array subscripting: A[vect]=B must have identical sizes");
  863. for(i=0;i<v.dims[0];i++) {
  864. Assert((v.data[i]>=1)&&(v.data[i]<=out.dims[out_dim]),"Assignment array subscripting: vector index out of bounds");
  865. }
  866. out_dim++;
  867. a_dim++;
  868. break;
  869. }
  870. case Index:
  871. {
  872. Integer i=va_arg(ap,Integer);
  873. Assert(out_dim<out.ndims,"Internal error in scalar subscripting");
  874. Assert((i>=1)&&(i<=out.dims[out_dim]),"Assignment array subscripting: scalar index out of bounds");
  875. out_dim++;
  876. break;
  877. }
  878. case EndMark:over=1;break;
  879. }
  880. }
  881. va_end(ap);
  882. Assert(a.ndims-a_dim==out.ndims-out_dim,"Assignment array subscripting: unequal number of dimensions");
  883. {
  884. SizeType i;
  885. for(i=a_dim;i<a.ndims;i++) {
  886. trailingsize*=a.dims[i];
  887. Assert(a.dims[i]==out.dims[(i-a_dim)+out_dim],"Internal error in subscripting");
  888. }
  889. }
  890. }
  891. /* Pass 2. Copy output */
  892. {
  893. struct TaggedIndexStack*apt=0;
  894. struct TaggedIndexStack VA_handler[100];
  895. va_start(ap,out);
  896. apt=HandleVaList(ap, VA_handler, sizeof(VA_handler)/sizeof(*VA_handler));
  897. va_end(ap);
  898. RealToSub(out,0,0,a,0,0,trailingsize,apt);
  899. }
  900. }
  901. /* For each operation Op(...) we create a temporary result res */
  902. /* and call OpAssign(res,...) */
  903. /* The operations Op(...) are convenient and used in the code */
  904. /* Fill */
  905. DYMOLA_STATIC RealArray RealFillAssign(RealArray res,const Real t) {
  906. SizeType i,prodsize;
  907. prodsize=RealNrElements(res);
  908. for(i=0;i<prodsize;i++) res.data[i]=t;
  909. return res;
  910. }
  911. DYMOLA_STATIC RealArray RealFill(const Real t,SizeType ndims,...) {
  912. va_list ap;
  913. RealArray temp;
  914. va_start(ap,ndims);
  915. temp=RealFillAssign(RealVaTemporary(ndims,ap),t);
  916. va_end(ap);
  917. return temp;
  918. }
  919. DYMOLA_STATIC RealArray RealFillArray(const RealArray a,SizeType ndims,...) {
  920. va_list ap;
  921. int i,j,inputProd,fillProd;
  922. RealArray temp;
  923. temp.ndims=a.ndims+ndims;
  924. temp.dims=SizeTemp(temp.ndims);
  925. va_start(ap,ndims);
  926. for(i=0;i<ndims;++i) temp.dims[i]=va_arg(ap,SizeType);
  927. va_end(ap);
  928. for(i=0;i<a.ndims;++i) temp.dims[i+ndims]=a.dims[i];
  929. fillProd=1;
  930. for(i=0;i<ndims;++i) fillProd*=temp.dims[i];
  931. inputProd=RealNrElements(a);
  932. temp.data=RealTemp(inputProd*fillProd);
  933. for(i=0;i<inputProd;++i) {
  934. for(j=0;j<fillProd;j++) {
  935. temp.data[i+j*inputProd]=a.data[i];
  936. }
  937. }
  938. return temp;
  939. }
  940. DYMOLA_STATIC Real Realscalar(const RealArray a) {
  941. Assert(RealNrElements(a)==1,"scalar requires exactly one element");
  942. return a.data[0];
  943. }
  944. /* Matrix operations not limited to numeric matrices */
  945. DYMOLA_STATIC RealArray Realvector(const RealArray a) {
  946. RealArray res;
  947. #ifndef NDEBUG
  948. Integer i,found_non_one=0;
  949. for(i=0;i<a.ndims;i++) {if (a.dims[i]>1) {Assert(!found_non_one,"vector requires exactly one vector non-unit dimension");found_non_one=1;}}
  950. #endif
  951. res.ndims=1;
  952. res.dims=SizeTemp(1);
  953. res.dims[0]=RealNrElements(a);
  954. res.data=a.data;
  955. return res;
  956. }
  957. DYMOLA_STATIC RealArray Realmatrix(const RealArray a) {
  958. RealArray res;
  959. res.ndims=2;
  960. res.dims=SizeTemp(2);
  961. res.dims[0]=a.dims[0];
  962. res.dims[1]=(a.ndims<2)?1:a.dims[1];
  963. res.data=a.data;
  964. Assert(RealNrElements(a)==RealNrElements(res),"matrix requires size(x,i)=1 for i>2");
  965. return res;
  966. }
  967. DYMOLA_STATIC RealArray Realtranspose(const RealArray a) {
  968. RealArray res;
  969. Integer i,j,k,remsize,leadingsize;
  970. res.ndims=a.ndims;
  971. Assert(a.ndims>=2,"transpose requires ndims>=2");
  972. res.dims=SizeTemp(a.ndims);
  973. res.dims[0]=a.dims[1];
  974. res.dims[1]=a.dims[0];
  975. remsize=1;
  976. leadingsize=res.dims[0]*res.dims[1];
  977. for(i=2;i<a.ndims;i++) {
  978. remsize*=(res.dims[i]=a.dims[i]);
  979. }
  980. res.data=RealTemp(RealNrElements(res));
  981. for(i=0;i<res.dims[0];i++) for(j=0;j<res.dims[1];j++) {
  982. for(k=0;k<remsize;k++) {
  983. res.data[(i*res.dims[1]+j)*remsize+k]=a.data[(j*a.dims[1]+i)*remsize+k];
  984. }
  985. }
  986. return res;
  987. }
  988. DYMOLA_STATIC RealArray Realouterproduct(const RealArray a,const RealArray b) {
  989. Assert(a.ndims==1,"Outerproduct require a vector as first argument");
  990. Assert(b.ndims==1,"Outerproduct require a vector as second argument");
  991. {
  992. SizeType na=a.dims[0],nb=b.dims[0];
  993. SizeType i,j;
  994. RealArray res=RealTemporaryMatrix(na,nb);
  995. for(i=0;i<na;i++) {
  996. Real ai=a.data[i];
  997. for(j=0;j<nb;j++)
  998. res.data[i*nb+j]=ai*b.data[j];
  999. }
  1000. return res;
  1001. }
  1002. }
  1003. DYMOLA_STATIC RealArray Realsymmetric(const RealArray a) {
  1004. RealArray res;
  1005. Integer i,j,n=a.dims[0];
  1006. Assert(a.ndims==2,"symmetric requires ndims==2");
  1007. Assert(a.dims[0]==a.dims[1],"symmetric requires square matrix");
  1008. res=RealTemporaryMatrix(n,n);
  1009. for(i=0;i<n;i++) {
  1010. for(j=0;j<=i;j++)
  1011. res.data[i*n+j]=a.data[j*n+i];
  1012. for(;j<n;j++) res.data[i*n+j]=a.data[i*n+j];
  1013. }
  1014. return res;
  1015. }
  1016. /* End of common routines for String*/
  1017. /* Basic operations, add, subtract, scale*/
  1018. /* For each operation Op(...) we create a temporary result res */
  1019. /* and call OpAssign(res,...) */
  1020. /* The operations Op(...) are convenient and used in the code */
  1021. DYMOLA_STATIC RealArray RealAddAssign(RealArray res,const RealArray a,const RealArray b) {
  1022. SizeType prodsize,i;
  1023. Assert(RealMatchingSizes(a,b),"Add of arrays require arguments of matching size");
  1024. Assert(RealMatchingSizes(res,a),"Add of arrays require result of matching size");
  1025. prodsize=RealNrElements(a);
  1026. for(i=0;i<prodsize;i++) res.data[i]=a.data[i]+b.data[i];
  1027. return res;
  1028. }
  1029. DYMOLA_STATIC RealArray RealAdd(const RealArray a,const RealArray b) {
  1030. return RealAddAssign(RealMatch(a),a,b);
  1031. }
  1032. DYMOLA_STATIC RealArray RealSubtractAssign(RealArray res,const RealArray a,const RealArray b) {
  1033. SizeType prodsize,i;
  1034. Assert(RealMatchingSizes(a,b),"Subtract of arrays require arguments of matching size");
  1035. Assert(RealMatchingSizes(res,a),"Subtract of arrays require result of matching size");
  1036. prodsize=RealNrElements(a);
  1037. for(i=0;i<prodsize;i++) res.data[i]=a.data[i]-b.data[i];
  1038. return res;
  1039. }
  1040. DYMOLA_STATIC RealArray RealSubtract(const RealArray a,const RealArray b) {
  1041. return RealSubtractAssign(RealMatch(a),a,b);
  1042. }
  1043. DYMOLA_STATIC RealArray RealScaleAssign(RealArray res,const RealArray a,const Real t) {
  1044. SizeType i,prodsize;
  1045. Assert(RealMatchingSizes(res,a),"Array times scalar require result of matching size");
  1046. prodsize=RealNrElements(a);
  1047. for(i=0;i<prodsize;i++) res.data[i]=t*a.data[i];
  1048. return res;
  1049. }
  1050. DYMOLA_STATIC RealArray RealScale(const RealArray a,const Real t) {
  1051. return RealScaleAssign(RealMatch(a),a,t);
  1052. }
  1053. DYMOLA_STATIC RealArray RealMinusAssign(RealArray res,const RealArray a) {
  1054. SizeType i,prodsize;
  1055. Assert(RealMatchingSizes(res,a),"Negating a matrix require result of matching size");
  1056. prodsize=RealNrElements(a);
  1057. for(i=0;i<prodsize;i++) res.data[i]=-a.data[i];
  1058. return res;
  1059. }
  1060. DYMOLA_STATIC RealArray RealMinus(const RealArray a) {
  1061. return RealMinusAssign(RealMatch(a),a);
  1062. }
  1063. /* sum, max, min, and product */
  1064. DYMOLA_STATIC Real Realsum(const RealArray a) {
  1065. Real res=0;
  1066. Integer max_elem=RealNrElements(a);
  1067. Integer i;
  1068. for(i=0;i<max_elem;i++) res+=a.data[i];
  1069. return res;
  1070. }
  1071. DYMOLA_STATIC Real RealAbssum(const RealArray a) {
  1072. Real res=0;
  1073. Integer max_elem=RealNrElements(a);
  1074. Integer i;
  1075. for(i=0;i<max_elem;i++) {
  1076. Real x=a.data[i];
  1077. if (x>0) res+=x; else res-=x;
  1078. }
  1079. return res;
  1080. }
  1081. DYMOLA_STATIC Real RealAbssumDiff(const RealArray a,const RealArray b) {
  1082. Real res=0;
  1083. Integer max_elem=RealNrElements(a);
  1084. Integer i;
  1085. Assert(max_elem==RealNrElements(b),"Diff");
  1086. for(i=0;i<max_elem;i++) {
  1087. Real xa=a.data[i];
  1088. Real xb=b.data[i];
  1089. Real scale=1+((xa>0)?xa:-xa);
  1090. Real x=(xa-xb)/scale;
  1091. if (x>0) res+=x; else res-=x;
  1092. }
  1093. return res;
  1094. }
  1095. DYMOLA_STATIC Real Realmax(const RealArray a) {
  1096. Real res=-DBL_MAX;
  1097. Integer max_elem=RealNrElements(a);
  1098. Integer i;
  1099. for(i=0;i<max_elem;i++) if (a.data[i]>res) res=a.data[i];
  1100. return res;
  1101. }
  1102. DYMOLA_STATIC Real Realmin(const RealArray a) {
  1103. Real res=DBL_MAX;
  1104. Integer max_elem=RealNrElements(a);
  1105. Integer i;
  1106. for(i=0;i<max_elem;i++) if (a.data[i]<res) res=a.data[i];
  1107. return res;
  1108. }
  1109. DYMOLA_STATIC Real Realproduct(const RealArray a) {
  1110. Real res=1;
  1111. Integer max_elem=RealNrElements(a);
  1112. Integer i;
  1113. for(i=0;i<max_elem;i++) res*=a.data[i];
  1114. return res;
  1115. }
  1116. DYMOLA_STATIC RealArray Realdiagonal(const RealArray a) {
  1117. RealArray res;
  1118. Integer i,j,n;
  1119. Assert(a.ndims==1,"diagonal requires vector input");
  1120. n=a.dims[0];
  1121. res=RealTemporaryMatrix(n,n);
  1122. for(i=0;i<n;i++) for(j=0;j<n;j++) res.data[i*n+j]=(i==j)?a.data[i]:0;
  1123. return res;
  1124. }
  1125. DYMOLA_STATIC RealArray Realcross(const RealArray x,const RealArray y) {
  1126. RealArray res=RealTemporaryVector(3);
  1127. Assert((x.ndims==1)&&(y.ndims==1),"cross requires vector input");
  1128. Assert(x.dims[0]==3,"cross requires 3-vector input for first argument");
  1129. Assert(y.dims[0]==3,"cross requires 3-vector input for second argument");
  1130. res.data[0]=x.data[1]*y.data[2]-x.data[2]*y.data[1];
  1131. res.data[1]=x.data[2]*y.data[0]-x.data[0]*y.data[2];
  1132. res.data[2]=x.data[0]*y.data[1]-x.data[1]*y.data[0];
  1133. return res;
  1134. }
  1135. DYMOLA_STATIC RealArray Realskew(const RealArray x) {
  1136. RealArray res=RealTemporaryMatrix(3,3);
  1137. Assert(x.ndims==1,"skew requires vector input");
  1138. Assert(x.dims[0]==3,"skew requires 3-vector input");
  1139. SetRealElement(0,res,1,1);
  1140. SetRealElement(-RealElement(x,3),res,1,2);
  1141. SetRealElement(RealElement(x,2),res,1,3);
  1142. SetRealElement(RealElement(x,3),res,2,1);
  1143. SetRealElement(0,res,2,2);
  1144. SetRealElement(-RealElement(x,1),res,2,3);
  1145. SetRealElement(-RealElement(x,2),res,3,1);
  1146. SetRealElement(RealElement(x,1),res,3,2);
  1147. SetRealElement(0,res,3,3);
  1148. return res;
  1149. }
  1150. /* Multiply */
  1151. DYMOLA_STATIC RealArray RealMultiplyMMAssign(RealArray res,
  1152. const RealArray a,const RealArray b) {
  1153. SizeType i,j,k,imax,jmax,kmax;
  1154. Assert(res.ndims==2,"Matrix multiply gives a matrix as result");
  1155. Assert(a.ndims==2,"Matrix multiply requires that first operand is a matrix");
  1156. Assert(b.ndims==2,"Matrix multiply requires that second operand is a matrix");
  1157. Assert(res.dims[0]==a.dims[0],"Matrix multiply requires that first dimension of result and first argument match");
  1158. Assert(res.dims[1]==b.dims[1],"Matrix multiply requires that second dimension of result and second argument match");
  1159. Assert(a.dims[1]==b.dims[0],"Matrix multiply requires that inner dimensions of operands match");
  1160. imax=res.dims[0];
  1161. jmax=res.dims[1];
  1162. kmax=a.dims[1];
  1163. for(i=0;i<imax;i++) for(j=0;j<jmax;j++) {
  1164. Real d=0;
  1165. for(k=0;k<kmax;k++) d+=a.data[i*kmax+k]*b.data[k*jmax+j];
  1166. res.data[i*jmax+j]=d;
  1167. }
  1168. return res;
  1169. }
  1170. DYMOLA_STATIC RealArray RealMultiplyMVAssign(RealArray res,const RealArray a,const RealArray b) {
  1171. SizeType i,j,imax,jmax;
  1172. Assert(a.ndims==2,"Matrix times vector requires a matrix as first operand");
  1173. Assert(b.ndims==1,"Matrix times vector requires a vector as second operand");
  1174. Assert(res.ndims==1,"Matrix times vector gives a vector result");
  1175. Assert(res.dims[0]==a.dims[0],"Matrix times vector: requires size(M*v,1)=size(M,1)");
  1176. Assert(a.dims[1]==b.dims[0],"Matrix times vector: requires size(M,2)==size(v,1)");
  1177. imax=a.dims[0];
  1178. jmax=a.dims[1];
  1179. for(i=0;i<imax;i++) {
  1180. Real d=0;
  1181. for(j=0;j<jmax;j++) d+=a.data[i*jmax+j]*b.data[j];
  1182. res.data[i]=d;
  1183. }
  1184. return res;
  1185. }
  1186. DYMOLA_STATIC RealArray RealMultiplyVMAssign(RealArray res,const RealArray a,const RealArray b) {
  1187. SizeType i,j,imax,jmax;
  1188. Assert(a.ndims==1,"Vector times matrix requires a vector as first operand");
  1189. Assert(b.ndims==2,"Vector times matrix requires a matrix as second operand");
  1190. Assert(res.ndims==1,"Vector times matrix gives a vector result");
  1191. Assert(res.dims[0]==b.dims[1],"Vector times matrix: requires size(v*M,1)=size(M,2)");
  1192. Assert(a.dims[0]==b.dims[0],"Vector times matrix: requires size(v,1)=size(M,1)");
  1193. imax=b.dims[1];
  1194. jmax=b.dims[0];
  1195. for(i=0;i<imax;i++) {
  1196. Real d=0;
  1197. for(j=0;j<jmax;j++) d+=a.data[j]*b.data[j*imax+i];
  1198. res.data[i]=d;
  1199. }
  1200. return res;
  1201. }
  1202. DYMOLA_STATIC Real RealMultiplyVV(const RealArray a,const RealArray b) {
  1203. SizeType i,imax;
  1204. Real d=0;
  1205. Assert(a.ndims==1,"Scalar product requires vector as first operand");
  1206. Assert(b.ndims==1,"Scalar product requires vector as second operand");
  1207. Assert(a.dims[0]==b.dims[0],"Scalar product requires vectors of matching size");
  1208. imax=a.dims[0];
  1209. for(i=0;i<imax;i++) d+=a.data[i]*b.data[i];
  1210. return d;
  1211. }
  1212. DYMOLA_STATIC RealArray RealMultiplyMM(const RealArray a,const RealArray b) {
  1213. return RealMultiplyMMAssign(RealTemporaryMatrix(a.dims[0],b.dims[1]),a,b);
  1214. }
  1215. DYMOLA_STATIC RealArray RealMultiplyMV(const RealArray a,const RealArray b) {
  1216. return RealMultiplyMVAssign(RealTemporaryVector(a.dims[0]),a,b);
  1217. }
  1218. DYMOLA_STATIC RealArray RealMultiplyVM(const RealArray a,const RealArray b) {
  1219. return RealMultiplyVMAssign(RealTemporaryVector(b.dims[1]),a,b);
  1220. }
  1221. DYMOLA_STATIC RealArray RealIdentity(SizeType n) {
  1222. RealArray res;
  1223. Integer i,j;
  1224. res.ndims=2;
  1225. res.dims=SizeTemp(2);
  1226. res.dims[0]=res.dims[1]=n;
  1227. res.data=RealTemp(n*n);
  1228. for(i=0;i<n;i++) for(j=0;j<n;j++) res.data[i*n+j]=(i==j);
  1229. return res;
  1230. }
  1231. DYMOLA_STATIC RealArray RealPow(const RealArray a,const Integer n) {
  1232. Assert(n>=0,"Matrices can only be raised to positive integer");
  1233. Assert(a.ndims==2,"Matrix raised to a positive integer requires a matrix as first operand");
  1234. Assert(a.dims[0]==a.dims[1],"Matrix raised to a positive integer requires a square matrix as first operand");
  1235. if (n==1) return a;
  1236. else if (n==0) return RealIdentity(a.dims[0]);
  1237. else {
  1238. if (n%2) {
  1239. return RealMultiplyMM(RealPow(a,n-1),a);
  1240. } else {
  1241. RealArray ahalf=RealPow(a,n/2);
  1242. return RealMultiplyMM(ahalf,ahalf);
  1243. }
  1244. }
  1245. }
  1246. /* For from:stride:to */
  1247. DYMOLA_STATIC RealArray RealRange(const Real from,const Real to,const Real stride) {
  1248. Real extraStride=stride;
  1249. Real diff=to-from;
  1250. Real extra=0;
  1251. Integer num;
  1252. Assert(stride!=0,"range requires non-zero stride");
  1253. if (stride<0) {
  1254. diff=-diff;
  1255. extraStride=-extraStride;
  1256. }
  1257. if (extraStride!=floor(extraStride)) {
  1258. extra+=fabs(diff);
  1259. }
  1260. if (diff!=floor(diff)) {
  1261. extra+=fabs(from)+fabs(to);
  1262. }
  1263. num=1+(Integer)floor((diff+extra*1.11022302462516E-016)/extraStride);
  1264. if (num<0) num=0;
  1265. {
  1266. RealArray res=RealTemporaryVector(num);
  1267. Integer i;
  1268. for(i=0;i<num;i++) SetRealElement(from+i*stride,res,i+1);
  1269. return res;
  1270. }
  1271. }
  1272. /* End of common routines with Integer */
  1273. /* Unique routines */
  1274. DYMOLA_STATIC RealArray linspace(const Real from,const Real to,const Integer n) {
  1275. RealArray res=RealTemporaryVector(n);
  1276. Integer i;
  1277. Real delta=(to-from)/(n-1);
  1278. Assert(n>=2,"Linspace number of point>=2");
  1279. for(i=0;i<n-1;i++) res.data[i]=from+delta*i;
  1280. res.data[n-1]=to; /* Guard against roundoff errors.*/
  1281. return res;
  1282. }
  1283. /* Go from IntegerArray to RealArray */
  1284. DYMOLA_STATIC RealArray RealConvertInteger(const IntegerArray a) {
  1285. RealArray res;
  1286. SizeType i,n;
  1287. res.ndims=a.ndims;
  1288. res.dims=a.dims;
  1289. n=RealNrElements(res);
  1290. res.data=RealTemp(n);
  1291. for(i=0;i<n;i++) res.data[i]=a.data[i];
  1292. return res;
  1293. }
  1294. DYMOLA_STATIC IntegerArray IntegerConvertReal(const RealArray a) {
  1295. IntegerArray res;
  1296. SizeType i,n;
  1297. res.ndims=a.ndims;
  1298. res.dims=a.dims;
  1299. n=IntegerNrElements(res);
  1300. res.data=IntegerTemp(n);
  1301. for(i=0;i<n;i++) res.data[i]=real2integer(a.data[i]);
  1302. return res;
  1303. }
  1304. /* Routines for moutil.h */
  1305. #if 0 && !defined(LINALG_PACK)
  1306. #error
  1307. #endif
  1308. DYMOLA_STATIC RealArray RealInverse(const RealArray A) {
  1309. Assert(A.ndims==2,"Can only invert matrices");
  1310. Assert(A.dims[0]==A.dims[1],"Can only invert square matrices");
  1311. {
  1312. RealArray Ainv=RealMatch(A);
  1313. MarkObject returnMark=PushMark();
  1314. Real*RWork=RealTemp(A.dims[0]*A.dims[0]+4+6*A.dims[0]);
  1315. Integer*IWork=IntegerTemp(A.dims[0]*2+1);
  1316. SizeType i1,i2,i3,i4,i,j,Ev=0;
  1317. SizeType Factored=0,IError=0;
  1318. i1 = A.dims[0];
  1319. i2 = A.dims[1];
  1320. i3 = 0;
  1321. i4 = 3;
  1322. for(i=0;i<A.dims[0];++i) {
  1323. double T=0;
  1324. double*b=Ainv.data+i*A.dims[0];
  1325. for(j=0;j<A.dims[0];++j) b[j]=0;
  1326. b[i]=1;
  1327. dymli2_(&i3,&i4,A.data,&i1,&i2,b,
  1328. &T,&Ev,&Ev,RWork,IWork,&Factored,&IError);
  1329. if (IError!=0 && A.dims[0]==1) {
  1330. Ainv.data[0]=0;
  1331. IError=0;
  1332. }
  1333. Assert(IError==0,"Inverse failed");
  1334. }
  1335. PopMark(returnMark);
  1336. return Ainv;
  1337. }
  1338. }
  1339. DYMOLA_STATIC RealArray RealScaleDiv(const RealArray a,const Real t) {
  1340. Assert(t!=0,"Division by zero in function RealScaleDiv");
  1341. return RealScaleAssign(RealMatch(a),a,1/t);
  1342. }
  1343. /* Routines for Integer */
  1344. /* Test for size compatibility, used in assertions */
  1345. DYMOLA_STATIC Integer IntegerMatchingSizes(const IntegerArray a,const IntegerArray b) {
  1346. SizeType i;
  1347. if (a.ndims!=b.ndims) return 0;
  1348. for(i=0;i<a.ndims;i++) {if(a.dims[i]!=b.dims[i]) return 0;}
  1349. return 1;
  1350. }
  1351. /* Return total number of elements */
  1352. DYMOLA_STATIC SizeType IntegerNrElements(const IntegerArray a) {
  1353. SizeType prodsize=1;
  1354. SizeType i;
  1355. for(i=0;i<a.ndims;i++) prodsize*=a.dims[i];
  1356. return prodsize;
  1357. }
  1358. /* Create Array-temporaries given the dimensions */
  1359. /* Internal: Use an existing va_list */
  1360. DYMOLA_STATIC IntegerArray IntegerVaTemporarySize(SizeType ndims,va_list ap) {
  1361. IntegerArray temp;
  1362. SizeType i;
  1363. temp.ndims=ndims;
  1364. temp.dims=SizeTemp(ndims);
  1365. for(i=0;i<ndims;i++) temp.dims[i]=va_arg(ap,SizeType);
  1366. return temp;
  1367. }
  1368. DYMOLA_STATIC IntegerArray IntegerVaTemporary(SizeType ndims,va_list ap) {
  1369. IntegerArray temp=IntegerVaTemporarySize(ndims,ap);
  1370. temp.data=IntegerTemp(IntegerNrElements(temp));
  1371. return temp;
  1372. }
  1373. /* Construct a temporary of the same size as a */
  1374. DYMOLA_STATIC IntegerArray IntegerMatch(const IntegerArray a) {
  1375. IntegerArray temp;
  1376. SizeType i;
  1377. temp.ndims=a.ndims;
  1378. temp.dims=SizeTemp(a.ndims);
  1379. for(i=0;i<a.ndims;i++) temp.dims[i]=a.dims[i];
  1380. temp.data=IntegerTemp(IntegerNrElements(a));
  1381. return temp;
  1382. }
  1383. /* Construct array from sizes, using variable number of arguments */
  1384. DYMOLA_STATIC IntegerArray IntegerTemporary(SizeType ndims,...) {
  1385. IntegerArray temp;
  1386. va_list ap;
  1387. va_start(ap,ndims);
  1388. temp=IntegerVaTemporary(ndims,ap);
  1389. va_end(ap);
  1390. return temp;
  1391. }
  1392. /* Special cases for vectors and matrices (most often used) */
  1393. DYMOLA_STATIC IntegerArray IntegerTemporaryMatrix(SizeType r,SizeType c) {
  1394. IntegerArray temp;
  1395. temp.ndims=2;
  1396. temp.dims=SizeTemp(2);
  1397. temp.dims[0]=r;temp.dims[1]=c;
  1398. temp.data=IntegerTemp(r*c);
  1399. return temp;
  1400. }
  1401. DYMOLA_STATIC IntegerArray IntegerTemporaryVector(SizeType r) {
  1402. IntegerArray temp;
  1403. temp.ndims=1;
  1404. temp.dims=SizeTemp(1);
  1405. temp.dims[0]=r;
  1406. temp.data=IntegerTemp(r);
  1407. return temp;
  1408. }
  1409. /* Assignment */
  1410. DYMOLA_STATIC void IntegerAssign(IntegerArray a,const IntegerArray b) {
  1411. SizeType prodsize=IntegerNrElements(a);
  1412. SizeType i;
  1413. Assert(IntegerMatchingSizes(a,b),"Array dimensions did not match");
  1414. for(i=0;i<prodsize;i++) a.data[i]=b.data[i];
  1415. }
  1416. /* Indexing to set/get elements */
  1417. DYMOLA_STATIC Integer IntegerElement(const IntegerArray a,...) {
  1418. SizeType index;
  1419. va_list ap;
  1420. va_start(ap,a);
  1421. index=FindIndex(a.ndims,a.dims,ap);
  1422. va_end(ap);
  1423. return a.data[index];
  1424. }
  1425. /* Sizes */
  1426. DYMOLA_STATIC Integer IntegerSize(const IntegerArray a,SizeType i) {
  1427. Assert((i>=1)&&(i<=a.ndims),"Size must be between 1 and ndims of array");
  1428. return a.dims[i-1];
  1429. }
  1430. DYMOLA_STATIC IntegerArray IntegerSizes(const IntegerArray a) {
  1431. IntegerArray res;
  1432. Integer i;
  1433. res.ndims=1;
  1434. res.dims=SizeTemp(1);
  1435. res.dims[0]=a.ndims;
  1436. res.data=IntegerTemp(a.ndims);
  1437. for(i=0;i<a.ndims;i++) res.data[i]=a.dims[i];
  1438. return res;
  1439. }
  1440. /* Set element, note that val is prior to the index list. */
  1441. DYMOLA_STATIC void SetIntegerElement(Integer val,IntegerArray a,...) {
  1442. SizeType index;
  1443. va_list ap;
  1444. va_start(ap,a);
  1445. index=FindIndex(a.ndims,a.dims,ap);
  1446. a.data[index]=val;
  1447. va_end(ap);
  1448. }
  1449. /* For debug write out */
  1450. DYMOLA_STATIC void IntegerWrite(const IntegerArray a) {
  1451. SizeType i;
  1452. DymosimMessageInt("Dims: ",a.ndims);
  1453. for(i=0;i<a.ndims;i++) DymosimMessageInt(" ",a.dims[i]);
  1454. for(i=0;i<IntegerNrElements(a);i++) DymosimMessageMatrixElement("",i,1,a.data[i]);
  1455. }
  1456. /* Construct Arrays from other arrays */
  1457. DYMOLA_STATIC IntegerArray IntegerArrayArray(SizeType narg,IntegerArray first,...) {
  1458. IntegerArray res;
  1459. SizeType i,j,prodsize;
  1460. va_list ap;
  1461. res.ndims=first.ndims+1;
  1462. res.dims=SizeTemp(res.ndims);
  1463. res.dims[0]=narg;
  1464. for(i=1;i<res.ndims;i++) res.dims[i]=first.dims[i-1];
  1465. prodsize=IntegerNrElements(first);
  1466. res.data=IntegerTemp(prodsize*narg);
  1467. va_start(ap,first);
  1468. for(i=0;i<narg;i++) {
  1469. IntegerArray next;
  1470. next=(i!=0)?va_arg(ap,IntegerArray):first;
  1471. Assert(IntegerMatchingSizes(first,next),"Arrays in array must be of equal sizes");
  1472. for(j=0;j<prodsize;j++)
  1473. res.data[i*prodsize+j]=next.data[j];
  1474. }
  1475. va_end(ap);
  1476. return res;
  1477. }
  1478. /* Construct arrays from scalars */
  1479. DYMOLA_STATIC IntegerArray IntegerScalarArray(SizeType narg,...) {
  1480. IntegerArray res;
  1481. SizeType i;
  1482. va_list ap;
  1483. res=IntegerTemporaryVector(narg);
  1484. va_start(ap,narg);
  1485. for(i=0;i<narg;i++) {
  1486. res.data[i]=va_arg(ap,Integer);
  1487. }
  1488. va_end(ap);
  1489. return res;
  1490. }
  1491. /* Get/Put of submatrices, i.e. a[i,:,v,1:4] */
  1492. /* Actual get of a submatrix */
  1493. DYMOLA_STATIC void IntegerFromSub(IntegerArray to,SizeType to_offset,SizeType to_dim,
  1494. const IntegerArray from,SizeType from_offset,SizeType from_dim,
  1495. SizeType trailingsize,
  1496. struct TaggedIndexStack*ap) {
  1497. Integer tag;
  1498. if (!ap) return; /* Error */
  1499. tag=ap->tag;
  1500. switch(tag) {
  1501. case Colon:
  1502. {
  1503. SizeType newdim=from.dims[from_dim];
  1504. SizeType i;
  1505. for(i=0;i<newdim;i++) IntegerFromSub(to,to_offset*newdim+i,
  1506. to_dim+1,from,from_offset*newdim+i,from_dim+1,
  1507. trailingsize,ap+1);
  1508. break;
  1509. }
  1510. case Range:case RangeRange:
  1511. {
  1512. Integer start,stop,stride=1,i,from_newdim,to_newdim;
  1513. start=ap->u.range[0];
  1514. if (tag==RangeRange) stride=ap->u.range[1];
  1515. stop=ap->u.range[2];
  1516. from_newdim=from.dims[from_dim];
  1517. to_newdim=to.dims[to_dim];
  1518. for(i=0;i<to_newdim;i++)
  1519. IntegerFromSub(to,to_offset*to_newdim+i,to_dim+1,
  1520. from,from_offset*from_newdim+(start+stride*i-1),from_dim+1,
  1521. trailingsize,ap+1);
  1522. break;
  1523. }
  1524. case Index:
  1525. {
  1526. Integer i=ap->u.index;
  1527. IntegerFromSub(to,to_offset,to_dim,
  1528. from,from_offset*from.dims[from_dim]+i-1,from_dim+1,trailingsize,ap+1);
  1529. break;
  1530. }
  1531. case Vector:
  1532. {
  1533. IntegerArray v=ap->u.vector;
  1534. Integer from_newdim,to_newdim,i;
  1535. from_newdim=from.dims[from_dim];
  1536. to_newdim=to.dims[to_dim];
  1537. for(i=0;i<v.dims[0];i++)
  1538. IntegerFromSub(to,to_offset*to_newdim+i,to_dim+1,
  1539. from,from_offset*from_newdim+v.data[i]-1,from_dim+1,
  1540. trailingsize,ap+1);
  1541. break;
  1542. }
  1543. case EndMark:
  1544. {
  1545. SizeType i;
  1546. Integer *to_p=to.data+to_offset;
  1547. Integer *from_p=from.data+from_offset;
  1548. for(i=0;i<trailingsize;i++,to_p+=1,from_p+=1) *to_p=*from_p;
  1549. break;
  1550. }
  1551. }
  1552. }
  1553. /* Concatenate along dimensions 'along' (1..ndims) and given nargs arguments */
  1554. DYMOLA_STATIC IntegerArray IntegerCat(SizeType along,SizeType nargs,IntegerArray first,...) {
  1555. IntegerArray res;
  1556. va_list ap;
  1557. SizeType i,j;
  1558. res.ndims=first.ndims;
  1559. res.dims=SizeTemp(res.ndims);
  1560. along--; /* Adapt to C usage */
  1561. {
  1562. /* Pass 1: determine size of output */
  1563. for(j=0;j<first.ndims;j++) res.dims[j]=first.dims[j]; /* Starting values */
  1564. va_start(ap,first);
  1565. for(i=1;i<nargs;i++) {
  1566. IntegerArray a;
  1567. a=va_arg(ap,IntegerArray);
  1568. Assert(a.ndims==first.ndims,"Number of dimensions must match for cat");
  1569. for(j=0;j<a.ndims;j++) if (j!=along) {Assert(first.dims[j]==a.dims[j],"Sizes must match for cat");}
  1570. res.dims[along]+=a.dims[along];
  1571. }
  1572. va_end(ap);
  1573. }
  1574. res.data=IntegerTemp(IntegerNrElements(res));
  1575. {
  1576. /* Pass 2: copy data */
  1577. SizeType presize=1; /* Blocks */
  1578. SizeType trailingsize=1; /* Elements in each block */
  1579. SizeType marker=0; /* How far are in res along dimension along */
  1580. for(i=0;i<along;i++) presize*=res.dims[i];
  1581. for(i=along+1;i<res.ndims;i++) trailingsize*=res.dims[i];
  1582. va_start(ap,first);
  1583. for(i=0;i<nargs;i++) {
  1584. SizeType pre,current,trailing;
  1585. IntegerArray a;
  1586. if (i!=0) a=va_arg(ap,IntegerArray); else a=first;
  1587. for(pre=0;pre<presize;pre++)
  1588. for(current=0;current<a.dims[along];current++)
  1589. for(trailing=0;trailing<trailingsize;trailing++)
  1590. res.data[(pre*res.dims[along]+(current+marker))*trailingsize+trailing]=
  1591. a.data[(pre*a.dims[along]+current)*trailingsize+trailing];
  1592. marker+=a.dims[along];
  1593. }
  1594. va_end(ap);
  1595. }
  1596. return res;
  1597. }
  1598. /* The helper in Modelica */
  1599. DYMOLA_STATIC IntegerArray IntegerPromote(const IntegerArray a,SizeType n) {
  1600. IntegerArray res;
  1601. SizeType i;
  1602. Assert(n>=a.ndims,"Promote cannot decrease number of dimensions");
  1603. res.ndims=n;
  1604. res.data=a.data; /* No need to copy */
  1605. res.dims=SizeTemp(n);
  1606. for(i=0;i<a.ndims;i++) res.dims[i]=a.dims[i];
  1607. for(i=a.ndims;i<n;i++) res.dims[i]=1;
  1608. return res;
  1609. }
  1610. DYMOLA_STATIC IntegerArray IntegerPromoteScalar(const Integer x,SizeType n) {
  1611. IntegerArray res;
  1612. Integer i;
  1613. res.ndims=n;
  1614. res.data=IntegerTemp(1);
  1615. res.data[0]=x;
  1616. res.dims=SizeTemp(n);
  1617. for(i=0;i<n;i++) res.dims[i]=1;
  1618. return res;
  1619. }
  1620. /* Actual put of submatrix */
  1621. DYMOLA_STATIC void IntegerToSub(IntegerArray to,SizeType to_offset,SizeType to_dim,
  1622. const IntegerArray from,SizeType from_offset,SizeType from_dim,
  1623. SizeType trailingsize,
  1624. struct TaggedIndexStack*ap) {
  1625. Integer tag;
  1626. if (!ap) return; /* Error */
  1627. tag=ap->tag;
  1628. switch(tag) {
  1629. case Colon:
  1630. {
  1631. SizeType newdim=from.dims[from_dim];
  1632. SizeType i;
  1633. for(i=0;i<newdim;i++) IntegerToSub(to,to_offset*newdim+i,
  1634. to_dim+1,from,from_offset*newdim+i,from_dim+1,
  1635. trailingsize,ap+1);
  1636. break;
  1637. }
  1638. case Range:case RangeRange:
  1639. {
  1640. Integer start,stop,stride=1,i,from_newdim,to_newdim;
  1641. start=ap->u.range[0];
  1642. if (tag==RangeRange) stride=ap->u.range[1];
  1643. stop=ap->u.range[2];
  1644. from_newdim=from.dims[from_dim];
  1645. to_newdim=to.dims[to_dim];
  1646. for(i=0;i<from_newdim;i++)
  1647. IntegerToSub(to,to_offset*to_newdim+(start+stride*i-1),to_dim+1,
  1648. from,from_offset*from_newdim+i,from_dim+1,
  1649. trailingsize,ap+1);
  1650. break;
  1651. }
  1652. case Index:
  1653. {
  1654. Integer i=ap->u.index;
  1655. IntegerToSub(to,to_offset*to.dims[to_dim]+(i-1),to_dim+1,
  1656. from,from_offset,from_dim,trailingsize,ap+1);
  1657. break;
  1658. }
  1659. case Vector:
  1660. {
  1661. IntegerArray v=ap->u.vector;
  1662. Integer from_newdim,to_newdim,i;
  1663. from_newdim=from.dims[from_dim];
  1664. to_newdim=to.dims[to_dim];
  1665. for(i=0;i<v.dims[0];i++)
  1666. IntegerToSub(to,to_offset*to_newdim+(v.data[i]-1),to_dim+1,
  1667. from,from_offset*from_newdim+i,from_dim+1,
  1668. trailingsize,ap+1);
  1669. break;
  1670. }
  1671. case EndMark:
  1672. {
  1673. SizeType i;
  1674. Integer *to_p=to.data+to_offset;
  1675. Integer *from_p=from.data+from_offset;
  1676. for(i=0;i<trailingsize;i++,to_p+=1,from_p+=1) *to_p=*from_p;
  1677. break;
  1678. }
  1679. }
  1680. }
  1681. /* Use as: IntegerGetSub(a,Colon,Index,3,Range,3,4,EndMark)=a[:,3,3:4] */
  1682. DYMOLA_STATIC IntegerArray IntegerGetSub(const IntegerArray a,...) {
  1683. IntegerArray temp;
  1684. va_list ap;
  1685. SizeType ndims=a.ndims,trailingsize=1,nargs=0;
  1686. /* Pass 1. Determine nr. dimensions of output */
  1687. {
  1688. Integer over=0;
  1689. va_start(ap,a);
  1690. for(;!over;) {
  1691. Integer tag=va_arg(ap,Integer);
  1692. switch (tag) {
  1693. case Colon:nargs++;break;
  1694. case RangeRange:va_arg(ap,Integer); /* Fallthru*/
  1695. case Range:va_arg(ap,Integer),va_arg(ap,Integer);nargs++;break;
  1696. case Vector:va_arg(ap,IntegerArray);nargs++;break;
  1697. case Index:va_arg(ap,Integer);Assert(ndims>0,"Internal error in subscriptring of array");ndims--;nargs++;break;
  1698. case EndMark:over=1;break;
  1699. }
  1700. }
  1701. va_end(ap);
  1702. Assert(nargs<=a.ndims,"Too many subscripts for array");
  1703. }
  1704. temp.ndims=ndims;
  1705. temp.dims=SizeTemp(ndims);
  1706. /* Pass 2. Determine size of output */
  1707. {
  1708. Integer over=0;
  1709. SizeType temp_dim=0,a_dim=0;
  1710. va_start(ap,a);
  1711. for(;!over;) {
  1712. Integer tag=va_arg(ap,Integer);
  1713. switch (tag) {
  1714. case Colon:temp.dims[temp_dim]=a.dims[a_dim];temp_dim++;break;
  1715. case RangeRange:case Range:
  1716. {
  1717. Integer start,stop,stride=1,num;
  1718. start=va_arg(ap,Integer);
  1719. if (tag==RangeRange) stride=va_arg(ap,Integer);
  1720. stop=va_arg(ap,Integer);
  1721. num=1+(stop-start)/stride;
  1722. if (num<=0) num=0;
  1723. else {
  1724. Assert((start>=1)&&(start<=a.dims[a_dim]),"Range subscripting: start out of range");
  1725. Assert((stop >=1)&&(stop <=a.dims[a_dim]),"Range subscripting: end out of range");
  1726. }
  1727. temp.dims[temp_dim]=num;
  1728. temp_dim++;
  1729. break;
  1730. }
  1731. case Vector:
  1732. {
  1733. IntegerArray v=va_arg(ap,IntegerArray);
  1734. SizeType i;
  1735. Assert(v.ndims==1,"Array subscripting: only vectors (and scalars) allowed as indicies");
  1736. temp.dims[temp_dim]=v.dims[0];
  1737. for(i=0;i<v.dims[0];i++) {
  1738. Assert((v.data[i]>=1)&&(v.data[i]<=a.dims[a_dim]),"Array subscripting: vector index out of range");
  1739. }
  1740. temp_dim++;
  1741. break;
  1742. }
  1743. case Index:
  1744. {
  1745. Integer i=va_arg(ap,Integer);
  1746. Assert((i>=1)&&(i<=a.dims[a_dim]),"Array subscripting: scalar index out of range");
  1747. break;
  1748. }
  1749. case EndMark:over=1;break;
  1750. }
  1751. a_dim++;
  1752. }
  1753. va_end(ap);
  1754. {
  1755. SizeType i;
  1756. for(i=nargs;i<a.ndims;i++) {
  1757. temp.dims[temp_dim++]=a.dims[i];
  1758. trailingsize*=a.dims[i];
  1759. }
  1760. }
  1761. }
  1762. temp.data=IntegerTemp(IntegerNrElements(temp));
  1763. /* Pass 3. Copy output */
  1764. {
  1765. Integer *data=temp.data;
  1766. struct TaggedIndexStack*apt=0;
  1767. struct TaggedIndexStack VA_handler[100];
  1768. va_start(ap,a);
  1769. apt=HandleVaList(ap, VA_handler, sizeof(VA_handler)/sizeof(*VA_handler));
  1770. va_end(ap);
  1771. IntegerFromSub(temp,0,0,a,0,0,trailingsize,apt);
  1772. }
  1773. return temp;
  1774. }
  1775. /* Use as IntegerPutSub(a, out,Index,3,Colon,Range,3,4) yields out[3,:,3:4]=a; */
  1776. DYMOLA_STATIC IntegerArray IntegerCopy(const IntegerArray a) {
  1777. int i,imax;
  1778. IntegerArray temp;
  1779. temp.ndims=a.ndims;
  1780. temp.dims=SizeTemp(a.ndims);
  1781. for(i=0;i<a.ndims;++i) temp.dims[i]=a.dims[i];
  1782. imax=IntegerNrElements(a);
  1783. temp.data=IntegerTemp(imax);
  1784. for(i=0;i<imax;++i) temp.data[i]=a.data[i];
  1785. return temp;
  1786. }
  1787. DYMOLA_STATIC void IntegerPutSub(const IntegerArray ain,IntegerArray out,...) {
  1788. IntegerArray a;
  1789. va_list ap;
  1790. SizeType out_dim=0,a_dim=0,trailingsize=1,nargs=0;
  1791. a=IntegerCopy(ain);
  1792. /* Pass 1. Determine nr. dimensions of output */
  1793. {
  1794. Integer over=0;
  1795. va_start(ap,out);
  1796. for(;!over;) {
  1797. Integer tag=va_arg(ap,Integer);
  1798. switch (tag) {
  1799. case Colon:
  1800. Assert(out_dim<out.ndims,"Internal error in subscripting (:)");
  1801. Assert(a_dim<a.ndims,"Internal error in subscripting (:)");
  1802. Assert(out.dims[out_dim]==a.dims[a_dim],"Assignment array subscripting: A[:]=B must have identical sizes");
  1803. out_dim++;
  1804. a_dim++;
  1805. break;
  1806. case RangeRange:case Range:
  1807. {
  1808. Integer start,stop,stride=1,num;
  1809. Assert(out_dim<out.ndims,"Internal error in subscripting: range");
  1810. Assert(a_dim<a.ndims,"Internal error in subscripting: range ");
  1811. start=va_arg(ap,Integer);
  1812. if (tag==RangeRange) stride=va_arg(ap,Integer);
  1813. stop=va_arg(ap,Integer);
  1814. num=(stop-start+stride)/stride;
  1815. if (num<=0) num=0;
  1816. else {
  1817. Assert((start>=1)&&(start<=out.dims[out_dim]),"Assignment array subscripting: start of range out of bounds");
  1818. Assert((stop>=1)&&(stop<=out.dims[out_dim]),"Assignment array subscripting: end of range out of bounds");
  1819. }
  1820. Assert(a.dims[a_dim]==num,"Assignment array subscripting: A[a:b]=B must have identical sizes");
  1821. out_dim++;
  1822. a_dim++;
  1823. break;
  1824. }
  1825. case Vector:
  1826. {
  1827. IntegerArray v=va_arg(ap,IntegerArray);
  1828. SizeType i;
  1829. Assert(out_dim<out.ndims,"Internal error in vector subscripting");
  1830. Assert(a_dim<a.ndims,"Internal error in vector subscripting");
  1831. Assert(v.ndims==1,"Assignment array subscripting: array index must be a vector");
  1832. Assert(a.dims[a_dim]==v.dims[0],"Assignment array subscripting: A[vect]=B must have identical sizes");
  1833. for(i=0;i<v.dims[0];i++) {
  1834. Assert((v.data[i]>=1)&&(v.data[i]<=out.dims[out_dim]),"Assignment array subscripting: vector index out of bounds");
  1835. }
  1836. out_dim++;
  1837. a_dim++;
  1838. break;
  1839. }
  1840. case Index:
  1841. {
  1842. Integer i=va_arg(ap,Integer);
  1843. Assert(out_dim<out.ndims,"Internal error in scalar subscripting");
  1844. Assert((i>=1)&&(i<=out.dims[out_dim]),"Assignment array subscripting: scalar index out of bounds");
  1845. out_dim++;
  1846. break;
  1847. }
  1848. case EndMark:over=1;break;
  1849. }
  1850. }
  1851. va_end(ap);
  1852. Assert(a.ndims-a_dim==out.ndims-out_dim,"Assignment array subscripting: unequal number of dimensions");
  1853. {
  1854. SizeType i;
  1855. for(i=a_dim;i<a.ndims;i++) {
  1856. trailingsize*=a.dims[i];
  1857. Assert(a.dims[i]==out.dims[(i-a_dim)+out_dim],"Internal error in subscripting");
  1858. }
  1859. }
  1860. }
  1861. /* Pass 2. Copy output */
  1862. {
  1863. struct TaggedIndexStack*apt=0;
  1864. struct TaggedIndexStack VA_handler[100];
  1865. va_start(ap,out);
  1866. apt=HandleVaList(ap, VA_handler, sizeof(VA_handler)/sizeof(*VA_handler));
  1867. va_end(ap);
  1868. IntegerToSub(out,0,0,a,0,0,trailingsize,apt);
  1869. }
  1870. }
  1871. /* For each operation Op(...) we create a temporary result res */
  1872. /* and call OpAssign(res,...) */
  1873. /* The operations Op(...) are convenient and used in the code */
  1874. /* Fill */
  1875. DYMOLA_STATIC IntegerArray IntegerFillAssign(IntegerArray res,const Integer t) {
  1876. SizeType i,prodsize;
  1877. prodsize=IntegerNrElements(res);
  1878. for(i=0;i<prodsize;i++) res.data[i]=t;
  1879. return res;
  1880. }
  1881. DYMOLA_STATIC IntegerArray IntegerFill(const Integer t,SizeType ndims,...) {
  1882. va_list ap;
  1883. IntegerArray temp;
  1884. va_start(ap,ndims);
  1885. temp=IntegerFillAssign(IntegerVaTemporary(ndims,ap),t);
  1886. va_end(ap);
  1887. return temp;
  1888. }
  1889. DYMOLA_STATIC IntegerArray IntegerFillArray(const IntegerArray a,SizeType ndims,...) {
  1890. va_list ap;
  1891. int i,j,inputProd,fillProd;
  1892. IntegerArray temp;
  1893. temp.ndims=a.ndims+ndims;
  1894. temp.dims=SizeTemp(temp.ndims);
  1895. va_start(ap,ndims);
  1896. for(i=0;i<ndims;++i) temp.dims[i]=va_arg(ap,SizeType);
  1897. va_end(ap);
  1898. for(i=0;i<a.ndims;++i) temp.dims[i+ndims]=a.dims[i];
  1899. fillProd=1;
  1900. for(i=0;i<ndims;++i) fillProd*=temp.dims[i];
  1901. inputProd=IntegerNrElements(a);
  1902. temp.data=IntegerTemp(inputProd*fillProd);
  1903. for(i=0;i<inputProd;++i) {
  1904. for(j=0;j<fillProd;j++) {
  1905. temp.data[i+j*inputProd]=a.data[i];
  1906. }
  1907. }
  1908. return temp;
  1909. }
  1910. DYMOLA_STATIC Integer Integerscalar(const IntegerArray a) {
  1911. Assert(IntegerNrElements(a)==1,"scalar requires exactly one element");
  1912. return a.data[0];
  1913. }
  1914. /* Matrix operations not limited to numeric matrices */
  1915. DYMOLA_STATIC IntegerArray Integervector(const IntegerArray a) {
  1916. IntegerArray res;
  1917. #ifndef NDEBUG
  1918. Integer i,found_non_one=0;
  1919. for(i=0;i<a.ndims;i++) {if (a.dims[i]>1) {Assert(!found_non_one,"vector requires exactly one vector non-unit dimension");found_non_one=1;}}
  1920. #endif
  1921. res.ndims=1;
  1922. res.dims=SizeTemp(1);
  1923. res.dims[0]=IntegerNrElements(a);
  1924. res.data=a.data;
  1925. return res;
  1926. }
  1927. DYMOLA_STATIC IntegerArray Integermatrix(const IntegerArray a) {
  1928. IntegerArray res;
  1929. res.ndims=2;
  1930. res.dims=SizeTemp(2);
  1931. res.dims[0]=a.dims[0];
  1932. res.dims[1]=(a.ndims<2)?1:a.dims[1];
  1933. res.data=a.data;
  1934. Assert(IntegerNrElements(a)==IntegerNrElements(res),"matrix requires size(x,i)=1 for i>2");
  1935. return res;
  1936. }
  1937. DYMOLA_STATIC IntegerArray Integertranspose(const IntegerArray a) {
  1938. IntegerArray res;
  1939. Integer i,j,k,remsize,leadingsize;
  1940. res.ndims=a.ndims;
  1941. Assert(a.ndims>=2,"transpose requires ndims>=2");
  1942. res.dims=SizeTemp(a.ndims);
  1943. res.dims[0]=a.dims[1];
  1944. res.dims[1]=a.dims[0];
  1945. remsize=1;
  1946. leadingsize=res.dims[0]*res.dims[1];
  1947. for(i=2;i<a.ndims;i++) {
  1948. remsize*=(res.dims[i]=a.dims[i]);
  1949. }
  1950. res.data=IntegerTemp(IntegerNrElements(res));
  1951. for(i=0;i<res.dims[0];i++) for(j=0;j<res.dims[1];j++) {
  1952. for(k=0;k<remsize;k++) {
  1953. res.data[(i*res.dims[1]+j)*remsize+k]=a.data[(j*a.dims[1]+i)*remsize+k];
  1954. }
  1955. }
  1956. return res;
  1957. }
  1958. DYMOLA_STATIC IntegerArray Integerouterproduct(const IntegerArray a,const IntegerArray b) {
  1959. Assert(a.ndims==1,"Outerproduct require a vector as first argument");
  1960. Assert(b.ndims==1,"Outerproduct require a vector as second argument");
  1961. {
  1962. SizeType na=a.dims[0],nb=b.dims[0];
  1963. SizeType i,j;
  1964. IntegerArray res=IntegerTemporaryMatrix(na,nb);
  1965. for(i=0;i<na;i++) {
  1966. Integer ai=a.data[i];
  1967. for(j=0;j<nb;j++)
  1968. res.data[i*nb+j]=ai*b.data[j];
  1969. }
  1970. return res;
  1971. }
  1972. }
  1973. DYMOLA_STATIC IntegerArray Integersymmetric(const IntegerArray a) {
  1974. IntegerArray res;
  1975. Integer i,j,n=a.dims[0];
  1976. Assert(a.ndims==2,"symmetric requires ndims==2");
  1977. Assert(a.dims[0]==a.dims[1],"symmetric requires square matrix");
  1978. res=IntegerTemporaryMatrix(n,n);
  1979. for(i=0;i<n;i++) {
  1980. for(j=0;j<=i;j++) res.data[i*n+j]=a.data[j*n+i];
  1981. for(;j<n;j++) res.data[i*n+j]=a.data[i*n+j];
  1982. }
  1983. return res;
  1984. }
  1985. /* End of common routines for String*/
  1986. /* Basic operations, add, subtract, scale*/
  1987. /* For each operation Op(...) we create a temporary result res */
  1988. /* and call OpAssign(res,...) */
  1989. /* The operations Op(...) are convenient and used in the code */
  1990. DYMOLA_STATIC IntegerArray IntegerAddAssign(IntegerArray res,const IntegerArray a,const IntegerArray b) {
  1991. SizeType prodsize,i;
  1992. Assert(IntegerMatchingSizes(a,b),"Add of arrays require arguments of matching size");
  1993. Assert(IntegerMatchingSizes(res,a),"Add of arrays require result of matching size");
  1994. prodsize=IntegerNrElements(a);
  1995. for(i=0;i<prodsize;i++) res.data[i]=a.data[i]+b.data[i];
  1996. return res;
  1997. }
  1998. DYMOLA_STATIC IntegerArray IntegerAdd(const IntegerArray a,const IntegerArray b) {
  1999. return IntegerAddAssign(IntegerMatch(a),a,b);
  2000. }
  2001. DYMOLA_STATIC IntegerArray IntegerSubtractAssign(IntegerArray res,const IntegerArray a,const IntegerArray b) {
  2002. SizeType prodsize,i;
  2003. Assert(IntegerMatchingSizes(a,b),"Subtract of arrays require arguments of matching size");
  2004. Assert(IntegerMatchingSizes(res,a),"Subtract of arrays require result of matching size");
  2005. prodsize=IntegerNrElements(a);
  2006. for(i=0;i<prodsize;i++) res.data[i]=a.data[i]-b.data[i];
  2007. return res;
  2008. }
  2009. DYMOLA_STATIC IntegerArray IntegerSubtract(const IntegerArray a,const IntegerArray b) {
  2010. return IntegerSubtractAssign(IntegerMatch(a),a,b);
  2011. }
  2012. DYMOLA_STATIC IntegerArray IntegerScaleAssign(IntegerArray res,const IntegerArray a,const Integer t) {
  2013. SizeType i,prodsize;
  2014. Assert(IntegerMatchingSizes(res,a),"Array times scalar require result of matching size");
  2015. prodsize=IntegerNrElements(a);
  2016. for(i=0;i<prodsize;i++) res.data[i]=t*a.data[i];
  2017. return res;
  2018. }
  2019. DYMOLA_STATIC IntegerArray IntegerScale(const IntegerArray a,const Integer t) {
  2020. return IntegerScaleAssign(IntegerMatch(a),a,t);
  2021. }
  2022. DYMOLA_STATIC IntegerArray IntegerMinusAssign(IntegerArray res,const IntegerArray a) {
  2023. SizeType i,prodsize;
  2024. Assert(IntegerMatchingSizes(res,a),"Negating a matrix require result of matching size");
  2025. prodsize=IntegerNrElements(a);
  2026. for(i=0;i<prodsize;i++) res.data[i]=-a.data[i];
  2027. return res;
  2028. }
  2029. DYMOLA_STATIC IntegerArray IntegerMinus(const IntegerArray a) {
  2030. return IntegerMinusAssign(IntegerMatch(a),a);
  2031. }
  2032. /* sum, max, min, and product */
  2033. DYMOLA_STATIC Integer Integersum(const IntegerArray a) {
  2034. Integer res=0;
  2035. Integer max_elem=IntegerNrElements(a);
  2036. Integer i;
  2037. for(i=0;i<max_elem;i++) res+=a.data[i];
  2038. return res;
  2039. }
  2040. DYMOLA_STATIC Integer IntegerAbssum(const IntegerArray a) {
  2041. Integer res=0;
  2042. Integer max_elem=IntegerNrElements(a);
  2043. Integer i;
  2044. for(i=0;i<max_elem;i++) {
  2045. Integer x=a.data[i];
  2046. if (x>0) res+=x; else res-=x;
  2047. }
  2048. return res;
  2049. }
  2050. DYMOLA_STATIC Integer Integermax(const IntegerArray a) {
  2051. Integer res=INT_MIN;
  2052. Integer max_elem=IntegerNrElements(a);
  2053. Integer i;
  2054. for(i=0;i<max_elem;i++) if (a.data[i]>res) res=a.data[i];
  2055. return res;
  2056. }
  2057. DYMOLA_STATIC Integer Integermin(const IntegerArray a) {
  2058. Integer res=INT_MAX;
  2059. Integer max_elem=IntegerNrElements(a);
  2060. Integer i;
  2061. for(i=0;i<max_elem;i++) if (a.data[i]<res) res=a.data[i];
  2062. return res;
  2063. }
  2064. DYMOLA_STATIC Integer Integerproduct(const IntegerArray a) {
  2065. Integer res=1;
  2066. Integer max_elem=IntegerNrElements(a);
  2067. Integer i;
  2068. for(i=0;i<max_elem;i++) res*=a.data[i];
  2069. return res;
  2070. }
  2071. DYMOLA_STATIC IntegerArray Integerdiagonal(const IntegerArray a) {
  2072. IntegerArray res;
  2073. Integer i,j,n;
  2074. Assert(a.ndims==1,"diagonal requires vector input");
  2075. n=a.dims[0];
  2076. res=IntegerTemporaryMatrix(n,n);
  2077. for(i=0;i<n;i++) for(j=0;j<n;j++) res.data[i*n+j]=(i==j)?a.data[i]:0;
  2078. return res;
  2079. }
  2080. DYMOLA_STATIC IntegerArray Integercross(const IntegerArray x,const IntegerArray y) {
  2081. IntegerArray res=IntegerTemporaryVector(3);
  2082. Assert((x.ndims==1)&&(y.ndims==1),"cross requires vector input");
  2083. Assert(x.dims[0]==3,"cross requires 3-vector input for first argument");
  2084. Assert(y.dims[0]==3,"cross requires 3-vector input for second argument");
  2085. res.data[0]=x.data[1]*y.data[2]-x.data[2]*y.data[1];
  2086. res.data[1]=x.data[2]*y.data[0]-x.data[0]*y.data[2];
  2087. res.data[2]=x.data[0]*y.data[1]-x.data[1]*y.data[0];
  2088. return res;
  2089. }
  2090. DYMOLA_STATIC IntegerArray Integerskew(const IntegerArray x) {
  2091. IntegerArray res=IntegerTemporaryMatrix(3,3);
  2092. Assert(x.ndims==1,"skew requires vector input");
  2093. Assert(x.dims[0]==3,"skew requires 3-vector input");
  2094. SetIntegerElement(0,res,1,1);
  2095. SetIntegerElement(-IntegerElement(x,3),res,1,2);
  2096. SetIntegerElement(IntegerElement(x,2),res,1,3);
  2097. SetIntegerElement(IntegerElement(x,3),res,2,1);
  2098. SetIntegerElement(0,res,2,2);
  2099. SetIntegerElement(-IntegerElement(x,1),res,2,3);
  2100. SetIntegerElement(-IntegerElement(x,2),res,3,1);
  2101. SetIntegerElement(IntegerElement(x,1),res,3,2);
  2102. SetIntegerElement(0,res,3,3);
  2103. return res;
  2104. }
  2105. /* Multiply */
  2106. DYMOLA_STATIC IntegerArray IntegerMultiplyMMAssign(IntegerArray res,
  2107. const IntegerArray a,const IntegerArray b) {
  2108. SizeType i,j,k,imax,jmax,kmax;
  2109. Assert(res.ndims==2,"Matrix multiply gives a matrix as result");
  2110. Assert(a.ndims==2,"Matrix multiply requires that first operand is a matrix");
  2111. Assert(b.ndims==2,"Matrix multiply requires that second operand is a matrix");
  2112. Assert(res.dims[0]==a.dims[0],"Matrix multiply requires that first dimension of result and first argument match");
  2113. Assert(res.dims[1]==b.dims[1],"Matrix multiply requires that second dimension of result and second argument match");
  2114. Assert(a.dims[1]==b.dims[0],"Matrix multiply requires that inner dimensions of operands match");
  2115. imax=res.dims[0];
  2116. jmax=res.dims[1];
  2117. kmax=a.dims[1];
  2118. for(i=0;i<imax;i++) for(j=0;j<jmax;j++) {
  2119. Integer d=0;
  2120. for(k=0;k<kmax;k++) d+=a.data[i*kmax+k]*b.data[k*jmax+j];
  2121. res.data[i*jmax+j]=d;
  2122. }
  2123. return res;
  2124. }
  2125. DYMOLA_STATIC IntegerArray IntegerMultiplyMVAssign(IntegerArray res,const IntegerArray a,const IntegerArray b) {
  2126. SizeType i,j,imax,jmax;
  2127. Assert(a.ndims==2,"Matrix times vector requires a matrix as first operand");
  2128. Assert(b.ndims==1,"Matrix times vector requires a vector as second operand");
  2129. Assert(res.ndims==1,"Matrix times vector gives a vector result");
  2130. Assert(res.dims[0]==a.dims[0],"Matrix times vector: requires size(M*v,1)=size(M,1)");
  2131. Assert(a.dims[1]==b.dims[0],"Matrix times vector: requires size(M,2)==size(v,1)");
  2132. imax=a.dims[0];
  2133. jmax=a.dims[1];
  2134. for(i=0;i<imax;i++) {
  2135. Integer d=0;
  2136. for(j=0;j<jmax;j++) {
  2137. d+=a.data[i*jmax+j]*b.data[j];
  2138. }
  2139. res.data[i]=d;
  2140. }
  2141. return res;
  2142. }
  2143. DYMOLA_STATIC IntegerArray IntegerMultiplyVMAssign(IntegerArray res,const IntegerArray a,const IntegerArray b) {
  2144. SizeType i,j,imax,jmax;
  2145. Assert(a.ndims==1,"Vector times matrix requires a vector as first operand");
  2146. Assert(b.ndims==2,"Vector times matrix requires a matrix as second operand");
  2147. Assert(res.ndims==1,"Vector times matrix gives a vector result");
  2148. Assert(res.dims[0]==b.dims[1],"Vector times matrix: requires size(v*M,1)=size(M,2)");
  2149. Assert(a.dims[0]==b.dims[0],"Vector times matrix: requires size(v,1)=size(M,1)");
  2150. imax=b.dims[1];
  2151. jmax=b.dims[0];
  2152. for(i=0;i<imax;i++) {
  2153. Integer d=0;
  2154. for(j=0;j<jmax;j++) {
  2155. d+=a.data[j]*b.data[j*imax+i];
  2156. }
  2157. res.data[i]=d;
  2158. }
  2159. return res;
  2160. }
  2161. DYMOLA_STATIC Integer IntegerMultiplyVV(const IntegerArray a,const IntegerArray b) {
  2162. SizeType i,imax;
  2163. Integer d=0;
  2164. Assert(a.ndims==1,"Scalar product requires vector as first operand");
  2165. Assert(b.ndims==1,"Scalar product requires vector as second operand");
  2166. Assert(a.dims[0]==b.dims[0],"Scalar product requires vectors of matching size");
  2167. imax=a.dims[0];
  2168. for(i=0;i<imax;i++) d+=a.data[i]*b.data[i];
  2169. return d;
  2170. }
  2171. DYMOLA_STATIC IntegerArray IntegerMultiplyMM(const IntegerArray a,const IntegerArray b) {
  2172. return IntegerMultiplyMMAssign(IntegerTemporaryMatrix(a.dims[0],b.dims[1]),a,b);
  2173. }
  2174. DYMOLA_STATIC IntegerArray IntegerMultiplyMV(const IntegerArray a,const IntegerArray b) {
  2175. return IntegerMultiplyMVAssign(IntegerTemporaryVector(a.dims[0]),a,b);
  2176. }
  2177. DYMOLA_STATIC IntegerArray IntegerMultiplyVM(const IntegerArray a,const IntegerArray b) {
  2178. return IntegerMultiplyVMAssign(IntegerTemporaryVector(b.dims[1]),a,b);
  2179. }
  2180. DYMOLA_STATIC IntegerArray IntegerIdentity(SizeType n) {
  2181. IntegerArray res;
  2182. Integer i,j;
  2183. res.ndims=2;
  2184. res.dims=SizeTemp(2);
  2185. res.dims[0]=res.dims[1]=n;
  2186. res.data=IntegerTemp(n*n);
  2187. for(i=0;i<n;i++) for(j=0;j<n;j++) res.data[i*n+j]=(i==j);
  2188. return res;
  2189. }
  2190. DYMOLA_STATIC IntegerArray IntegerPow(const IntegerArray a,const Integer n) {
  2191. Assert(n>=0,"Matrices can only be raised to positive integer");
  2192. Assert(a.ndims==2,"Matrix raised to a positive integer requires a matrix as first operand");
  2193. Assert(a.dims[0]==a.dims[1],"Matrix raised to a positive integer requires a square matrix as first operand");
  2194. if (n==1) return a;
  2195. else if (n==0) return IntegerIdentity(a.dims[0]);
  2196. else {
  2197. if (n%2) {
  2198. return IntegerMultiplyMM(IntegerPow(a,n-1),a);
  2199. } else {
  2200. IntegerArray ahalf=IntegerPow(a,n/2);
  2201. return IntegerMultiplyMM(ahalf,ahalf);
  2202. }
  2203. }
  2204. }
  2205. /* For from:stride:to */
  2206. DYMOLA_STATIC IntegerArray IntegerRange(const Integer from,const Integer to,const Integer stride) {
  2207. Integer num;
  2208. Assert(stride!=0,"range requires non-zero stride");
  2209. num=(Integer)floor((to-from)*1.0/stride)+1;
  2210. if (num<0) num=0;
  2211. {
  2212. IntegerArray res=IntegerTemporaryVector(num);
  2213. Integer i;
  2214. for(i=0;i<num;i++) SetIntegerElement(from+i*stride,res,i+1);
  2215. return res;
  2216. }
  2217. }
  2218. /* Test for size compatibility, used in assertions */
  2219. DYMOLA_STATIC Integer StringMatchingSizes(const StringArray a,const StringArray b) {
  2220. SizeType i;
  2221. if (a.ndims!=b.ndims) return 0;
  2222. for(i=0;i<a.ndims;i++) {if(a.dims[i]!=b.dims[i]) return 0;}
  2223. return 1;
  2224. }
  2225. /* Return total number of elements */
  2226. DYMOLA_STATIC SizeType StringNrElements(const StringArray a) {
  2227. SizeType prodsize=1;
  2228. SizeType i;
  2229. for(i=0;i<a.ndims;i++) prodsize*=a.dims[i];
  2230. return prodsize;
  2231. }
  2232. /* Create Array-temporaries given the dimensions */
  2233. /* Internal: Use an existing va_list */
  2234. DYMOLA_STATIC StringArray StringVaTemporarySize(SizeType ndims,va_list ap) {
  2235. StringArray temp;
  2236. SizeType i;
  2237. temp.ndims=ndims;
  2238. temp.dims=SizeTemp(ndims);
  2239. for(i=0;i<ndims;i++) temp.dims[i]=va_arg(ap,SizeType);
  2240. return temp;
  2241. }
  2242. DYMOLA_STATIC StringArray StringVaTemporary(SizeType ndims,va_list ap) {
  2243. StringArray temp=StringVaTemporarySize(ndims,ap);
  2244. temp.data=StringTemp(StringNrElements(temp));
  2245. return temp;
  2246. }
  2247. /* Construct a temporary of the same size as a */
  2248. DYMOLA_STATIC StringArray StringMatch(const StringArray a) {
  2249. StringArray temp;
  2250. SizeType i;
  2251. temp.ndims=a.ndims;
  2252. temp.dims=SizeTemp(a.ndims);
  2253. for(i=0;i<a.ndims;i++) temp.dims[i]=a.dims[i];
  2254. temp.data=StringTemp(StringNrElements(a));
  2255. return temp;
  2256. }
  2257. /* Construct array from sizes, using variable number of arguments */
  2258. DYMOLA_STATIC StringArray StringTemporary(SizeType ndims,...) {
  2259. StringArray temp;
  2260. va_list ap;
  2261. va_start(ap,ndims);
  2262. temp=StringVaTemporary(ndims,ap);
  2263. va_end(ap);
  2264. return temp;
  2265. }
  2266. /* Special cases for vectors and matrices (most often used) */
  2267. DYMOLA_STATIC StringArray StringTemporaryMatrix(SizeType r,SizeType c) {
  2268. StringArray temp;
  2269. temp.ndims=2;
  2270. temp.dims=SizeTemp(2);
  2271. temp.dims[0]=r;temp.dims[1]=c;
  2272. temp.data=StringTemp(r*c);
  2273. return temp;
  2274. }
  2275. DYMOLA_STATIC StringArray StringTemporaryVector(SizeType r) {
  2276. StringArray temp;
  2277. temp.ndims=1;
  2278. temp.dims=SizeTemp(1);
  2279. temp.dims[0]=r;
  2280. temp.data=StringTemp(r);
  2281. return temp;
  2282. }
  2283. /* Assignment */
  2284. DYMOLA_STATIC void StringAssign(StringArray a,const StringArray b) {
  2285. SizeType prodsize=StringNrElements(a);
  2286. SizeType i;
  2287. Assert(StringMatchingSizes(a,b),"Array dimensions did not match");
  2288. for(i=0;i<prodsize;i++) a.data[i]=b.data[i];
  2289. }
  2290. /* Indexing to set/get elements */
  2291. DYMOLA_STATIC const char* StringElement(const StringArray a,...) {
  2292. SizeType index;
  2293. va_list ap;
  2294. va_start(ap,a);
  2295. index=FindIndex(a.ndims,a.dims,ap);
  2296. va_end(ap);
  2297. return a.data[index];
  2298. }
  2299. /* Sizes */
  2300. DYMOLA_STATIC Integer StringSize(const StringArray a,SizeType i) {
  2301. Assert((i>=1)&&(i<=a.ndims),"Size must be between 1 and ndims of array");
  2302. return a.dims[i-1];
  2303. }
  2304. DYMOLA_STATIC IntegerArray StringSizes(const StringArray a) {
  2305. IntegerArray res;
  2306. Integer i;
  2307. res.ndims=1;
  2308. res.dims=SizeTemp(1);
  2309. res.dims[0]=a.ndims;
  2310. res.data=IntegerTemp(a.ndims);
  2311. for(i=0;i<a.ndims;i++) res.data[i]=a.dims[i];
  2312. return res;
  2313. }
  2314. /* Set element, note that val is prior to the index list. */
  2315. DYMOLA_STATIC void SetStringElement(const char* val,StringArray a,...) {
  2316. SizeType index;
  2317. va_list ap;
  2318. va_start(ap,a);
  2319. index=FindIndex(a.ndims,a.dims,ap);
  2320. a.data[index]=val;
  2321. va_end(ap);
  2322. }
  2323. /* For debug write out */
  2324. DYMOLA_STATIC void StringWrite(const StringArray a) {
  2325. SizeType i;
  2326. DymosimMessageInt("Dims: ",a.ndims);
  2327. for(i=0;i<a.ndims;i++) DymosimMessageInt(" ",a.dims[i]);
  2328. for(i=0;i<StringNrElements(a);i++) DymosimMessage((char *) a.data[i]);
  2329. }
  2330. /* Construct Arrays from other arrays */
  2331. DYMOLA_STATIC StringArray StringArrayArray(SizeType narg,StringArray first,...) {
  2332. StringArray res;
  2333. SizeType i,j,prodsize;
  2334. va_list ap;
  2335. res.ndims=first.ndims+1;
  2336. res.dims=SizeTemp(res.ndims);
  2337. res.dims[0]=narg;
  2338. for(i=1;i<res.ndims;i++) res.dims[i]=first.dims[i-1];
  2339. prodsize=StringNrElements(first);
  2340. res.data=StringTemp(prodsize*narg);
  2341. va_start(ap,first);
  2342. for(i=0;i<narg;i++) {
  2343. StringArray next;
  2344. next=(i!=0)?va_arg(ap,StringArray):first;
  2345. Assert(StringMatchingSizes(first,next),"Arrays in array must be of equal sizes");
  2346. for(j=0;j<prodsize;j++)
  2347. res.data[i*prodsize+j]=next.data[j];
  2348. }
  2349. va_end(ap);
  2350. return res;
  2351. }
  2352. /* Construct arrays from scalars */
  2353. DYMOLA_STATIC StringArray StringScalarArray(SizeType narg,...) {
  2354. StringArray res;
  2355. SizeType i;
  2356. va_list ap;
  2357. res=StringTemporaryVector(narg);
  2358. va_start(ap,narg);
  2359. for(i=0;i<narg;i++) {
  2360. res.data[i]=va_arg(ap,const char*);
  2361. }
  2362. va_end(ap);
  2363. return res;
  2364. }
  2365. /* Get/Put of submatrices, i.e. a[i,:,v,1:4] */
  2366. /* Actual get of a submatrix */
  2367. DYMOLA_STATIC void StringFromSub(StringArray to,SizeType to_offset,SizeType to_dim,
  2368. const StringArray from,SizeType from_offset,SizeType from_dim,
  2369. SizeType trailingsize,
  2370. struct TaggedIndexStack*ap) {
  2371. Integer tag;
  2372. if (!ap) return; /* Error */
  2373. tag=ap->tag;
  2374. switch(tag) {
  2375. case Colon:
  2376. {
  2377. SizeType newdim=from.dims[from_dim];
  2378. SizeType i;
  2379. for(i=0;i<newdim;i++) StringFromSub(to,to_offset*newdim+i,
  2380. to_dim+1,from,from_offset*newdim+i,from_dim+1,
  2381. trailingsize,ap+1);
  2382. break;
  2383. }
  2384. case Range:case RangeRange:
  2385. {
  2386. Integer start,stop,stride=1,i,from_newdim,to_newdim;
  2387. start=ap->u.range[0];
  2388. if (tag==RangeRange) stride=ap->u.range[1];
  2389. stop=ap->u.range[2];
  2390. from_newdim=from.dims[from_dim];
  2391. to_newdim=to.dims[to_dim];
  2392. for(i=0;i<to_newdim;i++)
  2393. StringFromSub(to,to_offset*to_newdim+i,to_dim+1,
  2394. from,from_offset*from_newdim+(start+stride*i-1),from_dim+1,
  2395. trailingsize,ap+1);
  2396. break;
  2397. }
  2398. case Index:
  2399. {
  2400. Integer i=ap->u.index;
  2401. StringFromSub(to,to_offset,to_dim,
  2402. from,from_offset*from.dims[from_dim]+i-1,from_dim+1,trailingsize,ap+1);
  2403. break;
  2404. }
  2405. case Vector:
  2406. {
  2407. IntegerArray v=ap->u.vector;
  2408. Integer from_newdim,to_newdim,i;
  2409. from_newdim=from.dims[from_dim];
  2410. to_newdim=to.dims[to_dim];
  2411. for(i=0;i<v.dims[0];i++)
  2412. StringFromSub(to,to_offset*to_newdim+i,to_dim+1,
  2413. from,from_offset*from_newdim+v.data[i]-1,from_dim+1,
  2414. trailingsize,ap+1);
  2415. break;
  2416. }
  2417. case EndMark:
  2418. {
  2419. SizeType i;
  2420. String *to_p=to.data+to_offset;
  2421. String *from_p=from.data+from_offset;
  2422. for(i=0;i<trailingsize;i++,to_p+=1,from_p+=1) *to_p=*from_p;
  2423. break;
  2424. }
  2425. }
  2426. }
  2427. /* Concatenate along dimensions 'along' (1..ndims) and given nargs arguments */
  2428. DYMOLA_STATIC StringArray StringCat(SizeType along,SizeType nargs,StringArray first,...) {
  2429. StringArray res;
  2430. va_list ap;
  2431. SizeType i,j;
  2432. res.ndims=first.ndims;
  2433. res.dims=SizeTemp(res.ndims);
  2434. along--; /* Adapt to C usage */
  2435. {
  2436. /* Pass 1: determine size of output */
  2437. for(j=0;j<first.ndims;j++) res.dims[j]=first.dims[j]; /* Starting values */
  2438. va_start(ap,first);
  2439. for(i=1;i<nargs;i++) {
  2440. StringArray a;
  2441. a=va_arg(ap,StringArray);
  2442. Assert(a.ndims==first.ndims,"Number of dimensions must match for cat");
  2443. for(j=0;j<a.ndims;j++) if (j!=along) {Assert(first.dims[j]==a.dims[j],"Sizes must match for cat");}
  2444. res.dims[along]+=a.dims[along];
  2445. }
  2446. va_end(ap);
  2447. }
  2448. res.data=StringTemp(StringNrElements(res));
  2449. {
  2450. /* Pass 2: copy data */
  2451. SizeType presize=1; /* Blocks */
  2452. SizeType trailingsize=1; /* Elements in each block */
  2453. SizeType marker=0; /* How far are in res along dimension along */
  2454. for(i=0;i<along;i++) presize*=res.dims[i];
  2455. for(i=along+1;i<res.ndims;i++) trailingsize*=res.dims[i];
  2456. va_start(ap,first);
  2457. for(i=0;i<nargs;i++) {
  2458. SizeType pre,current,trailing;
  2459. StringArray a;
  2460. if (i!=0) a=va_arg(ap,StringArray); else a=first;
  2461. for(pre=0;pre<presize;pre++)
  2462. for(current=0;current<a.dims[along];current++)
  2463. for(trailing=0;trailing<trailingsize;trailing++)
  2464. res.data[(pre*res.dims[along]+(current+marker))*trailingsize+trailing]=
  2465. a.data[(pre*a.dims[along]+current)*trailingsize+trailing];
  2466. marker+=a.dims[along];
  2467. }
  2468. va_end(ap);
  2469. }
  2470. return res;
  2471. }
  2472. /* The helper in Modelica */
  2473. DYMOLA_STATIC StringArray StringPromote(const StringArray a,SizeType n) {
  2474. StringArray res;
  2475. SizeType i;
  2476. Assert(n>=a.ndims,"Promote cannot decrease number of dimensions");
  2477. res.ndims=n;
  2478. res.data=a.data; /* No need to copy */
  2479. res.dims=SizeTemp(n);
  2480. for(i=0;i<a.ndims;i++) res.dims[i]=a.dims[i];
  2481. for(i=a.ndims;i<n;i++) res.dims[i]=1;
  2482. return res;
  2483. }
  2484. DYMOLA_STATIC StringArray StringPromoteScalar(const char* x,SizeType n) {
  2485. StringArray res;
  2486. Integer i;
  2487. res.ndims=n;
  2488. res.data=StringTemp(1);
  2489. res.data[0]=x;
  2490. res.dims=SizeTemp(n);
  2491. for(i=0;i<n;i++) res.dims[i]=1;
  2492. return res;
  2493. }
  2494. /* Actual put of submatrix */
  2495. DYMOLA_STATIC void StringToSub(StringArray to,SizeType to_offset,SizeType to_dim,
  2496. const StringArray from,SizeType from_offset,SizeType from_dim,
  2497. SizeType trailingsize,
  2498. struct TaggedIndexStack*ap) {
  2499. Integer tag;
  2500. if (!ap) return; /* Error */
  2501. tag=ap->tag;
  2502. switch(tag) {
  2503. case Colon:
  2504. {
  2505. SizeType newdim=from.dims[from_dim];
  2506. SizeType i;
  2507. for(i=0;i<newdim;i++) StringToSub(to,to_offset*newdim+i,
  2508. to_dim+1,from,from_offset*newdim+i,from_dim+1,
  2509. trailingsize,ap+1);
  2510. break;
  2511. }
  2512. case Range:case RangeRange:
  2513. {
  2514. Integer start,stop,stride=1,i,from_newdim,to_newdim;
  2515. start=ap->u.range[0];
  2516. if (tag==RangeRange) stride=ap->u.range[1];
  2517. stop=ap->u.range[2];
  2518. from_newdim=from.dims[from_dim];
  2519. to_newdim=to.dims[to_dim];
  2520. for(i=0;i<from_newdim;i++)
  2521. StringToSub(to,to_offset*to_newdim+(start+stride*i-1),to_dim+1,
  2522. from,from_offset*from_newdim+i,from_dim+1,
  2523. trailingsize,ap+1);
  2524. break;
  2525. }
  2526. case Index:
  2527. {
  2528. Integer i=ap->u.index;
  2529. StringToSub(to,to_offset*to.dims[to_dim]+(i-1),to_dim+1,
  2530. from,from_offset,from_dim,trailingsize,ap+1);
  2531. break;
  2532. }
  2533. case Vector:
  2534. {
  2535. IntegerArray v=ap->u.vector;
  2536. Integer from_newdim,to_newdim,i;
  2537. from_newdim=from.dims[from_dim];
  2538. to_newdim=to.dims[to_dim];
  2539. for(i=0;i<v.dims[0];i++)
  2540. StringToSub(to,to_offset*to_newdim+(v.data[i]-1),to_dim+1,
  2541. from,from_offset*from_newdim+i,from_dim+1,
  2542. trailingsize,ap+1);
  2543. break;
  2544. }
  2545. case EndMark:
  2546. {
  2547. SizeType i;
  2548. String *to_p=to.data+to_offset;
  2549. String *from_p=from.data+from_offset;
  2550. for(i=0;i<trailingsize;i++,to_p+=1,from_p+=1) *to_p=*from_p;
  2551. break;
  2552. }
  2553. }
  2554. }
  2555. /* Use as: StringGetSub(a,Colon,Index,3,Range,3,4,EndMark)=a[:,3,3:4] */
  2556. DYMOLA_STATIC StringArray StringGetSub(const StringArray a,...) {
  2557. StringArray temp;
  2558. va_list ap;
  2559. SizeType ndims=a.ndims,trailingsize=1,nargs=0;
  2560. /* Pass 1. Determine nr. dimensions of output */
  2561. {
  2562. Integer over=0;
  2563. va_start(ap,a);
  2564. for(;!over;) {
  2565. Integer tag=va_arg(ap,Integer);
  2566. switch (tag) {
  2567. case Colon:nargs++;break;
  2568. case RangeRange:va_arg(ap,Integer); /* Fallthru*/
  2569. case Range:va_arg(ap,Integer),va_arg(ap,Integer);nargs++;break;
  2570. case Vector:va_arg(ap,StringArray);nargs++;break;
  2571. case Index:va_arg(ap,Integer);Assert(ndims>0,"Internal error in subscriptring of array");ndims--;nargs++;break;
  2572. case EndMark:over=1;break;
  2573. }
  2574. }
  2575. va_end(ap);
  2576. Assert(nargs<=a.ndims,"Too many subscripts for array");
  2577. }
  2578. temp.ndims=ndims;
  2579. temp.dims=SizeTemp(ndims);
  2580. /* Pass 2. Determine size of output */
  2581. {
  2582. Integer over=0;
  2583. SizeType temp_dim=0,a_dim=0;
  2584. va_start(ap,a);
  2585. for(;!over;) {
  2586. Integer tag=va_arg(ap,Integer);
  2587. switch (tag) {
  2588. case Colon:temp.dims[temp_dim]=a.dims[a_dim];temp_dim++;break;
  2589. case RangeRange:case Range:
  2590. {
  2591. Integer start,stop,stride=1,num;
  2592. start=va_arg(ap,Integer);
  2593. if (tag==RangeRange) stride=va_arg(ap,Integer);
  2594. stop=va_arg(ap,Integer);
  2595. num=1+(stop-start)/stride;
  2596. if (num<=0) num=0;
  2597. else {
  2598. Assert((start>=1)&&(start<=a.dims[a_dim]),"Range subscripting: start out of range");
  2599. Assert((stop >=1)&&(stop <=a.dims[a_dim]),"Range subscripting: end out of range");
  2600. }
  2601. temp.dims[temp_dim]=num;
  2602. temp_dim++;
  2603. break;
  2604. }
  2605. case Vector:
  2606. {
  2607. IntegerArray v=va_arg(ap,IntegerArray);
  2608. SizeType i;
  2609. Assert(v.ndims==1,"Array subscripting: only vectors (and scalars) allowed as indicies");
  2610. temp.dims[temp_dim]=v.dims[0];
  2611. for(i=0;i<v.dims[0];i++) {
  2612. Assert((v.data[i]>=1)&&(v.data[i]<=a.dims[a_dim]),"Array subscripting: vector index out of range");
  2613. }
  2614. temp_dim++;
  2615. break;
  2616. }
  2617. case Index:
  2618. {
  2619. Integer i=va_arg(ap,Integer);
  2620. Assert((i>=1)&&(i<=a.dims[a_dim]),"Array subscripting: scalar index out of range");
  2621. break;
  2622. }
  2623. case EndMark:over=1;break;
  2624. }
  2625. a_dim++;
  2626. }
  2627. va_end(ap);
  2628. {
  2629. SizeType i;
  2630. for(i=nargs;i<a.ndims;i++) {
  2631. temp.dims[temp_dim++]=a.dims[i];
  2632. trailingsize*=a.dims[i];
  2633. }
  2634. }
  2635. }
  2636. temp.data=StringTemp(StringNrElements(temp));
  2637. /* Pass 3. Copy output */
  2638. {
  2639. String *data=temp.data;
  2640. struct TaggedIndexStack*apt=0;
  2641. struct TaggedIndexStack VA_handler[100];
  2642. va_start(ap,a);
  2643. apt=HandleVaList(ap, VA_handler, sizeof(VA_handler)/sizeof(*VA_handler));
  2644. va_end(ap);
  2645. StringFromSub(temp,0,0,a,0,0,trailingsize,apt);
  2646. }
  2647. return temp;
  2648. }
  2649. /* Use as StringPutSub(a, out,Index,3,Colon,Range,3,4) yields out[3,:,3:4]=a; */
  2650. DYMOLA_STATIC StringArray StringCopy(const StringArray a) {
  2651. int i,imax;
  2652. StringArray temp;
  2653. temp.ndims=a.ndims;
  2654. temp.dims=SizeTemp(a.ndims);
  2655. for(i=0;i<a.ndims;++i) temp.dims[i]=a.dims[i];
  2656. imax=StringNrElements(a);
  2657. temp.data=StringTemp(imax);
  2658. for(i=0;i<imax;++i) temp.data[i]=a.data[i];
  2659. return temp;
  2660. }
  2661. DYMOLA_STATIC void StringPutSub(const StringArray ain,StringArray out,...) {
  2662. StringArray a;
  2663. va_list ap;
  2664. SizeType out_dim=0,a_dim=0,trailingsize=1,nargs=0;
  2665. a=StringCopy(ain);
  2666. /* Pass 1. Determine nr. dimensions of output */
  2667. {
  2668. Integer over=0;
  2669. va_start(ap,out);
  2670. for(;!over;) {
  2671. enum Subtag tag=va_arg(ap,int);
  2672. switch (tag) {
  2673. case Colon:
  2674. Assert(out_dim<out.ndims,"Internal error in subscripting (:)");
  2675. Assert(a_dim<a.ndims,"Internal error in subscripting (:)");
  2676. Assert(out.dims[out_dim]==a.dims[a_dim],"Assignment array subscripting: A[:]=B must have identical sizes");
  2677. out_dim++;
  2678. a_dim++;
  2679. break;
  2680. case RangeRange:case Range:
  2681. {
  2682. Integer start,stop,stride=1,num;
  2683. Assert(out_dim<out.ndims,"Internal error in subscripting: range");
  2684. Assert(a_dim<a.ndims,"Internal error in subscripting: range ");
  2685. start=va_arg(ap,Integer);
  2686. if (tag==RangeRange) stride=va_arg(ap,Integer);
  2687. stop=va_arg(ap,Integer);
  2688. num=(stop-start+stride)/stride;
  2689. if (num<=0) num=0;
  2690. else {
  2691. Assert((start>=1)&&(start<=out.dims[out_dim]),"Assignment array subscripting: start of range out of bounds");
  2692. Assert((stop>=1)&&(stop<=out.dims[out_dim]),"Assignment array subscripting: end of range out of bounds");
  2693. }
  2694. Assert(a.dims[a_dim]==num,"Assignment array subscripting: A[a:b]=B must have identical sizes");
  2695. out_dim++;
  2696. a_dim++;
  2697. break;
  2698. }
  2699. case Vector:
  2700. {
  2701. IntegerArray v=va_arg(ap,IntegerArray);
  2702. SizeType i;
  2703. Assert(out_dim<out.ndims,"Internal error in vector subscripting");
  2704. Assert(a_dim<a.ndims,"Internal error in vector subscripting");
  2705. Assert(v.ndims==1,"Assignment array subscripting: array index must be a vector");
  2706. Assert(a.dims[a_dim]==v.dims[0],"Assignment array subscripting: A[vect]=B must have identical sizes");
  2707. for(i=0;i<v.dims[0];i++) {
  2708. Assert((v.data[i]>=1)&&(v.data[i]<=out.dims[out_dim]),"Assignment array subscripting: vector index out of bounds");
  2709. }
  2710. out_dim++;
  2711. a_dim++;
  2712. break;
  2713. }
  2714. case Index:
  2715. {
  2716. Integer i=va_arg(ap,Integer);
  2717. Assert(out_dim<out.ndims,"Internal error in scalar subscripting");
  2718. Assert((i>=1)&&(i<=out.dims[out_dim]),"Assignment array subscripting: scalar index out of bounds");
  2719. out_dim++;
  2720. break;
  2721. }
  2722. case EndMark:over=1;break;
  2723. }
  2724. }
  2725. va_end(ap);
  2726. Assert(a.ndims-a_dim==out.ndims-out_dim,"Assignment array subscripting: unequal number of dimensions");
  2727. {
  2728. SizeType i;
  2729. for(i=a_dim;i<a.ndims;i++) {
  2730. trailingsize*=a.dims[i];
  2731. Assert(a.dims[i]==out.dims[(i-a_dim)+out_dim],"Internal error in subscripting");
  2732. }
  2733. }
  2734. }
  2735. /* Pass 2. Copy output */
  2736. {
  2737. struct TaggedIndexStack*apt=0;
  2738. struct TaggedIndexStack VA_handler[100];
  2739. va_start(ap,out);
  2740. apt=HandleVaList(ap, VA_handler, sizeof(VA_handler)/sizeof(*VA_handler));
  2741. va_end(ap);
  2742. StringToSub(out,0,0,a,0,0,trailingsize,apt);
  2743. }
  2744. }
  2745. /* For each operation Op(...) we create a temporary result res */
  2746. /* and call OpAssign(res,...) */
  2747. /* The operations Op(...) are convenient and used in the code */
  2748. /* Fill */
  2749. DYMOLA_STATIC StringArray StringFillAssign(StringArray res,const char* t) {
  2750. SizeType i,prodsize;
  2751. prodsize=StringNrElements(res);
  2752. for(i=0;i<prodsize;i++) res.data[i]=t;
  2753. return res;
  2754. }
  2755. DYMOLA_STATIC StringArray StringFill(const char* t,SizeType ndims,...) {
  2756. va_list ap;
  2757. StringArray temp;
  2758. va_start(ap,ndims);
  2759. temp=StringFillAssign(StringVaTemporary(ndims,ap),t);
  2760. va_end(ap);
  2761. return temp;
  2762. }
  2763. DYMOLA_STATIC StringArray StringFillArray(const StringArray a,SizeType ndims,...) {
  2764. va_list ap;
  2765. int i,j,inputProd,fillProd;
  2766. StringArray temp;
  2767. temp.ndims=a.ndims+ndims;
  2768. temp.dims=SizeTemp(temp.ndims);
  2769. va_start(ap,ndims);
  2770. for(i=0;i<ndims;++i) temp.dims[i]=va_arg(ap,SizeType);
  2771. va_end(ap);
  2772. for(i=0;i<a.ndims;++i) temp.dims[i+ndims]=a.dims[i];
  2773. fillProd=1;
  2774. for(i=0;i<ndims;++i) fillProd*=temp.dims[i];
  2775. inputProd=StringNrElements(a);
  2776. temp.data=StringTemp(inputProd*fillProd);
  2777. for(i=0;i<inputProd;++i) {
  2778. for(j=0;j<fillProd;j++) {
  2779. temp.data[i+j*inputProd]=a.data[i];
  2780. }
  2781. }
  2782. return temp;
  2783. }
  2784. DYMOLA_STATIC const char* Stringscalar(const StringArray a) {
  2785. Assert(StringNrElements(a)==1,"scalar requires exactly one element");
  2786. return a.data[0];
  2787. }
  2788. /* Matrix operations not limited to numeric matrices */
  2789. DYMOLA_STATIC StringArray Stringvector(const StringArray a) {
  2790. StringArray res;
  2791. #ifndef NDEBUG
  2792. Integer i,found_non_one=0;
  2793. for(i=0;i<a.ndims;i++) {if (a.dims[i]>1) {Assert(!found_non_one,"vector requires exactly one vector non-unit dimension");found_non_one=1;}}
  2794. #endif
  2795. res.ndims=1;
  2796. res.dims=SizeTemp(1);
  2797. res.dims[0]=StringNrElements(a);
  2798. res.data=a.data;
  2799. return res;
  2800. }
  2801. DYMOLA_STATIC StringArray Stringmatrix(const StringArray a) {
  2802. StringArray res;
  2803. res.ndims=2;
  2804. res.dims=SizeTemp(2);
  2805. res.dims[0]=a.dims[0];
  2806. res.dims[1]=(a.ndims<2)?1:a.dims[1];
  2807. res.data=a.data;
  2808. Assert(StringNrElements(a)==StringNrElements(res),"matrix requires size(x,i)=1 for i>2");
  2809. return res;
  2810. }
  2811. DYMOLA_STATIC StringArray Stringtranspose(const StringArray a) {
  2812. StringArray res;
  2813. Integer i,j,k,remsize,leadingsize;
  2814. res.ndims=a.ndims;
  2815. Assert(a.ndims>=2,"transpose requires ndims>=2");
  2816. res.dims=SizeTemp(a.ndims);
  2817. res.dims[0]=a.dims[1];
  2818. res.dims[1]=a.dims[0];
  2819. remsize=1;
  2820. leadingsize=res.dims[0]*res.dims[1];
  2821. for(i=2;i<a.ndims;i++) {
  2822. remsize*=(res.dims[i]=a.dims[i]);
  2823. }
  2824. res.data=StringTemp(StringNrElements(res));
  2825. for(i=0;i<res.dims[0];i++) for(j=0;j<res.dims[1];j++) {
  2826. for(k=0;k<remsize;k++) {
  2827. res.data[(i*res.dims[1]+j)*remsize+k]=a.data[(j*a.dims[1]+i)*remsize+k];
  2828. }
  2829. }
  2830. return res;
  2831. }
  2832. DYMOLA_STATIC StringArray Stringsymmetric(const StringArray a) {
  2833. StringArray res;
  2834. Integer i,j,n=a.dims[0];
  2835. Assert(a.ndims==2,"symmetric requires ndims==2");
  2836. Assert(a.dims[0]==a.dims[1],"symmetric requires square matrix");
  2837. res=StringTemporaryMatrix(n,n);
  2838. for(i=1;i<=n;i++) {
  2839. for(j=1;j<=i;j++) SetStringElement(StringElement(a,j,i),res,i,j);
  2840. for(;j<=n;j++) SetStringElement(StringElement(a,i,j),res,i,j);
  2841. }
  2842. return res;
  2843. }
  2844. /* End of common routines for String*/
  2845. DYMOLA_STATIC Integer VectorWhenHandle(IntegerArray cond,IntegerArray eval,IntegerArray evalnew,Integer Event,Integer*AnyEvent) {
  2846. /* Returns true if edge of any of the vector conditions.*/
  2847. Integer anyTrue=false;
  2848. SizeType i,nrElem;
  2849. Assert(IntegerMatchingSizes(cond,eval),"Internal error in array when.");
  2850. nrElem=IntegerNrElements(cond);
  2851. for(i=0;i<nrElem;i++) {
  2852. if (cond.data[i]) {
  2853. if (Event) {
  2854. if (eval.data[i]) {
  2855. anyTrue = true;
  2856. *AnyEvent = true;
  2857. evalnew.data[i] = false;
  2858. }
  2859. }
  2860. } else {
  2861. if (Event && !eval.data[i]) {
  2862. /* *AnyEvent=true; */
  2863. }
  2864. evalnew.data[i] = true;
  2865. }
  2866. }
  2867. return anyTrue;
  2868. }
  2869. static void RealCopyMajor(RealArray to,SizeType to_offset,const RealArray x,SizeType from_offset,SizeType from_dist,SizeType dim) {
  2870. if (dim>=x.ndims-1) {
  2871. SizeType i,imax=to.dims[dim];
  2872. for(i=0;i<imax;i++)
  2873. to.data[to_offset*imax+i]=x.data[from_offset+i*from_dist];
  2874. } else {
  2875. SizeType i,imax=to.dims[dim];
  2876. for(i=0;i<imax;i++) RealCopyMajor(to,to_offset*imax+i,x,from_offset+i*from_dist,from_dist*imax,dim+1);
  2877. }
  2878. }
  2879. DYMOLA_STATIC void RealSwitchMajorAssign(RealArray temp,const RealArray x) {
  2880. RealCopyMajor(temp,0,x,0,1,0);
  2881. }
  2882. DYMOLA_STATIC RealArray RealSwitchMajor(const RealArray x) {
  2883. if (x.ndims<=1)
  2884. return x;
  2885. {
  2886. RealArray temp=RealMatch(x);
  2887. {int i;for(i=0;i<x.ndims;i++) temp.dims[i]=x.dims[x.ndims-i-1]; /* Switch dimensions */}
  2888. RealSwitchMajorAssign(temp,x);
  2889. return temp;
  2890. }
  2891. }
  2892. static void IntegerCopyMajor(IntegerArray to,SizeType to_offset,const IntegerArray x,SizeType from_offset,SizeType from_dist,SizeType dim) {
  2893. if (dim>=x.ndims-1) {
  2894. SizeType i,imax=to.dims[dim];
  2895. for(i=0;i<imax;i++)
  2896. to.data[to_offset*imax+i]=x.data[from_offset+i*from_dist];
  2897. } else {
  2898. SizeType i,imax=to.dims[dim];
  2899. for(i=0;i<imax;i++)
  2900. IntegerCopyMajor(to,to_offset*imax+i,x,from_offset+i*from_dist,from_dist*imax,dim+1);
  2901. }
  2902. }
  2903. DYMOLA_STATIC void IntegerSwitchMajorAssign(IntegerArray temp,const IntegerArray x) {
  2904. IntegerCopyMajor(temp,0,x,0,1,0);
  2905. }
  2906. DYMOLA_STATIC IntegerArray IntegerSwitchMajor(const IntegerArray x) {
  2907. if (x.ndims<=1)
  2908. return x;
  2909. {IntegerArray temp=IntegerMatch(x);
  2910. {int i;for(i=0;i<x.ndims;i++) temp.dims[i]=x.dims[x.ndims-i-1]; /* Switch dimensions */}
  2911. IntegerSwitchMajorAssign(temp,x);
  2912. return temp;
  2913. }
  2914. }
  2915. static void StringCopyMajor(StringArray to,SizeType to_offset,const StringArray x,SizeType from_offset,SizeType from_dist,SizeType dim) {
  2916. if (dim>=x.ndims-1) {
  2917. SizeType i,imax=to.dims[dim];
  2918. for(i=0;i<imax;i++)
  2919. to.data[to_offset*imax+i]=x.data[from_offset+i*from_dist];
  2920. } else {
  2921. SizeType i,imax=to.dims[dim];
  2922. for(i=0;i<imax;i++)
  2923. StringCopyMajor(to,to_offset*imax+i,x,from_offset+i*from_dist,from_dist*imax,dim+1);
  2924. }
  2925. }
  2926. DYMOLA_STATIC void StringSwitchMajorAssign(StringArray temp,const StringArray x) {
  2927. StringCopyMajor(temp,0,x,0,1,0);
  2928. }
  2929. DYMOLA_STATIC StringArray StringSwitchMajor(const StringArray x) {
  2930. if (x.ndims<=1)
  2931. return x;
  2932. {StringArray temp=StringMatch(x);
  2933. {int i;for(i=0;i<x.ndims;i++) temp.dims[i]=x.dims[x.ndims-i-1]; /* Switch dimensions */}
  2934. StringSwitchMajorAssign(temp,x);
  2935. return temp;
  2936. }
  2937. }
  2938. DYMOLA_STATIC RealArray RealLeading(int i,int j,RealArray a) {
  2939. RealArray res;
  2940. res.ndims=a.ndims-i;
  2941. res.dims=a.dims+i;
  2942. res.data=a.data+j*RealNrElements(res);
  2943. return res;
  2944. }
  2945. DYMOLA_STATIC IntegerArray IntegerLeading(int i,int j,IntegerArray a) {
  2946. IntegerArray res;
  2947. res.ndims=a.ndims-i;
  2948. res.dims=a.dims+i;
  2949. res.data=a.data+j*IntegerNrElements(res);
  2950. return res;
  2951. }
  2952. DYMOLA_STATIC StringArray StringLeading(int i,int j,StringArray a) {
  2953. StringArray res;
  2954. res.ndims=a.ndims-i;
  2955. res.dims=a.dims+i;
  2956. res.data=a.data+j*StringNrElements(res);
  2957. return res;
  2958. }
  2959. #if !defined(DYMOLA_DSPACE) && !defined(NO_FILE)
  2960. #include "amat.h"
  2961. #include "sprwat.h"
  2962. #endif
  2963. DYMOLA_STATIC RealArray readMatrix(const char*fil,const char*matnam,Integer rows,Integer cols) {
  2964. RealArray m=RealTemporaryMatrix(rows,cols);
  2965. #if !defined(DYMOLA_DSPACE) && !defined(NO_FILE)
  2966. Amatrix amatrix;
  2967. AmatGetFile afile;
  2968. int ret=amatGetOpen((char*)fil,"NoClass",(char*)0,&afile);
  2969. int found=0;
  2970. Assert(ret==0,amatError);
  2971. for(;ret==0 && !found;) {
  2972. amatInit(&amatrix);
  2973. ret=amatGetMatrix(&afile, &amatrix);
  2974. Assert(ret<=1,amatError);
  2975. if (ret<=1 && strcmp(matnam,amatrix.name)==0) {
  2976. int i,j;
  2977. Assert(rows==amatrix.nrow && cols==amatrix.ncol,"Matrix dimension incorrect");
  2978. Assert(amatrix.type==doubleMatrix || amatrix.type==realMatrix || amatrix.type==integerMatrix,"No string matrices allowed");
  2979. found=1;
  2980. for(i=0;i<rows;i++) for(j=0;j<cols;j++) {
  2981. double val=0;
  2982. switch(amatrix.type) {
  2983. case doubleMatrix:val=amatrix.data.d[i+j*rows];break;
  2984. case realMatrix:val=amatrix.data.r[i+j*rows];break;
  2985. case integerMatrix:val=amatrix.data.i[i+j*rows];break;
  2986. }
  2987. SetRealElement(val,m,i+1,j+1);
  2988. }
  2989. }
  2990. amatDel(&amatrix);
  2991. }
  2992. amatGetClose(&afile);
  2993. Assert(found, "Read of matrix failed");
  2994. #else
  2995. Assert(false, "Cannot read files");
  2996. #endif
  2997. return m;
  2998. }
  2999. DYMOLA_STATIC IntegerArray readMatrixSize(const char*fil,const char*matnam) {
  3000. IntegerArray m=IntegerTemporaryVector(2);
  3001. #if !defined(DYMOLA_DSPACE) && !defined(NO_FILE)
  3002. Amatrix amatrix;
  3003. AmatGetFile afile;
  3004. int ret=amatGetOpen((char*)fil,"NoClass",(char*)0,&afile);
  3005. int found=0;
  3006. Assert(ret==0,amatError);
  3007. for(;ret==0 && !found;) {
  3008. amatInit(&amatrix);
  3009. ret=amatGetMatrix(&afile, &amatrix);
  3010. Assert(ret<=1,amatError);
  3011. if (ret<=1 && strcmp(matnam,amatrix.name)==0) {
  3012. found=1;
  3013. SetIntegerElement(amatrix.nrow,m,1);
  3014. SetIntegerElement(amatrix.ncol,m,2);
  3015. }
  3016. amatDel(&amatrix);
  3017. }
  3018. amatGetClose(&afile);
  3019. Assert(found, "Read of matrix failed");
  3020. #else
  3021. Assert(false, "Cannot read files");
  3022. #endif
  3023. return m;
  3024. }
  3025. DYMOLA_STATIC StringArray readMATmatrices_M(const char*fil) {
  3026. StringArray s;
  3027. #if !defined(DYMOLA_DSPACE) && !defined(NO_FILE)
  3028. /* 1. Find number of matrices */
  3029. int nrMatrices=0,i=0;
  3030. Amatrix amatrix;
  3031. AmatGetFile afile;
  3032. int ret=amatGetOpen((char*)fil,"NoClass",(char*)0,&afile);
  3033. Assert(ret==0,amatError);
  3034. for(;ret==0;) {
  3035. amatInit(&amatrix);
  3036. ret=amatGetMatrix(&afile, &amatrix);
  3037. if (ret<=1) ++nrMatrices;
  3038. amatDel(&amatrix);
  3039. }
  3040. amatGetClose(&afile);
  3041. s=StringFillAssign(StringTemporaryMatrix(nrMatrices,2), "");
  3042. ret=amatGetOpen((char*)fil,"NoClass",(char*)0,&afile);
  3043. for(;ret==0;) {
  3044. amatInit(&amatrix);
  3045. ret=amatGetMatrix(&afile, &amatrix);
  3046. if (ret<=1) {
  3047. char*s1=StringAllocate(strlen(amatrix.name));
  3048. const char*s2="Unknown";
  3049. strcpy(s1, amatrix.name);
  3050. ++i;
  3051. switch(amatrix.type) {
  3052. case doubleMatrix:case realMatrix:s2="Real";break;
  3053. case integerMatrix:s2="Integer";break;
  3054. default:break;
  3055. }
  3056. SetStringElement(s1, s, i, 1);
  3057. SetStringElement(s2, s, i, 2);
  3058. }
  3059. amatDel(&amatrix);
  3060. }
  3061. amatGetClose(&afile);
  3062. #else
  3063. Assert(false, "Cannot read files");
  3064. s = StringTemporaryVector(0);
  3065. #endif
  3066. return s;
  3067. }
  3068. DYMOLA_STATIC Real RealReadScalar(const char*fil,const char*matnam) {
  3069. /*
  3070. Modified 2008-06-11 Dan Henriksson
  3071. Original implementation caused fatal error in
  3072. VS 8 when compiling models for HILS on xPC */
  3073. /* return Realscalar(RealReadArray(fil,matnam,2)); */
  3074. RealArray m;
  3075. Real val;
  3076. #if defined(DYMOLA_DSPACE) || defined(NO_FILE)
  3077. Assert(false, "Cannot read files");
  3078. m = RealTemporaryMatrix(0, 0);
  3079. #else
  3080. m = RealReadArray(fil,matnam,2);
  3081. #endif
  3082. val = Realscalar(m);
  3083. return val;
  3084. }
  3085. DYMOLA_STATIC RealArray RealReadArray(const char*fil,const char*matnam,Integer ndims) {
  3086. RealArray m;
  3087. #if !defined(DYMOLA_DSPACE) && !defined(NO_FILE)
  3088. Amatrix amatrix;
  3089. AmatGetFile afile;
  3090. int ret;
  3091. int found;
  3092. m.ndims=2;
  3093. m.dims=SizeTemp(2);
  3094. ret=amatGetOpen((char*)fil,"NoClass",(char*)0,&afile);
  3095. Assert(ret==0,amatError);
  3096. found=0;
  3097. Assert((ndims<=2)&&(ndims>=1),"Current version can only read scalars, vectors, and matrices");
  3098. for(;ret==0 && !found;) {
  3099. amatInit(&amatrix);
  3100. ret=amatGetMatrix(&afile, &amatrix);
  3101. Assert(ret<=1,amatError);
  3102. if (ret<=1 && strcmp(matnam,amatrix.name)==0) {
  3103. int i,j,rows=amatrix.nrow,cols=amatrix.ncol;
  3104. Assert(amatrix.type==doubleMatrix || amatrix.type==realMatrix || amatrix.type==integerMatrix,"No string matrices allowed");
  3105. found=1;
  3106. m.dims[0]=amatrix.nrow;
  3107. m.dims[1]=amatrix.ncol;
  3108. m.data=RealTemp(rows*cols);
  3109. for(i=0;i<rows;i++) for(j=0;j<cols;j++) {
  3110. double val=0;
  3111. switch(amatrix.type) {
  3112. case doubleMatrix:val=amatrix.data.d[i+j*rows];break;
  3113. case realMatrix:val=amatrix.data.r[i+j*rows];break;
  3114. case integerMatrix:val=amatrix.data.i[i+j*rows];break;
  3115. }
  3116. SetRealElement(val,m,i+1,j+1);
  3117. }
  3118. }
  3119. amatDel(&amatrix);
  3120. }
  3121. amatGetClose(&afile);
  3122. Assert(found, "Read of matrix failed");
  3123. if (ndims==1) return Realvector(m);
  3124. #else
  3125. Assert(false, "Cannot read files");
  3126. m = RealTemporaryMatrix(0, 0);
  3127. #endif
  3128. return m;
  3129. }
  3130. DYMOLA_STATIC Integer IntegerReadScalar(const char*fil,const char*matnam) {
  3131. /*
  3132. Modified 2008-06-11 Dan Henriksson
  3133. Original implementation caused fatal error in
  3134. VS 8 compiler for HILS on xPC */
  3135. /* return Integerscalar(IntegerReadArray(fil,matnam,2)); */
  3136. IntegerArray m;
  3137. Integer val;
  3138. #if defined(DYMOLA_DSPACE) || defined(NO_FILE)
  3139. Assert(false, "Cannot read files");
  3140. m = IntegerTemporaryMatrix(0, 0);
  3141. #else
  3142. m = IntegerReadArray(fil,matnam,2);
  3143. #endif
  3144. val = Integerscalar(m);
  3145. return val;
  3146. }
  3147. DYMOLA_STATIC IntegerArray IntegerReadArray(const char*fil,const char*matnam,Integer ndims) {
  3148. IntegerArray m;
  3149. #if !defined(DYMOLA_DSPACE) && !defined(NO_FILE)
  3150. Amatrix amatrix;
  3151. AmatGetFile afile;
  3152. int ret;
  3153. int found;
  3154. m.ndims=2;
  3155. m.dims=SizeTemp(2);
  3156. ret=amatGetOpen((char*)fil,"NoClass",(char*)0,&afile);
  3157. found=0;
  3158. Assert((ndims<=2)&&(ndims>=1),"Current version can only read scalars, vectors, and matrices");
  3159. for(;ret==0 && !found;) {
  3160. amatInit(&amatrix);
  3161. ret=amatGetMatrix(&afile, &amatrix);
  3162. if (ret<=1 && strcmp(matnam,amatrix.name)==0) {
  3163. int i,j,rows=amatrix.nrow,cols=amatrix.ncol;
  3164. Assert(amatrix.type==integerMatrix,"Integer matrix required");
  3165. found=1;
  3166. m.dims[0]=amatrix.nrow;
  3167. m.dims[1]=amatrix.ncol;
  3168. m.data=IntegerTemp(rows*cols);
  3169. for(i=0;i<rows;i++) for(j=0;j<cols;j++) {
  3170. int val=0;
  3171. switch(amatrix.type) {
  3172. case integerMatrix:val=amatrix.data.i[i+j*rows];break;
  3173. }
  3174. SetIntegerElement(val,m,i+1,j+1);
  3175. }
  3176. }
  3177. amatDel(&amatrix);
  3178. }
  3179. amatGetClose(&afile);
  3180. Assert(found, "Read of matrix failed");
  3181. if (ndims==1) return Integervector(m);
  3182. #else
  3183. Assert(false, "Cannot read files");
  3184. m = IntegerTemporaryMatrix(0, 0);
  3185. #endif
  3186. return m;
  3187. }
  3188. DYMOLA_STATIC String StringReadScalar(const char*fil,const char*matnam) {
  3189. /*
  3190. Modified 2008-06-11 Dan Henriksson
  3191. Original implementation caused fatal error in
  3192. VS 8 compiler for HILS on xPC */
  3193. /* return Stringscalar(StringReadArray(fil,matnam,1)); */
  3194. StringArray m;
  3195. String val;
  3196. #if defined(DYMOLA_DSPACE) || defined(NO_FILE)
  3197. Assert(false, "Cannot read files");
  3198. m = StringTemporaryVector(0);
  3199. #else
  3200. m = StringReadArray(fil,matnam,1);
  3201. #endif
  3202. val = Stringscalar(m);
  3203. return val;
  3204. }
  3205. DYMOLA_STATIC StringArray StringReadArray(const char*fil,const char*matnam,Integer ndims) {
  3206. StringArray m;
  3207. #if !defined(DYMOLA_DSPACE) && !defined(NO_FILE)
  3208. Amatrix amatrix;
  3209. AmatGetFile afile;
  3210. int ret=amatGetOpen((char*)fil,"NoClass",(char*)0,&afile);
  3211. int found=0;
  3212. m.ndims=1;
  3213. m.dims=SizeTemp(1);
  3214. Assert((ndims<=1)&&(ndims>=1),"Current version can only read scalars and vectors");
  3215. for(;ret==0 && !found;) {
  3216. amatInit(&amatrix);
  3217. ret=amatGetMatrixP3(&afile, &amatrix,voidMatrix,0,0);
  3218. Assert(ret<=1,amatError);
  3219. if (ret<=1 && strcmp(matnam,amatrix.name)==0) {
  3220. int i,j,rows=amatrix.nrow,cols=amatrix.ncol;
  3221. Assert(amatrix.type==charMatrix,"Only string matrices allowed");
  3222. found=1;
  3223. m.dims[0]=amatrix.nrow;
  3224. m.data=StringTemp(rows);
  3225. for(i=0;i<rows;i++) for(j=0;j<1;j++) {
  3226. #if defined(_MSC_VER) && _MSC_VER >= 1400
  3227. const char*val=amatrix.data.c[i] ? _strdup(amatrix.data.c[i]) : "";
  3228. #else
  3229. const char*val=amatrix.data.c[i] ? strdup(amatrix.data.c[i]) : "";
  3230. #endif
  3231. SetStringElement(val,m,i+1);
  3232. }
  3233. }
  3234. amatDel(&amatrix);
  3235. }
  3236. amatGetClose(&afile);
  3237. Assert(found, "Read of matrix failed");
  3238. if (ndims==1) return Stringvector(m);
  3239. #else
  3240. Assert(false, "Cannot read files");
  3241. m = StringTemporaryVector(0);
  3242. #endif
  3243. return m;
  3244. }
  3245. DYMOLA_STATIC void writeArrays(const char*fileName,int nargs,...) {
  3246. #if !defined(DYMOLA_DSPACE) && !defined(NO_FILE)
  3247. /* Format for ...: nargs copies of:
  3248. const char*name,AmatType typ,int ndims,Array (RealArray etc) or scalar (Real, Integer,...)
  3249. */
  3250. AmatPutFile file;
  3251. va_list ap;
  3252. if (amatPutOpen ((char*)fileName, amatBinary, binNormal, "", "", "", &file) != 0) {
  3253. Assert(false,"failed to open output file");
  3254. }
  3255. va_start(ap, nargs);
  3256. for(;nargs>0;nargs--) {
  3257. const char*matnam=va_arg(ap,const char*);
  3258. Amatrix amatrix;
  3259. int ret=100;
  3260. amatrix.name=(char*)matnam;
  3261. amatrix.nrow=amatrix.ncol=1;
  3262. {
  3263. AmatType argtype=va_arg(ap,AmatType);
  3264. int ndims=va_arg(ap,int);
  3265. Assert(ndims>=0 && ndims<=2,"Current version can only write scalars, vectors and matrices");
  3266. amatrix.type=argtype;
  3267. if (ndims==0) {
  3268. switch(argtype) {
  3269. case doubleMatrix:
  3270. {
  3271. Real x=va_arg(ap,Real);
  3272. amatrix.data.d=&x;
  3273. ret=amatPutMatrix(&file,amatrix);
  3274. break;
  3275. }
  3276. case integerMatrix:
  3277. {
  3278. Integer x=va_arg(ap,Integer);
  3279. amatrix.data.i=&x;
  3280. ret=amatPutMatrix(&file,amatrix);
  3281. break;
  3282. }
  3283. case charMatrix:
  3284. {
  3285. String x=va_arg(ap,String);
  3286. amatrix.data.c=(char**)&x;
  3287. ret=amatPutMatrixPadding(&file,amatrix,'\0');
  3288. break;
  3289. }
  3290. }
  3291. } else {
  3292. MarkObject mark=PushMark();
  3293. switch(argtype) {
  3294. case doubleMatrix:
  3295. {
  3296. RealArray x=va_arg(ap,RealArray);
  3297. RealArray temp=RealSwitchMajor(Realmatrix(x));
  3298. amatrix.nrow = x.dims[0];
  3299. if (x.ndims>1) amatrix.ncol = x.dims[1];
  3300. amatrix.data.d=(double*)temp.data;
  3301. ret=amatPutMatrix(&file,amatrix);
  3302. break;
  3303. }
  3304. case integerMatrix:
  3305. {
  3306. IntegerArray x=va_arg(ap,IntegerArray);
  3307. IntegerArray temp=IntegerSwitchMajor(Integermatrix(x));
  3308. amatrix.nrow = x.dims[0];
  3309. if (x.ndims>1) amatrix.ncol = x.dims[1];
  3310. amatrix.data.i = (Integer*)temp.data;
  3311. ret=amatPutMatrix(&file,amatrix);
  3312. break;
  3313. }
  3314. case charMatrix:
  3315. {
  3316. StringArray x=va_arg(ap,StringArray);
  3317. StringArray temp=StringSwitchMajor(Stringmatrix(x));
  3318. amatrix.nrow = x.dims[0];
  3319. if (x.ndims>1) amatrix.ncol = x.dims[1];
  3320. amatrix.data.c = (char**)temp.data;
  3321. ret = amatPutMatrix(&file,amatrix);
  3322. break;
  3323. }
  3324. }
  3325. PopMark(mark);
  3326. }
  3327. }
  3328. Assert(ret==0,"Write of matrix must succeed");
  3329. }
  3330. va_end(ap);
  3331. amatPutClose(&file);
  3332. #else
  3333. Assert(false, "Cannot write files");
  3334. #endif
  3335. }
  3336. DYMOLA_STATIC Integer writeMatrix(const char*fil,const char*matnam,const RealArray mat, int append) {
  3337. int ret=1;
  3338. #if !defined(DYMOLA_DSPACE) && !defined(NO_FILE)
  3339. if (append) {
  3340. int num=0,i;
  3341. Amatrix amatOld[20];
  3342. AmatGetFile fileHandle;
  3343. if ( amatGetOpen((char*)(fil), "NoClass", "0.0", &fileHandle ) == 0 ) {
  3344. for (;num<19;) {
  3345. amatInit(amatOld+num);
  3346. if (amatGetMatrix(&fileHandle, amatOld+num) !=0)
  3347. break;
  3348. if (strcmp(amatOld[num].name,matnam)!=0) {
  3349. num++;
  3350. } else {
  3351. amatDel(amatOld+num);
  3352. }
  3353. }
  3354. amatGetClose(&fileHandle);
  3355. }
  3356. {
  3357. MarkObject mark;
  3358. RealArray temp;
  3359. Amatrix amatrix;
  3360. AmatPutFile filehandle;
  3361. mark = PushMark();
  3362. temp = RealSwitchMajor(mat);
  3363. amatrix.name = (char*) matnam;
  3364. amatrix.nrow = mat.dims[0];
  3365. amatrix.ncol = mat.dims[1];
  3366. amatrix.type = doubleMatrix;
  3367. amatrix.data.d = (double*) temp.data;
  3368. if ( amatPutOpen ((char*)(fil), amatBinary,binNormal, "", "", "", &filehandle) != 0 )
  3369. ret=1;
  3370. else {
  3371. for(i=0;i<num;++i) {
  3372. ret=amatPutMatrix(&filehandle,amatOld[i]);
  3373. if (ret!=0) break;
  3374. }
  3375. if (ret==0)
  3376. ret=amatPutMatrix(&filehandle,amatrix);
  3377. amatPutClose(&filehandle);
  3378. }
  3379. for(i=0;i<num;++i) amatDel(amatOld+i);
  3380. Assert(mat.ndims==2,"Only writing of matrices");
  3381. PopMark(mark);
  3382. }
  3383. } else {
  3384. MarkObject mark;
  3385. RealArray temp;
  3386. Amatrix amatrix;
  3387. mark = PushMark();
  3388. temp = RealSwitchMajor(mat);
  3389. amatrix.name = (char*) matnam;
  3390. amatrix.nrow = mat.dims[0];
  3391. amatrix.ncol = mat.dims[1];
  3392. amatrix.type = doubleMatrix;
  3393. amatrix.data.d = (double*) temp.data;
  3394. ret=amatWrite((char*)fil,amatBinary,amatrix);
  3395. Assert(mat.ndims==2,"Only writing of matrices");
  3396. PopMark(mark);
  3397. }
  3398. #endif
  3399. return ret==0;
  3400. }
  3401. /* Major pop, e.g. at end of integration */
  3402. DYMOLA_STATIC void PopMarkMarks() {
  3403. EnsureMarkInitialized();
  3404. currentMark=startMark;
  3405. stringmark=startstringmark;
  3406. }
  3407. DYMOLA_STATIC char* GetStringMark() {
  3408. EnsureMarkInitialized();
  3409. return (char*)stringmark;
  3410. }
  3411. DYMOLA_STATIC void SetStringMark(char*s) {
  3412. EnsureMarkInitialized();
  3413. if (s) stringmark=s;
  3414. }
  3415. DYMOLA_STATIC const char* SqueezeString(const char*s, char*startMarker) {
  3416. EnsureMarkInitialized();
  3417. if (s>=startMarker && s<stringmark) {
  3418. int len=strlen(s)+1;
  3419. int i;
  3420. if (s+len<=stringmark) {
  3421. stringmark=startMarker+len;
  3422. for(i=0;i<len;++i) startMarker[i]=s[i]; /* Might overlap*/
  3423. s=startMarker;
  3424. }
  3425. } else {
  3426. stringmark=startMarker;
  3427. }
  3428. return s;
  3429. }
  3430. DYMOLA_STATIC String ConvertPointerToString(const char*a) {
  3431. if (a) return a;
  3432. else return "";
  3433. }
  3434. DYMOLA_STATIC String ConvertToNonTempString(String s) {
  3435. if (s>=startstringmark && s<Endsimplestring) {
  3436. char*s2;
  3437. SizeType len=0;
  3438. int i;
  3439. for(len=0;s[len]!=0;++len);
  3440. Assert(startstringmarkNon+len+1<Endsimplestring,"Room to allocate string");
  3441. s2=startstringmarkNon;
  3442. startstringmarkNon+=(len+1);
  3443. for(i=0;i<=len;++i) s2[i]=s[i];
  3444. return s2;
  3445. }
  3446. return s;
  3447. }
  3448. DYMOLA_STATIC StringArray ConvertToNonTempStringArray(StringArray s) {
  3449. StringArray s2;
  3450. int len,i;
  3451. s2=s;
  3452. len=StringNrElements(s);
  3453. for(i=0;i<len;++i) s2.data[i]=ConvertToNonTempString(s2.data[i]);
  3454. return s2;
  3455. }
  3456. DYMOLA_STATIC char* StringAllocate(SizeType len) {
  3457. char*ret=0;
  3458. EnsureMarkInitialized();
  3459. ret=(char*)stringmark;
  3460. Assert(stringmark+len+1<Endsimplestring,"Room to allocate string");
  3461. stringmark+=(len+1);
  3462. return ret;
  3463. }
  3464. DYMOLA_STATIC String StringAdd(String a,String b) {
  3465. char*ret=StringAllocate(strlen(a)+strlen(b));
  3466. strcpy(ret,a);
  3467. strcat(ret,b);
  3468. return ret;
  3469. }
  3470. DYMOLA_STATIC String Real2String(Real x,Integer minwidth,Integer precision) {
  3471. char buf[100];
  3472. char*ret;
  3473. Assert(precision<40 && minwidth<40,"");
  3474. sprintf(buf,"%*.*g",(int)minwidth,(int)precision,(double)x);
  3475. ret=StringAllocate(strlen(buf));
  3476. strcpy(ret,buf);
  3477. return ret;
  3478. }
  3479. DYMOLA_STATIC String Integer2String(Integer x,Integer minwidth,Integer precision) {
  3480. char buf[100];
  3481. char*ret;
  3482. Assert(precision<40 && minwidth<40,"");
  3483. sprintf(buf,"%*.*ld",(int)minwidth,(int)precision,(int)x);
  3484. ret=StringAllocate(strlen(buf));
  3485. strcpy(ret,buf);
  3486. return ret;
  3487. }
  3488. DYMOLA_STATIC String Real2String3(Real x,Integer leftJustified,Integer minwidth,Integer precision) {
  3489. char buf[100];
  3490. char*ret;
  3491. Assert(precision<40 && minwidth<40,"");
  3492. sprintf(buf,leftJustified?"%-*.*g":"%*.*g",(int)minwidth,(int)precision,(double)x);
  3493. ret=StringAllocate(strlen(buf));
  3494. strcpy(ret,buf);
  3495. return ret;
  3496. }
  3497. DYMOLA_STATIC String Real2String2(Real x,Integer leftJustified,Integer minwidth) {
  3498. return Real2String3(x,leftJustified,minwidth,6);
  3499. }
  3500. DYMOLA_STATIC String Integer2String2(Integer x,Integer leftJustified,Integer minwidth) {
  3501. char buf[100];
  3502. char*ret;
  3503. Assert(minwidth<40,"");
  3504. sprintf(buf,leftJustified?"%-*ld":"%*ld",(int)minwidth,(int)x);
  3505. ret=StringAllocate(strlen(buf));
  3506. strcpy(ret,buf);
  3507. return ret;
  3508. }
  3509. DYMOLA_STATIC String Boolean2String2(Integer x,Integer leftJustified,Integer minwidth) {
  3510. char buf[100];
  3511. char*ret;
  3512. Assert(minwidth<40,"");
  3513. sprintf(buf,leftJustified?"%-*s":"%*s",(int)minwidth,x?"true":"false");
  3514. ret=StringAllocate(strlen(buf));
  3515. strcpy(ret,buf);
  3516. return ret;
  3517. }
  3518. DYMOLA_STATIC String Real2StringFormat(Real x,String s) {
  3519. char buf[100];
  3520. char*ret;
  3521. buf[99]='\0';
  3522. sprintf(buf,StringAdd("%",s),x);
  3523. Assert(buf[99]=='\0',"");
  3524. ret=StringAllocate(strlen(buf));
  3525. strcpy(ret,buf);
  3526. return ret;
  3527. }
  3528. DYMOLA_STATIC void CopySlice(Real*x,RealArray y) {
  3529. SizeType nrElem=RealNrElements(y);
  3530. int i;
  3531. for(i=0;i<nrElem;++i) x[i]=y.data[i];
  3532. return;
  3533. }
  3534. DYMOLA_STATIC RealArray RealTemporaryDense(Real*d,SizeType ndims,...) {
  3535. RealArray temp;
  3536. va_list ap;
  3537. va_start(ap,ndims);
  3538. temp=RealVaTemporarySize(ndims,ap);
  3539. va_end(ap);
  3540. temp.data=d;
  3541. return temp;
  3542. }
  3543. DYMOLA_STATIC StringArray StringTemporaryDense(String*d,SizeType ndims,...) {
  3544. StringArray temp;
  3545. va_list ap;
  3546. va_start(ap,ndims);
  3547. temp=StringVaTemporarySize(ndims,ap);
  3548. va_end(ap);
  3549. temp.data=d;
  3550. return temp;
  3551. }
  3552. DYMOLA_STATIC IntegerArray IntegerTemporaryDense(Real*d,SizeType ndims,...) {
  3553. IntegerArray temp;
  3554. int i,nrElem;
  3555. va_list ap;
  3556. va_start(ap,ndims);
  3557. temp=IntegerVaTemporary(ndims,ap);
  3558. va_end(ap);
  3559. nrElem=IntegerNrElements(temp);
  3560. for(i=0;i<nrElem;++i) temp.data[i]=(Integer)(d[i]);
  3561. return temp;
  3562. }
  3563. DYMOLA_STATIC IntegerArray IntegerTemporaryDenseOrig(Integer*d,SizeType ndims,...) {
  3564. IntegerArray temp;
  3565. va_list ap;
  3566. va_start(ap,ndims);
  3567. temp=IntegerVaTemporarySize(ndims,ap);
  3568. va_end(ap);
  3569. temp.data=d;
  3570. return temp;
  3571. }
  3572. DYMOLA_STATIC void ModelicaError(const char *string) {
  3573. DymosimError((string));
  3574. }
  3575. DYMOLA_STATIC void ModelicaFormatError(const char *string,...) {
  3576. char buf[4000];
  3577. va_list ap;
  3578. va_start(ap,string);
  3579. #if defined(__WATCOMC__) && defined(DynSimStruct) || defined(NO_FILE) || defined(DYMOLA_DSPACE)
  3580. strcpy(buf,string);
  3581. #elif defined(_MSC_VER) && _MSC_VER>=1200
  3582. _vsnprintf(buf,sizeof(buf)/sizeof(*buf),string,ap);
  3583. #else
  3584. vsprintf(buf,string,ap);
  3585. #endif
  3586. va_end(ap);
  3587. DymosimError(buf);
  3588. }
  3589. DYMOLA_STATIC void DymosimMessageNoNL(const char*);
  3590. DYMOLA_STATIC void ModelicaMessage(const char *string) {
  3591. DymosimMessageNoNL(string);
  3592. }
  3593. DYMOLA_STATIC void ModelicaFormatMessage(const char *string,...) {
  3594. char buf[4000];
  3595. va_list ap;
  3596. va_start(ap,string);
  3597. #if defined(__WATCOMC__) && defined(DynSimStruct) || defined(NO_FILE) || defined(DYMOLA_DSPACE)
  3598. strcpy(buf,string);
  3599. #elif defined(_MSC_VER) && _MSC_VER>=1200
  3600. _vsnprintf(buf,sizeof(buf)/sizeof(*buf),string,ap);
  3601. #else
  3602. vsprintf(buf,string,ap);
  3603. #endif
  3604. va_end(ap);
  3605. DymosimMessageNoNL(buf);
  3606. }
  3607. DYMOLA_STATIC char* ModelicaAllocateString(size_t len) {
  3608. char*s=StringAllocate(len);
  3609. s[0]='\0';
  3610. return s;
  3611. }
  3612. DYMOLA_STATIC char* ModelicaAllocateStringWithErrorReturn(size_t len) {
  3613. EnsureMarkInitialized();
  3614. if (stringmark+len+1<Endsimplestring)
  3615. return ModelicaAllocateString(len);
  3616. else return 0;
  3617. }
  3618. DYMOLA_STATIC IntegerArray ANDArray(const IntegerArray a,const IntegerArray b) {
  3619. SizeType prodsize,i;
  3620. IntegerArray res=IntegerMatch(a);
  3621. Assert(IntegerMatchingSizes(a,b),"and of arrays require arguments of matching size");
  3622. prodsize=IntegerNrElements(a);
  3623. for(i=0;i<prodsize;i++) res.data[i]=a.data[i] && b.data[i];
  3624. return res;
  3625. }
  3626. DYMOLA_STATIC IntegerArray ORArray(const IntegerArray a,const IntegerArray b) {
  3627. SizeType prodsize,i;
  3628. IntegerArray res=IntegerMatch(a);
  3629. Assert(IntegerMatchingSizes(a,b),"or of arrays require arguments of matching size");
  3630. prodsize=IntegerNrElements(a);
  3631. for(i=0;i<prodsize;i++) res.data[i]=a.data[i] || b.data[i];
  3632. return res;
  3633. }
  3634. DYMOLA_STATIC IntegerArray NOTArray(const IntegerArray a) {
  3635. SizeType prodsize,i;
  3636. IntegerArray res=IntegerMatch(a);
  3637. prodsize=IntegerNrElements(a);
  3638. for(i=0;i<prodsize;i++) res.data[i]=!a.data[i];
  3639. return res;
  3640. }
  3641. #if defined(LIBDS_EXPORTS) || defined(LIBDSDLL_EXPORTS)
  3642. /*TODO: can it really be excluded for Windows? */
  3643. #if !defined(_MSC_VER) || defined(__MINGW32__)
  3644. #include "localeless.cpp"
  3645. #endif
  3646. #else
  3647. #include "localeless.cpp"
  3648. #endif
  3649. #endif
  3650. #if defined(_MSC_VER)
  3651. #if !DymolaGlobalOptimizations_
  3652. /* Reset optimization to compiler switches */
  3653. #pragma optimize( "", on )
  3654. #endif
  3655. #endif
  3656. #endif