opcua_basictypes.c 35 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099
  1. /*
  2. * opcua_basictypes.c
  3. *
  4. * Created on: 13.03.2014
  5. * Author: mrt
  6. */
  7. #include "opcua.h"
  8. #include <stdio.h> // printf
  9. #include <stdlib.h> // alloc, free
  10. #include <string.h>
  11. #include "opcua_basictypes.h"
  12. UA_Int32 UA_encode(void* const data, UA_Int32 *pos, UA_Int32 type, char* dst) {
  13. return UA_[type].encode(data,pos,dst);
  14. }
  15. UA_Int32 UA_decode(char* const data, UA_Int32* pos, UA_Int32 type, void* dst){
  16. return UA_[type].decode(data,pos,dst);
  17. }
  18. UA_Int32 UA_calcSize(void* const data, UInt32 type) {
  19. return (UA_[type].calcSize)(data);
  20. }
  21. UA_Int32 UA_Array_calcSize(UA_Int32 nElements, UA_Int32 type, void const ** data) {
  22. int length = sizeof(UA_Int32);
  23. int i;
  24. char** ptr = (char**)data;
  25. if (nElements > 0) {
  26. for(i=0; i<nElements;i++) {
  27. length += UA_calcSize((void*)ptr[i],type);
  28. }
  29. }
  30. return length;
  31. }
  32. UA_Int32 UA_Array_encode(void const **src, UA_Int32 noElements, UA_Int32 type, UA_Int32* pos, char * dst) {
  33. UA_Int32 retVal = 0;
  34. UA_Int32 i = 0;
  35. UA_Int32_encode(&noElements, pos, dst);
  36. for(i=0; i<noElements; i++) {
  37. retVal |= UA_[type].encode((void*)src[i], pos, dst);
  38. }
  39. return retVal;
  40. }
  41. UA_Int32 UA_Array_decode(char const * src,UA_Int32 noElements, UA_Int32 type, UA_Int32* pos, void const **dst) {
  42. UA_Int32 retval = 0;
  43. UA_Int32 i = 0;
  44. for(i=0; i<noElements; i++) {
  45. retval |= UA_[type].decode(src, pos, (void*)dst[i]);
  46. }
  47. return retval;
  48. }
  49. UA_Int32 UA_free(void * ptr){
  50. free(ptr);
  51. return UA_SUCCESS;
  52. }
  53. UA_Int32 UA_alloc(void ** ptr, int size){
  54. *ptr = malloc(size);
  55. printf("UA_alloc - ptr=%p, size=%d\n",*ptr,size);
  56. if(*ptr == UA_NULL) return UA_ERR_NO_MEMORY;
  57. return UA_SUCCESS;
  58. }
  59. UA_Int32 UA_memcpy(void * dst, void const * src, int size){
  60. memcpy(dst, src, size);
  61. return UA_SUCCESS;
  62. }
  63. UA_TYPE_METHOD_CALCSIZE_SIZEOF(UA_Boolean)
  64. UA_Int32 UA_Boolean_encode(UA_Boolean const * src, UA_Int32* pos, char * dst) {
  65. UA_Boolean tmpBool = ((*src > 0) ? UA_TRUE : UA_FALSE);
  66. memcpy(&(dst[(*pos)++]), &tmpBool, sizeof(UA_Boolean));
  67. return UA_SUCCESS;
  68. }
  69. UA_Int32 UA_Boolean_decode(char const * src, UA_Int32* pos, UA_Boolean * dst) {
  70. *dst = ((UA_Boolean) (src[(*pos)++]) > 0) ? UA_TRUE : UA_FALSE;
  71. return UA_SUCCESS;
  72. }
  73. UA_TYPE_METHOD_DELETE_FREE(UA_Boolean)
  74. UA_TYPE_METHOD_DELETEMEMBERS_NOACTION(UA_Boolean)
  75. UA_TYPE_METHOD_CALCSIZE_SIZEOF(UA_Byte)
  76. UA_Int32 UA_Byte_encode(UA_Byte const * src, UA_Int32* pos, char * dst) {
  77. *dst = src[(*pos)++];
  78. return UA_SUCCESS;
  79. }
  80. UA_Int32 UA_Byte_decode(char const * src, UA_Int32* pos, UA_Byte * dst) {
  81. memcpy(&(dst[(*pos)++]), src, sizeof(UA_Byte));
  82. return UA_SUCCESS;
  83. }
  84. UA_TYPE_METHOD_DELETE_FREE(UA_Byte)
  85. UA_TYPE_METHOD_DELETEMEMBERS_NOACTION(UA_Byte)
  86. UA_TYPE_METHOD_CALCSIZE_SIZEOF(UA_SByte)
  87. UA_Int32 UA_SByte_encode(UA_SByte const * src, UA_Int32* pos, char * dst) {
  88. dst[(*pos)++] = *src;
  89. return UA_SUCCESS;
  90. }
  91. UA_Int32 UA_SByte_decode(char const * src, UA_Int32* pos, UA_SByte * dst) {
  92. *dst = src[(*pos)++];
  93. return 1;
  94. }
  95. UA_TYPE_METHOD_DELETE_FREE(UA_SByte)
  96. UA_TYPE_METHOD_DELETEMEMBERS_NOACTION(UA_SByte)
  97. UA_TYPE_METHOD_CALCSIZE_SIZEOF(UA_UInt16)
  98. UA_Int32 UA_UInt16_encode(UA_UInt16 const *src, UA_Int32* pos, char * dst) {
  99. memcpy(&(dst[*pos]), src, sizeof(UA_UInt16));
  100. *pos += sizeof(UA_UInt16);
  101. return UA_SUCCESS;
  102. }
  103. UA_Int32 UA_UInt16_decode(char const * src, UA_Int32* pos, UA_UInt16* dst) {
  104. Byte t1 = src[(*pos)++];
  105. UInt16 t2 = (UInt16) (src[(*pos)++] << 8);
  106. *dst = t1 + t2;
  107. return UA_SUCCESS;
  108. }
  109. UA_TYPE_METHOD_DELETE_FREE(UA_UInt16)
  110. UA_TYPE_METHOD_DELETEMEMBERS_NOACTION(UA_UInt16)
  111. UA_TYPE_METHOD_CALCSIZE_SIZEOF(UA_Int16)
  112. UA_Int32 UA_Int16_encode(UA_Int16 const * src, UA_Int32* pos, char* dst) {
  113. memcpy(&(dst[*pos]), src, sizeof(UA_Int16));
  114. *pos += sizeof(UA_Int16);
  115. return UA_SUCCESS;
  116. }
  117. UA_Int32 UA_Int16_decode(char const * src, UA_Int32* pos, UA_Int16 *dst) {
  118. Int16 t1 = (Int16) (((SByte) (src[(*pos)++]) & 0xFF));
  119. Int16 t2 = (Int16) (((SByte) (src[(*pos)++]) & 0xFF) << 8);
  120. *dst = t1 + t2;
  121. return UA_SUCCESS;
  122. }
  123. UA_TYPE_METHOD_DELETE_FREE(UA_Int16)
  124. UA_TYPE_METHOD_DELETEMEMBERS_NOACTION(UA_Int16)
  125. UA_TYPE_METHOD_CALCSIZE_SIZEOF(UA_Int32)
  126. UA_Int32 UA_Int32_encode(UA_Int32 const * src, UA_Int32* pos, char *dst) {
  127. memcpy(&(dst[*pos]), src, sizeof(UA_Int32));
  128. *pos += sizeof(UA_Int32);
  129. return UA_SUCCESS;
  130. }
  131. UA_Int32 UA_Int32_decode(char const * src, UA_Int32* pos, UA_Int32* dst) {
  132. UA_Int32 t1 = (UA_Int32) (((SByte) (src[(*pos)++]) & 0xFF));
  133. UA_Int32 t2 = (UA_Int32) (((SByte) (src[(*pos)++]) & 0xFF) << 8);
  134. UA_Int32 t3 = (UA_Int32) (((SByte) (src[(*pos)++]) & 0xFF) << 16);
  135. UA_Int32 t4 = (UA_Int32) (((SByte) (src[(*pos)++]) & 0xFF) << 24);
  136. *dst = t1 + t2 + t3 + t4;
  137. return UA_SUCCESS;
  138. }
  139. UA_TYPE_METHOD_DELETE_FREE(UA_Int32)
  140. UA_TYPE_METHOD_DELETEMEMBERS_NOACTION(UA_Int32)
  141. UA_TYPE_METHOD_CALCSIZE_SIZEOF(UA_UInt32)
  142. UA_Int32 UA_UInt32_encode(UA_UInt32 const * src, UA_Int32* pos, char *dst) {
  143. memcpy(&(dst[*pos]), src, sizeof(UA_UInt32));
  144. *pos += sizeof(UA_UInt32);
  145. return UA_SUCCESS;
  146. }
  147. UA_Int32 UA_UInt32_decode(char const * src, UA_Int32* pos, UA_UInt32 *dst) {
  148. UInt32 t1 = (UInt32) src[(*pos)++];
  149. UInt32 t2 = (UInt32) src[(*pos)++] << 8;
  150. UInt32 t3 = (UInt32) src[(*pos)++] << 16;
  151. UInt32 t4 = (UInt32) src[(*pos)++] << 24;
  152. *dst = t1 + t2 + t3 + t4;
  153. return UA_SUCCESS;
  154. }
  155. UA_TYPE_METHOD_DELETE_FREE(UA_UInt32)
  156. UA_TYPE_METHOD_DELETEMEMBERS_NOACTION(UA_UInt32)
  157. UA_TYPE_METHOD_CALCSIZE_SIZEOF(UA_Int64)
  158. UA_Int32 UA_Int64_encode(UA_Int64 const * src, UA_Int32* pos, char *dst) {
  159. memcpy(&(dst[*pos]), src, sizeof(UA_Int64));
  160. *pos += sizeof(UA_Int64);
  161. return UA_SUCCESS;
  162. }
  163. UA_Int32 UA_Int64_decode(char const * src, UA_Int32* pos, UA_Int64* dst) {
  164. Int64 t1 = (Int64) src[(*pos)++];
  165. Int64 t2 = (Int64) src[(*pos)++] << 8;
  166. Int64 t3 = (Int64) src[(*pos)++] << 16;
  167. Int64 t4 = (Int64) src[(*pos)++] << 24;
  168. Int64 t5 = (Int64) src[(*pos)++] << 32;
  169. Int64 t6 = (Int64) src[(*pos)++] << 40;
  170. Int64 t7 = (Int64) src[(*pos)++] << 48;
  171. Int64 t8 = (Int64) src[(*pos)++] << 56;
  172. *dst = t1 + t2 + t3 + t4 + t5 + t6 + t7 + t8;
  173. return UA_SUCCESS;
  174. }
  175. UA_TYPE_METHOD_DELETE_FREE(UA_Int64)
  176. UA_TYPE_METHOD_DELETEMEMBERS_NOACTION(UA_Int64)
  177. UA_TYPE_METHOD_CALCSIZE_SIZEOF(UA_UInt64)
  178. UA_Int32 UA_UInt64_encode(UA_UInt64 const * src , UA_Int32* pos, char * dst) {
  179. memcpy(&(dst[*pos]), src, sizeof(UA_UInt64));
  180. *pos += sizeof(UInt64);
  181. return UA_SUCCESS;
  182. }
  183. UA_Int32 UA_UInt64_decode(char const * src, UA_Int32* pos, UA_UInt64* dst) {
  184. UInt64 t1 = (UInt64) src[(*pos)++];
  185. UInt64 t2 = (UInt64) src[(*pos)++] << 8;
  186. UInt64 t3 = (UInt64) src[(*pos)++] << 16;
  187. UInt64 t4 = (UInt64) src[(*pos)++] << 24;
  188. UInt64 t5 = (UInt64) src[(*pos)++] << 32;
  189. UInt64 t6 = (UInt64) src[(*pos)++] << 40;
  190. UInt64 t7 = (UInt64) src[(*pos)++] << 48;
  191. UInt64 t8 = (UInt64) src[(*pos)++] << 56;
  192. *dst = t1 + t2 + t3 + t4 + t5 + t6 + t7 + t8;
  193. return UA_SUCCESS;
  194. }
  195. UA_TYPE_METHOD_DELETE_FREE(UA_UInt64)
  196. UA_TYPE_METHOD_DELETEMEMBERS_NOACTION(UA_UInt64)
  197. UA_TYPE_METHOD_CALCSIZE_SIZEOF(UA_Float)
  198. UA_Int32 UA_Float_decode(char const * src, UA_Int32* pos, UA_Float* dst) {
  199. // TODO: not yet implemented
  200. memcpy(dst, &(src[*pos]), sizeof(UA_Float));
  201. *pos += sizeof(UA_Float);
  202. return UA_SUCCESS;
  203. }
  204. UA_Int32 UA_Float_encode(UA_Float const * src, UA_Int32* pos, char *dst) {
  205. // TODO: not yet implemented
  206. memcpy(&(dst[*pos]), src, sizeof(UA_Float));
  207. *pos += sizeof(UA_Float);
  208. return UA_SUCCESS;
  209. }
  210. UA_TYPE_METHOD_DELETE_FREE(UA_Float)
  211. UA_TYPE_METHOD_DELETEMEMBERS_NOACTION(UA_Float)
  212. UA_TYPE_METHOD_CALCSIZE_SIZEOF(UA_Double)
  213. UA_Int32 UA_Double_decode(char const * src, UA_Int32* pos, UA_Double * dst) {
  214. // TODO: not yet implemented
  215. Double tmpDouble;
  216. tmpDouble = (Double) (src[*pos]);
  217. *pos += sizeof(UA_Double);
  218. *dst = tmpDouble;
  219. return UA_SUCCESS;
  220. }
  221. UA_Int32 UA_Double_encode(UA_Double const * src, UA_Int32 *pos, char * dst) {
  222. // TODO: not yet implemented
  223. memcpy(&(dst[*pos]), src, sizeof(UA_Double));
  224. *pos *= sizeof(UA_Double);
  225. return UA_SUCCESS;
  226. }
  227. UA_TYPE_METHOD_DELETE_FREE(UA_Double)
  228. UA_TYPE_METHOD_DELETEMEMBERS_NOACTION(UA_Double)
  229. UA_Int32 UA_String_calcSize(UA_String const * string) {
  230. if (string == UA_NULL) {
  231. // internal size for UA_memalloc
  232. return sizeof(UA_String);
  233. } else {
  234. // binary encoding size
  235. if (string->length > 0) {
  236. return sizeof(UA_Int32) + string->length * sizeof(UA_Byte);
  237. } else {
  238. return sizeof(UA_Int32);
  239. }
  240. }
  241. }
  242. UA_Int32 UA_String_encode(UA_String const * src, UA_Int32* pos, char *dst) {
  243. UA_Int32_encode(&(src->length),pos,dst);
  244. if (src->length > 0) {
  245. UA_memcpy((void*)&(dst[*pos]), src->data, src->length);
  246. *pos += src->length;
  247. }
  248. return UA_SUCCESS;
  249. }
  250. UA_Int32 UA_String_decode(char const * src, UA_Int32* pos, UA_String * dst) {
  251. UA_Int32 retval = UA_SUCCESS;
  252. retval |= UA_Int32_decode(src,pos,&(dst->length));
  253. if (dst->length > 0) {
  254. retval |= UA_alloc((void**)&(dst->data),dst->length);
  255. retval |= UA_memcpy((void*)&(src[*pos]),dst->data,dst->length);
  256. *pos += dst->length;
  257. } else {
  258. dst->data = UA_NULL;
  259. }
  260. return retval;
  261. }
  262. UA_TYPE_METHOD_DELETE_STRUCT(UA_String)
  263. UA_Int32 UA_String_deleteMembers(UA_String* p) { return UA_free(p->data); }
  264. UA_Int32 UA_String_copy(UA_String const * src, UA_String* dst) {
  265. UA_Int32 retval = UA_SUCCESS;
  266. dst->length = src->length;
  267. dst->data = UA_NULL;
  268. if (src->length > 0) {
  269. retval |= UA_alloc((void**)&(dst->data), src->length);
  270. if (retval == UA_SUCCESS) {
  271. retval |= UA_memcpy((void*)dst->data, src->data, src->length);
  272. }
  273. }
  274. return retval;
  275. }
  276. UA_String UA_String_null = { -1, UA_NULL };
  277. UA_Byte UA_Byte_securityPoliceNoneData[] = "http://opcfoundation.org/UA/SecurityPolicy#None";
  278. UA_String UA_String_securityPoliceNone = { sizeof(UA_Byte_securityPoliceNoneData), UA_Byte_securityPoliceNoneData };
  279. // TODO: should we really handle UA_String and UA_ByteString the same way?
  280. UA_TYPE_METHOD_CALCSIZE_AS(UA_ByteString, UA_String)
  281. UA_TYPE_METHOD_ENCODE_AS(UA_ByteString, UA_String)
  282. UA_TYPE_METHOD_DECODE_AS(UA_ByteString, UA_String)
  283. UA_TYPE_METHOD_DELETE_AS(UA_ByteString, UA_String)
  284. UA_TYPE_METHOD_DELETEMEMBERS_AS(UA_ByteString, UA_String)
  285. UA_Int32 UA_Guid_calcSize(UA_Guid const * p) {
  286. if (p == UA_NULL) {
  287. return sizeof(UA_Guid);
  288. } else {
  289. return 0
  290. + sizeof(p->data1)
  291. + sizeof(p->data2)
  292. + sizeof(p->data3)
  293. + UA_ByteString_calcSize(&(p->data4))
  294. ;
  295. }
  296. }
  297. UA_Int32 UA_Guid_encode(UA_Guid const *src, UA_Int32* pos, char *dst) {
  298. UA_Int32 retval = UA_SUCCESS;
  299. retval |= UA_UInt32_encode(&(src->data1), pos, dst);
  300. retval |= UA_UInt16_encode(&(src->data2), pos, dst);
  301. retval |= UA_UInt16_encode(&(src->data3), pos, dst);
  302. retval |= UA_ByteString_encode(&(src->data4), pos, dst);
  303. return UA_SUCCESS;
  304. }
  305. UA_Int32 UA_Guid_decode(char const * src, UA_Int32* pos, UA_Guid *dst) {
  306. UA_Int32 retval = UA_SUCCESS;
  307. retval |= UA_UInt32_decode(src,pos,&(dst->data1));
  308. retval |= UA_UInt16_decode(src,pos,&(dst->data2));
  309. retval |= UA_UInt16_decode(src,pos,&(dst->data3));
  310. retval |= UA_ByteString_decode(src,pos,&(dst->data4));
  311. return retval;
  312. }
  313. UA_TYPE_METHOD_DELETE_STRUCT(UA_Guid)
  314. UA_Int32 UA_Guid_deleteMembers(UA_Guid* p) { return UA_ByteString_delete(&(p->data4)); }
  315. UA_Int32 UA_LocalizedText_calcSize(UA_LocalizedText const * p) {
  316. UA_Int32 length = 0;
  317. if (p==UA_NULL) {
  318. // size for UA_memalloc
  319. length = sizeof(UA_LocalizedText);
  320. } else {
  321. // size for binary encoding
  322. length += p->encodingMask;
  323. if (p->encodingMask & 0x01) {
  324. length += UA_String_calcSize(&(p->locale));
  325. }
  326. if (p->encodingMask & 0x02) {
  327. length += UA_String_calcSize(&(p->text));
  328. }
  329. }
  330. return length;
  331. }
  332. UA_Int32 UA_LocalizedText_encode(UA_LocalizedText const * src, UA_Int32 *pos,
  333. char * dst) {
  334. UA_Int32 retval = UA_SUCCESS;
  335. retval |= UA_Byte_encode(&(src->encodingMask),pos,dst);
  336. if (src->encodingMask & 0x01) {
  337. UA_String_encode(&(src->locale),pos,dst);
  338. }
  339. if (src->encodingMask & 0x02) {
  340. UA_String_encode(&(src->text),pos,dst);
  341. }
  342. return retval;
  343. }
  344. UA_Int32 UA_LocalizedText_decode(char const * src, UA_Int32 *pos,
  345. UA_LocalizedText *dst) {
  346. UA_Int32 retval = UA_SUCCESS;
  347. retval |= UA_String_copy(&UA_String_null,&(dst->locale));
  348. retval |= UA_String_copy(&UA_String_null,&(dst->text));
  349. retval |= UA_Byte_decode(src,pos,&(dst->encodingMask));
  350. if (dst->encodingMask & 0x01) {
  351. retval |= UA_String_decode(src,pos,&(dst->locale));
  352. }
  353. if (dst->encodingMask & 0x02) {
  354. retval |= UA_String_decode(src,pos,&(dst->text));
  355. }
  356. return retval;
  357. }
  358. UA_TYPE_METHOD_DELETE_STRUCT(UA_LocalizedText)
  359. UA_Int32 UA_LocalizedText_deleteMembers(UA_LocalizedText* p) {
  360. return UA_SUCCESS
  361. || UA_String_deleteMembers(&(p->locale))
  362. || UA_String_deleteMembers(&(p->text))
  363. ;
  364. }
  365. /* Serialization of UA_NodeID is specified in 62541-6, §5.2.2.9 */
  366. UA_Int32 UA_NodeId_calcSize(UA_NodeId const *p) {
  367. UA_Int32 length = 0;
  368. if (p == UA_NULL) {
  369. length = sizeof(UA_NodeId);
  370. } else {
  371. switch (p->encodingByte) {
  372. case UA_NodeIdType_TwoByte:
  373. length += 2 * sizeof(UA_Byte);
  374. break;
  375. case UA_NodeIdType_FourByte:
  376. length += 4 * sizeof(UA_Byte);
  377. break;
  378. case UA_NodeIdType_Numeric:
  379. length += sizeof(UA_Byte) + sizeof(UA_UInt16) + sizeof(UInt32);
  380. break;
  381. case UA_NodeIdType_String:
  382. length += sizeof(UA_Byte) + sizeof(UA_UInt16) + UA_String_calcSize(&(p->identifier.string));
  383. break;
  384. case UA_NodeIdType_Guid:
  385. length += sizeof(UA_Byte) + sizeof(UA_UInt16) + UA_Guid_calcSize(&(p->identifier.guid));
  386. break;
  387. case UA_NodeIdType_ByteString:
  388. length += sizeof(UA_Byte) + sizeof(UA_UInt16) + UA_ByteString_calcSize(&(p->identifier.byteString));
  389. break;
  390. default:
  391. break;
  392. }
  393. }
  394. return length;
  395. }
  396. UA_Int32 UA_NodeId_encode(UA_NodeId const * src, UA_Int32* pos, char *dst) {
  397. // temporary variables for endian-save code
  398. UA_Byte srcByte;
  399. UA_UInt16 srcUInt16;
  400. int retval = UA_SUCCESS;
  401. retval |= UA_Byte_encode(&(src->encodingByte),pos,dst);
  402. switch (src->encodingByte) {
  403. case UA_NodeIdType_TwoByte:
  404. srcByte = src->identifier.numeric;
  405. retval |= UA_Byte_encode(&srcByte,pos,dst);
  406. break;
  407. case UA_NodeIdType_FourByte:
  408. srcByte = src->namespace;
  409. srcUInt16 = src->identifier.numeric;
  410. retval |= UA_Byte_encode(&srcByte,pos,dst);
  411. retval |= UA_UInt16_encode(&srcUInt16,pos,dst);
  412. break;
  413. case UA_NodeIdType_Numeric:
  414. retval |= UA_UInt16_encode(&(src->namespace), pos, dst);
  415. retval |= UA_UInt32_encode(&(src->identifier.numeric), pos, dst);
  416. break;
  417. case UA_NodeIdType_String:
  418. retval |= UA_UInt16_encode(&(src->namespace), pos, dst);
  419. retval |= UA_String_encode(&(src->identifier.string), pos, dst);
  420. break;
  421. case UA_NodeIdType_Guid:
  422. retval |= UA_UInt16_encode(&(src->namespace), pos, dst);
  423. retval |= UA_Guid_encode(&(src->identifier.guid), pos, dst);
  424. break;
  425. case UA_NodeIdType_ByteString:
  426. retval |= UA_UInt16_encode(&(src->namespace), pos, dst);
  427. retval |= UA_ByteString_encode(&(src->identifier.byteString), pos, dst);
  428. break;
  429. }
  430. return retval;
  431. }
  432. UA_Int32 UA_NodeId_decode(char const * src, UA_Int32* pos, UA_NodeId *dst) {
  433. int retval = UA_SUCCESS;
  434. // temporary variables to overcome decoder's non-endian-saveness for datatypes
  435. UA_Byte dstByte;
  436. UA_UInt16 dstUInt16;
  437. retval |= UA_Byte_decode(src,pos,&(dst->encodingByte));
  438. switch (dst->encodingByte) {
  439. case UA_NodeIdType_TwoByte: // Table 7
  440. retval |=UA_Byte_decode(src, pos, &dstByte);
  441. dst->identifier.numeric = dstByte;
  442. dst->namespace = 0; // default namespace
  443. break;
  444. case UA_NodeIdType_FourByte: // Table 8
  445. retval |=UA_Byte_decode(src, pos, &dstByte);
  446. dst->namespace= dstByte;
  447. retval |=UA_UInt16_decode(src, pos, &dstUInt16);
  448. dst->identifier.numeric = dstUInt16;
  449. break;
  450. case UA_NodeIdType_Numeric: // Table 6, first entry
  451. retval |=UA_UInt16_decode(src,pos,&(dst->namespace));
  452. retval |=UA_UInt32_decode(src,pos,&(dst->identifier.numeric));
  453. break;
  454. case UA_NodeIdType_String: // Table 6, second entry
  455. retval |=UA_UInt16_decode(src,pos,&(dst->namespace));
  456. retval |=UA_String_decode(src,pos,&(dst->identifier.string));
  457. break;
  458. case UA_NodeIdType_Guid: // Table 6, third entry
  459. retval |=UA_UInt16_decode(src,pos,&(dst->namespace));
  460. retval |=UA_Guid_decode(src,pos,&(dst->identifier.guid));
  461. break;
  462. case UA_NodeIdType_ByteString: // Table 6, "OPAQUE"
  463. retval |=UA_UInt16_decode(src,pos,&(dst->namespace));
  464. retval |=UA_ByteString_decode(src,pos,&(dst->identifier.byteString));
  465. break;
  466. }
  467. return retval;
  468. }
  469. UA_TYPE_METHOD_DELETE_STRUCT(UA_NodeId)
  470. UA_Int32 UA_NodeId_deleteMembers(UA_NodeId* p) {
  471. int retval = UA_SUCCESS;
  472. switch (p->encodingByte) {
  473. case UA_NodeIdType_TwoByte:
  474. case UA_NodeIdType_FourByte:
  475. case UA_NodeIdType_Numeric:
  476. // nothing to do
  477. break;
  478. case UA_NodeIdType_String: // Table 6, second entry
  479. retval |= UA_String_deleteMembers(&(p->identifier.string));
  480. break;
  481. case UA_NodeIdType_Guid: // Table 6, third entry
  482. retval |= UA_Guid_deleteMembers(&(p->identifier.guid));
  483. break;
  484. case UA_NodeIdType_ByteString: // Table 6, "OPAQUE"
  485. retval |= UA_ByteString_deleteMembers(&(p->identifier.byteString));
  486. break;
  487. }
  488. return retval;
  489. }
  490. //FIXME: Sten Where do these two flags come from?
  491. #define NIEVT_NAMESPACE_URI_FLAG 0x80 //Is only for ExpandedNodeId required
  492. #define NIEVT_SERVERINDEX_FLAG 0x40 //Is only for ExpandedNodeId required
  493. UA_Int32 UA_ExpandedNodeId_calcSize(UA_ExpandedNodeId const * p) {
  494. UA_Int32 length = 0;
  495. if (p == UA_NULL) {
  496. length = sizeof(UA_ExpandedNodeId);
  497. } else {
  498. length = UA_NodeId_calcSize(&(p->nodeId));
  499. if (p->nodeId.encodingByte & NIEVT_NAMESPACE_URI_FLAG) {
  500. length += UA_String_calcSize(&(p->namespaceUri)); //p->namespaceUri
  501. }
  502. if (p->nodeId.encodingByte & NIEVT_SERVERINDEX_FLAG) {
  503. length += sizeof(UA_UInt32); //p->serverIndex
  504. }
  505. }
  506. return length;
  507. }
  508. UA_Int32 UA_ExpandedNodeId_encode(UA_ExpandedNodeId const * src, UA_Int32* pos, char *dst) {
  509. UInt32 retval = UA_SUCCESS;
  510. retval |= UA_NodeId_encode(&(src->nodeId),pos,dst);
  511. if (src->nodeId.encodingByte & NIEVT_NAMESPACE_URI_FLAG) {
  512. retval |= UA_String_encode(&(src->namespaceUri),pos,dst);
  513. }
  514. if (src->nodeId.encodingByte & NIEVT_SERVERINDEX_FLAG) {
  515. retval |= UA_UInt32_encode(&(src->serverIndex),pos,dst);
  516. }
  517. return retval;
  518. }
  519. UA_Int32 UA_ExpandedNodeId_decode(char const * src, UA_Int32* pos,
  520. UA_ExpandedNodeId *dst) {
  521. UInt32 retval = UA_SUCCESS;
  522. retval |= UA_NodeId_decode(src,pos,&(dst->nodeId));
  523. if (dst->nodeId.encodingByte & NIEVT_NAMESPACE_URI_FLAG) {
  524. dst->nodeId.namespace = 0;
  525. retval |= UA_String_decode(src,pos,&(dst->namespaceUri));
  526. } else {
  527. retval |= UA_String_copy(&UA_String_null, &(dst->namespaceUri));
  528. }
  529. if (dst->nodeId.encodingByte & NIEVT_SERVERINDEX_FLAG) {
  530. retval |= UA_UInt32_decode(src,pos,&(dst->serverIndex));
  531. }
  532. return retval;
  533. }
  534. UA_TYPE_METHOD_DELETE_STRUCT(UA_ExpandedNodeId)
  535. UA_Int32 UA_ExpandedNodeId_deleteMembers(UA_ExpandedNodeId* p) {
  536. UA_Int32 retval = UA_SUCCESS;
  537. retval |= UA_NodeId_deleteMembers(&(p->nodeId));
  538. retval |= UA_String_deleteMembers(&(p->namespaceUri));
  539. return retval;
  540. }
  541. UA_Int32 UA_ExtensionObject_calcSize(UA_ExtensionObject const * p) {
  542. UA_Int32 length = 0;
  543. if (p == UA_NULL) {
  544. length = sizeof(UA_ExtensionObject);
  545. } else {
  546. length += UA_NodeId_calcSize(&(p->typeId));
  547. length += sizeof(Byte); //p->encoding
  548. switch (p->encoding) {
  549. case 0x00:
  550. length += sizeof(UA_Int32); //p->body.length
  551. break;
  552. case 0x01:
  553. length += UA_ByteString_calcSize(&(p->body));
  554. break;
  555. case 0x02:
  556. length += UA_ByteString_calcSize(&(p->body));
  557. break;
  558. }
  559. }
  560. return length;
  561. }
  562. UA_Int32 UA_ExtensionObject_encode(UA_ExtensionObject const *src, UA_Int32* pos, char * dst) {
  563. UA_Int32 retval = UA_SUCCESS;
  564. retval |= UA_NodeId_encode(&(src->typeId),pos,dst);
  565. retval |= UA_Byte_encode(&(src->encoding),pos,dst);
  566. switch (src->encoding) {
  567. case UA_ExtensionObject_NoBodyIsEncoded:
  568. break;
  569. case UA_ExtensionObject_BodyIsByteString:
  570. case UA_ExtensionObject_BodyIsXml:
  571. retval |= UA_ByteString_encode(&(src->body),pos,dst);
  572. break;
  573. }
  574. return retval;
  575. }
  576. UA_Int32 UA_ExtensionObject_decode(char const * src, UA_Int32 *pos,
  577. UA_ExtensionObject *dst) {
  578. UA_Int32 retval = UA_SUCCESS;
  579. retval |= UA_NodeId_decode(src,pos,&(dst->typeId));
  580. retval |= UA_Byte_decode(src,pos,&(dst->encoding));
  581. retval |= UA_String_copy(&UA_String_null, (UA_String*) &(dst->body));
  582. switch (dst->encoding) {
  583. case UA_ExtensionObject_NoBodyIsEncoded:
  584. break;
  585. case UA_ExtensionObject_BodyIsByteString:
  586. case UA_ExtensionObject_BodyIsXml:
  587. retval |= UA_ByteString_decode(src,pos,&(dst->body));
  588. break;
  589. }
  590. return retval;
  591. }
  592. UA_TYPE_METHOD_DELETE_STRUCT(UA_ExtensionObject)
  593. UA_Int32 UA_ExtensionObject_deleteMembers(UA_ExtensionObject *p) {
  594. UA_Int32 retval = UA_SUCCESS;
  595. retval |= UA_NodeId_deleteMembers(&(p->typeId));
  596. retval |= UA_ByteString_deleteMembers(&(p->body));
  597. return retval;
  598. }
  599. // TODO: UA_DataValue_encode
  600. // TODO: UA_DataValue_decode
  601. // TODO: UA_DataValue_delete
  602. // TODO: UA_DataValue_deleteMembers
  603. /** DiagnosticInfo - Part: 4, Chapter: 7.9, Page: 116 */
  604. UA_Int32 UA_DiagnosticInfo_decode(char const * src, UA_Int32 *pos, UA_DiagnosticInfo *dst) {
  605. UA_Int32 retval = UA_SUCCESS;
  606. int i;
  607. retval |= UA_Byte_decode(src, pos, &(dst->encodingMask));
  608. for (i = 0; i < 7; i++) {
  609. switch ( (0x01 << i) & dst->encodingMask) {
  610. case UA_DiagnosticInfoEncodingMaskType_SymbolicId:
  611. retval |= UA_Int32_decode(src, pos, &(dst->symbolicId));
  612. break;
  613. case UA_DiagnosticInfoEncodingMaskType_Namespace:
  614. retval |= UA_Int32_decode(src, pos, &(dst->namespaceUri));
  615. break;
  616. case UA_DiagnosticInfoEncodingMaskType_LocalizedText:
  617. retval |= UA_Int32_decode(src, pos, &(dst->localizedText));
  618. break;
  619. case UA_DiagnosticInfoEncodingMaskType_Locale:
  620. retval |= UA_Int32_decode(src, pos, &(dst->locale));
  621. break;
  622. case UA_DiagnosticInfoEncodingMaskType_AdditionalInfo:
  623. retval |= UA_String_decode(src, pos, &(dst->additionalInfo));
  624. break;
  625. case UA_DiagnosticInfoEncodingMaskType_InnerStatusCode:
  626. retval |= UA_StatusCode_decode(src, pos, &(dst->innerStatusCode));
  627. break;
  628. case UA_DiagnosticInfoEncodingMaskType_InnerDiagnosticInfo:
  629. // innerDiagnosticInfo is a pointer to struct, therefore allocate
  630. retval |= UA_alloc((void **) &(dst->innerDiagnosticInfo),UA_DiagnosticInfo_calcSize(UA_NULL));
  631. retval |= UA_DiagnosticInfo_decode(src, pos, dst->innerDiagnosticInfo);
  632. break;
  633. }
  634. }
  635. return retval;
  636. }
  637. UA_Int32 UA_DiagnosticInfo_encode(UA_DiagnosticInfo const *src, UA_Int32 *pos, char *dst) {
  638. UA_Int32 retval = UA_SUCCESS;
  639. int i;
  640. UA_Byte_encode(&(src->encodingMask), pos, dst);
  641. for (i = 0; i < 7; i++) {
  642. switch ( (0x01 << i) & src->encodingMask) {
  643. case UA_DiagnosticInfoEncodingMaskType_SymbolicId:
  644. retval |= UA_Int32_encode(&(src->symbolicId), pos, dst);
  645. break;
  646. case UA_DiagnosticInfoEncodingMaskType_Namespace:
  647. retval |= UA_Int32_encode( &(src->namespaceUri), pos, dst);
  648. break;
  649. case UA_DiagnosticInfoEncodingMaskType_LocalizedText:
  650. retval |= UA_Int32_encode(&(src->localizedText), pos, dst);
  651. break;
  652. case UA_DiagnosticInfoEncodingMaskType_Locale:
  653. retval |= UA_Int32_encode(&(src->locale), pos, dst);
  654. break;
  655. case UA_DiagnosticInfoEncodingMaskType_AdditionalInfo:
  656. retval |= UA_String_encode(&(src->additionalInfo), pos, dst);
  657. break;
  658. case UA_DiagnosticInfoEncodingMaskType_InnerStatusCode:
  659. retval |= UA_StatusCode_encode(&(src->innerStatusCode), pos, dst);
  660. break;
  661. case UA_DiagnosticInfoEncodingMaskType_InnerDiagnosticInfo:
  662. retval |= UA_DiagnosticInfo_encode(src->innerDiagnosticInfo, pos, dst);
  663. break;
  664. }
  665. }
  666. return retval;
  667. }
  668. UA_Int32 UA_DiagnosticInfo_calcSize(UA_DiagnosticInfo const * ptr) {
  669. UA_Int32 length = 0;
  670. if (ptr == UA_NULL) {
  671. length = sizeof(UA_DiagnosticInfo);
  672. } else {
  673. Byte mask;
  674. length += sizeof(Byte); // EncodingMask
  675. for (mask = 0x01; mask <= 0x40; mask *= 2) {
  676. switch (mask & (ptr->encodingMask)) {
  677. case UA_DiagnosticInfoEncodingMaskType_SymbolicId:
  678. // puts("diagnosticInfo symbolic id");
  679. length += sizeof(UA_Int32);
  680. break;
  681. case UA_DiagnosticInfoEncodingMaskType_Namespace:
  682. length += sizeof(UA_Int32);
  683. break;
  684. case UA_DiagnosticInfoEncodingMaskType_LocalizedText:
  685. length += sizeof(UA_Int32);
  686. break;
  687. case UA_DiagnosticInfoEncodingMaskType_Locale:
  688. length += sizeof(UA_Int32);
  689. break;
  690. case UA_DiagnosticInfoEncodingMaskType_AdditionalInfo:
  691. length += UA_String_calcSize(&(ptr->additionalInfo));
  692. break;
  693. case UA_DiagnosticInfoEncodingMaskType_InnerStatusCode:
  694. length += sizeof(UA_StatusCode);
  695. break;
  696. case UA_DiagnosticInfoEncodingMaskType_InnerDiagnosticInfo:
  697. length += UA_DiagnosticInfo_calcSize(ptr->innerDiagnosticInfo);
  698. break;
  699. }
  700. }
  701. }
  702. return length;
  703. }
  704. UA_TYPE_METHOD_DELETE_STRUCT(UA_DiagnosticInfo)
  705. UA_Int32 UA_DiagnosticInfo_deleteMembers(UA_DiagnosticInfo *p) {
  706. UA_Int32 retval = UA_SUCCESS;
  707. if (p->encodingMask & UA_DiagnosticInfoEncodingMaskType_InnerDiagnosticInfo) {
  708. retval |= UA_DiagnosticInfo_deleteMembers(p->innerDiagnosticInfo);
  709. retval |= UA_free(p->innerDiagnosticInfo);
  710. }
  711. return retval;
  712. }
  713. UA_TYPE_METHOD_CALCSIZE_SIZEOF(UA_DateTime)
  714. UA_TYPE_METHOD_ENCODE_AS(UA_DateTime,UA_Int64)
  715. UA_TYPE_METHOD_DECODE_AS(UA_DateTime,UA_Int64)
  716. UA_TYPE_METHOD_DELETE_FREE(UA_DateTime)
  717. UA_TYPE_METHOD_DELETEMEMBERS_NOACTION(UA_DateTime)
  718. UA_TYPE_METHOD_CALCSIZE_AS(UA_XmlElement, UA_ByteString)
  719. UA_TYPE_METHOD_ENCODE_AS(UA_XmlElement, UA_ByteString)
  720. UA_TYPE_METHOD_DECODE_AS(UA_XmlElement, UA_ByteString)
  721. UA_TYPE_METHOD_DELETE_AS(UA_XmlElement, UA_ByteString)
  722. UA_TYPE_METHOD_DELETEMEMBERS_AS(UA_XmlElement, UA_ByteString)
  723. /** IntegerId - Part: 4, Chapter: 7.13, Page: 118 */
  724. UA_TYPE_METHOD_CALCSIZE_AS(UA_IntegerId, UA_Int32)
  725. UA_TYPE_METHOD_ENCODE_AS(UA_IntegerId, UA_Int32)
  726. UA_TYPE_METHOD_DECODE_AS(UA_IntegerId, UA_Int32)
  727. UA_TYPE_METHOD_DELETE_AS(UA_IntegerId, UA_Int32)
  728. UA_TYPE_METHOD_DELETEMEMBERS_AS(UA_IntegerId, UA_Int32)
  729. UA_TYPE_METHOD_CALCSIZE_AS(UA_StatusCode, UA_UInt32)
  730. UA_TYPE_METHOD_ENCODE_AS(UA_StatusCode, UA_UInt32)
  731. UA_TYPE_METHOD_DECODE_AS(UA_StatusCode, UA_UInt32)
  732. UA_TYPE_METHOD_DELETE_AS(UA_StatusCode, UA_UInt32)
  733. UA_TYPE_METHOD_DELETEMEMBERS_AS(UA_StatusCode, UA_UInt32)
  734. UA_Int32 UA_QualifiedName_calcSize(UA_QualifiedName const * p) {
  735. UA_Int32 length = 0;
  736. length += sizeof(UInt16); //qualifiedName->namespaceIndex
  737. length += sizeof(UInt16); //qualifiedName->reserved
  738. length += UA_String_calcSize(&(p->name)); //qualifiedName->name
  739. return length;
  740. }
  741. UA_Int32 UA_QualifiedName_decode(char const * src, UA_Int32 *pos,
  742. UA_QualifiedName *dst) {
  743. UA_Int32 retval = UA_SUCCESS;
  744. retval |= UA_UInt16_decode(src,pos,&(dst->namespaceIndex));
  745. retval |= UA_UInt16_decode(src,pos,&(dst->reserved));
  746. retval |= UA_String_decode(src,pos,&(dst->name));
  747. return retval;
  748. }
  749. UA_Int32 UA_QualifiedName_encode(UA_QualifiedName const *src, UA_Int32* pos,
  750. char *dst) {
  751. UA_Int32 retval = UA_SUCCESS;
  752. retval |= UA_UInt16_encode(&(src->namespaceIndex),pos,dst);
  753. retval |= UA_UInt16_encode(&(src->reserved),pos,dst);
  754. retval |= UA_String_encode(&(src->name),pos,dst);
  755. return retval;
  756. }
  757. UA_Int32 UA_Variant_calcSize(UA_Variant const * p) {
  758. UA_Int32 length = 0;
  759. Boolean isArray = p->encodingMask & (0x01 << 7); // Bit 7
  760. Boolean hasDimensions = p->encodingMask & (0x01 << 6); // Bit 6
  761. int i;
  762. if (p->vt == UA_NULL || ( p->encodingMask & 0x1F) != p->vt->Id) {
  763. return UA_ERR_INCONSISTENT;
  764. }
  765. length += sizeof(Byte); //p->encodingMask
  766. if (isArray) { // array length is encoded
  767. length += sizeof(UA_Int32); //p->arrayLength
  768. if (p->arrayLength > 0) {
  769. // TODO: add suggestions of @jfpr to not iterate over arrays with fixed len elements
  770. for (i=0;i<p->arrayLength;i++) {
  771. length += p->vt->calcSize(p->data[i]);
  772. }
  773. }
  774. } else { //single value to encode
  775. length += p->vt->calcSize(p->data[0]);
  776. }
  777. if (hasDimensions) {
  778. //ToDo: tobeInsert: length += the calcSize for dimensions
  779. }
  780. return length;
  781. }
  782. UA_Int32 UA_Variant_encode(UA_Variant const *src, UA_Int32* pos, char *dst) {
  783. UA_Int32 retval = UA_SUCCESS;
  784. int i = 0;
  785. if (src->vt == UA_NULL || ( src->encodingMask & 0x1F) != src->vt->Id) {
  786. return UA_ERR_INCONSISTENT;
  787. }
  788. retval |= UA_Byte_encode(&(src->encodingMask),pos,dst);
  789. if (src->encodingMask & (0x01 << 7)) { // encode array length
  790. retval |= UA_Int32_encode(&(src->arrayLength),pos,dst);
  791. }
  792. if (src->arrayLength > 0) {
  793. //encode array as given by variant type
  794. for (i=0;i<src->arrayLength;i++) {
  795. retval |= src->vt->encode(src->data[i],pos,dst);
  796. }
  797. } else {
  798. retval |= src->vt->encode(src->data[i],pos,dst);
  799. }
  800. if (src->encodingMask & (1 << 6)) { // encode array dimension field
  801. // TODO: encode array dimension field
  802. }
  803. return retval;
  804. }
  805. UA_Int32 UA_Variant_decode(char const * src, UA_Int32 *pos, UA_Variant *dst) {
  806. UA_Int32 retval = UA_SUCCESS;
  807. UA_Int32 ns0Id;
  808. int i;
  809. retval |= UA_Byte_decode(src,pos,&(dst->encodingMask));
  810. ns0Id = dst->encodingMask & 0x1F;
  811. // initialize vTable
  812. if (ns0Id < UA_BOOLEAN && ns0Id > UA_DOUBLECOMPLEXNUMBERTYPE) {
  813. return UA_ERR_INVALID_VALUE;
  814. } else {
  815. dst->vt = &UA_[UA_toIndex(ns0Id)];
  816. }
  817. // get size of array
  818. if (dst->encodingMask & (0x01 << 7)) { // encode array length
  819. retval |= UA_Int32_decode(src,pos,&(dst->arrayLength));
  820. } else {
  821. dst->arrayLength = 1;
  822. }
  823. // allocate place for arrayLength pointers to any type
  824. retval |= UA_alloc(dst->data,dst->arrayLength * sizeof(void*));
  825. for (i=0;i<dst->arrayLength;i++) {
  826. // TODO: this is crazy, how to work with variants with variable size?
  827. // actually we have two different sizes - the storage size without
  828. // dynamic members and the storage size with the dynamic members, e.g.
  829. // for a string we here need to allocate definitely 8 byte (length=4, data*=4)
  830. // on a 32-bit architecture - so this code is definitely wrong
  831. retval |= UA_alloc(&(dst->data[i]),dst->vt->calcSize(UA_NULL));
  832. retval |= dst->vt->decode(src,pos,dst->data[i]);
  833. }
  834. if (dst->encodingMask & (1 << 6)) {
  835. // TODO: decode array dimension field
  836. }
  837. return retval;
  838. }
  839. //TODO: place this define at the server configuration
  840. #define MAX_PICO_SECONDS 1000
  841. UA_Int32 UA_DataValue_decode(char const * src, UA_Int32* pos, UA_DataValue* dst) {
  842. UA_Int32 retval = UA_SUCCESS;
  843. retval |= UA_Byte_decode(src,pos,&(dst->encodingMask));
  844. if (dst->encodingMask & 0x01) {
  845. retval |= UA_Variant_decode(src,pos,&(dst->value));
  846. }
  847. if (dst->encodingMask & 0x02) {
  848. retval |= UA_StatusCode_decode(src,pos,&(dst->status));
  849. }
  850. if (dst->encodingMask & 0x04) {
  851. retval |= UA_DateTime_decode(src,pos,&(dst->sourceTimestamp));
  852. }
  853. if (dst->encodingMask & 0x08) {
  854. retval |= UA_DateTime_decode(src,pos,&(dst->serverTimestamp));
  855. }
  856. if (dst->encodingMask & 0x10) {
  857. retval |= UA_Int16_decode(src,pos,&(dst->sourcePicoseconds));
  858. if (dst->sourcePicoseconds > MAX_PICO_SECONDS) {
  859. dst->sourcePicoseconds = MAX_PICO_SECONDS;
  860. }
  861. }
  862. if (dst->encodingMask & 0x20) {
  863. retval |= UA_Int16_decode(src,pos,&(dst->serverPicoseconds));
  864. if (dst->serverPicoseconds > MAX_PICO_SECONDS) {
  865. dst->serverPicoseconds = MAX_PICO_SECONDS;
  866. }
  867. }
  868. return retval;
  869. }
  870. UA_Int32 UA_DataValue_encode(UA_DataValue const * src, UA_Int32* pos, char *dst) {
  871. UA_Int32 retval = UA_SUCCESS;
  872. retval |= UA_Byte_encode(&(src->encodingMask),pos,dst);
  873. if (src->encodingMask & 0x01) {
  874. retval |= UA_Variant_encode(&(src->value),pos,dst);
  875. }
  876. if (src->encodingMask & 0x02) {
  877. retval |= UA_StatusCode_encode(&(src->status),pos,dst);
  878. }
  879. if (src->encodingMask & 0x04) {
  880. retval |= UA_DateTime_encode(&(src->sourceTimestamp),pos,dst);
  881. }
  882. if (src->encodingMask & 0x08) {
  883. retval |= UA_DateTime_encode(&(src->serverTimestamp),pos,dst);
  884. }
  885. if (src->encodingMask & 0x10) {
  886. retval |= UA_Int16_encode(&(src->sourcePicoseconds),pos,dst);
  887. }
  888. if (src->encodingMask & 0x10) {
  889. retval |= UA_Int16_encode(&(src->serverPicoseconds),pos,dst);
  890. }
  891. return retval;
  892. }
  893. UA_Int32 UA_DataValue_calcSize(UA_DataValue const * p) {
  894. UA_Int32 length = 0;
  895. if (p == UA_NULL) { // get static storage size
  896. length = sizeof(UA_DataValue);
  897. } else { // get decoding size
  898. length = sizeof(UA_Byte);
  899. if (p->encodingMask & 0x01) {
  900. length += UA_Variant_calcSize(&(p->value));
  901. }
  902. if (p->encodingMask & 0x02) {
  903. length += sizeof(UInt32); //dataValue->status
  904. }
  905. if (p->encodingMask & 0x04) {
  906. length += sizeof(Int64); //dataValue->sourceTimestamp
  907. }
  908. if (p->encodingMask & 0x08) {
  909. length += sizeof(Int64); //dataValue->serverTimestamp
  910. }
  911. if (p->encodingMask & 0x10) {
  912. length += sizeof(Int64); //dataValue->sourcePicoseconds
  913. }
  914. if (p->encodingMask & 0x20) {
  915. length += sizeof(Int64); //dataValue->serverPicoseconds
  916. }
  917. }
  918. return length;
  919. }
  920. /**
  921. * RequestHeader
  922. * Part: 4
  923. * Chapter: 7.26
  924. * Page: 132
  925. */
  926. /** \copydoc decodeRequestHeader */
  927. /*** Sten: removed to compile
  928. Int32 decodeRequestHeader(const AD_RawMessage *srcRaw, Int32 *pos,
  929. UA_AD_RequestHeader *dstRequestHeader) {
  930. return decoder_decodeRequestHeader(srcRaw->message, pos, dstRequestHeader);
  931. }
  932. ***/
  933. /*** Sten: removed to compile
  934. Int32 decoder_decodeRequestHeader(char const * message, Int32 *pos,
  935. UA_AD_RequestHeader *dstRequestHeader) {
  936. // 62541-4 §5.5.2.2 OpenSecureChannelServiceParameters
  937. // requestHeader - common request parameters. The authenticationToken is always omitted
  938. decoder_decodeBuiltInDatatype(message, NODE_ID, pos,
  939. &(dstRequestHeader->authenticationToken));
  940. decoder_decodeBuiltInDatatype(message, DATE_TIME, pos,
  941. &(dstRequestHeader->timestamp));
  942. decoder_decodeBuiltInDatatype(message, UINT32, pos,
  943. &(dstRequestHeader->requestHandle));
  944. decoder_decodeBuiltInDatatype(message, UINT32, pos,
  945. &(dstRequestHeader->returnDiagnostics));
  946. decoder_decodeBuiltInDatatype(message, STRING, pos,
  947. &(dstRequestHeader->auditEntryId));
  948. decoder_decodeBuiltInDatatype(message, UINT32, pos,
  949. &(dstRequestHeader->timeoutHint));
  950. decoder_decodeBuiltInDatatype(message, EXTENSION_OBJECT, pos,
  951. &(dstRequestHeader->additionalHeader));
  952. // AdditionalHeader will stay empty, need to be changed if there is relevant information
  953. return 0;
  954. }
  955. ***/
  956. /**
  957. * ResponseHeader
  958. * Part: 4
  959. * Chapter: 7.27
  960. * Page: 133
  961. */
  962. /** \copydoc encodeResponseHeader */
  963. /*** Sten: removed to compile
  964. Int32 encodeResponseHeader(UA_AD_ResponseHeader const * responseHeader,
  965. Int32 *pos, UA_ByteString *dstBuf) {
  966. encodeUADateTime(responseHeader->timestamp, pos, dstBuf->data);
  967. encodeIntegerId(responseHeader->requestHandle, pos, dstBuf->data);
  968. encodeUInt32(responseHeader->serviceResult, pos, dstBuf->data);
  969. encodeDiagnosticInfo(responseHeader->serviceDiagnostics, pos, dstBuf->data);
  970. encoder_encodeBuiltInDatatypeArray(responseHeader->stringTable,
  971. responseHeader->noOfStringTable, STRING_ARRAY, pos, dstBuf->data);
  972. encodeExtensionObject(responseHeader->additionalHeader, pos, dstBuf->data);
  973. //Kodieren von String Datentypen
  974. return 0;
  975. }
  976. ***/
  977. /*** Sten: removed to compile
  978. Int32 extensionObject_calcSize(UA_ExtensionObject *extensionObject) {
  979. Int32 length = 0;
  980. length += nodeId_calcSize(&(extensionObject->typeId));
  981. length += sizeof(Byte); //The EncodingMask Byte
  982. if (extensionObject->encoding == BODY_IS_BYTE_STRING
  983. || extensionObject->encoding == BODY_IS_XML_ELEMENT) {
  984. length += UAByteString_calcSize(&(extensionObject->body));
  985. }
  986. return length;
  987. }
  988. ***/
  989. /*** Sten: removed to compile
  990. Int32 responseHeader_calcSize(UA_AD_ResponseHeader *responseHeader) {
  991. Int32 i;
  992. Int32 length = 0;
  993. // UtcTime timestamp 8
  994. length += sizeof(UA_DateTime);
  995. // IntegerId requestHandle 4
  996. length += sizeof(UA_AD_IntegerId);
  997. // StatusCode serviceResult 4
  998. length += sizeof(UA_StatusCode);
  999. // DiagnosticInfo serviceDiagnostics
  1000. length += diagnosticInfo_calcSize(responseHeader->serviceDiagnostics);
  1001. // String stringTable[], see 62541-6 § 5.2.4
  1002. length += sizeof(Int32); // Length of Stringtable always
  1003. if (responseHeader->noOfStringTable > 0) {
  1004. for (i = 0; i < responseHeader->noOfStringTable; i++) {
  1005. length += UAString_calcSize(responseHeader->stringTable[i]);
  1006. }
  1007. }
  1008. // ExtensibleObject additionalHeader
  1009. length += extensionObject_calcSize(responseHeader->additionalHeader);
  1010. return length;
  1011. }
  1012. ***/