opcua_basictypes.c 35 KB

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