ua_services_view.c 28 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687
  1. #include "ua_server_internal.h"
  2. #include "ua_services.h"
  3. #include "ua_statuscodes.h"
  4. #include "ua_nodestore.h"
  5. #include "ua_util.h"
  6. static UA_StatusCode fillrefdescr(UA_NodeStore *ns, const UA_Node *curr, UA_ReferenceNode *ref,
  7. UA_UInt32 mask, UA_ReferenceDescription *descr)
  8. {
  9. UA_StatusCode retval = UA_STATUSCODE_GOOD;
  10. UA_ReferenceDescription_init(descr);
  11. retval |= UA_NodeId_copy(&curr->nodeId, &descr->nodeId.nodeId);
  12. //TODO: ExpandedNodeId is mocked up
  13. descr->nodeId.serverIndex = 0;
  14. descr->nodeId.namespaceUri.length = -1;
  15. if(mask & UA_BROWSERESULTMASK_REFERENCETYPEID)
  16. retval |= UA_NodeId_copy(&ref->referenceTypeId, &descr->referenceTypeId);
  17. if(mask & UA_BROWSERESULTMASK_ISFORWARD)
  18. descr->isForward = !ref->isInverse;
  19. if(mask & UA_BROWSERESULTMASK_NODECLASS)
  20. retval |= UA_NodeClass_copy(&curr->nodeClass, &descr->nodeClass);
  21. if(mask & UA_BROWSERESULTMASK_BROWSENAME)
  22. retval |= UA_QualifiedName_copy(&curr->browseName, &descr->browseName);
  23. if(mask & UA_BROWSERESULTMASK_DISPLAYNAME)
  24. retval |= UA_LocalizedText_copy(&curr->displayName, &descr->displayName);
  25. if(mask & UA_BROWSERESULTMASK_TYPEDEFINITION){
  26. if(curr->nodeClass == UA_NODECLASS_OBJECT || curr->nodeClass == UA_NODECLASS_VARIABLE) {
  27. for(UA_Int32 i = 0; i < curr->referencesSize; i++) {
  28. UA_ReferenceNode *refnode = &curr->references[i];
  29. if(refnode->referenceTypeId.identifier.numeric != UA_NS0ID_HASTYPEDEFINITION)
  30. continue;
  31. retval |= UA_ExpandedNodeId_copy(&refnode->targetId, &descr->typeDefinition);
  32. break;
  33. }
  34. }
  35. }
  36. if(retval)
  37. UA_ReferenceDescription_deleteMembers(descr);
  38. return retval;
  39. }
  40. /* Tests if the node is relevant to the browse request and shall be returned. If
  41. so, it is retrieved from the Nodestore. If not, null is returned. */
  42. static const UA_Node *relevant_node(UA_Server *server, UA_NodeStore *ns, const UA_BrowseDescription *descr,
  43. UA_Boolean return_all, UA_ReferenceNode *reference,
  44. UA_NodeId *relevant, size_t relevant_count, UA_Boolean *isExternal)
  45. {
  46. if(reference->isInverse == UA_TRUE && descr->browseDirection == UA_BROWSEDIRECTION_FORWARD)
  47. return UA_NULL;
  48. else if(reference->isInverse == UA_FALSE && descr->browseDirection == UA_BROWSEDIRECTION_INVERSE)
  49. return UA_NULL;
  50. if(!return_all) {
  51. for(size_t i = 0; i < relevant_count; i++) {
  52. if(UA_NodeId_equal(&reference->referenceTypeId, &relevant[i]))
  53. goto is_relevant;
  54. }
  55. return UA_NULL;
  56. }
  57. is_relevant: ;
  58. *isExternal = UA_FALSE;
  59. #ifdef UA_EXTERNAL_NAMESPACES
  60. const UA_Node *node = NULL;
  61. size_t nsIndex;
  62. for(nsIndex = 0; nsIndex < server->externalNamespacesSize; nsIndex++) {
  63. if(reference->targetId.nodeId.namespaceIndex != server->externalNamespaces[nsIndex].index)
  64. continue;
  65. else{
  66. *isExternal = UA_TRUE;
  67. break;
  68. }
  69. }
  70. if(*isExternal == UA_FALSE){
  71. node = UA_NodeStore_get(ns, &reference->targetId.nodeId);
  72. } else {
  73. /* prepare a read request in the external nodestore */
  74. UA_ExternalNodeStore *ens = &server->externalNamespaces[nsIndex].externalNodeStore;
  75. UA_ReadValueId *readValueIds = UA_Array_new(&UA_TYPES[UA_TYPES_READVALUEID], 6);
  76. UA_UInt32 *indices = UA_Array_new(&UA_TYPES[UA_TYPES_UINT32], 6);
  77. UA_UInt32 indicesSize = 6;
  78. UA_DataValue *readNodesResults = UA_Array_new(&UA_TYPES[UA_TYPES_DATAVALUE], 6);
  79. UA_DiagnosticInfo *diagnosticInfos = UA_Array_new(&UA_TYPES[UA_TYPES_DIAGNOSTICINFO], 6);
  80. for(UA_UInt32 i = 0; i<6; i++){
  81. readValueIds[i].nodeId = reference->targetId.nodeId;
  82. UA_String_init(&(readValueIds[i].indexRange));
  83. UA_QualifiedName_init(&(readValueIds[i].dataEncoding));
  84. indices[i] = i;
  85. UA_DataValue_init(&(readNodesResults[i]));
  86. UA_DiagnosticInfo_init(&(diagnosticInfos[i]));
  87. }
  88. readValueIds[0].attributeId = UA_ATTRIBUTEID_NODECLASS;
  89. readValueIds[1].attributeId = UA_ATTRIBUTEID_BROWSENAME;
  90. readValueIds[2].attributeId = UA_ATTRIBUTEID_DISPLAYNAME;
  91. readValueIds[3].attributeId = UA_ATTRIBUTEID_DESCRIPTION;
  92. readValueIds[4].attributeId = UA_ATTRIBUTEID_WRITEMASK;
  93. readValueIds[5].attributeId = UA_ATTRIBUTEID_USERWRITEMASK;
  94. ens->readNodes(ens->ensHandle, NULL, readValueIds,
  95. indices, indicesSize, readNodesResults, UA_FALSE, diagnosticInfos);
  96. /* create and fill a dummy nodeStructure */
  97. UA_Node *tempNode = (UA_Node*) UA_ObjectNode_new();
  98. UA_NodeId_copy(&(reference->targetId.nodeId), &(tempNode->nodeId));
  99. if(readNodesResults[0].status == UA_STATUSCODE_GOOD){
  100. UA_NodeClass_copy((UA_NodeClass*)readNodesResults[0].value.data, &(tempNode->nodeClass));
  101. }
  102. if(readNodesResults[1].status == UA_STATUSCODE_GOOD){
  103. UA_QualifiedName_copy((UA_QualifiedName*)readNodesResults[1].value.data, &(tempNode->browseName));
  104. }
  105. if(readNodesResults[2].status == UA_STATUSCODE_GOOD){
  106. UA_LocalizedText_copy((UA_LocalizedText*)readNodesResults[2].value.data, &(tempNode->displayName));
  107. }
  108. if(readNodesResults[3].status == UA_STATUSCODE_GOOD){
  109. UA_LocalizedText_copy((UA_LocalizedText*)readNodesResults[3].value.data, &(tempNode->description));
  110. }
  111. if(readNodesResults[4].status == UA_STATUSCODE_GOOD){
  112. UA_UInt32_copy((UA_UInt32*)readNodesResults[4].value.data, &(tempNode->writeMask));
  113. }
  114. if(readNodesResults[5].status == UA_STATUSCODE_GOOD){
  115. UA_UInt32_copy((UA_UInt32*)readNodesResults[5].value.data, &(tempNode->userWriteMask));
  116. }
  117. UA_Array_delete(readValueIds, &UA_TYPES[UA_TYPES_READVALUEID], 6);
  118. UA_Array_delete(indices, &UA_TYPES[UA_TYPES_UINT32], 6);
  119. UA_Array_delete(readNodesResults, &UA_TYPES[UA_TYPES_DATAVALUE], 6);
  120. UA_Array_delete(diagnosticInfos, &UA_TYPES[UA_TYPES_DIAGNOSTICINFO], 6);
  121. node = tempNode;
  122. }
  123. #else
  124. const UA_Node *node = UA_NodeStore_get(ns, &reference->targetId.nodeId);
  125. #endif
  126. if(node && descr->nodeClassMask != 0 && (node->nodeClass & descr->nodeClassMask) == 0) {
  127. #ifdef UA_EXTERNAL_NAMESPACES
  128. if(*isExternal == UA_TRUE){
  129. UA_ObjectNode_delete((UA_ObjectNode*)node);
  130. } else
  131. #endif
  132. UA_NodeStore_release(node);
  133. return UA_NULL;
  134. }
  135. return node;
  136. }
  137. /**
  138. * We find all subtypes by a single iteration over the array. We start with an array with a single
  139. * root nodeid at the beginning. When we find relevant references, we add the nodeids to the back of
  140. * the array and increase the size. Since the hierarchy is not cyclic, we can safely progress in the
  141. * array to process the newly found referencetype nodeids (emulated recursion).
  142. */
  143. static UA_StatusCode findsubtypes(UA_NodeStore *ns, const UA_NodeId *root, UA_NodeId **reftypes,
  144. size_t *reftypes_count) {
  145. const UA_Node *node = UA_NodeStore_get(ns, root);
  146. if(!node)
  147. return UA_STATUSCODE_BADNOMATCH;
  148. if(node->nodeClass != UA_NODECLASS_REFERENCETYPE) {
  149. UA_NodeStore_release(node);
  150. return UA_STATUSCODE_BADREFERENCETYPEIDINVALID;
  151. }
  152. UA_NodeStore_release(node);
  153. size_t results_size = 20; // probably too big, but saves mallocs
  154. UA_NodeId *results = UA_malloc(sizeof(UA_NodeId) * results_size);
  155. if(!results)
  156. return UA_STATUSCODE_BADOUTOFMEMORY;
  157. UA_StatusCode retval = UA_NodeId_copy(root, &results[0]);
  158. if(retval != UA_STATUSCODE_GOOD) {
  159. UA_free(results);
  160. return retval;
  161. }
  162. size_t index = 0; // where are we currently in the array?
  163. size_t last = 0; // where is the last element in the array?
  164. do {
  165. node = UA_NodeStore_get(ns, &results[index]);
  166. if(!node || node->nodeClass != UA_NODECLASS_REFERENCETYPE)
  167. continue;
  168. for(UA_Int32 i = 0; i < node->referencesSize; i++) {
  169. if(node->references[i].referenceTypeId.identifier.numeric != UA_NS0ID_HASSUBTYPE ||
  170. node->references[i].isInverse == UA_TRUE)
  171. continue;
  172. if(++last >= results_size) { // is the array big enough?
  173. UA_NodeId *new_results = UA_realloc(results, sizeof(UA_NodeId) * results_size * 2);
  174. if(!new_results) {
  175. retval = UA_STATUSCODE_BADOUTOFMEMORY;
  176. break;
  177. }
  178. results = new_results;
  179. results_size *= 2;
  180. }
  181. retval = UA_NodeId_copy(&node->references[i].targetId.nodeId, &results[last]);
  182. if(retval != UA_STATUSCODE_GOOD) {
  183. last--; // for array_delete
  184. break;
  185. }
  186. }
  187. UA_NodeStore_release(node);
  188. } while(++index <= last && retval == UA_STATUSCODE_GOOD);
  189. if(retval) {
  190. UA_Array_delete(results, &UA_TYPES[UA_TYPES_NODEID], last);
  191. return retval;
  192. }
  193. *reftypes = results;
  194. *reftypes_count = last + 1;
  195. return UA_STATUSCODE_GOOD;
  196. }
  197. static void removeCp(struct ContinuationPointEntry *cp, UA_Session* session){
  198. session->availableContinuationPoints++;
  199. UA_ByteString_deleteMembers(&cp->identifier);
  200. UA_BrowseDescription_deleteMembers(&cp->browseDescription);
  201. LIST_REMOVE(cp, pointers);
  202. UA_free(cp);
  203. }
  204. /**
  205. * Results for a single browsedescription. This is the inner loop for both Browse and BrowseNext
  206. * @param session Session to save continuationpoints
  207. * @param ns The nodstore where the to-be-browsed node can be found
  208. * @param cp If cp points to a continuationpoint, we continue from there.
  209. * If cp is null, we can add a new continuation point if possible and necessary.
  210. * @param descr If no cp is set, we take the browsedescription from there
  211. * @param maxrefs The maximum number of references the client has requested
  212. * @param result The entry in the request
  213. */
  214. static void browse(UA_Server *server, UA_Session *session, UA_NodeStore *ns, struct ContinuationPointEntry *cp,
  215. const UA_BrowseDescription *descr, UA_UInt32 maxrefs, UA_BrowseResult *result) {
  216. UA_UInt32 continuationIndex = 0;
  217. size_t referencesCount = 0;
  218. UA_Int32 referencesIndex = 0;
  219. /* set the browsedescription if a cp is given */
  220. if(cp) {
  221. descr = &cp->browseDescription;
  222. maxrefs = cp->maxReferences;
  223. continuationIndex = cp->continuationIndex;
  224. }
  225. /* is the browsedirection valid? */
  226. if(descr->browseDirection != UA_BROWSEDIRECTION_BOTH &&
  227. descr->browseDirection != UA_BROWSEDIRECTION_FORWARD &&
  228. descr->browseDirection != UA_BROWSEDIRECTION_INVERSE) {
  229. result->statusCode = UA_STATUSCODE_BADBROWSEDIRECTIONINVALID;
  230. return;
  231. }
  232. /* get the references that match the browsedescription */
  233. size_t relevant_refs_size = 0;
  234. UA_NodeId *relevant_refs = UA_NULL;
  235. UA_Boolean all_refs = UA_NodeId_isNull(&descr->referenceTypeId);
  236. if(!all_refs) {
  237. if(descr->includeSubtypes) {
  238. result->statusCode = findsubtypes(ns, &descr->referenceTypeId, &relevant_refs, &relevant_refs_size);
  239. if(result->statusCode != UA_STATUSCODE_GOOD)
  240. return;
  241. } else {
  242. const UA_Node *rootRef = UA_NodeStore_get(ns, &descr->referenceTypeId);
  243. if(!rootRef) {
  244. result->statusCode = UA_STATUSCODE_BADREFERENCETYPEIDINVALID;
  245. return;
  246. } else if(rootRef->nodeClass != UA_NODECLASS_REFERENCETYPE) {
  247. UA_NodeStore_release(rootRef);
  248. result->statusCode = UA_STATUSCODE_BADREFERENCETYPEIDINVALID;
  249. return;
  250. }
  251. UA_NodeStore_release(rootRef);
  252. relevant_refs = (UA_NodeId*)(uintptr_t)&descr->referenceTypeId;
  253. relevant_refs_size = 1;
  254. }
  255. }
  256. /* get the node */
  257. const UA_Node *node = UA_NodeStore_get(ns, &descr->nodeId);
  258. if(!node) {
  259. result->statusCode = UA_STATUSCODE_BADNODEIDUNKNOWN;
  260. if(!all_refs && descr->includeSubtypes)
  261. UA_Array_delete(relevant_refs, &UA_TYPES[UA_TYPES_NODEID], relevant_refs_size);
  262. return;
  263. }
  264. /* if the node has no references, just return */
  265. if(node->referencesSize <= 0) {
  266. result->referencesSize = 0;
  267. UA_NodeStore_release(node);
  268. if(!all_refs && descr->includeSubtypes)
  269. UA_Array_delete(relevant_refs, &UA_TYPES[UA_TYPES_NODEID], relevant_refs_size);
  270. return;
  271. }
  272. /* how many references can we return at most? */
  273. UA_UInt32 real_maxrefs = maxrefs;
  274. if(real_maxrefs == 0)
  275. real_maxrefs = node->referencesSize;
  276. result->references = UA_malloc(sizeof(UA_ReferenceDescription) * real_maxrefs);
  277. if(!result->references) {
  278. result->statusCode = UA_STATUSCODE_BADOUTOFMEMORY;
  279. goto cleanup;
  280. }
  281. /* loop over the node's references */
  282. size_t skipped = 0;
  283. UA_Boolean isExternal = UA_FALSE;
  284. for(; referencesIndex < node->referencesSize && referencesCount < real_maxrefs; referencesIndex++) {
  285. isExternal = UA_FALSE;
  286. const UA_Node *current = relevant_node(server, ns, descr, all_refs, &node->references[referencesIndex],
  287. relevant_refs, relevant_refs_size, &isExternal);
  288. if(!current)
  289. continue;
  290. if(skipped < continuationIndex) {
  291. #ifdef UA_EXTERNAL_NAMESPACES
  292. if(isExternal == UA_TRUE){
  293. /* relevant_node returns a node malloced with UA_ObjectNode_new if it is external (there is no UA_Node_new function) */
  294. UA_ObjectNode_delete((UA_ObjectNode*)current);
  295. } else {
  296. UA_NodeStore_release(current);
  297. }
  298. #else
  299. UA_NodeStore_release(current);
  300. #endif
  301. skipped++;
  302. continue;
  303. }
  304. UA_StatusCode retval = fillrefdescr(ns, current, &node->references[referencesIndex], descr->resultMask,
  305. &result->references[referencesCount]);
  306. #ifdef UA_EXTERNAL_NAMESPACES
  307. if(isExternal == UA_TRUE){
  308. UA_ObjectNode_delete((UA_ObjectNode*)current);
  309. } else {
  310. UA_NodeStore_release(current);
  311. }
  312. #else
  313. UA_NodeStore_release(current);
  314. #endif
  315. if(retval != UA_STATUSCODE_GOOD) {
  316. UA_Array_delete(result->references, &UA_TYPES[UA_TYPES_REFERENCEDESCRIPTION], referencesCount);
  317. result->references = UA_NULL;
  318. result->referencesSize = 0;
  319. result->statusCode = UA_STATUSCODE_UNCERTAINNOTALLNODESAVAILABLE;
  320. goto cleanup;
  321. }
  322. referencesCount++;
  323. }
  324. result->referencesSize = referencesCount;
  325. if(referencesCount == 0) {
  326. UA_free(result->references);
  327. result->references = UA_NULL;
  328. }
  329. cleanup:
  330. UA_NodeStore_release(node);
  331. if(!all_refs && descr->includeSubtypes)
  332. UA_Array_delete(relevant_refs, &UA_TYPES[UA_TYPES_NODEID], relevant_refs_size);
  333. if(result->statusCode != UA_STATUSCODE_GOOD)
  334. return;
  335. /* create, update, delete continuation points */
  336. if(cp) {
  337. if(referencesIndex == node->referencesSize) {
  338. /* all done, remove a finished continuationPoint */
  339. removeCp(cp, session);
  340. } else {
  341. /* update the cp and return the cp identifier */
  342. cp->continuationIndex += referencesCount;
  343. UA_ByteString_copy(&cp->identifier, &result->continuationPoint);
  344. }
  345. } else if(maxrefs != 0 && referencesCount >= maxrefs) {
  346. /* create a cp */
  347. if(session->availableContinuationPoints <= 0 || !(cp = UA_malloc(sizeof(struct ContinuationPointEntry)))) {
  348. result->statusCode = UA_STATUSCODE_BADNOCONTINUATIONPOINTS;
  349. return;
  350. }
  351. UA_BrowseDescription_copy(descr, &cp->browseDescription);
  352. cp->maxReferences = maxrefs;
  353. cp->continuationIndex = referencesCount;
  354. UA_Guid *ident = UA_Guid_new();
  355. pcg32_random_t rng;
  356. pcg32_srandom_r(&rng, (uintptr_t)cp, UA_DateTime_now());
  357. *ident = UA_Guid_random(&rng);
  358. cp->identifier.data = (UA_Byte*)ident;
  359. cp->identifier.length = sizeof(UA_Guid);
  360. UA_ByteString_copy(&cp->identifier, &result->continuationPoint);
  361. /* store the cp */
  362. LIST_INSERT_HEAD(&session->continuationPoints, cp, pointers);
  363. session->availableContinuationPoints--;
  364. }
  365. }
  366. void Service_Browse(UA_Server *server, UA_Session *session, const UA_BrowseRequest *request,
  367. UA_BrowseResponse *response) {
  368. if(!UA_NodeId_isNull(&request->view.viewId)) {
  369. response->responseHeader.serviceResult = UA_STATUSCODE_BADVIEWIDUNKNOWN;
  370. return;
  371. }
  372. if(request->nodesToBrowseSize <= 0) {
  373. response->responseHeader.serviceResult = UA_STATUSCODE_BADNOTHINGTODO;
  374. return;
  375. }
  376. size_t size = request->nodesToBrowseSize;
  377. response->results = UA_Array_new(&UA_TYPES[UA_TYPES_BROWSERESULT], size);
  378. if(!response->results) {
  379. response->responseHeader.serviceResult = UA_STATUSCODE_BADOUTOFMEMORY;
  380. return;
  381. }
  382. response->resultsSize = size;
  383. #ifdef UA_EXTERNAL_NAMESPACES
  384. #ifdef NO_ALLOCA
  385. UA_Boolean isExternal[size];
  386. UA_UInt32 indices[size];
  387. #else
  388. UA_Boolean *isExternal = UA_alloca(sizeof(UA_Boolean) * size);
  389. UA_UInt32 *indices = UA_alloca(sizeof(UA_UInt32) * size);
  390. #endif /*NO_ALLOCA */
  391. UA_memset(isExternal, UA_FALSE, sizeof(UA_Boolean) * size);
  392. for(size_t j = 0; j < server->externalNamespacesSize; j++) {
  393. size_t indexSize = 0;
  394. for(size_t i = 0; i < size; i++) {
  395. if(request->nodesToBrowse[i].nodeId.namespaceIndex != server->externalNamespaces[j].index)
  396. continue;
  397. isExternal[i] = UA_TRUE;
  398. indices[indexSize] = i;
  399. indexSize++;
  400. }
  401. if(indexSize == 0)
  402. continue;
  403. UA_ExternalNodeStore *ens = &server->externalNamespaces[j].externalNodeStore;
  404. ens->browseNodes(ens->ensHandle, &request->requestHeader, request->nodesToBrowse, indices, indexSize,
  405. request->requestedMaxReferencesPerNode, response->results, response->diagnosticInfos);
  406. }
  407. #endif
  408. for(size_t i = 0; i < size; i++) {
  409. #ifdef UA_EXTERNAL_NAMESPACES
  410. if(!isExternal[i])
  411. #endif
  412. browse(server, session, server->nodestore, UA_NULL, &request->nodesToBrowse[i],
  413. request->requestedMaxReferencesPerNode, &response->results[i]);
  414. }
  415. }
  416. void Service_BrowseNext(UA_Server *server, UA_Session *session, const UA_BrowseNextRequest *request,
  417. UA_BrowseNextResponse *response) {
  418. if(request->continuationPointsSize <= 0) {
  419. response->responseHeader.serviceResult = UA_STATUSCODE_BADNOTHINGTODO;
  420. return;
  421. }
  422. size_t size = request->continuationPointsSize;
  423. if(!request->releaseContinuationPoints) {
  424. /* continue with the cp */
  425. response->results = UA_Array_new(&UA_TYPES[UA_TYPES_BROWSERESULT], size);
  426. if(!response->results) {
  427. response->responseHeader.serviceResult = UA_STATUSCODE_BADOUTOFMEMORY;
  428. return;
  429. }
  430. response->resultsSize = size;
  431. for(size_t i = 0; i < size; i++) {
  432. struct ContinuationPointEntry *cp;
  433. LIST_FOREACH(cp, &session->continuationPoints, pointers) {
  434. if(UA_ByteString_equal(&cp->identifier, &request->continuationPoints[i])) {
  435. browse(server, session, server->nodestore, cp, UA_NULL, 0, &response->results[i]);
  436. break;
  437. }
  438. }
  439. if(!cp)
  440. response->results[i].statusCode = UA_STATUSCODE_BADCONTINUATIONPOINTINVALID;
  441. }
  442. } else {
  443. /* remove the cp */
  444. response->results = UA_Array_new(&UA_TYPES[UA_TYPES_BROWSERESULT], size);
  445. if(!response->results) {
  446. response->responseHeader.serviceResult = UA_STATUSCODE_BADOUTOFMEMORY;
  447. return;
  448. }
  449. response->resultsSize = size;
  450. for(size_t i = 0; i < size; i++) {
  451. struct ContinuationPointEntry *cp = UA_NULL;
  452. LIST_FOREACH(cp, &session->continuationPoints, pointers) {
  453. if(UA_ByteString_equal(&cp->identifier, &request->continuationPoints[i])) {
  454. removeCp(cp, session);
  455. break;
  456. }
  457. }
  458. if(!cp)
  459. response->results[i].statusCode = UA_STATUSCODE_BADCONTINUATIONPOINTINVALID;
  460. }
  461. }
  462. }
  463. /***********************/
  464. /* TranslateBrowsePath */
  465. /***********************/
  466. static UA_StatusCode
  467. walkBrowsePath(UA_Server *server, UA_Session *session, const UA_Node *node, const UA_RelativePath *path,
  468. UA_Int32 pathindex, UA_BrowsePathTarget **targets, UA_Int32 *targets_size,
  469. UA_Int32 *target_count)
  470. {
  471. const UA_RelativePathElement *elem = &path->elements[pathindex];
  472. if(elem->targetName.name.length == -1)
  473. return UA_STATUSCODE_BADBROWSENAMEINVALID;
  474. UA_StatusCode retval = UA_STATUSCODE_GOOD;
  475. UA_NodeId *reftypes = UA_NULL;
  476. size_t reftypes_count = 1; // all_refs or no subtypes => 1
  477. UA_Boolean all_refs = UA_FALSE;
  478. if(UA_NodeId_isNull(&elem->referenceTypeId))
  479. all_refs = UA_TRUE;
  480. else if(!elem->includeSubtypes)
  481. reftypes = (UA_NodeId*)(uintptr_t)&elem->referenceTypeId; // ptr magic due to const cast
  482. else {
  483. retval = findsubtypes(server->nodestore, &elem->referenceTypeId, &reftypes, &reftypes_count);
  484. if(retval != UA_STATUSCODE_GOOD)
  485. return retval;
  486. }
  487. for(UA_Int32 i = 0; i < node->referencesSize && retval == UA_STATUSCODE_GOOD; i++) {
  488. UA_Boolean match = all_refs;
  489. for(size_t j = 0; j < reftypes_count && !match; j++) {
  490. if(node->references[i].isInverse == elem->isInverse &&
  491. UA_NodeId_equal(&node->references[i].referenceTypeId, &reftypes[j]))
  492. match = UA_TRUE;
  493. }
  494. if(!match)
  495. continue;
  496. // get the node, todo: expandednodeid
  497. const UA_Node *next = UA_NodeStore_get(server->nodestore, &node->references[i].targetId.nodeId);
  498. if(!next)
  499. continue;
  500. // test the browsename
  501. if(elem->targetName.namespaceIndex != next->browseName.namespaceIndex ||
  502. !UA_String_equal(&elem->targetName.name, &next->browseName.name)) {
  503. UA_NodeStore_release(next);
  504. continue;
  505. }
  506. if(pathindex + 1 < path->elementsSize) {
  507. // recursion if the path is longer
  508. retval = walkBrowsePath(server, session, next, path, pathindex + 1,
  509. targets, targets_size, target_count);
  510. UA_NodeStore_release(next);
  511. } else {
  512. // add the browsetarget
  513. if(*target_count >= *targets_size) {
  514. UA_BrowsePathTarget *newtargets;
  515. newtargets = UA_realloc(targets, sizeof(UA_BrowsePathTarget) * (*targets_size) * 2);
  516. if(!newtargets) {
  517. retval = UA_STATUSCODE_BADOUTOFMEMORY;
  518. UA_NodeStore_release(next);
  519. break;
  520. }
  521. *targets = newtargets;
  522. *targets_size *= 2;
  523. }
  524. UA_BrowsePathTarget *res = *targets;
  525. UA_ExpandedNodeId_init(&res[*target_count].targetId);
  526. retval = UA_NodeId_copy(&next->nodeId, &res[*target_count].targetId.nodeId);
  527. UA_NodeStore_release(next);
  528. if(retval != UA_STATUSCODE_GOOD)
  529. break;
  530. res[*target_count].remainingPathIndex = UA_UINT32_MAX;
  531. *target_count += 1;
  532. }
  533. }
  534. if(!all_refs && elem->includeSubtypes)
  535. UA_Array_delete(reftypes, &UA_TYPES[UA_TYPES_NODEID], (UA_Int32)reftypes_count);
  536. return retval;
  537. }
  538. static void translateBrowsePath(UA_Server *server, UA_Session *session, const UA_BrowsePath *path,
  539. UA_BrowsePathResult *result) {
  540. if(path->relativePath.elementsSize <= 0) {
  541. result->statusCode = UA_STATUSCODE_BADNOTHINGTODO;
  542. return;
  543. }
  544. UA_Int32 arraySize = 10;
  545. result->targets = UA_malloc(sizeof(UA_BrowsePathTarget) * arraySize);
  546. if(!result->targets) {
  547. result->statusCode = UA_STATUSCODE_BADOUTOFMEMORY;
  548. return;
  549. }
  550. result->targetsSize = 0;
  551. const UA_Node *firstNode = UA_NodeStore_get(server->nodestore, &path->startingNode);
  552. if(!firstNode) {
  553. result->statusCode = UA_STATUSCODE_BADNODEIDUNKNOWN;
  554. UA_free(result->targets);
  555. result->targets = UA_NULL;
  556. return;
  557. }
  558. result->statusCode = walkBrowsePath(server, session, firstNode, &path->relativePath, 0,
  559. &result->targets, &arraySize, &result->targetsSize);
  560. UA_NodeStore_release(firstNode);
  561. if(result->targetsSize == 0 && result->statusCode == UA_STATUSCODE_GOOD)
  562. result->statusCode = UA_STATUSCODE_BADNOMATCH;
  563. if(result->statusCode != UA_STATUSCODE_GOOD) {
  564. UA_Array_delete(result->targets, &UA_TYPES[UA_TYPES_BROWSEPATHTARGET], result->targetsSize);
  565. result->targets = UA_NULL;
  566. result->targetsSize = -1;
  567. }
  568. }
  569. void Service_TranslateBrowsePathsToNodeIds(UA_Server *server, UA_Session *session,
  570. const UA_TranslateBrowsePathsToNodeIdsRequest *request,
  571. UA_TranslateBrowsePathsToNodeIdsResponse *response) {
  572. if(request->browsePathsSize <= 0) {
  573. response->responseHeader.serviceResult = UA_STATUSCODE_BADNOTHINGTODO;
  574. return;
  575. }
  576. size_t size = request->browsePathsSize;
  577. response->results = UA_Array_new(&UA_TYPES[UA_TYPES_BROWSEPATHRESULT], size);
  578. if(!response->results) {
  579. response->responseHeader.serviceResult = UA_STATUSCODE_BADOUTOFMEMORY;
  580. return;
  581. }
  582. #ifdef UA_EXTERNAL_NAMESPACES
  583. #ifdef NO_ALLOCA
  584. UA_Boolean isExternal[size];
  585. UA_UInt32 indices[size];
  586. #else
  587. UA_Boolean *isExternal = UA_alloca(sizeof(UA_Boolean) * size);
  588. UA_UInt32 *indices = UA_alloca(sizeof(UA_UInt32) * size);
  589. #endif /*NO_ALLOCA */
  590. UA_memset(isExternal, UA_FALSE, sizeof(UA_Boolean) * size);
  591. for(size_t j = 0; j < server->externalNamespacesSize; j++) {
  592. size_t indexSize = 0;
  593. for(size_t i = 0;i < size;i++) {
  594. if(request->browsePaths[i].startingNode.namespaceIndex != server->externalNamespaces[j].index)
  595. continue;
  596. isExternal[i] = UA_TRUE;
  597. indices[indexSize] = i;
  598. indexSize++;
  599. }
  600. if(indexSize == 0)
  601. continue;
  602. UA_ExternalNodeStore *ens = &server->externalNamespaces[j].externalNodeStore;
  603. ens->translateBrowsePathsToNodeIds(ens->ensHandle, &request->requestHeader, request->browsePaths,
  604. indices, indexSize, response->results, response->diagnosticInfos);
  605. }
  606. #endif
  607. response->resultsSize = size;
  608. for(size_t i = 0; i < size; i++) {
  609. #ifdef UA_EXTERNAL_NAMESPACES
  610. if(!isExternal[i])
  611. #endif
  612. translateBrowsePath(server, session, &request->browsePaths[i], &response->results[i]);
  613. }
  614. }
  615. void Service_RegisterNodes(UA_Server *server, UA_Session *session, const UA_RegisterNodesRequest *request,
  616. UA_RegisterNodesResponse *response) {
  617. //TODO: hang the nodeids to the session if really needed
  618. response->responseHeader.timestamp = UA_DateTime_now();
  619. if(request->nodesToRegisterSize <= 0)
  620. response->responseHeader.serviceResult = UA_STATUSCODE_BADNOTHINGTODO;
  621. else {
  622. response->responseHeader.serviceResult =
  623. UA_Array_copy(request->nodesToRegister, (void**)&response->registeredNodeIds, &UA_TYPES[UA_TYPES_NODEID],
  624. request->nodesToRegisterSize);
  625. if(response->responseHeader.serviceResult == UA_STATUSCODE_GOOD)
  626. response->registeredNodeIdsSize = request->nodesToRegisterSize;
  627. }
  628. }
  629. void Service_UnregisterNodes(UA_Server *server, UA_Session *session, const UA_UnregisterNodesRequest *request,
  630. UA_UnregisterNodesResponse *response) {
  631. //TODO: remove the nodeids from the session if really needed
  632. response->responseHeader.timestamp = UA_DateTime_now();
  633. if(request->nodesToUnregisterSize==0)
  634. response->responseHeader.serviceResult = UA_STATUSCODE_BADNOTHINGTODO;
  635. }