void Service_Write(UA_Server *server, UA_Session *session, const UA_WriteRequest *request,
UA_WriteResponse *response) {
UA_assert(server != UA_NULL && session != UA_NULL && request != UA_NULL && response != UA_NULL);
if(request->nodesToWriteSize <= 0){
response->responseHeader.serviceResult = UA_STATUSCODE_BADNOTHINGTODO;
return;
}
response->results = UA_Array_new(&UA_TYPES[UA_TYPES_STATUSCODE], request->nodesToWriteSize);
if(!response->results) {
response->responseHeader.serviceResult = UA_STATUSCODE_BADOUTOFMEMORY;
return;
}
#ifdef UA_EXTERNAL_NAMESPACES
#ifdef NO_ALLOCA
UA_Boolean isExternal[request->nodesToWriteSize];
UA_UInt32 indices[request->nodesToWriteSize];
#else
UA_Boolean *isExternal = UA_alloca(sizeof(UA_Boolean) * request->nodesToWriteSize);
UA_UInt32 *indices = UA_alloca(sizeof(UA_UInt32) * request->nodesToWriteSize);
#endif /*NO_ALLOCA */
UA_memset(isExternal, UA_FALSE, sizeof(UA_Boolean)*request->nodesToWriteSize);
for(size_t j = 0; j < server->externalNamespacesSize; j++) {
UA_UInt32 indexSize = 0;
for(UA_Int32 i = 0; i < request->nodesToWriteSize; i++) {
if(request->nodesToWrite[i].nodeId.namespaceIndex !=
server->externalNamespaces[j].index)
continue;
isExternal[i] = UA_TRUE;
indices[indexSize] = i;
indexSize++;
}
if(indexSize == 0)
continue;
UA_ExternalNodeStore *ens = &server->externalNamespaces[j].externalNodeStore;
ens->writeNodes(ens->ensHandle, &request->requestHeader, request->nodesToWrite,
indices, indexSize, response->results, response->diagnosticInfos);
}
#endif
response->resultsSize = request->nodesToWriteSize;
for(UA_Int32 i = 0;i < request->nodesToWriteSize;i++) {
#ifdef UA_EXTERNAL_NAMESPACES
if(!isExternal[i])
#endif
response->results[i] = writeValue(server, &request->nodesToWrite[i]);
}
}
void Service_AddReferences(UA_Server *server, UA_Session *session, const UA_AddReferencesRequest *request,
UA_AddReferencesResponse *response) {
if(request->referencesToAddSize <= 0) {
response->responseHeader.serviceResult = UA_STATUSCODE_BADNOTHINGTODO;
return;
}
size_t size = request->referencesToAddSize;
if(!(response->results = UA_malloc(sizeof(UA_StatusCode) * size))) {
response->responseHeader.serviceResult = UA_STATUSCODE_BADOUTOFMEMORY;
return;
}
response->resultsSize = size;
UA_memset(response->results, UA_STATUSCODE_GOOD, sizeof(UA_StatusCode) * size);
#ifdef UA_EXTERNAL_NAMESPACES
#ifdef NO_ALLOCA
UA_Boolean isExternal[size];
UA_UInt32 indices[size];
#else
UA_Boolean *isExternal = UA_alloca(sizeof(UA_Boolean) * size);
UA_UInt32 *indices = UA_alloca(sizeof(UA_UInt32) * size);
#endif /*NO_ALLOCA */
UA_memset(isExternal, UA_FALSE, sizeof(UA_Boolean) * size);
for(size_t j = 0; j < server->externalNamespacesSize; j++) {
size_t indicesSize = 0;
for(size_t i = 0;i < size;i++) {
if(request->referencesToAdd[i].sourceNodeId.namespaceIndex
!= server->externalNamespaces[j].index)
continue;
isExternal[i] = UA_TRUE;
indices[indicesSize] = i;
indicesSize++;
}
if (indicesSize == 0)
continue;
UA_ExternalNodeStore *ens = &server->externalNamespaces[j].externalNodeStore;
ens->addReferences(ens->ensHandle, &request->requestHeader, request->referencesToAdd,
indices, indicesSize, response->results, response->diagnosticInfos);
}
#endif
response->resultsSize = size;
for(UA_Int32 i = 0; i < response->resultsSize; i++) {
#ifdef UA_EXTERNAL_NAMESPACES
if(!isExternal[i])
#endif
UA_Server_addReferenceWithSession(server, session, &request->referencesToAdd[i]);
}
}
void Service_AddNodes(UA_Server *server, UA_Session *session, const UA_AddNodesRequest *request,
UA_AddNodesResponse *response) {
if(request->nodesToAddSize <= 0) {
response->responseHeader.serviceResult = UA_STATUSCODE_BADNOTHINGTODO;
return;
}
size_t size = request->nodesToAddSize;
response->results = UA_Array_new(size, &UA_TYPES[UA_TYPES_ADDNODESRESULT]);
if(!response->results) {
response->responseHeader.serviceResult = UA_STATUSCODE_BADOUTOFMEMORY;
return;
}
#ifdef UA_EXTERNAL_NAMESPACES
#ifdef _MSVC_VER
UA_Boolean *isExternal = UA_alloca(size);
UA_UInt32 *indices = UA_alloca(sizeof(UA_UInt32)*size);
#else
UA_Boolean isExternal[size];
UA_UInt32 indices[size];
#endif
memset(isExternal, UA_FALSE, sizeof(UA_Boolean) * size);
for(size_t j = 0; j <server->externalNamespacesSize; j++) {
size_t indexSize = 0;
for(size_t i = 0;i < size;i++) {
if(request->nodesToAdd[i].requestedNewNodeId.nodeId.namespaceIndex !=
server->externalNamespaces[j].index)
continue;
isExternal[i] = UA_TRUE;
indices[indexSize] = i;
indexSize++;
}
if(indexSize == 0)
continue;
UA_ExternalNodeStore *ens = &server->externalNamespaces[j].externalNodeStore;
ens->addNodes(ens->ensHandle, &request->requestHeader, request->nodesToAdd,
indices, indexSize, response->results, response->diagnosticInfos);
}
#endif
response->resultsSize = size;
for(size_t i = 0; i < size; i++) {
#ifdef UA_EXTERNAL_NAMESPACES
if(!isExternal[i])
#endif
Service_AddNodes_single(server, session, &request->nodesToAdd[i], &response->results[i]);
}
}
/* The request/response are casted to the header (first element of their struct) */
static void invoke_service(UA_Server *server, UA_SecureChannel *channel,
UA_UInt32 requestId, UA_RequestHeader *request, const UA_DataType *responseType,
void (*service)(UA_Server*, UA_Session*, void*, void*)) {
UA_ResponseHeader *response = UA_alloca(responseType->memSize);
UA_init(response, responseType);
init_response_header(request, response);
/* try to get the session from the securechannel first */
UA_Session *session = UA_SecureChannel_getSession(channel, &request->authenticationToken);
if(!session)
session = UA_SessionManager_getSession(&server->sessionManager, &request->authenticationToken);
if(!session)
response->serviceResult = UA_STATUSCODE_BADSESSIONIDINVALID;
else if(session->activated == UA_FALSE) {
response->serviceResult = UA_STATUSCODE_BADSESSIONNOTACTIVATED;
/* the session is invalidated FIXME: do this delayed*/
UA_SessionManager_removeSession(&server->sessionManager, &request->authenticationToken);
} else if(session->channel != channel) {
response->serviceResult = UA_STATUSCODE_BADSESSIONIDINVALID;
} else {
UA_Session_updateLifetime(session);
service(server, session, request, response);
}
UA_SecureChannel_sendBinaryMessage(channel, requestId, response, responseType);
UA_deleteMembers(response, responseType);
}
static void
sendError(UA_SecureChannel *channel, const UA_ByteString *msg,
size_t offset, const UA_DataType *responseType,
UA_UInt32 requestId, UA_StatusCode error) {
UA_RequestHeader requestHeader;
UA_StatusCode retval = UA_RequestHeader_decodeBinary(msg, &offset, &requestHeader);
if(retval != UA_STATUSCODE_GOOD)
return;
void *response = UA_alloca(responseType->memSize);
UA_init(response, responseType);
UA_ResponseHeader *responseHeader = (UA_ResponseHeader*)response;
responseHeader->requestHandle = requestHeader.requestHandle;
responseHeader->timestamp = UA_DateTime_now();
responseHeader->serviceResult = error;
UA_SecureChannel_sendBinaryMessage(channel, requestId, response, responseType);
UA_RequestHeader_deleteMembers(&requestHeader);
UA_ResponseHeader_deleteMembers(responseHeader);
}
/* The request/response are casted to the header (first element of their struct) */
static void invoke_service(UA_Server *server, UA_SecureChannel *channel, UA_UInt32 requestId,
UA_RequestHeader *request, const UA_DataType *responseType,
void (*service)(UA_Server*, UA_Session*, void*, void*)) {
UA_ResponseHeader *response = UA_alloca(responseType->memSize);
UA_init(response, responseType);
init_response_header(request, response);
/* try to get the session from the securechannel first */
UA_Session *session = UA_SecureChannel_getSession(channel, &request->authenticationToken);
#ifdef EXTENSION_STATELESS
if(request->authenticationToken.namespaceIndex == 0
&& request->authenticationToken.identifierType == UA_NODEIDTYPE_NUMERIC
&& request->authenticationToken.identifier.numeric == 0
&& (responseType->typeIndex == UA_TYPES_READRESPONSE
|| responseType->typeIndex == UA_TYPES_WRITERESPONSE
|| responseType->typeIndex == UA_TYPES_BROWSERESPONSE)
){
session = &anonymousSession;
service(server, session, request, response);
}else{
#endif
if(!session || session->channel != channel) {
response->serviceResult = UA_STATUSCODE_BADSESSIONIDINVALID;
} else if(session->activated == UA_FALSE) {
response->serviceResult = UA_STATUSCODE_BADSESSIONNOTACTIVATED;
/* /\* the session is invalidated FIXME: do this delayed*\/ */
/* UA_SessionManager_removeSession(&server->sessionManager, server, &request->authenticationToken); */
} else {
UA_Session_updateLifetime(session);
service(server, session, request, response);
}
#ifdef EXTENSION_STATELESS
}
#endif
UA_StatusCode retval = UA_SecureChannel_sendBinaryMessage(channel, requestId, response, responseType);
if(retval != UA_STATUSCODE_GOOD) {
if(retval == UA_STATUSCODE_BADENCODINGLIMITSEXCEEDED)
response->serviceResult = UA_STATUSCODE_BADRESPONSETOOLARGE;
else
response->serviceResult = retval;
UA_SecureChannel_sendBinaryMessage(channel, requestId, response, &UA_TYPES[UA_TYPES_SERVICEFAULT]);
}
UA_deleteMembers(response, responseType);
}
static UA_StatusCode
parse_numericrange(const UA_String str, UA_NumericRange *range)
{
if(str.length < 0 || str.length >= 1023)
return UA_STATUSCODE_BADINTERNALERROR;
char *cstring = UA_alloca(str.length+1);
UA_memcpy(cstring, str.data, str.length);
cstring[str.length] = 0;
UA_Int32 index = 0;
size_t dimensionsIndex = 0;
size_t dimensionsMax = 3; // more should be uncommon
struct UA_NumericRangeDimension *dimensions = UA_malloc(sizeof(struct UA_NumericRangeDimension) * 3);
if(!dimensions)
return UA_STATUSCODE_BADOUTOFMEMORY;
UA_StatusCode retval = UA_STATUSCODE_GOOD;
do {
UA_Int32 min, max;
UA_Int32 progress;
UA_Int32 res = sscanf(&cstring[index], "%" SCNu32 "%n", &min, &progress);
if(res <= 0 || min < 0) {
retval = UA_STATUSCODE_BADINDEXRANGEINVALID;
break;
}
index += progress;
if(index >= str.length || cstring[index] == ',')
max = min;
else {
res = sscanf(&cstring[index], ":%" SCNu32 "%n", &max, &progress);
if(res <= 0 || max < 0 || min >= max) {
retval = UA_STATUSCODE_BADINDEXRANGEINVALID;
break;
}
index += progress;
}
if(dimensionsIndex >= dimensionsMax) {
struct UA_NumericRangeDimension *newDimensions =
UA_realloc(dimensions, sizeof(struct UA_NumericRangeDimension) * 2 * dimensionsMax);
if(!newDimensions) {
UA_free(dimensions);
return UA_STATUSCODE_BADOUTOFMEMORY;
}
dimensions = newDimensions;
dimensionsMax *= 2;
}
dimensions[dimensionsIndex].min = min;
dimensions[dimensionsIndex].max = max;
dimensionsIndex++;
} while(retval == UA_STATUSCODE_GOOD && index + 1 < str.length && cstring[index] == ',' && ++index);
if(retval != UA_STATUSCODE_GOOD) {
UA_free(dimensions);
return retval;
}
range->dimensions = dimensions;
range->dimensionsSize = dimensionsIndex;
return retval;
}
void Service_Read(UA_Server *server, UA_Session *session, const UA_ReadRequest *request,
UA_ReadResponse *response) {
if(request->nodesToReadSize <= 0) {
response->responseHeader.serviceResult = UA_STATUSCODE_BADNOTHINGTODO;
return;
}
if(request->timestampsToReturn > 3){
response->responseHeader.serviceResult = UA_STATUSCODE_BADTIMESTAMPSTORETURNINVALID;
return;
}
size_t size = request->nodesToReadSize;
response->results = UA_Array_new(&UA_TYPES[UA_TYPES_DATAVALUE], size);
if(!response->results) {
response->responseHeader.serviceResult = UA_STATUSCODE_BADOUTOFMEMORY;
return;
}
response->resultsSize = size;
if(request->maxAge < 0) {
response->responseHeader.serviceResult = UA_STATUSCODE_BADMAXAGEINVALID;
return;
}
/* ### Begin External Namespaces */
UA_Boolean *isExternal = UA_alloca(sizeof(UA_Boolean) * size);
UA_memset(isExternal, UA_FALSE, sizeof(UA_Boolean) * size);
UA_UInt32 *indices = UA_alloca(sizeof(UA_UInt32) * size);
for(UA_Int32 j = 0;j<server->externalNamespacesSize;j++) {
size_t indexSize = 0;
for(size_t i = 0;i < size;i++) {
if(request->nodesToRead[i].nodeId.namespaceIndex != server->externalNamespaces[j].index)
continue;
isExternal[i] = UA_TRUE;
indices[indexSize] = i;
indexSize++;
}
if(indexSize == 0)
continue;
UA_ExternalNodeStore *ens = &server->externalNamespaces[j].externalNodeStore;
ens->readNodes(ens->ensHandle, &request->requestHeader, request->nodesToRead,
indices, indexSize, response->results, UA_FALSE, response->diagnosticInfos);
}
/* ### End External Namespaces */
for(size_t i = 0;i < size;i++) {
if(!isExternal[i])
readValue(server, request->timestampsToReturn, &request->nodesToRead[i], &response->results[i]);
}
#ifdef EXTENSION_STATELESS
if(session==&anonymousSession){
/* expiry header */
UA_ExtensionObject additionalHeader;
UA_ExtensionObject_init(&additionalHeader);
additionalHeader.encoding = UA_EXTENSIONOBJECT_ENCODINGMASK_BODYISBYTESTRING;
UA_Variant variant;
UA_Variant_init(&variant);
variant.type = &UA_TYPES[UA_TYPES_DATETIME];
variant.arrayLength = request->nodesToReadSize;
UA_DateTime* expireArray = UA_NULL;
expireArray = UA_Array_new(&UA_TYPES[UA_TYPES_DATETIME], request->nodesToReadSize);
variant.data = expireArray;
UA_ByteString str;
UA_ByteString_init(&str);
/*expires in 20 seconds*/
for(UA_Int32 i = 0;i < response->resultsSize;i++) {
expireArray[i] = UA_DateTime_now() + 20 * 100 * 1000 * 1000;
}
size_t offset = 0;
str.data = UA_malloc(UA_Variant_calcSizeBinary(&variant));
str.length = UA_Variant_calcSizeBinary(&variant);
UA_Variant_encodeBinary(&variant, &str, &offset);
additionalHeader.body = str;
response->responseHeader.additionalHeader = additionalHeader;
}
#endif
}
static void
processMSG(UA_Server *server, UA_SecureChannel *channel,
UA_UInt32 requestId, const UA_ByteString *msg) {
/* At 0, the nodeid starts... */
size_t ppos = 0;
size_t *offset = &ppos;
/* Decode the nodeid */
UA_NodeId requestTypeId;
UA_StatusCode retval = UA_NodeId_decodeBinary(msg, offset, &requestTypeId);
if(retval != UA_STATUSCODE_GOOD)
return;
if(requestTypeId.identifierType != UA_NODEIDTYPE_NUMERIC)
UA_NodeId_deleteMembers(&requestTypeId); /* leads to badserviceunsupported */
/* Store the start-position of the request */
size_t requestPos = *offset;
/* Get the service pointers */
UA_Service service = NULL;
const UA_DataType *requestType = NULL;
const UA_DataType *responseType = NULL;
UA_Boolean sessionRequired = true;
getServicePointers(requestTypeId.identifier.numeric, &requestType,
&responseType, &service, &sessionRequired);
if(!requestType) {
if(requestTypeId.identifier.numeric == 787) {
UA_LOG_INFO_CHANNEL(server->config.logger, channel,
"Client requested a subscription, " \
"but those are not enabled in the build");
} else {
UA_LOG_INFO_CHANNEL(server->config.logger, channel, "Unknown request %i",
requestTypeId.identifier.numeric);
}
sendError(channel, msg, requestPos, &UA_TYPES[UA_TYPES_SERVICEFAULT],
requestId, UA_STATUSCODE_BADSERVICEUNSUPPORTED);
return;
}
UA_assert(responseType);
#ifdef UA_ENABLE_NONSTANDARD_STATELESS
/* Stateless extension: Sessions are optional */
sessionRequired = false;
#endif
/* Decode the request */
void *request = UA_alloca(requestType->memSize);
UA_RequestHeader *requestHeader = (UA_RequestHeader*)request;
retval = UA_decodeBinary(msg, offset, request, requestType);
if(retval != UA_STATUSCODE_GOOD) {
UA_LOG_DEBUG_CHANNEL(server->config.logger, channel, "Could not decode the request");
sendError(channel, msg, requestPos, responseType, requestId, retval);
return;
}
/* Prepare the respone */
void *response = UA_alloca(responseType->memSize);
UA_init(response, responseType);
UA_Session *session = NULL; /* must be initialized before goto send_response */
/* CreateSession doesn't need a session */
if(requestType == &UA_TYPES[UA_TYPES_CREATESESSIONREQUEST]) {
Service_CreateSession(server, channel, request, response);
goto send_response;
}
/* Find the matching session */
session = UA_SecureChannel_getSession(channel, &requestHeader->authenticationToken);
if(!session)
session = UA_SessionManager_getSession(&server->sessionManager,
&requestHeader->authenticationToken);
if(requestType == &UA_TYPES[UA_TYPES_ACTIVATESESSIONREQUEST]) {
if(!session) {
UA_LOG_DEBUG_CHANNEL(server->config.logger, channel,
"Trying to activate a session that is " \
"not known in the server");
sendError(channel, msg, requestPos, responseType,
requestId, UA_STATUSCODE_BADSESSIONIDINVALID);
UA_deleteMembers(request, requestType);
return;
}
Service_ActivateSession(server, channel, session, request, response);
goto send_response;
}
/* Set an anonymous, inactive session for services that need no session */
UA_Session anonymousSession;
if(!session) {
if(sessionRequired) {
UA_LOG_INFO_CHANNEL(server->config.logger, channel,
"Service request %i without a valid session",
requestType->binaryEncodingId);
sendError(channel, msg, requestPos, responseType,
requestId, UA_STATUSCODE_BADSESSIONIDINVALID);
UA_deleteMembers(request, requestType);
return;
}
UA_Session_init(&anonymousSession);
anonymousSession.sessionId = UA_NODEID_GUID(0, UA_GUID_NULL);
anonymousSession.channel = channel;
session = &anonymousSession;
}
/* Trying to use a non-activated session? */
if(sessionRequired && !session->activated) {
UA_LOG_INFO_SESSION(server->config.logger, session,
"Calling service %i on a non-activated session",
requestType->binaryEncodingId);
sendError(channel, msg, requestPos, responseType,
requestId, UA_STATUSCODE_BADSESSIONNOTACTIVATED);
UA_SessionManager_removeSession(&server->sessionManager,
&session->authenticationToken);
UA_deleteMembers(request, requestType);
return;
}
/* The session is bound to another channel */
if(session->channel != channel) {
UA_LOG_DEBUG_CHANNEL(server->config.logger, channel,
"Client tries to use an obsolete securechannel");
sendError(channel, msg, requestPos, responseType,
requestId, UA_STATUSCODE_BADSECURECHANNELIDINVALID);
UA_deleteMembers(request, requestType);
return;
}
/* Update the session lifetime */
UA_Session_updateLifetime(session);
#ifdef UA_ENABLE_SUBSCRIPTIONS
/* The publish request is not answered immediately */
if(requestType == &UA_TYPES[UA_TYPES_PUBLISHREQUEST]) {
Service_Publish(server, session, request, requestId);
UA_deleteMembers(request, requestType);
return;
}
#endif
/* Call the service */
UA_assert(service); /* For all services besides publish, the service pointer is non-NULL*/
service(server, session, request, response);
send_response:
/* Send the response */
((UA_ResponseHeader*)response)->requestHandle = requestHeader->requestHandle;
((UA_ResponseHeader*)response)->timestamp = UA_DateTime_now();
retval = UA_SecureChannel_sendBinaryMessage(channel, requestId, response, responseType);
if(retval != UA_STATUSCODE_GOOD)
UA_LOG_INFO_CHANNEL(server->config.logger, channel, "Could not send the message over "
"the SecureChannel with error code 0x%08x", retval);
/* Clean up */
UA_deleteMembers(request, requestType);
UA_deleteMembers(response, responseType);
}
static UA_StatusCode
register_server_with_discovery_server(UA_Server *server,
const char* discoveryServerUrl,
const UA_Boolean isUnregister,
const char* semaphoreFilePath) {
if(!discoveryServerUrl) {
UA_LOG_ERROR(server->config.logger, UA_LOGCATEGORY_SERVER,
"No discovery server url provided");
return UA_STATUSCODE_BADINTERNALERROR;
}
/* Create the client */
UA_Client *client = UA_Client_new(UA_ClientConfig_default);
if(!client)
return UA_STATUSCODE_BADOUTOFMEMORY;
/* Connect the client */
UA_StatusCode retval = UA_Client_connect(client, discoveryServerUrl);
if(retval != UA_STATUSCODE_GOOD) {
UA_LOG_ERROR(server->config.logger, UA_LOGCATEGORY_CLIENT,
"Connecting to the discovery server failed with statuscode %s",
UA_StatusCode_name(retval));
UA_Client_delete(client);
return retval;
}
/* Prepare the request. Do not cleanup the request after the service call,
* as the members are stack-allocated or point into the server config. */
UA_RegisterServer2Request request;
UA_RegisterServer2Request_init(&request);
request.requestHeader.timestamp = UA_DateTime_now();
request.requestHeader.timeoutHint = 10000;
request.server.isOnline = !isUnregister;
request.server.serverUri = server->config.applicationDescription.applicationUri;
request.server.productUri = server->config.applicationDescription.productUri;
request.server.serverType = server->config.applicationDescription.applicationType;
request.server.gatewayServerUri = server->config.applicationDescription.gatewayServerUri;
if(semaphoreFilePath) {
#ifdef UA_ENABLE_DISCOVERY_SEMAPHORE
request.server.semaphoreFilePath =
UA_STRING((char*)(uintptr_t)semaphoreFilePath); /* dirty cast */
#else
UA_LOG_WARNING(server->config.logger, UA_LOGCATEGORY_CLIENT,
"Ignoring semaphore file path. open62541 not compiled "
"with UA_ENABLE_DISCOVERY_SEMAPHORE=ON");
#endif
}
request.server.serverNames = &server->config.applicationDescription.applicationName;
request.server.serverNamesSize = 1;
/* Copy the discovery urls from the server config and the network layers*/
size_t config_discurls = server->config.applicationDescription.discoveryUrlsSize;
size_t nl_discurls = server->config.networkLayersSize;
size_t total_discurls = config_discurls * nl_discurls;
request.server.discoveryUrls = (UA_String*)UA_alloca(sizeof(UA_String) * total_discurls);
request.server.discoveryUrlsSize = config_discurls + nl_discurls;
for(size_t i = 0; i < config_discurls; ++i)
request.server.discoveryUrls[i] = server->config.applicationDescription.discoveryUrls[i];
/* TODO: Add nl only if discoveryUrl not already present */
for(size_t i = 0; i < nl_discurls; ++i) {
UA_ServerNetworkLayer *nl = &server->config.networkLayers[i];
request.server.discoveryUrls[config_discurls + i] = nl->discoveryUrl;
}
UA_MdnsDiscoveryConfiguration mdnsConfig;
UA_MdnsDiscoveryConfiguration_init(&mdnsConfig);
request.discoveryConfigurationSize = 1;
request.discoveryConfiguration = UA_ExtensionObject_new();
UA_ExtensionObject_init(&request.discoveryConfiguration[0]);
request.discoveryConfiguration[0].encoding = UA_EXTENSIONOBJECT_DECODED_NODELETE;
request.discoveryConfiguration[0].content.decoded.type = &UA_TYPES[UA_TYPES_MDNSDISCOVERYCONFIGURATION];
request.discoveryConfiguration[0].content.decoded.data = &mdnsConfig;
mdnsConfig.mdnsServerName = server->config.mdnsServerName;
mdnsConfig.serverCapabilities = server->config.serverCapabilities;
mdnsConfig.serverCapabilitiesSize = server->config.serverCapabilitiesSize;
// First try with RegisterServer2, if that isn't implemented, use RegisterServer
UA_RegisterServer2Response response;
UA_RegisterServer2Response_init(&response);
__UA_Client_Service(client, &request, &UA_TYPES[UA_TYPES_REGISTERSERVER2REQUEST],
&response, &UA_TYPES[UA_TYPES_REGISTERSERVER2RESPONSE]);
UA_StatusCode serviceResult = response.responseHeader.serviceResult;
UA_RegisterServer2Response_deleteMembers(&response);
UA_ExtensionObject_delete(request.discoveryConfiguration);
if(serviceResult == UA_STATUSCODE_BADNOTIMPLEMENTED ||
serviceResult == UA_STATUSCODE_BADSERVICEUNSUPPORTED) {
/* Try RegisterServer */
UA_RegisterServerRequest request_fallback;
UA_RegisterServerRequest_init(&request_fallback);
/* Copy from RegisterServer2 request */
request_fallback.requestHeader = request.requestHeader;
request_fallback.server = request.server;
UA_RegisterServerResponse response_fallback;
UA_RegisterServerResponse_init(&response_fallback);
__UA_Client_Service(client, &request_fallback,
&UA_TYPES[UA_TYPES_REGISTERSERVERREQUEST],
&response_fallback,
&UA_TYPES[UA_TYPES_REGISTERSERVERRESPONSE]);
serviceResult = response_fallback.responseHeader.serviceResult;
UA_RegisterServerResponse_deleteMembers(&response_fallback);
}
if(serviceResult != UA_STATUSCODE_GOOD) {
UA_LOG_ERROR(server->config.logger, UA_LOGCATEGORY_CLIENT,
"RegisterServer/RegisterServer2 failed with statuscode %s",
UA_StatusCode_name(serviceResult));
}
UA_Client_disconnect(client);
UA_Client_delete(client);
return serviceResult;
}
static void
processMSG(UA_Connection *connection, UA_Server *server, const UA_ByteString *msg, size_t *pos) {
/* If we cannot decode these, don't respond */
UA_UInt32 secureChannelId = 0;
UA_UInt32 tokenId = 0;
UA_SequenceHeader sequenceHeader;
UA_NodeId requestTypeId;
UA_StatusCode retval = UA_UInt32_decodeBinary(msg, pos, &secureChannelId);
retval |= UA_UInt32_decodeBinary(msg, pos, &tokenId);
retval |= UA_SequenceHeader_decodeBinary(msg, pos, &sequenceHeader);
retval = UA_NodeId_decodeBinary(msg, pos, &requestTypeId);
if(retval != UA_STATUSCODE_GOOD)
return;
UA_SecureChannel *channel = connection->channel;
UA_SecureChannel anonymousChannel;
if(!channel) {
UA_SecureChannel_init(&anonymousChannel);
anonymousChannel.connection = connection;
channel = &anonymousChannel;
}
/* Test if the secure channel is ok */
if(secureChannelId != channel->securityToken.channelId)
return;
if(tokenId != channel->securityToken.tokenId) {
if(tokenId != channel->nextSecurityToken.tokenId) {
/* close the securechannel but keep the connection open */
UA_LOG_INFO(server->logger, UA_LOGCATEGORY_SECURECHANNEL,
"Request with a wrong security token. Closing the SecureChannel %i.",
channel->securityToken.channelId);
Service_CloseSecureChannel(server, channel->securityToken.channelId);
return;
}
UA_SecureChannel_revolveTokens(channel);
}
/* Test if the service type nodeid has the right format */
if(requestTypeId.identifierType != UA_NODEIDTYPE_NUMERIC ||
requestTypeId.namespaceIndex != 0) {
UA_NodeId_deleteMembers(&requestTypeId);
sendError(channel, msg, *pos, sequenceHeader.requestId, UA_STATUSCODE_BADSERVICEUNSUPPORTED);
return;
}
/* Get the service pointers */
UA_Service service = NULL;
const UA_DataType *requestType = NULL;
const UA_DataType *responseType = NULL;
getServicePointers(requestTypeId.identifier.numeric, &requestType, &responseType, &service);
if(!service) {
/* The service is not supported */
if(requestTypeId.identifier.numeric==787)
UA_LOG_INFO(server->logger, UA_LOGCATEGORY_SERVER,
"Client requested a subscription that are not supported, "
"the message will be skipped");
else
UA_LOG_INFO(server->logger, UA_LOGCATEGORY_SERVER, "Unknown request: NodeId(ns=%d, i=%d)",
requestTypeId.namespaceIndex, requestTypeId.identifier.numeric);
sendError(channel, msg, *pos, sequenceHeader.requestId, UA_STATUSCODE_BADSERVICEUNSUPPORTED);
return;
}
/* Most services can only be called with a valid securechannel */
#ifndef EXTENSION_STATELESS
if(channel == &anonymousChannel &&
requestType->typeIndex > UA_TYPES_OPENSECURECHANNELREQUEST) {
sendError(channel, msg, *pos, sequenceHeader.requestId, UA_STATUSCODE_BADSECURECHANNELIDINVALID);
return;
}
#endif
/* Decode the request */
void *request = UA_alloca(requestType->memSize);
size_t oldpos = *pos;
retval = UA_decodeBinary(msg, pos, request, requestType);
if(retval != UA_STATUSCODE_GOOD) {
sendError(channel, msg, oldpos, sequenceHeader.requestId, retval);
return;
}
/* Find the matching session */
UA_Session *session =
UA_SecureChannel_getSession(channel, &((UA_RequestHeader*)request)->authenticationToken);
UA_Session anonymousSession;
if(!session) {
UA_Session_init(&anonymousSession);
anonymousSession.channel = channel;
anonymousSession.activated = UA_TRUE;
session = &anonymousSession;
}
/* Test if the session is valid */
if(!session->activated && requestType->typeIndex != UA_TYPES_ACTIVATESESSIONREQUEST) {
UA_LOG_INFO(server->logger, UA_LOGCATEGORY_SERVER, "Client tries to call a service with a non-activated session");
sendError(channel, msg, *pos, sequenceHeader.requestId, UA_STATUSCODE_BADSESSIONNOTACTIVATED);
return;
}
#ifndef EXTENSION_STATELESS
if(session == &anonymousSession &&
requestType->typeIndex > UA_TYPES_ACTIVATESESSIONREQUEST) {
UA_LOG_INFO(server->logger, UA_LOGCATEGORY_SERVER, "Client tries to call a service without a session");
sendError(channel, msg, *pos, sequenceHeader.requestId, UA_STATUSCODE_BADSESSIONIDINVALID);
return;
}
#endif
/* Call the service */
UA_Session_updateLifetime(session);
void *response = UA_alloca(responseType->memSize);
UA_init(response, responseType);
init_response_header(request, response);
service(server, session, request, response);
/* Send the response */
retval = UA_SecureChannel_sendBinaryMessage(channel, sequenceHeader.requestId,
response, responseType);
if(retval != UA_STATUSCODE_GOOD) {
/* e.g. UA_STATUSCODE_BADENCODINGLIMITSEXCEEDED */
sendError(channel, msg, oldpos, sequenceHeader.requestId, retval);
}
/* Clean up */
UA_deleteMembers(request, requestType);
UA_deleteMembers(response, responseType);
return;
}
