Imported Upstream version 0.9.2
[platform/upstream/iotivity.git] / resource / csdk / stack / src / ocstack.c
index 2ccd77a..be6fa96 100644 (file)
 #include "occlientcb.h"
 #include "ocobserve.h"
 #include "ocrandom.h"
-#include "ocmalloc.h"
+#include "oic_malloc.h"
+#include "oic_string.h"
 #include "ocserverrequest.h"
-#include "ocsecurityinternal.h"
-
+#include "secureresourcemanager.h"
 #include "cacommon.h"
 #include "cainterface.h"
+#include "ocpayload.h"
+#include "ocpayloadcbor.h"
 
 #ifdef WITH_ARDUINO
 #include "Time.h"
@@ -96,8 +98,12 @@ static uint32_t PresenceTimeOut[] = {50, 75, 85, 95, 100};
 #endif
 
 static OCMode myStackMode;
+#ifdef RA_ADAPTER
+//TODO: revisit this design
+static bool gRASetInfo = false;
+#endif
 OCDeviceEntityHandler defaultDeviceHandler;
-
+void* defaultDeviceHandlerCallbackParameter = NULL;
 
 //-----------------------------------------------------------------------------
 // Macros
@@ -107,6 +113,8 @@ OCDeviceEntityHandler defaultDeviceHandler;
             {OC_LOG_V(FATAL, TAG, "%s failed!!", #op); goto exit;} }
 #define VERIFY_NON_NULL(arg, logLevel, retVal) { if (!(arg)) { OC_LOG((logLevel), \
              TAG, PCF(#arg " is NULL")); return (retVal); } }
+#define VERIFY_NON_NULL_NR(arg, logLevel) { if (!(arg)) { OC_LOG((logLevel), \
+             TAG, PCF(#arg " is NULL")); return; } }
 #define VERIFY_NON_NULL_V(arg) { if (!arg) {OC_LOG_V(FATAL, TAG, "%s is NULL", #arg);\
     goto exit;} }
 
@@ -114,21 +122,6 @@ OCDeviceEntityHandler defaultDeviceHandler;
 #define MAX_OBSERVE_AGE (0x2FFFFUL)
 
 #define MILLISECONDS_PER_SECOND   (1000)
-/**
- * Parse the presence payload and extract various parameters.
- * Note: Caller should invoke OCFree after done with resType pointer.
- *
- * @param payload Presence payload.
- * @param seqNum Sequence number.
- * @param maxAge Time To Live (in seconds).
- * @param resType Resource type.
- */
-// TODO: Not sure if I agree with this.  I think it should be static but it is called in
-// stack/test/stacktests.cpp, not included via a header file.  If we intend to allow it
-// to be called externally, we should change the name to OCParsePresencePayload and make
-// it part of the official public API.  But can't change now due to current API freeze.
-// Another option might be to make non-API utility functions for doing stuff like this.
-void parsePresencePayload(char* payload, uint32_t* seqNum, uint32_t* maxAge, char** resType);
 
 //-----------------------------------------------------------------------------
 // Private internal function prototypes
@@ -264,36 +257,6 @@ static void incrementSequenceNumber(OCResource * resPtr);
 static OCStackResult verifyUriQueryLength(const char * inputUri,
         uint16_t uriLen);
 
-/**
- * Determine if a request/response must be sent in a block transfer because it is too large to be
- * sent in a single PDU.  This function can be used for either a request or a response.
- * Note:  Either the request or response parameter should be non-NULL (i.e. only one, not both).
- *
- * @param request  NULL or pointer to request.
- * @param response NULL or pointer to response.
- * @param size     0 or size of the request/response.  If 0, strlen is used for determining
- *                 the length of the request/response.
- *
- * @return
- *    false - packet transfer NOT required (i.e. normal request/response).
- *    true  - packet transfer required (i.e. block transfer needed).
- */
-static bool OCIsPacketTransferRequired(const char *request, const char *response, size_t size);
-
-/**
- * Retrieves a resource type based upon a query contains only just one
- * resource attribute (and that has to be of type "rt").
- *
- * @remark This API malloc's memory for the resource type. Do not malloc resourceType
- * before passing in.
- *
- * @param query The query part of the URI.
- * @param resourceType The resource type to be populated; pass by reference.
- *
- * @return ::OC_STACK_OK on success, some other value upon failure.
- */
-static OCStackResult getResourceType(const char * query, char** resourceType);
-
 /*
  * Attempts to initialize every network interface that the CA Layer might have compiled in.
  *
@@ -314,22 +277,6 @@ static CAResult_t OCSelectNetwork();
 static uint32_t GetTicks(uint32_t afterMilliSeconds);
 
 /**
- * This method is used to create the IPv4 dev_addr structure.
- * Builds a socket interface address using IP address and port number.
- * TODO: Remove in future. Temporary helper function.
- *
- * @param a IPv4 octet 0.
- * @param b IPv4 octet 1.
- * @param c IPv4 octet 2.
- * @param d IPv4 octet 3.
- * @param port Port number.
- * @param ipAddr - IPv4 address.
- * @return ::OC_STACK_OK on success, some other value upon failure.
- */
-static OCStackResult OCBuildIPv4Address(uint8_t a, uint8_t b, uint8_t c, uint8_t d,
-        uint16_t port, OCDevAddr *ipAddr);
-
-/**
  * Convert CAResponseResult_t to OCStackResult.
  *
  * @param caCode CAResponseResult_t code.
@@ -346,33 +293,20 @@ static OCStackResult CAToOCStackResult(CAResponseResult_t caCode);
 static CAResponseResult_t OCToCAStackResult(OCStackResult ocCode);
 
 /**
- * Convert OCConnectivityType to CATransportType_t.
+ * Convert OCTransportFlags_t to CATransportModifiers_t.
  *
- * @param ocConType OCConnectivityType input.
- * @param caConType CATransportType_t output.
- * @return  ::OC_STACK_OK on success, some other value upon failure.
+ * @param ocConType OCTransportFlags_t input.
+ * @return CATransportFlags
  */
-static OCStackResult OCToCATransportType(OCConnectivityType ocConType,
-        CATransportType_t* caConType);
+static CATransportFlags_t OCToCATransportFlags(OCTransportFlags ocConType);
 
 /**
- * Convert CATransportType_t to OCConnectivityType.
+ * Convert CATransportFlags_t to OCTransportModifiers_t.
  *
- * @param caConType CATransportType_t input.
- * @param ocConType OCConnectivityType output.
- * @return ::OC_STACK_OK on success, some other value upon failure.
- */
-static OCStackResult CAToOCConnectivityType(CATransportType_t caConType,
-        OCConnectivityType *ocConType);
-
-/**
- * Update response.addr appropriately from endPoint.addressInfo.
- *
- * @param address OCDevAddr output.
- * @param endPoint CARemoteEndpoint_t input.
- * @return ::OC_STACK_OK on success, some other value upon failure.
+ * @param caConType CATransportFlags_t input.
+ * @return OCTransportFlags
  */
-static OCStackResult UpdateResponseAddr(OCDevAddr *address, const CARemoteEndpoint_t* endPoint);
+static OCTransportFlags CAToOCTransportFlags(CATransportFlags_t caConType);
 
 /**
  * Handle response from presence request.
@@ -381,8 +315,8 @@ static OCStackResult UpdateResponseAddr(OCDevAddr *address, const CARemoteEndpoi
  * @param responseInfo CA response info.
  * @return ::OC_STACK_OK on success, some other value upon failure.
  */
-static OCStackResult HandlePresenceResponse(const CARemoteEndpoint_t* endPoint,
-        const CAResponseInfo_tresponseInfo);
+static OCStackResult HandlePresenceResponse(const CAEndpoint_t *endPoint,
+        const CAResponseInfo_t *responseInfo);
 
 /**
  * This function will be called back by CA layer when a response is received.
@@ -390,7 +324,7 @@ static OCStackResult HandlePresenceResponse(const CARemoteEndpoint_t* endPoint,
  * @param endPoint CA remote endpoint.
  * @param responseInfo CA response info.
  */
-static void HandleCAResponses(const CARemoteEndpoint_t* endPoint,
+static void HandleCAResponses(const CAEndpoint_t* endPoint,
         const CAResponseInfo_t* responseInfo);
 
 /**
@@ -399,7 +333,7 @@ static void HandleCAResponses(const CARemoteEndpoint_t* endPoint,
  * @param endPoint CA remote endpoint.
  * @param requestInfo CA request info.
  */
-static void HandleCARequests(const CARemoteEndpoint_t* endPoint,
+static void HandleCARequests(const CAEndpoint_t* endPoint,
         const CARequestInfo_t* requestInfo);
 
 /**
@@ -456,25 +390,68 @@ uint32_t GetTicks(uint32_t afterMilliSeconds)
     }
 }
 
-OCStackResult OCBuildIPv4Address(uint8_t a, uint8_t b, uint8_t c, uint8_t d,
-        uint16_t port, OCDevAddr *ipAddr)
+void CopyEndpointToDevAddr(const CAEndpoint_t *in, OCDevAddr *out)
+{
+    VERIFY_NON_NULL_NR(in, FATAL);
+    VERIFY_NON_NULL_NR(out, FATAL);
+
+    out->adapter = (OCTransportAdapter)in->adapter;
+    out->flags = CAToOCTransportFlags(in->flags);
+    strncpy(out->addr, in->addr, MAX_ADDR_STR_SIZE);
+    out->addr[MAX_ADDR_STR_SIZE - 1] = '\0';
+    out->port = in->port;
+}
+
+void CopyDevAddrToEndpoint(const OCDevAddr *in, CAEndpoint_t *out)
+{
+    VERIFY_NON_NULL_NR(in, FATAL);
+    VERIFY_NON_NULL_NR(out, FATAL);
+
+    out->adapter = (CATransportAdapter_t)in->adapter;
+    out->flags = OCToCATransportFlags(in->flags);
+    strncpy(out->addr, in->addr, MAX_ADDR_STR_SIZE);
+    out->port = in->port;
+}
+
+static OCStackResult OCCreateEndpoint(OCDevAddr *devAddr, CAEndpoint_t **endpoint)
 {
-    if (!ipAddr )
+    VERIFY_NON_NULL(devAddr, FATAL, OC_STACK_INVALID_PARAM);
+    VERIFY_NON_NULL(endpoint, FATAL, OC_STACK_INVALID_PARAM);
+
+    CAEndpoint_t *ep = (CAEndpoint_t *)OICMalloc(sizeof (CAEndpoint_t));
+    if (!ep)
     {
-        OC_LOG(FATAL, TAG, PCF("Invalid argument"));
-        return OC_STACK_INVALID_PARAM;
+        return OC_STACK_NO_MEMORY;
+    }
+
+    ep->adapter = (CATransportAdapter_t)devAddr->adapter;
+    if (!ep->adapter)
+    {
+        ep->adapter = CA_ADAPTER_IP;
     }
+    ep->flags = OCToCATransportFlags(devAddr->flags);
+    strncpy(ep->addr, devAddr->addr, MAX_ADDR_STR_SIZE_CA);
+    ep->port = devAddr->port;
 
-    ipAddr->addr[0] = a;
-    ipAddr->addr[1] = b;
-    ipAddr->addr[2] = c;
-    ipAddr->addr[3] = d;
-    ipAddr->addr[4] = (uint8_t)port;
-    ipAddr->addr[5] = (uint8_t)(port >> 8);
+    *endpoint = ep;
 
     return OC_STACK_OK;
 }
 
+static void OCDestroyEndpoint(CAEndpoint_t *endpoint)
+{
+    free(endpoint);
+}
+
+void FixUpClientResponse(OCClientResponse *cr)
+{
+    VERIFY_NON_NULL_NR(cr, FATAL);
+
+    cr->addr = &cr->devAddr;
+    cr->connType = (OCConnectivityType)
+        ((cr->devAddr.adapter << CT_ADAPTER_SHIFT) | (cr->devAddr.flags & CT_MASK_FLAGS));
+}
+
 //-----------------------------------------------------------------------------
 // Internal API function
 //-----------------------------------------------------------------------------
@@ -490,20 +467,26 @@ OCStackResult OCStackFeedBack(CAToken_t token, uint8_t tokenLength, uint8_t stat
     switch(status)
     {
     case OC_OBSERVER_NOT_INTERESTED:
-        OC_LOG(DEBUG, TAG, PCF("observer is not interested in our notifications anymore"));
+        OC_LOG(DEBUG, TAG, PCF("observer not interested in our notifications"));
         observer = GetObserverUsingToken (token, tokenLength);
         if(observer)
         {
-            result = FormOCEntityHandlerRequest(&ehRequest, (OCRequestHandle) NULL,
-                    OC_REST_NOMETHOD, (OCResourceHandle) NULL, NULL, NULL, 0,
-                    NULL, OC_OBSERVE_DEREGISTER, observer->observeId);
+            result = FormOCEntityHandlerRequest(&ehRequest,
+                                                (OCRequestHandle)NULL,
+                                                OC_REST_NOMETHOD,
+                                                &observer->devAddr,
+                                                (OCResourceHandle)NULL,
+                                                NULL, NULL, 0, 0, NULL,
+                                                OC_OBSERVE_DEREGISTER,
+                                                observer->observeId);
             if(result != OC_STACK_OK)
             {
                 return result;
             }
-            observer->resource->entityHandler(OC_OBSERVE_FLAG, &ehRequest);
+            observer->resource->entityHandler(OC_OBSERVE_FLAG, &ehRequest,
+                            observer->resource->entityHandlerCallbackParam);
         }
-        //observer is not observing anymore
+
         result = DeleteObserverUsingToken (token, tokenLength);
         if(result == OC_STACK_OK)
         {
@@ -515,10 +498,9 @@ OCStackResult OCStackFeedBack(CAToken_t token, uint8_t tokenLength, uint8_t stat
             OC_LOG(DEBUG, TAG, PCF("Observer Removal failed"));
         }
         break;
+
     case OC_OBSERVER_STILL_INTERESTED:
-        //observer is still interested
-        OC_LOG(DEBUG, TAG, PCF("observer is interested in our \
-                notifications, reset the failedCount"));
+        OC_LOG(DEBUG, TAG, PCF("observer still interested, reset the failedCount"));
         observer = GetObserverUsingToken (token, tokenLength);
         if(observer)
         {
@@ -531,23 +513,29 @@ OCStackResult OCStackFeedBack(CAToken_t token, uint8_t tokenLength, uint8_t stat
             result = OC_STACK_OBSERVER_NOT_FOUND;
         }
         break;
+
     case OC_OBSERVER_FAILED_COMM:
-        //observer is not reachable
         OC_LOG(DEBUG, TAG, PCF("observer is unreachable"));
         observer = GetObserverUsingToken (token, tokenLength);
         if(observer)
         {
             if(observer->failedCommCount >= MAX_OBSERVER_FAILED_COMM)
             {
-                result = FormOCEntityHandlerRequest(&ehRequest, (OCRequestHandle) NULL,
-                        OC_REST_NOMETHOD, (OCResourceHandle) NULL, NULL, NULL, 0,
-                        NULL, OC_OBSERVE_DEREGISTER, observer->observeId);
+                result = FormOCEntityHandlerRequest(&ehRequest,
+                                                    (OCRequestHandle)NULL,
+                                                    OC_REST_NOMETHOD,
+                                                    &observer->devAddr,
+                                                    (OCResourceHandle)NULL,
+                                                    NULL, NULL, 0, 0, NULL,
+                                                    OC_OBSERVE_DEREGISTER,
+                                                    observer->observeId);
                 if(result != OC_STACK_OK)
                 {
                     return OC_STACK_ERROR;
                 }
-                observer->resource->entityHandler(OC_OBSERVE_FLAG, &ehRequest);
-                //observer is unreachable
+                observer->resource->entityHandler(OC_OBSERVE_FLAG, &ehRequest,
+                                    observer->resource->entityHandlerCallbackParam);
+
                 result = DeleteObserverUsingToken (token, tokenLength);
                 if(result == OC_STACK_OK)
                 {
@@ -593,6 +581,9 @@ OCStackResult CAToOCStackResult(CAResponseResult_t caCode)
         case CA_BAD_REQ:
             ret = OC_STACK_INVALID_QUERY;
             break;
+        case CA_UNAUTHORIZED_REQ:
+            ret = OC_STACK_UNAUTHORIZED_REQ;
+            break;
         case CA_BAD_OPT:
             ret = OC_STACK_INVALID_OPTION;
             break;
@@ -635,100 +626,34 @@ CAResponseResult_t OCToCAStackResult(OCStackResult ocCode)
         case OC_STACK_COMM_ERROR:
             ret = CA_RETRANSMIT_TIMEOUT;
             break;
+        case OC_STACK_UNAUTHORIZED_REQ:
+            ret = CA_UNAUTHORIZED_REQ;
+            break;
         default:
             break;
     }
     return ret;
 }
 
-OCStackResult OCToCATransportType(OCConnectivityType ocConType, CATransportType_t* caConType)
+CATransportFlags_t OCToCATransportFlags(OCTransportFlags ocFlags)
 {
-    OCStackResult ret = OC_STACK_OK;
+    CATransportFlags_t caFlags = (CATransportFlags_t)ocFlags;
 
-    switch(ocConType)
+    // supply default behavior.
+    if ((caFlags & (CA_IPV6|CA_IPV4)) == 0)
     {
-        case OC_IPV4:
-            *caConType = CA_IPV4;
-            break;
-        case OC_IPV6:
-            *caConType = CA_IPV6;
-            break;
-        case OC_EDR:
-            *caConType = CA_EDR;
-            break;
-        case OC_LE:
-            *caConType = CA_LE;
-            break;
-        case OC_ALL:
-            // Currently OC_ALL represents IPv4
-            // Add other connectivity types as they are enabled in future
-            *caConType = (CATransportType_t) (CA_IPV4);
-            break;
-        default:
-            ret = OC_STACK_INVALID_PARAM;
-            break;
+        caFlags = (CATransportFlags_t)(caFlags|CA_IPV6|CA_IPV4);
     }
-    return ret;
-}
-
-OCStackResult CAToOCConnectivityType(CATransportType_t caConType, OCConnectivityType *ocConType)
-{
-    OCStackResult ret = OC_STACK_OK;
-
-    switch(caConType)
+    if ((caFlags & OC_MASK_SCOPE) == 0)
     {
-        case CA_IPV4:
-            *ocConType = OC_IPV4;
-            break;
-        case CA_IPV6:
-            *ocConType = OC_IPV6;
-            break;
-        case CA_EDR:
-            *ocConType = OC_EDR;
-            break;
-        case CA_LE:
-            *ocConType = OC_LE;
-            break;
-        default:
-            ret = OC_STACK_INVALID_PARAM;
-            break;
+        caFlags = (CATransportFlags_t)(caFlags|OC_SCOPE_LINK);
     }
-    return ret;
+    return caFlags;
 }
 
-OCStackResult UpdateResponseAddr(OCDevAddr *address, const CARemoteEndpoint_t* endPoint)
+OCTransportFlags CAToOCTransportFlags(CATransportFlags_t caFlags)
 {
-    OCStackResult ret = OC_STACK_ERROR;
-    char * tok = NULL;
-    char * savePtr = NULL;
-    char * cpAddress = (char *) OCMalloc(strlen(endPoint->addressInfo.IP.ipAddress) + 1);
-    if(!cpAddress)
-    {
-        ret = OC_STACK_NO_MEMORY;
-        goto exit;
-    }
-    memcpy(cpAddress, endPoint->addressInfo.IP.ipAddress,
-            strlen(endPoint->addressInfo.IP.ipAddress) + 1);
-
-    // Grabs the first three numbers from the IPv4 address and replaces dots
-    for(int i=0; i<4; i++)
-    {
-        tok = strtok_r(i==0 ? cpAddress : NULL, ".", &savePtr);
-
-        if(!tok)
-        {
-            ret = OC_STACK_ERROR;
-            goto exit;
-        }
-        address->addr[i] = atoi(tok);
-    }
-
-    memcpy(&address->addr[4], &endPoint->addressInfo.IP.port, sizeof(uint16_t));
-    ret = OC_STACK_OK;
-
-exit:
-    OCFree(cpAddress);
-    return ret;
+    return (OCTransportFlags)caFlags;
 }
 
 static OCStackResult ResetPresenceTTL(ClientCB *cbNode, uint32_t maxAgeSeconds)
@@ -785,74 +710,103 @@ static OCStackResult ResetPresenceTTL(ClientCB *cbNode, uint32_t maxAgeSeconds)
     return OC_STACK_OK;
 }
 
-void parsePresencePayload(char* payload, uint32_t* seqNum, uint32_t* maxAge, char** resType)
+const char *convertTriggerEnumToString(OCPresenceTrigger trigger)
 {
-    char * tok = NULL;
-    char * savePtr = NULL;
-    // The format of the payload is {"oc":[%u:%u:%s]}
-    // %u : sequence number,
-    // %u : max age
-    // %s : Resource Type (Optional)
-
-    if (!payload || !seqNum || !maxAge || !resType)
+    if (trigger == OC_PRESENCE_TRIGGER_CREATE)
     {
-        return;
+        return OC_RSRVD_TRIGGER_CREATE;
     }
-    tok = strtok_r(payload, "[:]}", &savePtr);
-    payload[strlen(payload)] = ':';
-
-    //Retrieve sequence number
-    tok = strtok_r(NULL, "[:]}", &savePtr);
-    if(tok == NULL)
+    else if (trigger == OC_PRESENCE_TRIGGER_CHANGE)
     {
-        return;
+        return OC_RSRVD_TRIGGER_CHANGE;
     }
-    payload[strlen((char *)payload)] = ':';
-    *seqNum = (uint32_t) atoi(tok);
-
-    //Retrieve MaxAge
-    tok = strtok_r(NULL, "[:]}", &savePtr);
-    if(tok == NULL)
+    else
     {
-        return;
+        return OC_RSRVD_TRIGGER_DELETE;
     }
-    *maxAge = (uint32_t) atoi(tok);
+}
 
-    //Retrieve ResourceType
-    tok = strtok_r(NULL, "[:]}",&savePtr);
-    if(tok == NULL)
+OCPresenceTrigger convertTriggerStringToEnum(const char * triggerStr)
+{
+    if(strcmp(triggerStr, OC_RSRVD_TRIGGER_CREATE) == 0)
     {
-        return;
+        return OC_PRESENCE_TRIGGER_CREATE;
     }
+    else if(strcmp(triggerStr, OC_RSRVD_TRIGGER_CHANGE) == 0)
+    {
+        return OC_PRESENCE_TRIGGER_CHANGE;
+    }
+    else
+    {
+        return OC_PRESENCE_TRIGGER_DELETE;
+    }
+}
+
+/**
+ * The cononical presence allows constructed URIs to be string compared.
+ *
+ * requestUri must be a char array of size CA_MAX_URI_LENGTH
+ */
+static int FormCanonicalPresenceUri(const CAEndpoint_t *endpoint, char *resourceUri,
+        char *presenceUri)
+{
+    VERIFY_NON_NULL(endpoint   , FATAL, OC_STACK_INVALID_PARAM);
+    VERIFY_NON_NULL(resourceUri, FATAL, OC_STACK_INVALID_PARAM);
+    VERIFY_NON_NULL(presenceUri, FATAL, OC_STACK_INVALID_PARAM);
+
+    const char *format;
+    CAEndpoint_t *ep = (CAEndpoint_t *)endpoint;
 
-    *resType = (char *)OCMalloc(strlen(tok) + 1);
-    if(!*resType)
+    if (ep->adapter == CA_ADAPTER_IP)
     {
-        return;
+        if ((ep->flags & CA_IPV6) && !(ep->flags & CA_IPV4))
+        {
+            if ('\0' == ep->addr[0])  // multicast
+            {
+                return snprintf(presenceUri, CA_MAX_URI_LENGTH, OC_RSRVD_PRESENCE_URI);
+            }
+            else
+            {
+                format = "coap://[%s]:%u%s";
+            }
+        }
+        else
+        {
+            if ('\0' == ep->addr[0])  // multicast
+            {
+                OICStrcpy(ep->addr, sizeof(ep->addr), OC_MULTICAST_IP);
+                ep->port = OC_MULTICAST_PORT;
+            }
+            format = "coap://%s:%u%s";
+        }
+        return snprintf(presenceUri, CA_MAX_URI_LENGTH, format, ep->addr,
+                        ep->port, OC_RSRVD_PRESENCE_URI);
     }
-    payload[strlen((char *)payload)] = ':';
-    strcpy(*resType, tok);
-    OC_LOG_V(DEBUG, TAG, "resourceTypeName %s", *resType);
 
-    payload[strlen((char *)payload)] = ']';
+    // might work for other adapters (untested, but better than nothing)
+    format = "coap://%s%s";
+    return snprintf(presenceUri, CA_MAX_URI_LENGTH, format, ep->addr,
+                    OC_RSRVD_PRESENCE_URI);
 }
 
-static OCStackResult HandlePresenceResponse(const CARemoteEndpoint_t* endPoint,
-                            const CAResponseInfo_t* responseInfo)
+
+OCStackResult HandlePresenceResponse(const CAEndpoint_t *endpoint,
+                            const CAResponseInfo_t *responseInfo)
 {
+    VERIFY_NON_NULL(endpoint, FATAL, OC_STACK_INVALID_PARAM);
+    VERIFY_NON_NULL(responseInfo, FATAL, OC_STACK_INVALID_PARAM);
+
     OCStackApplicationResult cbResult = OC_STACK_DELETE_TRANSACTION;
     ClientCB * cbNode = NULL;
     char *resourceTypeName = NULL;
-    OCClientResponse response = {};
-    OCDevAddr address = {};
+    OCClientResponse response;
     OCStackResult result = OC_STACK_ERROR;
     uint32_t maxAge = 0;
+    int uriLen;
+    char presenceUri[CA_MAX_URI_LENGTH];
 
-    char *fullUri = NULL;
-    char *ipAddress = NULL;
     int presenceSubscribe = 0;
     int multicastPresenceSubscribe = 0;
-    size_t addressLen = 0;
 
     if (responseInfo->result != CA_SUCCESS)
     {
@@ -860,111 +814,77 @@ static OCStackResult HandlePresenceResponse(const CARemoteEndpoint_t* endPoint,
         return OC_STACK_ERROR;
     }
 
-    fullUri = (char *) OCMalloc(MAX_URI_LENGTH);
-
-    if(!fullUri)
-    {
-        OC_LOG(ERROR, TAG, PCF("Memory could not be allocated for fullUri"));
-        result = OC_STACK_NO_MEMORY;
-        goto exit;
-    }
-
-    addressLen = strlen(endPoint->addressInfo.IP.ipAddress);
-    ipAddress = (char *) OCMalloc(addressLen + 1);
-
-    if(!ipAddress)
+    // check for unicast presence
+    uriLen = FormCanonicalPresenceUri(endpoint, OC_RSRVD_PRESENCE_URI, presenceUri);
+    if (uriLen < 0 || uriLen >= sizeof (presenceUri))
     {
-        OC_LOG(ERROR, TAG, PCF("Memory could not be allocated for ipAddress"));
-        result = OC_STACK_NO_MEMORY;
-        goto exit;
+        return OC_STACK_INVALID_URI;
     }
 
-    strncpy(ipAddress, endPoint->addressInfo.IP.ipAddress, addressLen);
-    ipAddress[addressLen] = '\0';
-
-    snprintf(fullUri, MAX_URI_LENGTH, "coap://%s:%u%s", ipAddress, endPoint->addressInfo.IP.port,
-                OC_PRESENCE_URI);
-
-    cbNode = GetClientCB(NULL, 0, NULL, fullUri);
-
-    if(cbNode)
+    cbNode = GetClientCB(NULL, 0, NULL, presenceUri);
+    if (cbNode)
     {
         presenceSubscribe = 1;
     }
     else
     {
-        snprintf(fullUri, MAX_URI_LENGTH, "coap://%s:%u%s", OC_MULTICAST_IP, OC_MULTICAST_PORT,
-                                                endPoint->resourceUri);
-        cbNode = GetClientCB(NULL, 0, NULL, fullUri);
-        if(cbNode)
+        // check for multiicast presence
+        CAEndpoint_t ep = { endpoint->adapter, endpoint->flags };
+        OICStrcpy(ep.addr, sizeof(ep.addr), OC_MULTICAST_IP);
+        ep.port = OC_MULTICAST_PORT;
+
+        uriLen = FormCanonicalPresenceUri(&ep, OC_RSRVD_PRESENCE_URI, presenceUri);
+
+        cbNode = GetClientCB(NULL, 0, NULL, presenceUri);
+        if (cbNode)
         {
             multicastPresenceSubscribe = 1;
         }
     }
 
-    if(!presenceSubscribe && !multicastPresenceSubscribe)
+    if (!presenceSubscribe && !multicastPresenceSubscribe)
     {
         OC_LOG(ERROR, TAG, PCF("Received a presence notification, but no callback, ignoring"));
         goto exit;
     }
 
-    // No payload to the application in case of presence
-    response.resJSONPayload = NULL;
+    response.payload = NULL;
     response.result = OC_STACK_OK;
 
-    result = UpdateResponseAddr(&address, endPoint);
-    if(result != OC_STACK_OK)
-    {
-        goto exit;
-    }
-
-    response.addr = &address;
+    CopyEndpointToDevAddr(endpoint, &response.devAddr);
+    FixUpClientResponse(&response);
 
-    result = CAToOCConnectivityType(endPoint->transportType, &(response.connType));
-    if(result != OC_STACK_OK)
+    if (responseInfo->info.payload)
     {
-        OC_LOG(ERROR, TAG, PCF("Invalid connectivity type in endpoint"));
-        goto exit;
-    }
+        result = OCParsePayload(&response.payload,  responseInfo->info.payload,
+                responseInfo->info.payloadSize);
 
-    if(responseInfo->info.payload)
-    {
-        parsePresencePayload(responseInfo->info.payload,
-                                &(response.sequenceNumber),
-                                &maxAge,
-                                &resourceTypeName);
+        if(result != OC_STACK_OK || response.payload->type != PAYLOAD_TYPE_PRESENCE)
+        {
+            OC_LOG(ERROR, TAG, PCF("Presence parse failed"));
+            goto exit;
+        }
+        response.sequenceNumber = ((OCPresencePayload*)response.payload)->sequenceNumber;
+        resourceTypeName = ((OCPresencePayload*)response.payload)->resourceType;
+        maxAge = ((OCPresencePayload*)response.payload)->maxAge;
     }
 
-    if(presenceSubscribe)
+    if (presenceSubscribe)
     {
         if(cbNode->sequenceNumber == response.sequenceNumber)
         {
-            if (cbNode->presence)
-            {
-                OC_LOG(INFO, TAG, PCF("No presence change. Updating TTL."));
-
-                result = ResetPresenceTTL(cbNode, maxAge);
-
-                if (result != OC_STACK_OK)
-                {
-                    OC_LOG_V(ERROR, TAG, "ResetPresenceTTL failed with error: %u", result);
-                }
-            }
-            else
-            {
-                OC_LOG(INFO, TAG, PCF("Not subscribed to presence."));
-            }
-
+            OC_LOG(INFO, TAG, PCF("No presence change"));
             goto exit;
         }
+
         if(maxAge == 0)
         {
             OC_LOG(INFO, TAG, PCF("Stopping presence"));
             response.result = OC_STACK_PRESENCE_STOPPED;
             if(cbNode->presence)
             {
-                OCFree(cbNode->presence->timeOut);
-                OCFree(cbNode->presence);
+                OICFree(cbNode->presence->timeOut);
+                OICFree(cbNode->presence);
                 cbNode->presence = NULL;
             }
         }
@@ -972,7 +892,8 @@ static OCStackResult HandlePresenceResponse(const CARemoteEndpoint_t* endPoint,
         {
             if(!cbNode->presence)
             {
-                cbNode->presence = (OCPresence *) OCMalloc(sizeof(OCPresence));
+                cbNode->presence = (OCPresence *)OICMalloc(sizeof (OCPresence));
+
                 if(!(cbNode->presence))
                 {
                     OC_LOG(ERROR, TAG, PCF("Could not allocate memory for cbNode->presence"));
@@ -983,11 +904,11 @@ static OCStackResult HandlePresenceResponse(const CARemoteEndpoint_t* endPoint,
                 VERIFY_NON_NULL_V(cbNode->presence);
                 cbNode->presence->timeOut = NULL;
                 cbNode->presence->timeOut = (uint32_t *)
-                        OCMalloc(PresenceTimeOutSize * sizeof(uint32_t));
+                        OICMalloc(PresenceTimeOutSize * sizeof(uint32_t));
                 if(!(cbNode->presence->timeOut)){
                     OC_LOG(ERROR, TAG,
                                   PCF("Could not allocate memory for cbNode->presence->timeOut"));
-                    OCFree(cbNode->presence);
+                    OICFree(cbNode->presence);
                     result = OC_STACK_NO_MEMORY;
                     goto exit;
                 }
@@ -995,11 +916,10 @@ static OCStackResult HandlePresenceResponse(const CARemoteEndpoint_t* endPoint,
 
             ResetPresenceTTL(cbNode, maxAge);
 
-            OC_LOG(INFO, TAG, PCF("Presence changed, calling up the stack"));
             cbNode->sequenceNumber = response.sequenceNumber;
 
             // Ensure that a filter is actually applied.
-            if(resourceTypeName && cbNode->filterResourceType)
+            if( resourceTypeName && cbNode->filterResourceType)
             {
                 if(!findResourceType(cbNode->filterResourceType, resourceTypeName))
                 {
@@ -1011,9 +931,8 @@ static OCStackResult HandlePresenceResponse(const CARemoteEndpoint_t* endPoint,
     else
     {
         // This is the multicast case
-
         OCMulticastNode* mcNode = NULL;
-        mcNode = GetMCPresenceNode(fullUri);
+        mcNode = GetMCPresenceNode(presenceUri);
 
         if(mcNode != NULL)
         {
@@ -1032,27 +951,24 @@ static OCStackResult HandlePresenceResponse(const CARemoteEndpoint_t* endPoint,
         }
         else
         {
-            uint32_t uriLen = strlen(fullUri);
-            char* uri = (char *) OCMalloc(uriLen + 1);
-            if(uri)
+            char* uri = OICStrdup(presenceUri);
+            if (!uri)
             {
-                memcpy(uri, fullUri, (uriLen + 1));
-            }
-            else
-            {
-                OC_LOG(ERROR, TAG,
+                OC_LOG(INFO, TAG,
                     PCF("No Memory for URI to store in the presence node"));
                 result = OC_STACK_NO_MEMORY;
                 goto exit;
             }
+
             result = AddMCPresenceNode(&mcNode, uri, response.sequenceNumber);
-            if(result != OC_STACK_OK)
+            if(result == OC_STACK_NO_MEMORY)
             {
-                OC_LOG(ERROR, TAG,
-                    PCF("Unable to add Multicast Presence Node"));
-                OCFree(uri);
+                OC_LOG(INFO, TAG,
+                    PCF("No Memory for Multicast Presence Node"));
+                OICFree(uri);
                 goto exit;
             }
+            // presence node now owns uri
         }
 
         // Ensure that a filter is actually applied.
@@ -1073,29 +989,19 @@ static OCStackResult HandlePresenceResponse(const CARemoteEndpoint_t* endPoint,
     }
 
 exit:
-OCFree(fullUri);
-OCFree(ipAddress);
-OCFree(resourceTypeName);
-return result;
+    OICFree(resourceTypeName);
+    return result;
 }
 
-void HandleCAResponses(const CARemoteEndpoint_t* endPoint, const CAResponseInfo_t* responseInfo)
+void HandleCAResponses(const CAEndpoint_t* endPoint, const CAResponseInfo_t* responseInfo)
 {
-    OC_LOG(INFO, TAG, PCF("Enter HandleCAResponses"));
-
-    if(NULL == endPoint)
-    {
-        OC_LOG(ERROR, TAG, PCF("endPoint is NULL"));
-        return;
-    }
+    VERIFY_NON_NULL_NR(endPoint, FATAL);
+    VERIFY_NON_NULL_NR(responseInfo, FATAL);
 
-    if(NULL == responseInfo)
-    {
-        OC_LOG(ERROR, TAG, PCF("responseInfo is NULL"));
-        return;
-    }
+    OC_LOG(INFO, TAG, PCF("Enter HandleCAResponses"));
 
-    if(strcmp(endPoint->resourceUri, OC_PRESENCE_URI) == 0)
+    if(responseInfo->info.resourceUri &&
+        strcmp(responseInfo->info.resourceUri, OC_RSRVD_PRESENCE_URI) == 0)
     {
         HandlePresenceResponse(endPoint, responseInfo);
         return;
@@ -1103,7 +1009,7 @@ void HandleCAResponses(const CARemoteEndpoint_t* endPoint, const CAResponseInfo_
 
     ClientCB *cbNode = GetClientCB(responseInfo->info.token,
             responseInfo->info.tokenLength, NULL, NULL);
-    OC_LOG_V(DEBUG, TAG, "Response has the token %s", responseInfo->info.token);
+
     ResourceObserver * observer = GetObserverUsingToken (responseInfo->info.token,
             responseInfo->info.tokenLength);
 
@@ -1126,22 +1032,11 @@ void HandleCAResponses(const CARemoteEndpoint_t* endPoint, const CAResponseInfo_
         {
             OC_LOG(INFO, TAG, PCF("Receiving A Timeout for this token"));
             OC_LOG(INFO, TAG, PCF("Calling into application address space"));
-            OCClientResponse response = {};
-            OCDevAddr address = {};
-            OCStackResult result = UpdateResponseAddr(&address, endPoint);
-            if(result != OC_STACK_OK)
-            {
-                OC_LOG(ERROR, TAG, PCF("Error parsing IP address in UpdateResponseAddr"));
-                return;
-            }
 
-            result = UpdateResponseAddr(&address, endPoint);
-            if(result != OC_STACK_OK)
-            {
-                OC_LOG(ERROR, TAG, PCF("Invalid connectivity type in endpoint"));
-                return;
-            }
-            response.addr = &address;
+            OCClientResponse response = {};
+            CopyEndpointToDevAddr(endPoint, &response.devAddr);
+            FixUpClientResponse(&response);
+            response.resourceUri = responseInfo->info.resourceUri;
 
             response.result = CAToOCStackResult(responseInfo->result);
             cbNode->callBack(cbNode->context,
@@ -1152,29 +1047,23 @@ void HandleCAResponses(const CARemoteEndpoint_t* endPoint, const CAResponseInfo_
         {
             OC_LOG(INFO, TAG, PCF("This is a regular response, A client call back is found"));
             OC_LOG(INFO, TAG, PCF("Calling into application address space"));
+
             OCClientResponse response = {};
-            OCDevAddr address = {};
+            response.sequenceNumber = OC_OBSERVE_NO_OPTION;
+            CopyEndpointToDevAddr(endPoint, &response.devAddr);
+            FixUpClientResponse(&response);
+            response.resourceUri = responseInfo->info.resourceUri;
 
-            OCStackResult result = UpdateResponseAddr(&address, endPoint);
-            if(result != OC_STACK_OK)
-            {
-                OC_LOG(ERROR, TAG, PCF("Error parsing IP address in UpdateResponseAddr"));
-                return;
-            }
-            response.addr = &address;
-            // Populate the connectivity type. If this is a discovery response,
-            // the resource that will be constructed from this response will make
-            // further API calls from this interface.
-            result = CAToOCConnectivityType(endPoint->transportType,
-                                    &(response.connType));
-            if(result != OC_STACK_OK)
+            response.result = CAToOCStackResult(responseInfo->result);
+            if(responseInfo->info.payload &&
+               responseInfo->info.payloadSize &&
+               OC_STACK_OK != OCParsePayload(&response.payload, responseInfo->info.payload,
+                                           responseInfo->info.payloadSize))
             {
-                OC_LOG(ERROR, TAG, PCF("Invalid connectivity type in endpoint"));
+                OC_LOG(ERROR, TAG, PCF("Error converting payload"));
                 return;
             }
 
-            response.result = CAToOCStackResult(responseInfo->result);
-            response.resJSONPayload = (const char*)responseInfo->info.payload;
             response.numRcvdVendorSpecificHeaderOptions = 0;
             if(responseInfo->info.numOptions > 0)
             {
@@ -1229,6 +1118,7 @@ void HandleCAResponses(const CARemoteEndpoint_t* endPoint, const CAResponseInfo_
                     cbNode->TTL = GetTicks(MAX_CB_TIMEOUT_SECONDS *
                                             MILLISECONDS_PER_SECOND);
                 }
+                OCPayloadDestroy(response.payload);
             }
 
             //Need to send ACK when the response is CON
@@ -1280,8 +1170,7 @@ void HandleCAResponses(const CARemoteEndpoint_t* endPoint, const CAResponseInfo_
             }
             else
             {
-                OC_LOG(INFO, TAG, PCF("Received a response or notification,\
-                        but I do not have callback. Sending RESET"));
+                OC_LOG(INFO, TAG, PCF("Received a message without callbacks. Sending RESET"));
                 SendDirectStackResponse(endPoint, responseInfo->info.messageId, CA_EMPTY,
                         CA_MSG_RESET, 0, NULL, NULL, 0);
             }
@@ -1304,16 +1193,37 @@ void HandleCAResponses(const CARemoteEndpoint_t* endPoint, const CAResponseInfo_
         return;
     }
 
-    OC_LOG_V(INFO, TAG, PCF("Received payload: %s\n"), (char*)responseInfo->info.payload);
     OC_LOG(INFO, TAG, PCF("Exit HandleCAResponses"));
 }
 
 /*
+ * This function handles error response from CA
+ * code shall be added to handle the errors
+ */
+void HandleCAErrorResponse(const CAEndpoint_t *endPoint, const CAErrorInfo_t *errrorInfo)
+{
+    OC_LOG(INFO, TAG, PCF("Enter HandleCAErrorResponse"));
+
+    if(NULL == endPoint)
+    {
+        OC_LOG(ERROR, TAG, PCF("endPoint is NULL"));
+        return;
+    }
+
+    if(NULL == errrorInfo)
+    {
+        OC_LOG(ERROR, TAG, PCF("errrorInfo is NULL"));
+        return;
+    }
+    OC_LOG(INFO, TAG, PCF("Exit HandleCAErrorResponse"));
+}
+
+/*
  * This function sends out Direct Stack Responses. These are responses that are not coming
  * from the application entity handler. These responses have no payload and are usually ACKs,
  * RESETs or some error conditions that were caught by the stack.
  */
-OCStackResult SendDirectStackResponse(const CARemoteEndpoint_t* endPoint, const uint16_t coapID,
+OCStackResult SendDirectStackResponse(const CAEndpoint_t* endPoint, const uint16_t coapID,
         const CAResponseResult_t responseResult, const CAMessageType_t type,
         const uint8_t numOptions, const CAHeaderOption_t *options,
         CAToken_t token, uint8_t tokenLength)
@@ -1338,7 +1248,7 @@ OCStackResult SendDirectStackResponse(const CARemoteEndpoint_t* endPoint, const
 }
 
 //This function will be called back by CA layer when a request is received
-void HandleCARequests(const CARemoteEndpoint_t* endPoint, const CARequestInfo_t* requestInfo)
+void HandleCARequests(const CAEndpoint_t* endPoint, const CARequestInfo_t* requestInfo)
 {
     OC_LOG(INFO, TAG, PCF("Enter HandleCARequests"));
     if(!endPoint)
@@ -1363,106 +1273,91 @@ void HandleCARequests(const CARemoteEndpoint_t* endPoint, const CARequestInfo_t*
 
     OCServerProtocolRequest serverRequest = {};
 
-    OC_LOG_V(INFO, TAG, PCF("Endpoint URI : %s\n"), (char*)endPoint->resourceUri);
+    OC_LOG_V(INFO, TAG, PCF("Endpoint URI : %s"), requestInfo->info.resourceUri);
 
-    char * newUri = NULL;
+    char * uriWithoutQuery = NULL;
     char * query  = NULL;
 
-    requestResult = getQueryFromUri(endPoint->resourceUri, &query, &newUri);
+    requestResult = getQueryFromUri(requestInfo->info.resourceUri, &query, &uriWithoutQuery);
 
     if (requestResult != OC_STACK_OK)
     {
         OC_LOG_V(ERROR, TAG, "getQueryFromUri() failed with OC error code %d\n", requestResult);
         return;
     }
-    OC_LOG_V(INFO, TAG, PCF("URI without query: %s\n"), newUri);
-    OC_LOG_V(INFO, TAG, PCF("Query : %s\n"), query);
+    OC_LOG_V(INFO, TAG, PCF("URI without query: %s"), uriWithoutQuery);
+    OC_LOG_V(INFO, TAG, PCF("Query : %s"), query);
 
-    if(strlen(newUri) < MAX_URI_LENGTH)
+    if(strlen(uriWithoutQuery) < MAX_URI_LENGTH)
     {
-        //copy URI
-        memcpy (&(serverRequest.resourceUrl), newUri, strlen(newUri));
-        OCFree(newUri);
+        OICStrcpy(serverRequest.resourceUrl, sizeof(serverRequest.resourceUrl), uriWithoutQuery);
+        OICFree(uriWithoutQuery);
     }
     else
     {
         OC_LOG(ERROR, TAG, PCF("URI length exceeds MAX_URI_LENGTH."));
-        OCFree(newUri);
-        OCFree(query);
+        OICFree(uriWithoutQuery);
+        OICFree(query);
         return;
     }
-    //copy query
+
     if(query)
     {
         if(strlen(query) < MAX_QUERY_LENGTH)
         {
-            memcpy (&(serverRequest.query), query, strlen(query));
-            OCFree(query);
+            OICStrcpy(serverRequest.query, sizeof(serverRequest.query), query);
+            OICFree(query);
         }
         else
         {
             OC_LOG(ERROR, TAG, PCF("Query length exceeds MAX_QUERY_LENGTH."));
-            OCFree(query);
+            OICFree(query);
             return;
         }
     }
-    //copy request payload
+
     if (requestInfo->info.payload)
     {
-        size_t payloadLen = strlen(requestInfo->info.payload);
-        serverRequest.reqTotalSize = payloadLen + 1;
-        memcpy (&(serverRequest.reqJSONPayload), requestInfo->info.payload,
-                payloadLen);
+        serverRequest.reqTotalSize = requestInfo->info.payloadSize;
+        memcpy (&(serverRequest.payload), requestInfo->info.payload,
+                requestInfo->info.payloadSize);
     }
     else
     {
-        serverRequest.reqTotalSize = 1;
-        serverRequest.reqJSONPayload[0] = '\0';
+        serverRequest.reqTotalSize = 0;
     }
 
     switch (requestInfo->method)
     {
         case CA_GET:
-            {
-                serverRequest.method = OC_REST_GET;
-                break;
-            }
+            serverRequest.method = OC_REST_GET;
+            break;
         case CA_PUT:
-            {
-                serverRequest.method = OC_REST_PUT;
-                break;
-            }
+            serverRequest.method = OC_REST_PUT;
+            break;
         case CA_POST:
-            {
-                serverRequest.method = OC_REST_POST;
-                break;
-            }
+            serverRequest.method = OC_REST_POST;
+            break;
         case CA_DELETE:
-            {
-                serverRequest.method = OC_REST_DELETE;
-                break;
-            }
+            serverRequest.method = OC_REST_DELETE;
+            break;
         default:
-            {
-                OC_LOG(ERROR, TAG, PCF("Received CA method %d not supported"));
-                SendDirectStackResponse(endPoint, requestInfo->info.messageId, CA_BAD_REQ,
+            OC_LOG_V(ERROR, TAG, "Received CA method %d not supported", requestInfo->method);
+            SendDirectStackResponse(endPoint, requestInfo->info.messageId, CA_BAD_REQ,
                         requestInfo->info.type, requestInfo->info.numOptions,
                         requestInfo->info.options, requestInfo->info.token,
                         requestInfo->info.tokenLength);
-                return;
-            }
+            return;
     }
 
-    OC_LOG_V(INFO, TAG, "HandleCARequests: CA token length = %d",
-            requestInfo->info.tokenLength);
     OC_LOG_BUFFER(INFO, TAG, (const uint8_t *)requestInfo->info.token,
             requestInfo->info.tokenLength);
-    serverRequest.requestToken = (CAToken_t)OCMalloc(requestInfo->info.tokenLength);
+    serverRequest.requestToken = (CAToken_t)OICMalloc(requestInfo->info.tokenLength);
     serverRequest.tokenLength = requestInfo->info.tokenLength;
-    // Module Name
+
     if (!serverRequest.requestToken)
     {
-        OC_LOG(FATAL, TAG, "Server Request Token is NULL");
+        OC_LOG(FATAL, TAG, "Allocation for token failed.");
         SendDirectStackResponse(endPoint, requestInfo->info.messageId, CA_INTERNAL_SERVER_ERROR,
                 requestInfo->info.type, requestInfo->info.numOptions,
                 requestInfo->info.options, requestInfo->info.token,
@@ -1479,16 +1374,13 @@ void HandleCARequests(const CARemoteEndpoint_t* endPoint, const CARequestInfo_t*
     {
         serverRequest.qos = OC_LOW_QOS;
     }
-    // CA does not need the following 2 fields
+    // CA does not need the following field
     // Are we sure CA does not need them? how is it responding to multicast
     serverRequest.delayedResNeeded = 0;
-    serverRequest.secured = endPoint->isSecured;
 
     serverRequest.coapID = requestInfo->info.messageId;
 
-    // copy the address
-    serverRequest.addressInfo      = endPoint->addressInfo;
-    serverRequest.connectivityType = endPoint->transportType;
+    CopyEndpointToDevAddr(endPoint, &serverRequest.devAddr);
 
     // copy vendor specific header options
     uint8_t tempNum = (requestInfo->info.numOptions);
@@ -1501,7 +1393,7 @@ void HandleCARequests(const CARemoteEndpoint_t* endPoint, const CARequestInfo_t*
                 requestInfo->info.type, requestInfo->info.numOptions,
                 requestInfo->info.options, requestInfo->info.token,
                 requestInfo->info.tokenLength);
-        OCFree(serverRequest.requestToken);
+        OICFree(serverRequest.requestToken);
         return;
     }
     serverRequest.numRcvdVendorSpecificHeaderOptions = tempNum;
@@ -1532,7 +1424,7 @@ void HandleCARequests(const CARemoteEndpoint_t* endPoint, const CARequestInfo_t*
     }
     // requestToken is fed to HandleStackRequests, which then goes to AddServerRequest.
     // The token is copied in there, and is thus still owned by this function.
-    OCFree(serverRequest.requestToken);
+    OICFree(serverRequest.requestToken);
     OC_LOG(INFO, TAG, PCF("Exit HandleCARequests"));
 }
 
@@ -1554,14 +1446,14 @@ OCStackResult HandleStackRequests(OCServerProtocolRequest * protocolRequest)
     {
         OC_LOG(INFO, TAG, PCF("This is a new Server Request"));
         result = AddServerRequest(&request, protocolRequest->coapID,
-                protocolRequest->delayedResNeeded, protocolRequest->secured, 0,
+                protocolRequest->delayedResNeeded, 0,
                 protocolRequest->method, protocolRequest->numRcvdVendorSpecificHeaderOptions,
                 protocolRequest->observationOption, protocolRequest->qos,
                 protocolRequest->query, protocolRequest->rcvdVendorSpecificHeaderOptions,
-                protocolRequest->reqJSONPayload, protocolRequest->requestToken,
+                protocolRequest->payload, protocolRequest->requestToken,
                 protocolRequest->tokenLength,
-                protocolRequest->resourceUrl,protocolRequest->reqTotalSize,
-                &protocolRequest->addressInfo, protocolRequest->connectivityType);
+                protocolRequest->resourceUrl, protocolRequest->reqTotalSize,
+                &protocolRequest->devAddr);
         if (OC_STACK_OK != result)
         {
             OC_LOG(ERROR, TAG, PCF("Error adding server request"));
@@ -1581,8 +1473,7 @@ OCStackResult HandleStackRequests(OCServerProtocolRequest * protocolRequest)
     }
     else
     {
-        OC_LOG(INFO, TAG,
-                PCF("This is either a repeated or blocked Server Request"));
+        OC_LOG(INFO, TAG, PCF("This is either a repeated or blocked Server Request"));
     }
 
     if(request->requestComplete)
@@ -1602,76 +1493,16 @@ OCStackResult HandleStackRequests(OCServerProtocolRequest * protocolRequest)
     return result;
 }
 
-bool ParseIPv4Address(char * ipAddrStr, uint8_t * ipAddr, uint16_t * port)
+bool validatePlatformInfo(OCPlatformInfo info)
 {
-    size_t index = 0;
-     char *itr, *coap;
-     uint8_t dotCount = 0;
 
-     ipAddr[index] = 0;
-     *port = 0;
-     /* search for scheme */
-     itr = ipAddrStr;
-    if (!isdigit((char) *ipAddrStr))
+    if (!info.platformID)
     {
-        coap = OC_COAP_SCHEME;
-        while (*coap && tolower(*itr) == *coap)
-        {
-            coap++;
-            itr++;
-        }
+        OC_LOG(ERROR, TAG, PCF("No platform ID found."));
+        return false;
     }
-    ipAddrStr = itr;
 
-    while (*ipAddrStr)
-    {
-        if (isdigit(*ipAddrStr))
-        {
-            ipAddr[index] *= 10;
-            ipAddr[index] += *ipAddrStr - '0';
-        }
-        else if (*ipAddrStr == '.')
-        {
-            index++;
-            dotCount++;
-            ipAddr[index] = 0;
-        }
-        else
-        {
-            break;
-        }
-        ipAddrStr++;
-    }
-    if(*ipAddrStr == ':')
-    {
-        ipAddrStr++;
-        while (*ipAddrStr){
-            if (isdigit(*ipAddrStr))
-            {
-                *port *= 10;
-                *port += *ipAddrStr - '0';
-            }
-            else
-            {
-                break;
-            }
-            ipAddrStr++;
-        }
-    }
-
-    return (3 == dotCount);
-}
-
-bool validatePlatformInfo(OCPlatformInfo info)
-{
-
-    if (!info.platformID)
-    {
-        OC_LOG(ERROR, TAG, PCF("No platform ID found."));
-        return false;
-    }
-
-    if (info.manufacturerName)
+    if (info.manufacturerName)
     {
         size_t lenManufacturerName = strlen(info.manufacturerName);
 
@@ -1697,12 +1528,44 @@ bool validatePlatformInfo(OCPlatformInfo info)
     }
     return true;
 }
+
 //-----------------------------------------------------------------------------
 // Public APIs
 //-----------------------------------------------------------------------------
+#ifdef RA_ADAPTER
+OCStackResult OCSetRAInfo(const OCRAInfo_t *raInfo)
+{
+    if (!raInfo           ||
+        !raInfo->username ||
+        !raInfo->hostname ||
+        !raInfo->xmpp_domain)
+    {
+
+        return OC_STACK_INVALID_PARAM;
+    }
+    OCStackResult result = CAResultToOCResult(CASetRAInfo((const CARAInfo_t *) raInfo));
+    gRASetInfo = (result == OC_STACK_OK)? true : false;
+
+    return result;
+}
+#endif
 
 OCStackResult OCInit(const char *ipAddr, uint16_t port, OCMode mode)
 {
+    (void) ipAddr;
+    (void) port;
+#ifdef RA_ADAPTER
+    if(!gRASetInfo)
+    {
+        OC_LOG(ERROR, TAG, PCF("Need to call OCSetRAInfo before calling OCInit"));
+        return OC_STACK_ERROR;
+    }
+#endif
+    return OCInit1(mode, OC_DEFAULT_FLAGS, OC_DEFAULT_FLAGS);
+}
+
+OCStackResult OCInit1(OCMode mode, OCTransportFlags serverFlags, OCTransportFlags clientFlags)
+{
     if(stackState == OC_STACK_INITIALIZED)
     {
         OC_LOG(INFO, TAG, PCF("Subsequent calls to OCInit() without calling \
@@ -1710,8 +1573,6 @@ OCStackResult OCInit(const char *ipAddr, uint16_t port, OCMode mode)
         return OC_STACK_OK;
     }
 
-    (void) ipAddr;
-    (void) port;
     OCStackResult result = OC_STACK_ERROR;
     OC_LOG(INFO, TAG, PCF("Entering OCInit"));
 
@@ -1723,7 +1584,28 @@ OCStackResult OCInit(const char *ipAddr, uint16_t port, OCMode mode)
     }
     myStackMode = mode;
 
+    if (mode == OC_CLIENT || mode == OC_CLIENT_SERVER)
+    {
+        caglobals.client = true;
+    }
+    if (mode == OC_SERVER || mode == OC_CLIENT_SERVER)
+    {
+        caglobals.server = true;
+    }
+
+    caglobals.serverFlags = (CATransportFlags_t)serverFlags;
+    if (!(caglobals.serverFlags & CA_IPFAMILY_MASK))
+    {
+        caglobals.serverFlags = (CATransportFlags_t)(caglobals.serverFlags|CA_IPV4);
+    }
+    caglobals.clientFlags = (CATransportFlags_t)clientFlags;
+    if (!(caglobals.clientFlags & CA_IPFAMILY_MASK))
+    {
+        caglobals.clientFlags = (CATransportFlags_t)(caglobals.clientFlags|CA_IPV4);
+    }
+
     defaultDeviceHandler = NULL;
+    defaultDeviceHandlerCallbackParameter = NULL;
     OCSeedRandom();
 
     result = CAResultToOCResult(CAInitialize());
@@ -1732,18 +1614,20 @@ OCStackResult OCInit(const char *ipAddr, uint16_t port, OCMode mode)
     result = CAResultToOCResult(OCSelectNetwork());
     VERIFY_SUCCESS(result, OC_STACK_OK);
 
-    CARegisterHandler(HandleCARequests, HandleCAResponses);
     switch (myStackMode)
     {
         case OC_CLIENT:
+                       CARegisterHandler(HandleCARequests, HandleCAResponses, HandleCAErrorResponse);
             result = CAResultToOCResult(CAStartDiscoveryServer());
             OC_LOG(INFO, TAG, PCF("Client mode: CAStartDiscoveryServer"));
             break;
         case OC_SERVER:
+                       SRMRegisterHandler(HandleCARequests, HandleCAResponses, HandleCAErrorResponse);
             result = CAResultToOCResult(CAStartListeningServer());
             OC_LOG(INFO, TAG, PCF("Server mode: CAStartListeningServer"));
             break;
         case OC_CLIENT_SERVER:
+                       SRMRegisterHandler(HandleCARequests, HandleCAResponses, HandleCAErrorResponse);
             result = CAResultToOCResult(CAStartListeningServer());
             if(result == OC_STACK_OK)
             {
@@ -1753,12 +1637,6 @@ OCStackResult OCInit(const char *ipAddr, uint16_t port, OCMode mode)
     }
     VERIFY_SUCCESS(result, OC_STACK_OK);
 
-#if defined(__WITH_DTLS__)
-    result = (CARegisterDTLSCredentialsHandler(GetDtlsPskCredentials) == CA_STATUS_OK) ?
-        OC_STACK_OK : OC_STACK_ERROR;
-    VERIFY_SUCCESS(result, OC_STACK_OK);
-#endif // (__WITH_DTLS__)
-
 #ifdef WITH_PRESENCE
     PresenceTimeOutSize = sizeof(PresenceTimeOut)/sizeof(PresenceTimeOut[0]) - 1;
 #endif // WITH_PRESENCE
@@ -1772,6 +1650,13 @@ OCStackResult OCInit(const char *ipAddr, uint16_t port, OCMode mode)
         result = initResources();
     }
 
+    // Initialize the SRM Policy Engine
+    if(result == OC_STACK_OK)
+    {
+        result = SRMInitPolicyEngine();
+        // TODO after BeachHead delivery: consolidate into single SRMInit()
+    }
+
 exit:
     if(result != OC_STACK_OK)
     {
@@ -1815,8 +1700,12 @@ OCStackResult OCStop()
     DeleteObserverList();
     // Remove all the client callbacks
     DeleteClientCBList();
-    // Deinit security blob
-    DeinitOCSecurityInfo();
+
+       // De-init the SRM Policy Engine
+    // TODO after BeachHead delivery: consolidate into single SRMDeInit()
+    SRMDeInitPolicyEngine();
+
+
     stackState = OC_STACK_UNINITIALIZED;
     return OC_STACK_OK;
 }
@@ -1860,259 +1749,468 @@ OCStackResult verifyUriQueryLength(const char *inputUri, uint16_t uriLen)
     return OC_STACK_OK;
 }
 
-OCStackResult OCDoResource(OCDoHandle *handle, OCMethod method, const char *requiredUri,
-            const char *referenceUri, const char *request, OCConnectivityType conType,
-            OCQualityOfService qos, OCCallbackData *cbData,
-            OCHeaderOption * options, uint8_t numOptions)
+/**
+ *  A request uri consists of the following components in order:
+ *                              example
+ *  optional prefix             "coap://"
+ *  optionally one of
+ *      IPv6 address            "[1234::5678]"
+ *      IPv4 address            "192.168.1.1"
+ *  optional port               ":5683"
+ *  resource uri                "/oc/core..."
+ *
+ *  for PRESENCE requests, extract resource type.
+ */
+static OCStackResult ParseRequestUri(const char *fullUri,
+                                        OCTransportAdapter adapter,
+                                        OCTransportFlags flags,
+                                        OCDevAddr **devAddr,
+                                        char **resourceUri,
+                                        char **resourceType)
 {
-    OCStackResult result = OC_STACK_ERROR;
-    ClientCB *clientCB = NULL;
-    char * requestUri = NULL;
-    char * resourceType = NULL;
-    char * query = NULL;
-    char * newUri = (char *)requiredUri;
-    (void) referenceUri;
-    CARemoteEndpoint_t* endpoint = NULL;
-    CAResult_t caResult;
-    CAToken_t token = NULL;
-    uint8_t tokenLength = CA_MAX_TOKEN_LEN;
-    OCDoHandle resHandle = NULL;
-    CAInfo_t requestData ={};
-    CARequestInfo_t requestInfo ={};
-    CAGroupEndpoint_t grpEnd = {};
+    VERIFY_NON_NULL(fullUri, FATAL, OC_STACK_INVALID_CALLBACK);
 
-    OC_LOG(INFO, TAG, PCF("Entering OCDoResource"));
+    OCStackResult result = OC_STACK_OK;
+    OCDevAddr *da = NULL;
+    char *colon = NULL;
+    char *end;
 
-    // Validate input parameters
-    VERIFY_NON_NULL(cbData, FATAL, OC_STACK_INVALID_CALLBACK);
-    VERIFY_NON_NULL(cbData->cb, FATAL, OC_STACK_INVALID_CALLBACK);
+    // provide defaults for all returned values
+    if (devAddr)
+    {
+        *devAddr = NULL;
+    }
+    if (resourceUri)
+    {
+        *resourceUri = NULL;
+    }
+    if (resourceType)
+    {
+        *resourceType = NULL;
+    }
 
-    //TODO ("Need to form the final query by concatenating require and reference URI's");
-    VERIFY_NON_NULL(requiredUri, FATAL, OC_STACK_INVALID_URI);
+    // delimit url prefix, if any
+    const char *start = fullUri;
+    char *slash2 = strstr(start, "//");
+    if (slash2)
+    {
+        start = slash2 + 2;
+    }
+    char *slash = strchr(start, '/');
+    if (!slash)
+    {
+        return OC_STACK_INVALID_URI;
+    }
 
-    uint16_t uriLen = strlen(requiredUri);
+    // processs url prefix, if any
+    size_t urlLen = slash - start;
+    // port
+    uint16_t port = 0;
+    size_t len = 0;
+    if (urlLen && devAddr)
+    {   // construct OCDevAddr
+        if (OC_ADAPTER_IP == adapter)
+        {
+            if (start[0] == '[')
+            {   // ipv6 address
+                char *close = strchr(++start, ']');
+                if (!close || close > slash)
+                {
+                    return OC_STACK_INVALID_URI;
+                }
+                end = close;
+                if (close[1] == ':')
+                {
+                    colon = close + 1;
+                }
+            }
+            else
+            {   // ipv4 address
+                end = slash;
+                colon = strchr(start, ':');
+                end = (colon && colon < slash) ? colon : slash;
+            }
+            len = end - start;
+            if (len >= sizeof(da->addr))
+            {
+                return OC_STACK_INVALID_URI;
+            }
+            // collect port, if any
+            if (colon && colon < slash)
+            {
+                for (colon++; colon < slash; colon++)
+                {
+                    char c = colon[0];
+                    if (c < '0' || c > '9')
+                    {
+                        return OC_STACK_INVALID_URI;
+                    }
+                    port = 10 * port + c - '0';
+                }
+            }
+        }
+        else
+        {
+            /**
+             * This is for Non-IP adapters(EDR and BLE).
+             * The address will be between "//" and "/" in the request URI.
+             * [Ex. coap://AB:BC:CD:DE:EF:FG/resource_uri]
+             */
+            end = slash;
+        }
 
-    // ToDo: We should also check if the requiredUri has a mutlicast address,
-    // then qos has to be OC_Low_QOS
-    switch (method)
-    {
-        case OC_REST_GET:
-        case OC_REST_OBSERVE:
-        case OC_REST_OBSERVE_ALL:
-        case OC_REST_CANCEL_OBSERVE:
-            requestInfo.method = CA_GET;
-            break;
+        len = end - start;
+        if (len >= sizeof(da->addr))
+        {
+            return OC_STACK_INVALID_URI;
+        }
 
-        case OC_REST_PUT:
-            requestInfo.method = CA_PUT;
-            break;
+        da = (OCDevAddr *)OICCalloc(sizeof (OCDevAddr), 1);
+        if (!da)
+        {
+            return OC_STACK_NO_MEMORY;
+        }
+        OICStrcpyPartial(da->addr, sizeof(da->addr), start, len);
+        da->port = port;
+        da->adapter = adapter;
+        da->flags = flags;
+        if (!strncmp(fullUri, "coaps:", 6))
+        {
+            da->flags = (OCTransportFlags)(da->flags|CA_SECURE);
+        }
+        *devAddr = da;
+    }
 
-        case OC_REST_POST:
-            requestInfo.method = CA_POST;
-            break;
+    // process resource uri, if any
+    if (slash)
+    {   // request uri and query
+        size_t ulen = strlen(slash); // resource uri length
+        size_t tlen = 0;      // resource type length
+        char *type = NULL;
 
-        case OC_REST_DELETE:
-            requestInfo.method = CA_DELETE;
-            break;
+        static const char strPresence[] = "/oic/ad?rt=";
+        static const size_t lenPresence = sizeof(strPresence) - 1;
+        if (!strncmp(slash, strPresence, lenPresence))
+        {
+            type = slash + lenPresence;
+            tlen = ulen - lenPresence;
+        }
+        // resource uri
+        if (resourceUri)
+        {
+            *resourceUri = (char *)OICMalloc(ulen + 1);
+            if (!*resourceUri)
+            {
+                result = OC_STACK_NO_MEMORY;
+                goto error;
+            }
+            strcpy(*resourceUri, slash);
+        }
+        // resource type
+        if (type && resourceType)
+        {
+            *resourceType = (char *)OICMalloc(tlen + 1);
+            if (!*resourceType)
+            {
+                result = OC_STACK_NO_MEMORY;
+                goto error;
+            }
 
-        #ifdef WITH_PRESENCE
-        case OC_REST_PRESENCE:
-            // Replacing method type with GET because "presence"
-            // is a stack layer only implementation.
-            requestInfo.method = CA_GET;
-            break;
-        #endif
+            OICStrcpy(*resourceType, (tlen+1), type);
+        }
+    }
 
-        default:
-            result = OC_STACK_INVALID_METHOD;
-            goto exit;
+    return OC_STACK_OK;
+
+error:
+    // free all returned values
+    if (devAddr)
+    {
+        OICFree(*devAddr);
+    }
+    if (resourceUri)
+    {
+        OICFree(*resourceUri);
     }
+    if (resourceType)
+    {
+        OICFree(*resourceType);
+    }
+    return result;
+}
 
-    if((result = verifyUriQueryLength(requiredUri, uriLen)) != OC_STACK_OK)
+static OCStackResult OCPreparePresence(CAEndpoint_t *endpoint,
+                                        char *resourceUri, char **requestUri)
+{
+    char uri[CA_MAX_URI_LENGTH];
+
+    FormCanonicalPresenceUri(endpoint, resourceUri, uri);
+
+    *requestUri = (char *)OICMalloc(strlen(uri) + 1);
+    if (!*requestUri)
     {
-        goto exit;
+        return OC_STACK_NO_MEMORY;
     }
 
-    if((request) && (strlen(request) > MAX_REQUEST_LENGTH))
+    strcpy(*requestUri, uri);
+    return OC_STACK_OK;
+}
+
+/**
+ * Discover or Perform requests on a specified resource
+ */
+OCStackResult OCDoResource(OCDoHandle *handle,
+                            OCMethod method,
+                            const char *requestUri,
+                            const OCDevAddr *destination,
+                            OCPayload* payload,
+                            OCConnectivityType connectivityType,
+                            OCQualityOfService qos,
+                            OCCallbackData *cbData,
+                            OCHeaderOption *options,
+                            uint8_t numOptions)
+{
+    OC_LOG(INFO, TAG, PCF("Entering OCDoResource"));
+
+    // Validate input parameters
+    VERIFY_NON_NULL(cbData, FATAL, OC_STACK_INVALID_CALLBACK);
+    VERIFY_NON_NULL(cbData->cb, FATAL, OC_STACK_INVALID_CALLBACK);
+    VERIFY_NON_NULL(requestUri , FATAL, OC_STACK_INVALID_URI);
+
+    OCStackResult result = OC_STACK_ERROR;
+    CAResult_t caResult;
+    CAToken_t token = NULL;
+    uint8_t tokenLength = CA_MAX_TOKEN_LEN;
+    ClientCB *clientCB = NULL;
+    OCDoHandle resHandle = NULL;
+    CAEndpoint_t *endpoint = NULL;
+    OCDevAddr tmpDevAddr = { OC_DEFAULT_ADAPTER };
+    uint32_t ttl = 0;
+    OCTransportAdapter adapter;
+    OCTransportFlags flags;
+    // the request contents are put here
+    CARequestInfo_t requestInfo = { CA_GET };
+    // requestUri  will be parsed into the following three variables
+    OCDevAddr *devAddr = NULL;
+    char *resourceUri = NULL;
+    char *resourceType = NULL;
+
+    // To track if memory is allocated for additional header options
+    uint8_t hdrOptionMemAlloc = 0;
+
+    // This validation is broken, but doesn't cause harm
+    size_t uriLen = strlen(requestUri );
+    if ((result = verifyUriQueryLength(requestUri , uriLen)) != OC_STACK_OK)
     {
-        result = OC_STACK_INVALID_PARAM;
         goto exit;
     }
 
-#ifdef WITH_PRESENCE
-    if(method == OC_REST_PRESENCE)
+    /*
+     * Support original behavior with address on resourceUri argument.
+     */
+    adapter = (OCTransportAdapter)(connectivityType >> CT_ADAPTER_SHIFT);
+    flags = (OCTransportFlags)(connectivityType & CT_MASK_FLAGS);
+
+    result = ParseRequestUri(requestUri, adapter, flags, &devAddr, &resourceUri, &resourceType);
+
+    if (result != OC_STACK_OK)
     {
-        result = getQueryFromUri(requiredUri, &query, &newUri);
+        OC_LOG_V(DEBUG, TAG, "Unable to parse uri: %s", requestUri);
+        goto exit;
+    }
 
-        if(result != OC_STACK_OK)
+    switch (method)
+    {
+    case OC_REST_GET:
+    case OC_REST_OBSERVE:
+    case OC_REST_OBSERVE_ALL:
+    case OC_REST_CANCEL_OBSERVE:
+        requestInfo.method = CA_GET;
+        break;
+    case OC_REST_PUT:
+        requestInfo.method = CA_PUT;
+        break;
+    case OC_REST_POST:
+        requestInfo.method = CA_POST;
+        break;
+    case OC_REST_DELETE:
+        requestInfo.method = CA_DELETE;
+        break;
+    case OC_REST_DISCOVER:
+        qos = OC_LOW_QOS;
+        if (destination || devAddr)
         {
-            OC_LOG_V(ERROR, TAG, "Invalid Param from getQueryFromUri: %d, URI is %s",
-                    result, requiredUri);
-            goto exit;
-        }
-
-        if(query)
-        {
-            result = getResourceType((char *) query, &resourceType);
-            OCFree(query);
-            if(resourceType)
-            {
-                OC_LOG_V(DEBUG, TAG, "Got Resource Type: %s", resourceType);
-            }
-            else
-            {
-                OC_LOG(DEBUG, TAG, PCF("Resource type is NULL."));
-            }
+            requestInfo.isMulticast = false;
         }
         else
         {
-            OC_LOG(DEBUG, TAG, PCF("Query string is NULL."));
-        }
-        if(result != OC_STACK_OK)
-        {
-            goto exit;
+            destination = &tmpDevAddr;
+            requestInfo.isMulticast = true;
         }
+        // CA_DISCOVER will become GET and isMulticast
+        requestInfo.method = CA_GET;
+        break;
+    #ifdef WITH_PRESENCE
+    case OC_REST_PRESENCE:
+        // Replacing method type with GET because "presence"
+        // is a stack layer only implementation.
+        requestInfo.method = CA_GET;
+        break;
+    #endif
+    default:
+        result = OC_STACK_INVALID_METHOD;
+        goto exit;
     }
-#endif // WITH_PRESENCE
 
-    requestUri = (char *) OCMalloc(uriLen + 1);
-    if(requestUri)
+    if (!devAddr && !destination)
     {
-        memcpy(requestUri, newUri, (uriLen + 1));
+        OC_LOG_V(DEBUG, TAG, "no devAddr and no destination");
+        result = OC_STACK_INVALID_PARAM;
+        goto exit;
     }
-    else
+
+    /* If not original behavior, use destination argument */
+    if (destination && !devAddr)
     {
-        result = OC_STACK_NO_MEMORY;
-        goto exit;
+        devAddr = (OCDevAddr *)OICMalloc(sizeof (OCDevAddr));
+        if (!devAddr)
+        {
+            result = OC_STACK_NO_MEMORY;
+            goto exit;
+        }
+        *devAddr = *destination;
     }
 
     resHandle = GenerateInvocationHandle();
-    if(!resHandle)
+    if (!resHandle)
     {
         result = OC_STACK_NO_MEMORY;
         goto exit;
     }
 
-    // create token
     caResult = CAGenerateToken(&token, tokenLength);
     if (caResult != CA_STATUS_OK)
     {
         OC_LOG(ERROR, TAG, PCF("CAGenerateToken error"));
-        CADestroyToken(token);
-        result = CAResultToOCResult (caResult);
         goto exit;
     }
 
-    requestData.type = qualityOfServiceToMessageType(qos);
-
-    requestData.token = token;
-    requestData.tokenLength = tokenLength;
+    // fill in request data
+    requestInfo.info.type = qualityOfServiceToMessageType(qos);
+    requestInfo.info.token = token;
+    requestInfo.info.tokenLength = tokenLength;
+    requestInfo.info.resourceUri = resourceUri;
 
     if ((method == OC_REST_OBSERVE) || (method == OC_REST_OBSERVE_ALL))
     {
-        result = CreateObserveHeaderOption (&(requestData.options), options,
-                                    numOptions, OC_OBSERVE_REGISTER);
+        result = CreateObserveHeaderOption (&(requestInfo.info.options),
+                                    options, numOptions, OC_OBSERVE_REGISTER);
         if (result != OC_STACK_OK)
         {
-            CADestroyToken(token);
             goto exit;
         }
-        requestData.numOptions = numOptions + 1;
+        hdrOptionMemAlloc = 1;
+        requestInfo.info.numOptions = numOptions + 1;
     }
     else
     {
-        requestData.options = (CAHeaderOption_t*)options;
-        requestData.numOptions = numOptions;
+        requestInfo.info.options = (CAHeaderOption_t*)options;
+        requestInfo.info.numOptions = numOptions;
     }
 
-    requestData.payload = (char *)request;
+    // create remote endpoint
+    result = OCCreateEndpoint(devAddr, &endpoint);
+    if(payload)
+    {
+        if((result =
+            OCConvertPayload(payload, &requestInfo.info.payload, &requestInfo.info.payloadSize))
+                != OC_STACK_OK)
+        {
+            OC_LOG(ERROR, TAG, PCF("Failed to create CBOR Payload"));
+            goto exit;
+        }
+    }
+    else
+    {
+        requestInfo.info.payload = NULL;
+        requestInfo.info.payloadSize = 0;
+    }
 
-    requestInfo.info = requestData;
 
-    CATransportType_t caConType;
 
-    result = OCToCATransportType((OCConnectivityType) conType, &caConType);
     if (result != OC_STACK_OK)
     {
-        OC_LOG(ERROR, TAG, PCF("Invalid Connectivity Type"));
+        OC_LOG(ERROR, TAG, PCF("CACreateEndpoint error"));
         goto exit;
     }
 
-    // send request
-    if(conType == OC_ALL)
-    {
-        grpEnd.transportType = caConType;
-
-        grpEnd.resourceUri = (CAURI_t) OCMalloc(uriLen + 1);
-        if(!grpEnd.resourceUri)
-        {
-            result = OC_STACK_NO_MEMORY;
-            CADestroyToken(token);
-            goto exit;
-        }
-        strncpy(grpEnd.resourceUri, requiredUri, (uriLen + 1));
-
-        caResult = CASendRequestToAll(&grpEnd, &requestInfo);
-    }
-    else
+    // prepare for response
+    #ifdef WITH_PRESENCE
+    if (method == OC_REST_PRESENCE)
     {
-        caResult = CACreateRemoteEndpoint(newUri, caConType, &endpoint);
-
-        if (caResult != CA_STATUS_OK)
+        char *presenceUri = NULL;
+        result = OCPreparePresence(endpoint, resourceUri, &presenceUri);
+        if (OC_STACK_OK != result)
         {
-            OC_LOG(ERROR, TAG, PCF("CACreateRemoteEndpoint error"));
-            result = CAResultToOCResult (caResult);
-            CADestroyToken(token);
             goto exit;
         }
 
-        caResult = CASendRequest(endpoint, &requestInfo);
+        // Assign full presence uri as coap://ip:port/oic/ad to add to callback list.
+        // Presence notification will form a canonical uri to
+        // look for callbacks into the application.
+        resourceUri = presenceUri;
     }
+    #endif
 
-    if (caResult != CA_STATUS_OK)
+    ttl = GetTicks(MAX_CB_TIMEOUT_SECONDS * MILLISECONDS_PER_SECOND);
+    result = AddClientCB(&clientCB, cbData, token, tokenLength, &resHandle,
+                            method, devAddr, resourceUri, resourceType, ttl);
+    if (OC_STACK_OK != result)
     {
-        OC_LOG(ERROR, TAG, PCF("CASendRequest"));
-        result = CAResultToOCResult (caResult);
-        CADestroyToken(token);
         goto exit;
     }
 
-    result = AddClientCB(&clientCB, cbData, token, tokenLength, &resHandle, method,
-                             requestUri, resourceType, conType,
-                             GetTicks(MAX_CB_TIMEOUT_SECONDS * MILLISECONDS_PER_SECOND));
-    if(result != OC_STACK_OK)
+    devAddr = NULL;       // Client CB list entry now owns it
+    resourceUri = NULL;   // Client CB list entry now owns it
+    resourceType = NULL;  // Client CB list entry now owns it
+
+    // send request
+    caResult = CASendRequest(endpoint, &requestInfo);
+    if (caResult != CA_STATUS_OK)
     {
-        result = OC_STACK_NO_MEMORY;
+        OC_LOG(ERROR, TAG, PCF("CASendRequest"));
+        result = OC_STACK_COMM_ERROR;
         goto exit;
     }
 
-    if(handle)
+    if (handle)
     {
         *handle = resHandle;
     }
 
 exit:
-    if(newUri != requiredUri)
-    {
-        OCFree(newUri);
-    }
     if (result != OC_STACK_OK)
     {
-        OC_LOG_V(ERROR, TAG, PCF("OCDoResource error no %d"), result);
+        OC_LOG(ERROR, TAG, PCF("OCDoResource error"));
         FindAndDeleteClientCB(clientCB);
-        OCFree(resHandle);
-        OCFree(requestUri);
-        OCFree(resourceType);
+        CADestroyToken(token);
+        if (handle)
+        {
+            *handle = NULL;
+        }
+        OICFree(resHandle);
     }
-    CADestroyRemoteEndpoint(endpoint);
-    OCFree(grpEnd.resourceUri);
 
-    if (requestData.options  && requestData.numOptions > 0)
+    // This is the owner of the payload object, so we free it
+    OCPayloadDestroy(payload);
+    OICFree(requestInfo.info.payload);
+    OICFree(devAddr);
+    OICFree(resourceUri);
+    OICFree(resourceType);
+    OICFree(endpoint);
+    if (hdrOptionMemAlloc)
     {
-        if ((method == OC_REST_OBSERVE) || (method == OC_REST_OBSERVE_ALL))
-        {
-            OCFree(requestData.options);
-        }
+        OICFree(requestInfo.info.options);
     }
     return result;
 }
@@ -2138,7 +2236,7 @@ OCStackResult OCCancel(OCDoHandle handle, OCQualityOfService qos, OCHeaderOption
      *      Remove the callback associated on client side.
      */
     OCStackResult ret = OC_STACK_OK;
-    CARemoteEndpoint_t* endpoint = NULL;
+    CAEndpoint_t* endpoint = NULL;
     CAResult_t caResult;
     CAInfo_t requestData = {};
     CARequestInfo_t requestInfo = {};
@@ -2148,201 +2246,216 @@ OCStackResult OCCancel(OCDoHandle handle, OCQualityOfService qos, OCHeaderOption
         return OC_STACK_INVALID_PARAM;
     }
 
-    OC_LOG(INFO, TAG, PCF("Entering OCCancel"));
-
     ClientCB *clientCB = GetClientCB(NULL, 0, handle, NULL);
+    if (!clientCB)
+    {
+        OC_LOG(ERROR, TAG, PCF("Client callback not found. Called OCCancel twice?"));
+        goto Error;
+    }
 
-    if(clientCB)
+    switch (clientCB->method)
     {
-        switch (clientCB->method)
-        {
-            case OC_REST_OBSERVE:
-            case OC_REST_OBSERVE_ALL:
-                if(qos == OC_HIGH_QOS)
-                {
-                    requestData.type =  qualityOfServiceToMessageType(qos);
-                    requestData.token = clientCB->token;
-                    requestData.tokenLength = clientCB->tokenLength;
+        case OC_REST_OBSERVE:
+        case OC_REST_OBSERVE_ALL:
+            OC_LOG_V(INFO, TAG, "Canceling observation for resource %s",
+                                        clientCB->requestUri);
+            if (qos != OC_HIGH_QOS)
+            {
+                FindAndDeleteClientCB(clientCB);
+                break;
+            }
+            else
+            {
+                OC_LOG(INFO, TAG, PCF("Cancelling observation as CONFIRMABLE"));
+            }
 
-                    if (CreateObserveHeaderOption (&(requestData.options),
-                            options, numOptions, OC_OBSERVE_DEREGISTER) != OC_STACK_OK)
-                    {
-                        return OC_STACK_ERROR;
-                    }
-                    requestData.numOptions = numOptions + 1;
-                    requestInfo.method = CA_GET;
-                    requestInfo.info = requestData;
+            requestData.type = qualityOfServiceToMessageType(qos);
+            requestData.token = clientCB->token;
+            requestData.tokenLength = clientCB->tokenLength;
+            if (CreateObserveHeaderOption (&(requestData.options),
+                    options, numOptions, OC_OBSERVE_DEREGISTER) != OC_STACK_OK)
+            {
+                return OC_STACK_ERROR;
+            }
+            requestData.numOptions = numOptions + 1;
+            requestData.resourceUri = OICStrdup (clientCB->requestUri);
 
-                    CATransportType_t caConType;
-                    ret = OCToCATransportType(clientCB->conType, &caConType);
-                    if(ret != OC_STACK_OK)
-                    {
-                        goto Error;
-                    }
+            requestInfo.method = CA_GET;
+            requestInfo.info = requestData;
 
-                    caResult = CACreateRemoteEndpoint((char *)clientCB->requestUri,
-                            caConType, &endpoint);
-                    if (caResult != CA_STATUS_OK)
-                    {
-                        OC_LOG(ERROR, TAG, PCF("CACreateRemoteEndpoint error"));
-                        ret = OC_STACK_ERROR;
-                        goto Error;
-                    }
+            ret = OCCreateEndpoint(clientCB->devAddr, &endpoint);
+            if (ret != OC_STACK_OK)
+            {
+                OC_LOG(ERROR, TAG, PCF("CACreateEndpoint error"));
+                goto Error;
+            }
 
-                    // send request
-                    caResult = CASendRequest(endpoint, &requestInfo);
-                    if (caResult != CA_STATUS_OK)
-                    {
-                        OC_LOG(ERROR, TAG, PCF("CASendRequest error"));
-                        ret = OC_STACK_ERROR;
-                    }
-                    ret = CAResultToOCResult (caResult);
-                }
-                else
-                {
-                    FindAndDeleteClientCB(clientCB);
-                }
-                break;
+            // send request
+            caResult = CASendRequest(endpoint, &requestInfo);
+            if (caResult != CA_STATUS_OK)
+            {
+                OC_LOG(ERROR, TAG, PCF("CASendRequest error"));
+                ret = OC_STACK_ERROR;
+            }
+            ret = CAResultToOCResult (caResult);
+            break;
 
-            #ifdef WITH_PRESENCE
-            case OC_REST_PRESENCE:
-                FindAndDeleteClientCB(clientCB);
-                break;
-            #endif
-            default:
-                ret = OC_STACK_INVALID_METHOD;
-                break;
-        }
-    }
-    else
-    {
-        OC_LOG(ERROR, TAG, PCF("Client callback not found. Called OCCancel twice?"));
+        #ifdef WITH_PRESENCE
+        case OC_REST_PRESENCE:
+            FindAndDeleteClientCB(clientCB);
+            break;
+        #endif
+
+        default:
+            ret = OC_STACK_INVALID_METHOD;
+            break;
     }
 
-    Error:
-    CADestroyRemoteEndpoint(endpoint);
+Error:
+    OCDestroyEndpoint(endpoint);
     if (requestData.numOptions > 0)
     {
-        OCFree(requestData.options);
+        OICFree(requestData.options);
+    }
+    if (requestData.resourceUri)
+    {
+        OICFree (requestData.resourceUri);
     }
 
     return ret;
 }
 
+/**
+ * @brief   Register Persistent storage callback.
+ * @param   persistentStorageHandler [IN] Pointers to open, read, write, close & unlink handlers.
+ * @return
+ *     OC_STACK_OK    - No errors; Success
+ *     OC_STACK_INVALID_PARAM - Invalid parameter
+ */
+OCStackResult OCRegisterPersistentStorageHandler(OCPersistentStorage* persistentStorageHandler)
+{
+    OC_LOG(INFO, TAG, PCF("RegisterPersistentStorageHandler !!"));
+    if(!persistentStorageHandler)
+    {
+        OC_LOG(ERROR, TAG, PCF("The persistent storage handler is invalid"));
+        return OC_STACK_INVALID_PARAM;
+    }
+    else
+    {
+        if( !persistentStorageHandler->open ||
+                !persistentStorageHandler->close ||
+                !persistentStorageHandler->read ||
+                !persistentStorageHandler->unlink ||
+                !persistentStorageHandler->write)
+        {
+            OC_LOG(ERROR, TAG, PCF("The persistent storage handler is invalid"));
+            return OC_STACK_INVALID_PARAM;
+        }
+    }
+    return SRMRegisterPersistentStorageHandler(persistentStorageHandler);
+}
+
 #ifdef WITH_PRESENCE
+
 OCStackResult OCProcessPresence()
 {
     OCStackResult result = OC_STACK_OK;
-    uint8_t ipAddr[4] = { 0 };
-    uint16_t port = 0;
 
-    OC_LOG(INFO, TAG, PCF("Entering RequestPresence"));
+    // the following line floods the log with messages that are irrelevant
+    // to most purposes.  Uncomment as needed.
+    //OC_LOG(INFO, TAG, PCF("Entering RequestPresence"));
     ClientCB* cbNode = NULL;
-    OCDevAddr dst = {};
-    OCClientResponse clientResponse ={};
+    OCClientResponse clientResponse;
     OCStackApplicationResult cbResult = OC_STACK_DELETE_TRANSACTION;
 
     LL_FOREACH(cbList, cbNode)
     {
-        if(OC_REST_PRESENCE == cbNode->method)
+        if (OC_REST_PRESENCE != cbNode->method || !cbNode->presence)
         {
-            if(cbNode->presence)
-            {
-                uint32_t now = GetTicks(0);
-                OC_LOG_V(DEBUG, TAG, "this TTL level %d",
-                                                        cbNode->presence->TTLlevel);
-                OC_LOG_V(DEBUG, TAG, "current ticks %d", now);
+            continue;
+        }
 
+        uint32_t now = GetTicks(0);
+        OC_LOG_V(DEBUG, TAG, "this TTL level %d",
+                                                cbNode->presence->TTLlevel);
+        OC_LOG_V(DEBUG, TAG, "current ticks %d", now);
 
-                if(cbNode->presence->TTLlevel >= (PresenceTimeOutSize + 1))
-                {
-                    goto exit;
-                }
+        if(cbNode->presence->TTLlevel >= (PresenceTimeOutSize + 1))
+        {
+            goto exit;
+        }
 
-                if(cbNode->presence->TTLlevel < PresenceTimeOutSize)
-                {
-                    OC_LOG_V(DEBUG, TAG, "timeout ticks %d",
-                            cbNode->presence->timeOut[cbNode->presence->TTLlevel]);
-                }
+        if (cbNode->presence->TTLlevel < PresenceTimeOutSize)
+        {
+            OC_LOG_V(DEBUG, TAG, "timeout ticks %d",
+                    cbNode->presence->timeOut[cbNode->presence->TTLlevel]);
+        }
 
-                if(cbNode->presence->TTLlevel >= PresenceTimeOutSize)
-                {
-                    OC_LOG(DEBUG, TAG, PCF("No more timeout ticks"));
-                    if (ParseIPv4Address(cbNode->requestUri, ipAddr, &port))
-                    {
-                        OCBuildIPv4Address(ipAddr[0], ipAddr[1], ipAddr[2], ipAddr[3], port,
-                                &dst);
-
-                        clientResponse.sequenceNumber = 0;
-                        clientResponse.result = OC_STACK_PRESENCE_TIMEOUT;
-                        clientResponse.addr = (OCDevAddr *) &dst;
-                        clientResponse.resJSONPayload = NULL;
-
-                        // Increment the TTLLevel (going to a next state), so we don't keep
-                        // sending presence notification to client.
-                        cbNode->presence->TTLlevel++;
-                        OC_LOG_V(DEBUG, TAG, "moving to TTL level %d",
-                                                cbNode->presence->TTLlevel);
-                    }
-                    else
-                    {
-                        result = OC_STACK_INVALID_IP;
-                        goto exit;
-                    }
+        if (cbNode->presence->TTLlevel >= PresenceTimeOutSize)
+        {
+            OC_LOG(DEBUG, TAG, PCF("No more timeout ticks"));
 
-                    cbResult = cbNode->callBack(cbNode->context, cbNode->handle, &clientResponse);
-                    if (cbResult == OC_STACK_DELETE_TRANSACTION)
-                    {
-                        FindAndDeleteClientCB(cbNode);
-                    }
-                }
+            clientResponse.sequenceNumber = 0;
+            clientResponse.result = OC_STACK_PRESENCE_TIMEOUT;
+            clientResponse.devAddr = *cbNode->devAddr;
+            FixUpClientResponse(&clientResponse);
+            clientResponse.payload = NULL;
 
-                if(now >= cbNode->presence->timeOut[cbNode->presence->TTLlevel])
-                {
-                    CAResult_t caResult = CA_STATUS_OK;
-                    CARemoteEndpoint_t* endpoint = NULL;
-                    CAInfo_t requestData ={};
-                    CARequestInfo_t requestInfo = {};
+            // Increment the TTLLevel (going to a next state), so we don't keep
+            // sending presence notification to client.
+            cbNode->presence->TTLlevel++;
+            OC_LOG_V(DEBUG, TAG, "moving to TTL level %d",
+                                        cbNode->presence->TTLlevel);
 
-                    OC_LOG(DEBUG, TAG, PCF("time to test server presence"));
+            cbResult = cbNode->callBack(cbNode->context, cbNode->handle, &clientResponse);
+            if (cbResult == OC_STACK_DELETE_TRANSACTION)
+            {
+                FindAndDeleteClientCB(cbNode);
+            }
+        }
 
+        if (now < cbNode->presence->timeOut[cbNode->presence->TTLlevel])
+        {
+            continue;
+        }
 
-                    CATransportType_t caConType;
-                    result = OCToCATransportType(cbNode->conType, &caConType);
-                    caResult = CACreateRemoteEndpoint((char *)cbNode->requestUri, caConType,
-                                                        &endpoint);
-                    if (caResult != CA_STATUS_OK || result != OC_STACK_OK)
-                    {
-                        OC_LOG(ERROR, TAG, PCF("CACreateRemoteEndpoint error"));
-                        goto exit;
-                    }
+        CAResult_t caResult = CA_STATUS_OK;
+        CAEndpoint_t* endpoint = NULL;
+        CAInfo_t requestData ={};
+        CARequestInfo_t requestInfo = {};
 
-                    requestData.type = CA_MSG_NONCONFIRM;
-                    requestData.token = cbNode->token;
-                    requestData.tokenLength = cbNode->tokenLength;
-                    requestInfo.method = CA_GET;
-                    requestInfo.info = requestData;
+        OC_LOG(DEBUG, TAG, PCF("time to test server presence"));
 
-                    caResult = CASendRequest(endpoint, &requestInfo);
-                    CADestroyRemoteEndpoint(endpoint);
+        result = OCCreateEndpoint(cbNode->devAddr, &endpoint);
+        if (result != OC_STACK_OK)
+        {
+            OC_LOG(ERROR, TAG, PCF("CACreateEndpoint error"));
+            goto exit;
+        }
 
-                    if (caResult != CA_STATUS_OK)
-                    {
-                        OC_LOG(ERROR, TAG, PCF("CASendRequest error"));
-                        goto exit;
-                    }
+        requestData.type = CA_MSG_NONCONFIRM;
+        requestData.token = cbNode->token;
+        requestData.tokenLength = cbNode->tokenLength;
+        requestData.resourceUri = OC_RSRVD_PRESENCE_URI;
+        requestInfo.method = CA_GET;
+        requestInfo.info = requestData;
 
-                    cbNode->presence->TTLlevel++;
-                    OC_LOG_V(DEBUG, TAG, "moving to TTL level %d",
-                                                            cbNode->presence->TTLlevel);
-                }
-            }
+        caResult = CASendRequest(endpoint, &requestInfo);
+        OCDestroyEndpoint(endpoint);
+
+        if (caResult != CA_STATUS_OK)
+        {
+            OC_LOG(ERROR, TAG, PCF("CASendRequest error"));
+            goto exit;
         }
+
+        cbNode->presence->TTLlevel++;
+        OC_LOG_V(DEBUG, TAG, "moving to TTL level %d", cbNode->presence->TTLlevel);
     }
 exit:
     if (result != OC_STACK_OK)
     {
-        OC_LOG_V(ERROR, TAG, PCF("OCProcessPresence error no %d"), result);
+        OC_LOG(ERROR, TAG, PCF("OCProcessPresence error"));
     }
     return result;
 }
@@ -2386,9 +2499,9 @@ OCStackResult OCStartPresence(const uint32_t ttl)
     {
         presenceState = OC_PRESENCE_INITIALIZED;
 
-        CAAddress_t addressInfo;
-        strncpy(addressInfo.IP.ipAddress, OC_MULTICAST_IP, CA_IPADDR_SIZE);
-        addressInfo.IP.port = OC_MULTICAST_PORT;
+        OCDevAddr devAddr = { OC_DEFAULT_ADAPTER };
+        OICStrcpy(devAddr.addr, sizeof(devAddr.addr), OC_MULTICAST_IP);
+        devAddr.port = OC_MULTICAST_PORT;
 
         CAToken_t caToken = NULL;
         CAResult_t caResult = CAGenerateToken(&caToken, tokenLength);
@@ -2399,11 +2512,8 @@ OCStackResult OCStartPresence(const uint32_t ttl)
             return OC_STACK_ERROR;
         }
 
-        CATransportType_t connType;
-        OCToCATransportType(OC_ALL, &connType );
-        AddObserver(OC_PRESENCE_URI, NULL, 0, caToken, tokenLength,
-                (OCResource *)presenceResource.handle, OC_LOW_QOS,
-                &addressInfo, connType);
+        AddObserver(OC_RSRVD_PRESENCE_URI, NULL, 0, caToken, tokenLength,
+                (OCResource *)presenceResource.handle, OC_LOW_QOS, &devAddr);
         CADestroyToken(caToken);
     }
 
@@ -2411,7 +2521,8 @@ OCStackResult OCStartPresence(const uint32_t ttl)
     // a different random 32-bit integer number is used
     ((OCResource *)presenceResource.handle)->sequenceNum = OCGetRandom();
 
-    return SendPresenceNotification(NULL);
+    return SendPresenceNotification(((OCResource *)presenceResource.handle)->rsrcType,
+            OC_PRESENCE_TRIGGER_CREATE);
 }
 
 OCStackResult OCStopPresence()
@@ -2421,12 +2532,12 @@ OCStackResult OCStopPresence()
     if(presenceResource.handle)
     {
         ((OCResource *)presenceResource.handle)->sequenceNum = OCGetRandom();
-    }
 
     // make resource inactive
     result = OCChangeResourceProperty(
             &(((OCResource *) presenceResource.handle)->resourceProperties),
             OC_ACTIVE, 0);
+    }
 
     if(result != OC_STACK_OK)
     {
@@ -2439,9 +2550,11 @@ OCStackResult OCStopPresence()
 }
 #endif
 
-OCStackResult OCSetDefaultDeviceEntityHandler(OCDeviceEntityHandler entityHandler)
+OCStackResult OCSetDefaultDeviceEntityHandler(OCDeviceEntityHandler entityHandler,
+                                            void* callbackParameter)
 {
     defaultDeviceHandler = entityHandler;
+    defaultDeviceHandlerCallbackParameter = callbackParameter;
 
     return OC_STACK_OK;
 }
@@ -2469,23 +2582,27 @@ OCStackResult OCSetPlatformInfo(OCPlatformInfo platformInfo)
 
 OCStackResult OCSetDeviceInfo(OCDeviceInfo deviceInfo)
 {
-    // TODO: Implement this.
-    OC_LOG(ERROR, TAG, "Implement OCSetDeviceInfo !!");
+    OC_LOG(INFO, TAG, PCF("Entering OCSetDeviceInfo"));
 
-    // Returning ok to make samples work.
-    return OC_STACK_OK;
+    if (!deviceInfo.deviceName || deviceInfo.deviceName[0] == '\0')
+    {
+        OC_LOG(ERROR, TAG, PCF("Null or empty device name."));
+        return OC_STACK_INVALID_PARAM;
+    }
+
+    return SaveDeviceInfo(deviceInfo);
 }
 
 OCStackResult OCCreateResource(OCResourceHandle *handle,
         const char *resourceTypeName,
         const char *resourceInterfaceName,
         const char *uri, OCEntityHandler entityHandler,
+        void* callbackParam,
         uint8_t resourceProperties)
 {
 
     OCResource *pointer = NULL;
     char *str = NULL;
-    size_t size = 0;
     OCStackResult result = OC_STACK_ERROR;
 
     OC_LOG(INFO, TAG, PCF("Entering OCCreateResource"));
@@ -2497,11 +2614,11 @@ OCStackResult OCCreateResource(OCResourceHandle *handle,
     // Validate parameters
     if(!uri || uri[0]=='\0' || strlen(uri)>=MAX_URI_LENGTH )
     {
-        OC_LOG(ERROR, TAG, PCF("URI is invalid"));
+        OC_LOG(ERROR, TAG, PCF("URI is empty or too long"));
         return OC_STACK_INVALID_URI;
     }
     // Is it presented during resource discovery?
-    if (!handle || !resourceTypeName)
+    if (!handle || !resourceTypeName || resourceTypeName[0] == '\0' )
     {
         OC_LOG(ERROR, TAG, PCF("Input parameter is NULL"));
         return OC_STACK_INVALID_PARAM;
@@ -2514,7 +2631,8 @@ OCStackResult OCCreateResource(OCResourceHandle *handle,
 
     // Make sure resourceProperties bitmask has allowed properties specified
     if (resourceProperties
-            > (OC_ACTIVE | OC_DISCOVERABLE | OC_OBSERVABLE | OC_SLOW | OC_SECURE))
+            > (OC_ACTIVE | OC_DISCOVERABLE | OC_OBSERVABLE | OC_SLOW | OC_SECURE |
+               OC_EXPLICIT_DISCOVERABLE))
     {
         OC_LOG(ERROR, TAG, PCF("Invalid property"));
         return OC_STACK_INVALID_PARAM;
@@ -2530,14 +2648,14 @@ OCStackResult OCCreateResource(OCResourceHandle *handle,
         {
             if (strncmp(uri, pointer->uri, MAX_URI_LENGTH) == 0)
             {
-                OC_LOG(ERROR, TAG, PCF("URI already in use"));
+                OC_LOG_V(ERROR, TAG, "Resource %s already exists", uri);
                 return OC_STACK_INVALID_PARAM;
             }
             pointer = pointer->next;
         }
     }
     // Create the pointer and insert it into the resource list
-    pointer = (OCResource *) OCCalloc(1, sizeof(OCResource));
+    pointer = (OCResource *) OICCalloc(1, sizeof(OCResource));
     if (!pointer)
     {
         result = OC_STACK_NO_MEMORY;
@@ -2548,14 +2666,12 @@ OCStackResult OCCreateResource(OCResourceHandle *handle,
     insertResource(pointer);
 
     // Set the uri
-    size = strlen(uri) + 1;
-    str = (char *) OCMalloc(size);
+    str = OICStrdup(uri);
     if (!str)
     {
         result = OC_STACK_NO_MEMORY;
         goto exit;
     }
-    strncpy(str, uri, size);
     pointer->uri = str;
 
     // Set properties.  Set OC_ACTIVE
@@ -2583,10 +2699,12 @@ OCStackResult OCCreateResource(OCResourceHandle *handle,
     if (entityHandler)
     {
         pointer->entityHandler = entityHandler;
+        pointer->entityHandlerCallbackParam = callbackParam;
     }
     else
     {
         pointer->entityHandler = defaultResourceEHandler;
+        pointer->entityHandlerCallbackParam = NULL;
     }
 
     *handle = pointer;
@@ -2596,7 +2714,7 @@ OCStackResult OCCreateResource(OCResourceHandle *handle,
     if(presenceResource.handle)
     {
         ((OCResource *)presenceResource.handle)->sequenceNum = OCGetRandom();
-        SendPresenceNotification(pointer->rsrcType);
+        SendPresenceNotification(pointer->rsrcType, OC_PRESENCE_TRIGGER_CREATE);
     }
     #endif
 exit:
@@ -2604,51 +2722,11 @@ exit:
     {
         // Deep delete of resource and other dynamic elements that it contains
         deleteResource(pointer);
-        OCFree(str);
+        OICFree(str);
     }
     return result;
 }
 
-OCStackResult OCCreateResourceWithHost(OCResourceHandle *handle,
-        const char *resourceTypeName,
-        const char *resourceInterfaceName,
-        const char *host,
-        const char *uri,
-        OCEntityHandler entityHandler,
-        uint8_t resourceProperties)
-{
-    OC_LOG(INFO, TAG, PCF("Entering OCCreateResourceWithHost"));
-    char *str = NULL;
-    size_t size = 0;
-
-    if(!host)
-    {
-        OC_LOG(ERROR, TAG, PCF("Added resource host is NULL."));
-        return OC_STACK_INVALID_PARAM;
-    }
-
-    OCStackResult result = OC_STACK_ERROR;
-
-    result = OCCreateResource(handle, resourceTypeName, resourceInterfaceName,
-                                uri, entityHandler, resourceProperties);
-
-    if (result == OC_STACK_OK)
-    {
-        // Set the uri
-        size = strlen(host) + 1;
-        str = (char *) OCMalloc(size);
-        if (!str)
-        {
-            OC_LOG(ERROR, TAG, PCF("Memory could not be allocated."));
-            return OC_STACK_NO_MEMORY;
-        }
-        strncpy(str, host, size);
-
-        ((OCResource *) *handle)->host = str;
-    }
-
-    return result;
-}
 
 OCStackResult OCBindResource(
         OCResourceHandle collectionHandle, OCResourceHandle resourceHandle)
@@ -2689,7 +2767,8 @@ OCStackResult OCBindResource(
             if(presenceResource.handle)
             {
                 ((OCResource *)presenceResource.handle)->sequenceNum = OCGetRandom();
-                SendPresenceNotification(((OCResource *) resourceHandle)->rsrcType);
+                SendPresenceNotification(((OCResource *) resourceHandle)->rsrcType,
+                        OC_PRESENCE_TRIGGER_CHANGE);
             }
             #endif
             return OC_STACK_OK;
@@ -2741,7 +2820,8 @@ OCStackResult OCUnBindResource(
             if(presenceResource.handle)
             {
                 ((OCResource *)presenceResource.handle)->sequenceNum = OCGetRandom();
-                SendPresenceNotification(((OCResource *) resourceHandle)->rsrcType);
+                SendPresenceNotification(((OCResource *) resourceHandle)->rsrcType,
+                        OC_PRESENCE_TRIGGER_CHANGE);
             }
             #endif
             return OC_STACK_OK;
@@ -2759,33 +2839,23 @@ OCStackResult BindResourceTypeToResource(OCResource* resource,
 {
     OCResourceType *pointer = NULL;
     char *str = NULL;
-    size_t size = 0;
     OCStackResult result = OC_STACK_ERROR;
 
-    OC_LOG(INFO, TAG, PCF("Entering BindResourceTypeToResource"));
-
-    // Validate parameters
     VERIFY_NON_NULL(resourceTypeName, ERROR, OC_STACK_INVALID_PARAM);
-    // TODO:  Does resource attribute representation really have to be maintained in stack?
-    // Is it presented during resource discovery?
 
-    // Create the resourcetype and insert it into the resource list
-    pointer = (OCResourceType *) OCCalloc(1, sizeof(OCResourceType));
+    pointer = (OCResourceType *) OICCalloc(1, sizeof(OCResourceType));
     if (!pointer)
     {
         result = OC_STACK_NO_MEMORY;
         goto exit;
     }
 
-    // Set the resourceTypeName
-    size = strlen(resourceTypeName) + 1;
-    str = (char *) OCMalloc(size);
+    str = OICStrdup(resourceTypeName);
     if (!str)
     {
         result = OC_STACK_NO_MEMORY;
         goto exit;
     }
-    strncpy(str, resourceTypeName, size);
     pointer->resourcetypename = str;
 
     insertResourceType(resource, pointer);
@@ -2794,8 +2864,8 @@ OCStackResult BindResourceTypeToResource(OCResource* resource,
     exit:
     if (result != OC_STACK_OK)
     {
-        OCFree(pointer);
-        OCFree(str);
+        OICFree(pointer);
+        OICFree(str);
     }
 
     return result;
@@ -2806,33 +2876,25 @@ OCStackResult BindResourceInterfaceToResource(OCResource* resource,
 {
     OCResourceInterface *pointer = NULL;
     char *str = NULL;
-    size_t size = 0;
     OCStackResult result = OC_STACK_ERROR;
 
-    OC_LOG(INFO, TAG, PCF("Entering BindResourceInterfaceToResource"));
-
-    // Validate parameters
     VERIFY_NON_NULL(resourceInterfaceName, ERROR, OC_STACK_INVALID_PARAM);
 
-    //TODO ("Make sure that the resourceinterface name doesn't already exist in the resource");
+    OC_LOG_V(INFO, TAG, "Binding %s interface to %s", resourceInterfaceName, resource->uri);
 
-    // Create the resourceinterface and insert it into the resource list
-    pointer = (OCResourceInterface *) OCCalloc(1, sizeof(OCResourceInterface));
+    pointer = (OCResourceInterface *) OICCalloc(1, sizeof(OCResourceInterface));
     if (!pointer)
     {
         result = OC_STACK_NO_MEMORY;
         goto exit;
     }
 
-    // Set the resourceinterface name
-    size = strlen(resourceInterfaceName) + 1;
-    str = (char *) OCMalloc(size);
+    str = OICStrdup(resourceInterfaceName);
     if (!str)
     {
         result = OC_STACK_NO_MEMORY;
         goto exit;
     }
-    strncpy(str, resourceInterfaceName, size);
     pointer->name = str;
 
     // Bind the resourceinterface to the resource
@@ -2843,8 +2905,8 @@ OCStackResult BindResourceInterfaceToResource(OCResource* resource,
     exit:
     if (result != OC_STACK_OK)
     {
-        OCFree(pointer);
-        OCFree(str);
+        OICFree(pointer);
+        OICFree(str);
     }
 
     return result;
@@ -2857,7 +2919,6 @@ OCStackResult OCBindResourceTypeToResource(OCResourceHandle handle,
     OCStackResult result = OC_STACK_ERROR;
     OCResource *resource = NULL;
 
-    // Make sure resource exists
     resource = findResource((OCResource *) handle);
     if (!resource)
     {
@@ -2865,14 +2926,13 @@ OCStackResult OCBindResourceTypeToResource(OCResourceHandle handle,
         return OC_STACK_ERROR;
     }
 
-    // call internal function
     result = BindResourceTypeToResource(resource, resourceTypeName);
 
     #ifdef WITH_PRESENCE
     if(presenceResource.handle)
     {
         ((OCResource *)presenceResource.handle)->sequenceNum = OCGetRandom();
-        SendPresenceNotification(resource->rsrcType);
+        SendPresenceNotification(resource->rsrcType, OC_PRESENCE_TRIGGER_CHANGE);
     }
     #endif
 
@@ -2886,7 +2946,6 @@ OCStackResult OCBindResourceInterfaceToResource(OCResourceHandle handle,
     OCStackResult result = OC_STACK_ERROR;
     OCResource *resource = NULL;
 
-    // Make sure resource exists
     resource = findResource((OCResource *) handle);
     if (!resource)
     {
@@ -2894,14 +2953,13 @@ OCStackResult OCBindResourceInterfaceToResource(OCResourceHandle handle,
         return OC_STACK_ERROR;
     }
 
-    // call internal function
     result = BindResourceInterfaceToResource(resource, resourceInterfaceName);
 
     #ifdef WITH_PRESENCE
     if(presenceResource.handle)
     {
         ((OCResource *)presenceResource.handle)->sequenceNum = OCGetRandom();
-        SendPresenceNotification(resource->rsrcType);
+        SendPresenceNotification(resource->rsrcType, OC_PRESENCE_TRIGGER_CHANGE);
     }
     #endif
 
@@ -2912,7 +2970,6 @@ OCStackResult OCGetNumberOfResources(uint8_t *numResources)
 {
     OCResource *pointer = headResource;
 
-    OC_LOG(INFO, TAG, PCF("Entering OCGetNumberOfResources"));
     VERIFY_NON_NULL(numResources, ERROR, OC_STACK_INVALID_PARAM);
     *numResources = 0;
     while (pointer)
@@ -2927,9 +2984,6 @@ OCResourceHandle OCGetResourceHandle(uint8_t index)
 {
     OCResource *pointer = headResource;
 
-    OC_LOG(INFO, TAG, PCF("Entering OCGetResourceHandle"));
-
-    // Iterate through the list
     for( uint8_t i = 0; i < index && pointer; ++i)
     {
         pointer = pointer->next;
@@ -2939,11 +2993,9 @@ OCResourceHandle OCGetResourceHandle(uint8_t index)
 
 OCStackResult OCDeleteResource(OCResourceHandle handle)
 {
-    OC_LOG(INFO, TAG, PCF("Entering OCDeleteResource"));
-
     if (!handle)
     {
-        OC_LOG(ERROR, TAG, PCF("Invalid param"));
+        OC_LOG(ERROR, TAG, PCF("Invalid handle for deletion"));
         return OC_STACK_INVALID_PARAM;
     }
 
@@ -2966,7 +3018,6 @@ OCStackResult OCDeleteResource(OCResourceHandle handle)
 const char *OCGetResourceUri(OCResourceHandle handle)
 {
     OCResource *resource = NULL;
-    OC_LOG(INFO, TAG, PCF("Entering OCGetResourceUri"));
 
     resource = findResource((OCResource *) handle);
     if (resource)
@@ -2979,7 +3030,6 @@ const char *OCGetResourceUri(OCResourceHandle handle)
 OCResourceProperty OCGetResourceProperties(OCResourceHandle handle)
 {
     OCResource *resource = NULL;
-    OC_LOG(INFO, TAG, PCF("Entering OCGetResourceProperties"));
 
     resource = findResource((OCResource *) handle);
     if (resource)
@@ -2995,7 +3045,6 @@ OCStackResult OCGetNumberOfResourceTypes(OCResourceHandle handle,
     OCResource *resource = NULL;
     OCResourceType *pointer = NULL;
 
-    OC_LOG(INFO, TAG, PCF("Entering OCGetNumberOfResourceTypes"));
     VERIFY_NON_NULL(numResourceTypes, ERROR, OC_STACK_INVALID_PARAM);
     VERIFY_NON_NULL(handle, ERROR, OC_STACK_INVALID_PARAM);
 
@@ -3018,8 +3067,6 @@ const char *OCGetResourceTypeName(OCResourceHandle handle, uint8_t index)
 {
     OCResourceType *resourceType = NULL;
 
-    OC_LOG(INFO, TAG, PCF("Entering OCGetResourceTypeName"));
-
     resourceType = findResourceTypeAtIndex(handle, index);
     if (resourceType)
     {
@@ -3034,8 +3081,6 @@ OCStackResult OCGetNumberOfResourceInterfaces(OCResourceHandle handle,
     OCResourceInterface *pointer = NULL;
     OCResource *resource = NULL;
 
-    OC_LOG(INFO, TAG, PCF("Entering OCGetNumberOfResourceInterfaces"));
-
     VERIFY_NON_NULL(handle, ERROR, OC_STACK_INVALID_PARAM);
     VERIFY_NON_NULL(numResourceInterfaces, ERROR, OC_STACK_INVALID_PARAM);
 
@@ -3057,8 +3102,6 @@ const char *OCGetResourceInterfaceName(OCResourceHandle handle, uint8_t index)
 {
     OCResourceInterface *resourceInterface = NULL;
 
-    OC_LOG(INFO, TAG, PCF("Entering OCGetResourceInterfaceName"));
-
     resourceInterface = findResourceInterfaceAtIndex(handle, index);
     if (resourceInterface)
     {
@@ -3072,8 +3115,6 @@ OCResourceHandle OCGetResourceHandleFromCollection(OCResourceHandle collectionHa
 {
     OCResource *resource = NULL;
 
-    OC_LOG(INFO, TAG, PCF("Entering OCGetContainedResource"));
-
     if (index >= MAX_CONTAINED_RESOURCES)
     {
         return NULL;
@@ -3089,12 +3130,11 @@ OCResourceHandle OCGetResourceHandleFromCollection(OCResourceHandle collectionHa
 }
 
 OCStackResult OCBindResourceHandler(OCResourceHandle handle,
-        OCEntityHandler entityHandler)
+        OCEntityHandler entityHandler,
+        void* callbackParam)
 {
     OCResource *resource = NULL;
 
-    OC_LOG(INFO, TAG, PCF("Entering OCBindResourceHandler"));
-
     // Validate parameters
     VERIFY_NON_NULL(handle, ERROR, OC_STACK_INVALID_PARAM);
 
@@ -3108,12 +3148,13 @@ OCStackResult OCBindResourceHandler(OCResourceHandle handle,
 
     // Bind the handler
     resource->entityHandler = entityHandler;
+    resource->entityHandlerCallbackParam = callbackParam;
 
     #ifdef WITH_PRESENCE
     if(presenceResource.handle)
     {
         ((OCResource *)presenceResource.handle)->sequenceNum = OCGetRandom();
-        SendPresenceNotification(resource->rsrcType);
+        SendPresenceNotification(resource->rsrcType, OC_PRESENCE_TRIGGER_CHANGE);
     }
     #endif
 
@@ -3124,9 +3165,6 @@ OCEntityHandler OCGetResourceHandler(OCResourceHandle handle)
 {
     OCResource *resource = NULL;
 
-    OC_LOG(INFO, TAG, PCF("Entering OCGetResourceHandler"));
-
-    // Use the handle to find the resource in the resource linked list
     resource = findResource((OCResource *)handle);
     if (!resource)
     {
@@ -3150,7 +3188,8 @@ void incrementSequenceNumber(OCResource * resPtr)
 }
 
 #ifdef WITH_PRESENCE
-OCStackResult SendPresenceNotification(OCResourceType *resourceType)
+OCStackResult SendPresenceNotification(OCResourceType *resourceType,
+        OCPresenceTrigger trigger)
 {
     OCResource *resPtr = NULL;
     OCStackResult result = OC_STACK_ERROR;
@@ -3166,7 +3205,8 @@ OCStackResult SendPresenceNotification(OCResourceType *resourceType)
     {
         maxAge = presenceResource.presenceTTL;
 
-        result = SendAllObserverNotification(method, resPtr, maxAge, resourceType, OC_LOW_QOS);
+        result = SendAllObserverNotification(method, resPtr, maxAge,
+                trigger, resourceType, OC_LOW_QOS);
     }
 
     return result;
@@ -3184,7 +3224,8 @@ OCStackResult SendStopNotification()
     }
 
     // maxAge is 0. ResourceType is NULL.
-    result = SendAllObserverNotification(method, resPtr, 0, NULL, OC_LOW_QOS);
+    result = SendAllObserverNotification(method, resPtr, 0, OC_PRESENCE_TRIGGER_DELETE,
+            NULL, OC_LOW_QOS);
 
     return result;
 }
@@ -3192,15 +3233,12 @@ OCStackResult SendStopNotification()
 #endif // WITH_PRESENCE
 OCStackResult OCNotifyAllObservers(OCResourceHandle handle, OCQualityOfService qos)
 {
-
-    OC_LOG(INFO, TAG, PCF("Entering OCNotifyAllObservers"));
-
     OCResource *resPtr = NULL;
     OCStackResult result = OC_STACK_ERROR;
     OCMethod method = OC_REST_NOMETHOD;
     uint32_t maxAge = 0;
 
-    OC_LOG(INFO, TAG, PCF("Entering OCNotifyAllObservers"));
+    OC_LOG(INFO, TAG, PCF("Notifying all observers"));
     #ifdef WITH_PRESENCE
     if(handle == presenceResource.handle)
     {
@@ -3222,7 +3260,8 @@ OCStackResult OCNotifyAllObservers(OCResourceHandle handle, OCQualityOfService q
         method = OC_REST_OBSERVE;
         maxAge = MAX_OBSERVE_AGE;
         #ifdef WITH_PRESENCE
-        result = SendAllObserverNotification (method, resPtr, maxAge, NULL, qos);
+        result = SendAllObserverNotification (method, resPtr, maxAge,
+                OC_PRESENCE_TRIGGER_DELETE, NULL, qos);
         #else
         result = SendAllObserverNotification (method, resPtr, maxAge, qos);
         #endif
@@ -3234,7 +3273,7 @@ OCStackResult
 OCNotifyListOfObservers (OCResourceHandle handle,
                          OCObservationId  *obsIdList,
                          uint8_t          numberOfIds,
-                         const char       *notificationJSONPayload,
+                         const OCRepPayload       *payload,
                          OCQualityOfService qos)
 {
     OC_LOG(INFO, TAG, PCF("Entering OCNotifyListOfObservers"));
@@ -3245,9 +3284,8 @@ OCNotifyListOfObservers (OCResourceHandle handle,
 
     VERIFY_NON_NULL(handle, ERROR, OC_STACK_ERROR);
     VERIFY_NON_NULL(obsIdList, ERROR, OC_STACK_ERROR);
-    VERIFY_NON_NULL(notificationJSONPayload, ERROR, OC_STACK_ERROR);
+    VERIFY_NON_NULL(payload, ERROR, OC_STACK_ERROR);
 
-    // Verify that the resource exists
     resPtr = findResource ((OCResource *) handle);
     if (NULL == resPtr || myStackMode == OC_CLIENT)
     {
@@ -3258,7 +3296,7 @@ OCNotifyListOfObservers (OCResourceHandle handle,
         incrementSequenceNumber(resPtr);
     }
     return (SendListObserverNotification(resPtr, obsIdList, numberOfIds,
-            notificationJSONPayload, maxAge, qos));
+            payload, maxAge, qos));
 }
 
 OCStackResult OCDoResponse(OCEntityHandlerResponse *ehResponse)
@@ -3272,35 +3310,15 @@ OCStackResult OCDoResponse(OCEntityHandlerResponse *ehResponse)
     VERIFY_NON_NULL(ehResponse, ERROR, OC_STACK_INVALID_PARAM);
     VERIFY_NON_NULL(ehResponse->requestHandle, ERROR, OC_STACK_INVALID_PARAM);
 
-    // TODO: Placeholder for creating a response entry when implementing
-    // block transfer feature
-
-    // If a response payload is present, check if block transfer is required
-    if (ehResponse->payload && OCIsPacketTransferRequired(NULL,
-            (const char *)ehResponse->payload, ehResponse->payloadSize))
+    // Normal response
+    // Get pointer to request info
+    serverRequest = GetServerRequestUsingHandle((OCServerRequest *)ehResponse->requestHandle);
+    if(serverRequest)
     {
-        OC_LOG(INFO, TAG, PCF("Block transfer required"));
-
-        // Persistent response buffer is needed for block transfer
-        if (!ehResponse->persistentBufferFlag)
-        {
-            OC_LOG(WARNING, TAG, PCF("Persistent response buffer required"));
-            return OC_STACK_PERSISTENT_BUFFER_REQUIRED;
-        }
-        // TODO: Placeholder for block transfer handling
-        // TODO: Placeholder for setting the the response handle in the OCServerResponse struct
-            // when implementing the block transfer feature
-    }
-    else
-    {
-        // Normal response
-        // Get pointer to request info
-        serverRequest = GetServerRequestUsingHandle((OCServerRequest *)ehResponse->requestHandle);
-        if(serverRequest)
-        {
-            result = serverRequest->ehResponseHandler(ehResponse);
-        }
+        // response handler in ocserverrequest.c. Usually HandleSingleResponse.
+        result = serverRequest->ehResponseHandler(ehResponse);
     }
+
     return result;
 }
 
@@ -3311,7 +3329,7 @@ static OCDoHandle GenerateInvocationHandle()
 {
     OCDoHandle handle = NULL;
     // Generate token here, it will be deleted when the transaction is deleted
-    handle = (OCDoHandle) OCMalloc(sizeof(uint8_t[CA_MAX_TOKEN_LEN]));
+    handle = (OCDoHandle) OICMalloc(sizeof(uint8_t[CA_MAX_TOKEN_LEN]));
     if (handle)
     {
         OCFillRandomMem((uint8_t*)handle, sizeof(uint8_t[CA_MAX_TOKEN_LEN]));
@@ -3349,17 +3367,18 @@ OCStackResult OCChangeResourceProperty(OCResourceProperty * inputProperty,
 OCStackResult initResources()
 {
     OCStackResult result = OC_STACK_OK;
-    // Init application resource vars
+
     headResource = NULL;
     tailResource = NULL;
     // Init Virtual Resources
     #ifdef WITH_PRESENCE
     presenceResource.presenceTTL = OC_DEFAULT_PRESENCE_TTL_SECONDS;
-    //presenceResource.token = OCGenerateCoAPToken();
+
     result = OCCreateResource(&presenceResource.handle,
             OC_RSRVD_RESOURCE_TYPE_PRESENCE,
             "core.r",
-            OC_PRESENCE_URI,
+            OC_RSRVD_PRESENCE_URI,
+            NULL,
             NULL,
             OC_OBSERVABLE);
     //make resource inactive
@@ -3367,6 +3386,12 @@ OCStackResult initResources()
             &(((OCResource *) presenceResource.handle)->resourceProperties),
             OC_ACTIVE, 0);
     #endif
+
+    if (result == OC_STACK_OK)
+    {
+        result = SRMInitSecureResources();
+    }
+
     return result;
 }
 
@@ -3419,6 +3444,8 @@ void deleteAllResources()
         pointer = temp;
     }
 
+    SRMDeInitSecureResources();
+
     #ifdef WITH_PRESENCE
     // Ensure that the last resource to be deleted is the presence resource. This allows for all
     // presence notification attributed to their deletion to be processed.
@@ -3430,6 +3457,13 @@ OCStackResult deleteResource(OCResource *resource)
 {
     OCResource *prev = NULL;
     OCResource *temp = NULL;
+    if(!resource)
+    {
+        OC_LOG_V(DEBUG,TAG,"resource is NULL");
+        return OC_STACK_INVALID_PARAM;
+    }
+
+    OC_LOG_V (INFO, TAG, "Deleting resource %s", resource->uri);
 
     temp = headResource;
     while (temp)
@@ -3449,14 +3483,7 @@ OCStackResult deleteResource(OCResource *resource)
             if(presenceResource.handle)
             {
                 ((OCResource *)presenceResource.handle)->sequenceNum = OCGetRandom();
-                if(resource != (OCResource *) presenceResource.handle)
-                {
-                    SendPresenceNotification(resource->rsrcType);
-                }
-                else
-                {
-                    SendPresenceNotification(NULL);
-                }
+                SendPresenceNotification(resource->rsrcType, OC_PRESENCE_TRIGGER_DELETE);
             }
             #endif
             // Only resource in list.
@@ -3482,7 +3509,7 @@ OCStackResult deleteResource(OCResource *resource)
             }
 
             deleteResourceElements(temp);
-            OCFree(temp);
+            OICFree(temp);
             return OC_STACK_OK;
         }
         else
@@ -3502,13 +3529,8 @@ void deleteResourceElements(OCResource *resource)
         return;
     }
 
-    // remove URI
-    OCFree(resource->uri);
-
-    // Delete resourcetype linked list
+    OICFree(resource->uri);
     deleteResourceType(resource->rsrcType);
-
-    // Delete resourceinterface linked list
     deleteResourceInterface(resource->rsrcInterface);
 }
 
@@ -3520,8 +3542,8 @@ void deleteResourceType(OCResourceType *resourceType)
     while (pointer)
     {
         next = pointer->next;
-        OCFree(pointer->resourcetypename);
-        OCFree(pointer);
+        OICFree(pointer->resourcetypename);
+        OICFree(pointer);
         pointer = next;
     }
 }
@@ -3534,8 +3556,8 @@ void deleteResourceInterface(OCResourceInterface *resourceInterface)
     while (pointer)
     {
         next = pointer->next;
-        OCFree(pointer->name);
-        OCFree(pointer);
+        OICFree(pointer->name);
+        OICFree(pointer);
         pointer = next;
     }
 }
@@ -3559,11 +3581,11 @@ void insertResourceType(OCResource *resource, OCResourceType *resourceType)
 
         while (pointer)
         {
-            // resource type already exists. Free 2nd arg and return.
             if (!strcmp(resourceType->resourcetypename, pointer->resourcetypename))
             {
-                OCFree(resourceType->resourcetypename);
-                OCFree(resourceType);
+                OC_LOG_V(INFO, TAG, "Type %s already exists", resourceType->resourcetypename);
+                OICFree(resourceType->resourcetypename);
+                OICFree(resourceType);
                 return;
             }
             previous = pointer;
@@ -3572,6 +3594,8 @@ void insertResourceType(OCResource *resource, OCResourceType *resourceType)
         previous->next = resourceType;
     }
     resourceType->next = NULL;
+
+    OC_LOG_V(INFO, TAG, "Added type %s to %s", resourceType->resourcetypename, resource->uri);
 }
 
 OCResourceType *findResourceTypeAtIndex(OCResourceHandle handle, uint8_t index)
@@ -3643,8 +3667,8 @@ void insertResourceInterface(OCResource *resource, OCResourceInterface *newInter
     {
         if (strcmp((*firstInterface)->name, OC_RSRVD_INTERFACE_DEFAULT) == 0)
         {
-            OCFree(newInterface->name);
-            OCFree(newInterface);
+            OICFree(newInterface->name);
+            OICFree(newInterface);
             return;
         }
         else
@@ -3660,8 +3684,8 @@ void insertResourceInterface(OCResource *resource, OCResourceInterface *newInter
         {
             if (strcmp(newInterface->name, pointer->name) == 0)
             {
-                OCFree(newInterface->name);
-                OCFree(newInterface);
+                OICFree(newInterface->name);
+                OICFree(newInterface);
                 return;
             }
             previous = pointer;
@@ -3700,58 +3724,6 @@ OCResourceInterface *findResourceInterfaceAtIndex(OCResourceHandle handle,
     return pointer;
 }
 
-bool OCIsPacketTransferRequired(const char *request, const char *response, size_t size)
-{
-    bool result = false;
-
-    // Determine if we are checking a request or a response
-    if (request)
-    {
-        // If size is greater than 0, use it for the request size value, otherwise
-        // assume request is null terminated and use strlen for size value
-        if ((size > MAX_REQUEST_LENGTH) || (strlen(request) > MAX_REQUEST_LENGTH))
-        {
-            result = true;
-        }
-    }
-    else if (response)
-    {
-        // If size is greater than 0, use it for the response size value, otherwise
-        // assume response is null terminated and use strlen for size value
-        if ((size > MAX_RESPONSE_LENGTH) || (strlen(response) > MAX_RESPONSE_LENGTH))
-        {
-            result = true;
-        }
-    }
-    return result;
-}
-
-OCStackResult getResourceType(const char * query, char** resourceType)
-{
-    if(!query)
-    {
-        return OC_STACK_INVALID_PARAM;
-    }
-
-    OCStackResult result = OC_STACK_ERROR;
-
-    if(strncmp(query, "rt=", 3) == 0)
-    {
-        *resourceType = (char *) OCMalloc(strlen(query)-3 + 1);
-        if(!*resourceType)
-        {
-            result = OC_STACK_NO_MEMORY;
-        }
-        else
-        {
-            strcpy((char *)*resourceType, ((const char *)&query[3]));
-            result = OC_STACK_OK;
-        }
-    }
-
-    return result;
-}
-
 /*
  * This function splits the uri using the '?' delimiter.
  * "uriWithoutQuery" is the block of characters between the beginning
@@ -3790,28 +3762,23 @@ OCStackResult getQueryFromUri(const char * uri, char** query, char ** uriWithout
 
     if (uriWithoutQueryLen)
     {
-        *uriWithoutQuery =  (char *) OCCalloc(uriWithoutQueryLen + 1, 1);
+        *uriWithoutQuery =  (char *) OICCalloc(uriWithoutQueryLen + 1, 1);
         if (!*uriWithoutQuery)
         {
             goto exit;
         }
-        strncpy(*uriWithoutQuery, uri, uriWithoutQueryLen);
-    }
-    else
-    {
-        return OC_STACK_INVALID_PARAM;
+        OICStrcpy(*uriWithoutQuery, uriWithoutQueryLen +1, uri);
     }
-
     if (queryLen)
     {
-        *query = (char *) OCCalloc(queryLen + 1, 1);
+        *query = (char *) OICCalloc(queryLen + 1, 1);
         if (!*query)
         {
-            OCFree(*uriWithoutQuery);
+            OICFree(*uriWithoutQuery);
             *uriWithoutQuery = NULL;
             goto exit;
         }
-        strncpy(*query, pointerToDelimiter + 1, queryLen);
+        OICStrcpy(*query, queryLen + 1, pointerToDelimiter + 1);
     }
 
     return OC_STACK_OK;
@@ -3860,45 +3827,20 @@ const char* OCGetServerInstanceIDString(void)
     return sidStr;
 }
 
-int32_t OCDevAddrToIPv4Addr(OCDevAddr *ipAddr, uint8_t *a, uint8_t *b,
-        uint8_t *c, uint8_t *d )
-{
-    if ( !ipAddr || !a || !b || !c || !d )
-    {
-        OC_LOG(FATAL, TAG, PCF("Invalid argument"));
-        return OC_STACK_INVALID_PARAM;
-    }
-
-    *a = ipAddr->addr[0];
-    *b = ipAddr->addr[1];
-    *c = ipAddr->addr[2];
-    *d = ipAddr->addr[3];
-
-    return OC_STACK_OK;
-}
-
-int32_t OCDevAddrToPort(OCDevAddr *ipAddr, uint16_t *port)
-{
-    if ( !ipAddr || !port )
-    {
-        OC_LOG(FATAL, TAG, PCF("Invalid argument"));
-        return OC_STACK_INVALID_PARAM;
-    }
-
-    *port = (ipAddr->addr[5]<< 8) | ipAddr->addr[4];
-
-    return OC_STACK_OK;
-}
-
 CAResult_t OCSelectNetwork()
 {
     CAResult_t retResult = CA_STATUS_FAILED;
     CAResult_t caResult = CA_STATUS_OK;
 
-    CATransportType_t connTypes[] = {
-            CA_IPV4,
-            CA_EDR,
-            CA_LE};
+    CATransportAdapter_t connTypes[] = {
+            CA_ADAPTER_IP,
+            CA_ADAPTER_RFCOMM_BTEDR,
+            CA_ADAPTER_GATT_BTLE
+
+            #ifdef RA_ADAPTER
+            ,CA_ADAPTER_REMOTE_ACCESS
+            #endif
+        };
     int numConnTypes = sizeof(connTypes)/sizeof(connTypes[0]);
 
     for(int i = 0; i<numConnTypes; i++)