1
0
mirror of https://github.com/RIOT-OS/RIOT.git synced 2024-12-29 04:50:03 +01:00
RIOT/pkg/wakaama/contrib/objects/common.c

462 lines
16 KiB
C

/*
* Copyright (C) 2021 HAW Hamburg
*
* This file is subject to the terms and conditions of the GNU Lesser
* General Public License v2.1. See the file LICENSE in the top level
* directory for more details.
*/
/**
* @{
* @ingroup lwm2m_objects_common
*
* @file
* @brief Common functionalities to interact with LwM2M objects
*
* @author Leandro Lanzieri <leandro.lanzieri@haw-hamburg.de>
* @}
*/
#include "liblwm2m.h"
#include "lwm2m_client.h"
#include "objects/common.h"
#define ENABLE_DEBUG 0
#include "debug.h"
/**
* @brief Auxiliary structure to hold pointers that form an object link data type.
*/
typedef struct {
uint16_t *object_id; /**< pointer to object ID */
uint16_t *instance_id; /**< pointer to instance ID */
} _objlink_t;
/**
* @brief Get data of a given type from an object's instance.
*
* @param[in] client_data Pointer to the LwM2M client data.
* @param[in] uri Initialized URI structure specifying the resource to get.
* @param[in] expected_type Type of data that is expected from the specified resource.
* @param[out] out Pointer where to store the data.
* @param[in, out] out_len Length of @p out, returns the amount of read bytes.
*
* @retval 0 on success
* @retval -ENOMEM when there is not enough space in buffer or can not allocate a data structure
* @retval -ENOENT when the resource is not found
* @retval -EINVAL when the resource cannot be read or has an unexpected type
* @retval -ENOTSUP when the resource expected type is not known
*/
static int _get_resource_data(lwm2m_client_data_t *client_data, const lwm2m_uri_t *uri,
lwm2m_data_type_t expected_type, void *out, size_t *out_len)
{
assert(client_data);
assert(uri);
assert(out);
assert(out_len);
int result = 0;
int data_num = 1;
lwm2m_data_t *data = NULL;
/* try to find the requested object */
lwm2m_object_t *object = lwm2m_get_object_by_id(client_data, uri->objectId);
if (!object || !object->readFunc) {
DEBUG("[lwm2m:get_data] could not find object with ID %d\n", uri->objectId);
result = -ENOENT;
goto out;
}
/* prepare a new data structure */
data = lwm2m_data_new(1);
if (!data) {
DEBUG("[lwm2m:get_data] could not allocate data structure\n");
result = -ENOMEM;
goto out;
}
data->id = uri->resourceId;
/* read the resource from the specified instance */
uint8_t res = object->readFunc(client_data->lwm2m_ctx, uri->instanceId, &data_num, &data, object);
if (res != COAP_205_CONTENT || data->type != expected_type) {
result = -EINVAL;
goto out;
}
/* process the data according to the type */
switch (expected_type) {
case LWM2M_TYPE_INTEGER:
*(int64_t *)out = data->value.asInteger;
*out_len = sizeof(int64_t);
break;
case LWM2M_TYPE_FLOAT:
*(double *)out = data->value.asFloat;
*out_len = sizeof(double);
break;
case LWM2M_TYPE_BOOLEAN:
*(bool *)out = data->value.asBoolean;
*out_len = sizeof(bool);
break;
case LWM2M_TYPE_OBJECT_LINK:
{
_objlink_t *_out = (_objlink_t *)out;
*_out->object_id = data->value.asObjLink.objectId;
*_out->instance_id = data->value.asObjLink.objectInstanceId;
*out_len = sizeof(_objlink_t);
break;
}
case LWM2M_TYPE_STRING:
case LWM2M_TYPE_OPAQUE:
if (data->value.asBuffer.length > *out_len) {
DEBUG("[lwm2m:get_data] not enough space in buffer\n");
result = -ENOMEM;
}
else {
memcpy(out, data->value.asBuffer.buffer, data->value.asBuffer.length);
*out_len = data->value.asBuffer.length;
}
break;
default:
DEBUG("[lwm2m:get_data] not supported type\n");
result = -ENOTSUP;
break;
}
out:
if (data) {
lwm2m_data_free(1, data);
}
return result;
}
/**
* @brief Get the value of a resource, specified by a path @p path.
*
* Convenience function to call @ref _get_resource_data with a string representing the resource's
* path.
*
* @param[in] client_data Pointer to the LwM2M client data.
* @param[in] path Array containing the path to the resource to get.
* @param[in] path_len Length of @p path.
* @param[in] expected_type Type of data that is expected from the specified resource.
* @param[out] out Pointer where to store the data.
* @param[in, out] out_len Length of @p out, returns the amount of read bytes.
*
* @retval 0 on success
* @retval -EINVAL if the path is malformed, the resource cannot be read or has an unexpected type
* @retval -ENOMEM when there is not enough space in buffer or can not allocate a data structure
* @retval -ENOENT when the resource is not found
*/
static int _get_resource_data_by_path(lwm2m_client_data_t *client_data, const char *path,
size_t path_len, lwm2m_data_type_t expected_type, void *out,
size_t *out_len)
{
assert(path);
lwm2m_uri_t uri;
if (!lwm2m_stringToUri(path, path_len, &uri)) {
DEBUG("[lwm2m:get_resource] malformed path\n");
return -EINVAL;
}
return _get_resource_data(client_data, &uri, expected_type, out, out_len);
}
/**
* @brief Set data of a given type to an object's instance.
*
* @param[in] client_data Pointer to the LwM2M client data.
* @param[in] uri Initialized URI structure specifying the resource to set.
* @param[in] type Type of data of the specified resource.
* @param[in] in Pointer to the data to set.
* @param[in] in_len Length of @p in.
*
* @retval 0 on success
* @retval -ENOMEM when data structure can not be allocated
* @retval -ENOENT when the resource is not found
* @retval -ENOTSUP when the resource type is not known
* @retval -EINVAL when the value can not be set
*/
static int _set_resource_data(lwm2m_client_data_t *client_data, const lwm2m_uri_t *uri,
lwm2m_data_type_t type, void *in, size_t in_len)
{
assert(client_data);
assert(uri);
assert(in);
int result = 0;
lwm2m_data_t *data = NULL;
/* try to find the requested object */
lwm2m_object_t *object = lwm2m_get_object_by_id(client_data, uri->objectId);
if (!object || !object->writeFunc) {
DEBUG("[lwm2m:get_data] could not find object with ID %d\n", uri->objectId);
result = -ENOENT;
goto out;
}
/* prepare a new data structure */
data = lwm2m_data_new(1);
if (!data) {
DEBUG("[lwm2m:set_data] could not allocate data structure\n");
result = -ENOMEM;
goto out;
}
data->id = uri->resourceId;
data->type = type;
/* prepare the data according to the type */
switch (type) {
case LWM2M_TYPE_INTEGER:
data->value.asInteger = *(int64_t *)in;
break;
case LWM2M_TYPE_FLOAT:
data->value.asFloat = *(double *)in;
break;
case LWM2M_TYPE_BOOLEAN:
data->value.asBoolean = *(bool *)in;
break;
case LWM2M_TYPE_OBJECT_LINK:
{
_objlink_t *_in = (_objlink_t *)in;
data->value.asObjLink.objectId = *_in->object_id;
data->value.asObjLink.objectInstanceId = *_in->instance_id;
break;
}
case LWM2M_TYPE_STRING:
case LWM2M_TYPE_OPAQUE:
data->value.asBuffer.length = in_len;
data->value.asBuffer.buffer = in;
break;
default:
DEBUG("[lwm2m:get_data] not supported type\n");
result = -ENOTSUP;
goto out;
break;
}
/* write the resource of the specified instance */
uint8_t res = object->writeFunc(client_data->lwm2m_ctx, uri->instanceId, 1, data, object, LWM2M_WRITE_PARTIAL_UPDATE);
lwm2m_resource_value_changed(client_data->lwm2m_ctx, uri);
if (res != COAP_204_CHANGED) {
result = -EINVAL;
}
out:
if (data) {
/* NOTE: lwm2m_data_free will try to free strings and opaques if set, assuming they were
allocated, so empty the pointer first */
if (type == LWM2M_TYPE_STRING || type == LWM2M_TYPE_OPAQUE) {
data->value.asBuffer.buffer = NULL;
}
lwm2m_data_free(1, data);
}
return result;
}
/**
* @brief Set the value of a string-type resource, specified by a path @p path.
*
* Convenience function to call @ref _set_resource_data with a string representing the resource's
* path.
*
* @param[in] client_data Pointer to the LwM2M client data.
* @param[in] path Array containing the path to the resource to get.
* @param[in] path_len Length of @p path.
* @param[in] expected_type Type of data that is expected from the specified resource.
* @param[in] in Pointer where to store the data.
* @param[in] in_len Length of @p out.
*
* @retval 0 on success
* @retval -EINVAL when the path is malformed, the value can not be set
* @retval -ENOENT when the resource is not found
* @retval -ENOTSUP when the resource type is not known
* @retval -ENOMEM when data structure can not be allocated
*/
static int _set_resource_data_by_path(lwm2m_client_data_t *client_data, const char *path,
size_t path_len, lwm2m_data_type_t type, void *in,
size_t in_len)
{
assert(path);
lwm2m_uri_t uri;
if (!lwm2m_stringToUri(path, path_len, &uri)) {
DEBUG("[lwm2m:set_resource] malformed path\n");
return -EINVAL;
}
return _set_resource_data(client_data, &uri, type, in, in_len);
}
int lwm2m_get_string(lwm2m_client_data_t *client_data, const lwm2m_uri_t *uri, char *out,
size_t *out_len)
{
return _get_resource_data(client_data, uri, LWM2M_TYPE_STRING, out, out_len);
}
int lwm2m_get_opaque(lwm2m_client_data_t *client_data, const lwm2m_uri_t *uri, uint8_t *out,
size_t *out_len)
{
return _get_resource_data(client_data, uri, LWM2M_TYPE_OPAQUE, out, out_len);
}
int lwm2m_get_int(lwm2m_client_data_t *client_data, const lwm2m_uri_t *uri, int64_t *out)
{
size_t len = sizeof(int64_t);
return _get_resource_data(client_data, uri, LWM2M_TYPE_INTEGER, out, &len);
}
int lwm2m_get_float(lwm2m_client_data_t *client_data, const lwm2m_uri_t *uri, double *out)
{
size_t len = sizeof(double);
return _get_resource_data(client_data, uri, LWM2M_TYPE_FLOAT, out, &len);
}
int lwm2m_get_bool(lwm2m_client_data_t *client_data, const lwm2m_uri_t *uri, bool *out)
{
size_t len = sizeof(bool);
return _get_resource_data(client_data, uri, LWM2M_TYPE_BOOLEAN, out, &len);
}
int lwm2m_get_objlink(lwm2m_client_data_t *client_data, const lwm2m_uri_t *uri,
uint16_t *object_id_out, uint16_t *instance_id_out)
{
assert(object_id_out);
assert(instance_id_out);
_objlink_t link = { .object_id = object_id_out, .instance_id = instance_id_out };
size_t len = sizeof(_objlink_t);
return _get_resource_data(client_data, uri, LWM2M_TYPE_OBJECT_LINK, &link, &len);
}
int lwm2m_get_string_by_path(lwm2m_client_data_t *client_data, const char *path, size_t path_len,
char *out, size_t *out_len)
{
return _get_resource_data_by_path(client_data, path, path_len, LWM2M_TYPE_STRING, out, out_len);
}
int lwm2m_get_opaque_by_path(lwm2m_client_data_t *client_data, const char *path, size_t path_len,
uint8_t *out, size_t *out_len)
{
return _get_resource_data_by_path(client_data, path, path_len, LWM2M_TYPE_OPAQUE, out, out_len);
}
int lwm2m_get_int_by_path(lwm2m_client_data_t *client_data, const char *path, size_t path_len,
int64_t *out)
{
size_t len = sizeof(int64_t);
return _get_resource_data_by_path(client_data, path, path_len, LWM2M_TYPE_INTEGER, out, &len);
}
int lwm2m_get_float_by_path(lwm2m_client_data_t *client_data, const char *path, size_t path_len,
double *out)
{
size_t len = sizeof(double);
return _get_resource_data_by_path(client_data, path, path_len, LWM2M_TYPE_FLOAT, out, &len);
}
int lwm2m_get_bool_by_path(lwm2m_client_data_t *client_data, const char *path, size_t path_len,
bool *out)
{
size_t len = sizeof(bool);
return _get_resource_data_by_path(client_data, path, path_len, LWM2M_TYPE_BOOLEAN, out, &len);
}
int lwm2m_get_objlink_by_path(lwm2m_client_data_t *client_data, const char *path, size_t path_len,
uint16_t *object_id_out, uint16_t *instance_id_out)
{
assert(object_id_out);
assert(instance_id_out);
_objlink_t link = { .object_id = object_id_out, .instance_id = instance_id_out };
size_t len = sizeof(_objlink_t);
return _get_resource_data_by_path(client_data, path, path_len, LWM2M_TYPE_OBJECT_LINK, &link,
&len);
}
int lwm2m_set_string(lwm2m_client_data_t *client_data, const lwm2m_uri_t *uri, char *val,
size_t val_len)
{
return _set_resource_data(client_data, uri, LWM2M_TYPE_STRING, val, val_len);
}
int lwm2m_set_opaque(lwm2m_client_data_t *client_data, const lwm2m_uri_t *uri, uint8_t *val,
size_t val_len)
{
return _set_resource_data(client_data, uri, LWM2M_TYPE_OPAQUE, val, val_len);
}
int lwm2m_set_int(lwm2m_client_data_t *client_data, const lwm2m_uri_t *uri, int64_t val)
{
return _set_resource_data(client_data, uri, LWM2M_TYPE_INTEGER, &val, sizeof(int64_t));
}
int lwm2m_set_float(lwm2m_client_data_t *client_data, const lwm2m_uri_t *uri, double val)
{
return _set_resource_data(client_data, uri, LWM2M_TYPE_FLOAT, &val, sizeof(double));
}
int lwm2m_set_bool(lwm2m_client_data_t *client_data, const lwm2m_uri_t *uri, bool val)
{
return _set_resource_data(client_data, uri, LWM2M_TYPE_BOOLEAN, &val, sizeof(bool));
}
int lwm2m_set_objlink(lwm2m_client_data_t *client_data, const lwm2m_uri_t *uri,
uint16_t object_id_in, uint16_t instance_id_in)
{
_objlink_t link = { .object_id = &object_id_in, .instance_id = &instance_id_in };
return _set_resource_data(client_data, uri, LWM2M_TYPE_OBJECT_LINK, &link, sizeof(_objlink_t));
}
int lwm2m_set_string_by_path(lwm2m_client_data_t *client_data, const char *path, size_t path_len,
char *val, size_t val_len)
{
return _set_resource_data_by_path(client_data, path, path_len, LWM2M_TYPE_STRING, val, val_len);
}
int lwm2m_set_opaque_by_path(lwm2m_client_data_t *client_data, const char *path, size_t path_len,
uint8_t *val, size_t val_len)
{
return _set_resource_data_by_path(client_data, path, path_len, LWM2M_TYPE_OPAQUE, val, val_len);
}
int lwm2m_set_int_by_path(lwm2m_client_data_t *client_data, const char *path, size_t path_len,
int64_t val)
{
return _set_resource_data_by_path(client_data, path, path_len, LWM2M_TYPE_INTEGER, &val,
sizeof(int64_t));
}
int lwm2m_set_float_by_path(lwm2m_client_data_t *client_data, const char *path, size_t path_len,
double val)
{
return _set_resource_data_by_path(client_data, path, path_len, LWM2M_TYPE_FLOAT, &val,
sizeof(double));
}
int lwm2m_set_bool_by_path(lwm2m_client_data_t *client_data, const char *path, size_t path_len,
bool val)
{
return _set_resource_data_by_path(client_data, path, path_len, LWM2M_TYPE_BOOLEAN, &val,
sizeof(bool));
}
int lwm2m_set_objlink_by_path(lwm2m_client_data_t *client_data, const char *path, size_t path_len,
uint16_t object_id_in, uint16_t instance_id_in)
{
_objlink_t link = { .object_id = &object_id_in, .instance_id = &instance_id_in };
return _set_resource_data_by_path(client_data, path, path_len, LWM2M_TYPE_OBJECT_LINK, &link,
sizeof(_objlink_t));
}