mirror of
https://github.com/espressif/esp-matter.git
synced 2026-04-27 19:13:13 +00:00
1640 lines
54 KiB
C++
1640 lines
54 KiB
C++
// Copyright 2021 Espressif Systems (Shanghai) PTE LTD
|
|
//
|
|
// Licensed under the Apache License, Version 2.0 (the "License");
|
|
// you may not use this file except in compliance with the License.
|
|
// You may obtain a copy of the License at
|
|
//
|
|
// http://www.apache.org/licenses/LICENSE-2.0
|
|
//
|
|
// Unless required by applicable law or agreed to in writing, software
|
|
// distributed under the License is distributed on an "AS IS" BASIS,
|
|
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
// See the License for the specific language governing permissions and
|
|
// limitations under the License.
|
|
|
|
#include <esp_log.h>
|
|
#include <esp_matter.h>
|
|
#include <esp_matter_core.h>
|
|
#include <nvs.h>
|
|
|
|
#include <app/clusters/network-commissioning/network-commissioning.h>
|
|
#include <app/clusters/general-diagnostics-server/general-diagnostics-server.h>
|
|
#include <app/server/Dnssd.h>
|
|
#include <app/server/Server.h>
|
|
#include <app/util/attribute-storage.h>
|
|
#include <credentials/DeviceAttestationCredsProvider.h>
|
|
#include <credentials/examples/DeviceAttestationCredsExample.h>
|
|
#include <platform/CHIPDeviceLayer.h>
|
|
#include <platform/DiagnosticDataProvider.h>
|
|
#include <platform/ESP32/ESP32FactoryDataProvider.h>
|
|
#include <platform/ESP32/NetworkCommissioningDriver.h>
|
|
#if CHIP_DEVICE_CONFIG_ENABLE_THREAD
|
|
#include <esp_matter_openthread.h>
|
|
#endif
|
|
|
|
using chip::CommandId;
|
|
using chip::DataVersion;
|
|
using chip::kInvalidAttributeId;
|
|
using chip::kInvalidCommandId;
|
|
using chip::kInvalidClusterId;
|
|
using chip::kInvalidEndpointId;
|
|
using chip::Credentials::SetDeviceAttestationCredentialsProvider;
|
|
using chip::Credentials::Examples::GetExampleDACProvider;
|
|
using chip::DeviceLayer::ChipDeviceEvent;
|
|
using chip::DeviceLayer::ConfigurationMgr;
|
|
using chip::DeviceLayer::ConnectivityManager;
|
|
using chip::DeviceLayer::ConnectivityMgr;
|
|
using chip::DeviceLayer::PlatformMgr;
|
|
using chip::DeviceLayer::DiagnosticDataProvider;
|
|
using chip::DeviceLayer::GetDiagnosticDataProvider;
|
|
#if CHIP_DEVICE_CONFIG_ENABLE_THREAD
|
|
using chip::DeviceLayer::ThreadStackMgr;
|
|
#endif
|
|
|
|
#define ESP_MATTER_NVS_PART_NAME "nvs"
|
|
|
|
static const char *TAG = "esp_matter_core";
|
|
|
|
namespace esp_matter {
|
|
|
|
namespace {
|
|
#if CONFIG_ENABLE_ESP32_FACTORY_DATA_PROVIDER
|
|
chip::DeviceLayer::ESP32FactoryDataProvider factory_data_provider;
|
|
#endif // CONFIG_ENABLE_ESP32_FACTORY_DATA_PROVIDER
|
|
} // namespace
|
|
|
|
typedef struct _attribute {
|
|
uint32_t attribute_id;
|
|
uint32_t cluster_id;
|
|
uint16_t endpoint_id;
|
|
uint16_t flags;
|
|
esp_matter_attr_val_t val;
|
|
esp_matter_attr_bounds_t *bounds;
|
|
EmberAfDefaultOrMinMaxAttributeValue default_value;
|
|
uint16_t default_value_size;
|
|
attribute::callback_t override_callback;
|
|
struct _attribute *next;
|
|
} _attribute_t;
|
|
|
|
typedef struct _command {
|
|
uint32_t command_id;
|
|
uint16_t flags;
|
|
command::callback_t callback;
|
|
struct _command *next;
|
|
} _command_t;
|
|
|
|
typedef struct _cluster {
|
|
uint32_t cluster_id;
|
|
uint16_t endpoint_id;
|
|
uint16_t flags;
|
|
const cluster::function_generic_t *function_list;
|
|
cluster::plugin_server_init_callback_t plugin_server_init_callback;
|
|
cluster::plugin_client_init_callback_t plugin_client_init_callback;
|
|
_attribute_t *attribute_list;
|
|
_command_t *command_list;
|
|
struct _cluster *next;
|
|
} _cluster_t;
|
|
|
|
typedef struct _endpoint {
|
|
uint16_t endpoint_id;
|
|
uint32_t device_type_id;
|
|
uint16_t flags;
|
|
_cluster_t *cluster_list;
|
|
EmberAfEndpointType *endpoint_type;
|
|
DataVersion *data_versions_ptr;
|
|
EmberAfDeviceType *device_types_ptr;
|
|
struct _endpoint *next;
|
|
} _endpoint_t;
|
|
|
|
typedef struct _node {
|
|
_endpoint_t *endpoint_list;
|
|
uint16_t current_endpoint_id;
|
|
} _node_t;
|
|
|
|
namespace cluster {
|
|
static int get_count(_cluster_t *current)
|
|
{
|
|
int count = 0;
|
|
while (current) {
|
|
current = current->next;
|
|
count++;
|
|
}
|
|
return count;
|
|
}
|
|
} /* cluster */
|
|
|
|
namespace command {
|
|
static int get_count(_command_t *current, int command_flag)
|
|
{
|
|
int count = 0;
|
|
while (current) {
|
|
if (current->flags & command_flag) {
|
|
count++;
|
|
}
|
|
current = current->next;
|
|
}
|
|
return count;
|
|
}
|
|
} /* command */
|
|
|
|
namespace attribute {
|
|
|
|
extern esp_err_t get_data_from_attr_val(esp_matter_attr_val_t *val, EmberAfAttributeType *attribute_type,
|
|
uint16_t *attribute_size, uint8_t *value);
|
|
|
|
static int get_count(_attribute_t *current)
|
|
{
|
|
int count = 0;
|
|
while (current) {
|
|
current = current->next;
|
|
count++;
|
|
}
|
|
return count;
|
|
}
|
|
|
|
static esp_err_t free_default_value(attribute_t *attribute)
|
|
{
|
|
if (!attribute) {
|
|
ESP_LOGE(TAG, "Attribute cannot be NULL");
|
|
return ESP_FAIL;
|
|
}
|
|
_attribute_t *current_attribute = (_attribute_t *)attribute;
|
|
|
|
/* Free value if data is more than 2 bytes or if it is min max attribute */
|
|
if (current_attribute->flags & ATTRIBUTE_FLAG_MIN_MAX) {
|
|
if (current_attribute->default_value_size > 2) {
|
|
if (current_attribute->default_value.ptrToMinMaxValue->defaultValue.ptrToDefaultValue) {
|
|
free((void *)current_attribute->default_value.ptrToMinMaxValue->defaultValue.ptrToDefaultValue);
|
|
}
|
|
if (current_attribute->default_value.ptrToMinMaxValue->minValue.ptrToDefaultValue) {
|
|
free((void *)current_attribute->default_value.ptrToMinMaxValue->minValue.ptrToDefaultValue);
|
|
}
|
|
if (current_attribute->default_value.ptrToMinMaxValue->maxValue.ptrToDefaultValue) {
|
|
free((void *)current_attribute->default_value.ptrToMinMaxValue->maxValue.ptrToDefaultValue);
|
|
}
|
|
}
|
|
free((void *)current_attribute->default_value.ptrToMinMaxValue);
|
|
} else if (current_attribute->default_value_size > 2) {
|
|
if (current_attribute->default_value.ptrToDefaultValue) {
|
|
free((void *)current_attribute->default_value.ptrToDefaultValue);
|
|
}
|
|
}
|
|
return ESP_OK;
|
|
}
|
|
|
|
static EmberAfDefaultAttributeValue get_default_value_from_data(esp_matter_attr_val_t *val,
|
|
EmberAfAttributeType attribute_type,
|
|
uint16_t attribute_size)
|
|
{
|
|
EmberAfDefaultAttributeValue default_value = (uint16_t)0;
|
|
uint8_t *value = (uint8_t *)calloc(1, attribute_size);
|
|
if (!value) {
|
|
ESP_LOGE(TAG, "Could not allocate value buffer for default value");
|
|
return default_value;
|
|
}
|
|
get_data_from_attr_val(val, &attribute_type, &attribute_size, value);
|
|
|
|
if (attribute_size > 2) {
|
|
/* Directly set the pointer */
|
|
default_value = value;
|
|
} else {
|
|
/* This data is 2 bytes or less. This should be represented as uint16. Copy the bytes appropriately
|
|
for 0 or 1 or 2 bytes to be converted to uint16. Then free the allocated buffer. */
|
|
uint16_t int_value = 0;
|
|
if (attribute_size == 2) {
|
|
memcpy(&int_value, value, attribute_size);
|
|
} else if (attribute_size == 1) {
|
|
int_value = (uint16_t)*value;
|
|
}
|
|
default_value = int_value;
|
|
free(value);
|
|
}
|
|
return default_value;
|
|
}
|
|
|
|
static esp_err_t set_default_value_from_current_val(attribute_t *attribute)
|
|
{
|
|
if (!attribute) {
|
|
ESP_LOGE(TAG, "Attribute cannot be NULL");
|
|
return ESP_FAIL;
|
|
}
|
|
_attribute_t *current_attribute = (_attribute_t *)attribute;
|
|
esp_matter_attr_val_t *val = ¤t_attribute->val;
|
|
|
|
/* Get size */
|
|
EmberAfAttributeType attribute_type = 0;
|
|
uint16_t attribute_size = 0;
|
|
get_data_from_attr_val(val, &attribute_type, &attribute_size, NULL);
|
|
|
|
/* Get and set value */
|
|
if (current_attribute->flags & ATTRIBUTE_FLAG_MIN_MAX) {
|
|
EmberAfAttributeMinMaxValue *temp_value = (EmberAfAttributeMinMaxValue *)calloc(1,
|
|
sizeof(EmberAfAttributeMinMaxValue));
|
|
if (!temp_value) {
|
|
ESP_LOGE(TAG, "Could not allocate ptrToMinMaxValue for default value");
|
|
return ESP_FAIL;
|
|
}
|
|
temp_value->defaultValue = get_default_value_from_data(val, attribute_type, attribute_size);
|
|
temp_value->minValue = get_default_value_from_data(¤t_attribute->bounds->min, attribute_type,
|
|
attribute_size);
|
|
temp_value->maxValue = get_default_value_from_data(¤t_attribute->bounds->max, attribute_type,
|
|
attribute_size);
|
|
current_attribute->default_value.ptrToMinMaxValue = temp_value;
|
|
} else if (attribute_size > 2) {
|
|
EmberAfDefaultAttributeValue temp_value = get_default_value_from_data(val, attribute_type, attribute_size);
|
|
current_attribute->default_value.ptrToDefaultValue = temp_value.ptrToDefaultValue;
|
|
} else {
|
|
EmberAfDefaultAttributeValue temp_value = get_default_value_from_data(val, attribute_type, attribute_size);
|
|
current_attribute->default_value.defaultValue = temp_value.defaultValue;
|
|
}
|
|
current_attribute->default_value_size = attribute_size;
|
|
return ESP_OK;
|
|
}
|
|
} /* attribute */
|
|
|
|
namespace endpoint {
|
|
|
|
static int get_next_index()
|
|
{
|
|
uint16_t endpoint_id = 0;
|
|
for (int index = 0; index < MAX_ENDPOINT_COUNT; index++) {
|
|
endpoint_id = emberAfEndpointFromIndex(index);
|
|
if (endpoint_id == kInvalidEndpointId) {
|
|
return index;
|
|
}
|
|
}
|
|
return 0xFFFF;
|
|
}
|
|
|
|
static esp_err_t disable(endpoint_t *endpoint)
|
|
{
|
|
if (!endpoint) {
|
|
ESP_LOGE(TAG, "Endpoint cannot be NULL");
|
|
return ESP_ERR_INVALID_ARG;
|
|
}
|
|
|
|
/* Take lock if not already taken */
|
|
lock::status_t lock_status = lock::chip_stack_lock(portMAX_DELAY);
|
|
if (lock_status == lock::FAILED) {
|
|
ESP_LOGE(TAG, "Could not get task context");
|
|
return ESP_FAIL;
|
|
}
|
|
|
|
/* Remove endpoint */
|
|
_endpoint_t *current_endpoint = (_endpoint_t *)endpoint;
|
|
int endpoint_index = emberAfGetDynamicIndexFromEndpoint(current_endpoint->endpoint_id);
|
|
if (endpoint_index == 0xFFFF) {
|
|
ESP_LOGE(TAG, "Could not find endpoint index");
|
|
if (lock_status == lock::SUCCESS) {
|
|
lock::chip_stack_unlock();
|
|
}
|
|
return ESP_FAIL;
|
|
}
|
|
emberAfClearDynamicEndpoint(endpoint_index);
|
|
|
|
if (lock_status == lock::SUCCESS) {
|
|
lock::chip_stack_unlock();
|
|
}
|
|
if (!(current_endpoint->endpoint_type)) {
|
|
ESP_LOGE(TAG, "endpoint %d's endpoint_type is NULL", current_endpoint->endpoint_id);
|
|
return ESP_ERR_INVALID_STATE;
|
|
}
|
|
/* Free all clusters */
|
|
EmberAfEndpointType *endpoint_type = current_endpoint->endpoint_type;
|
|
int cluster_count = endpoint_type->clusterCount;
|
|
for (int cluster_index = 0; cluster_index < cluster_count; cluster_index++) {
|
|
/* Free attributes */
|
|
free((void *)endpoint_type->cluster[cluster_index].attributes);
|
|
/* Free commands */
|
|
if (endpoint_type->cluster[cluster_index].acceptedCommandList) {
|
|
free((void *)endpoint_type->cluster[cluster_index].acceptedCommandList);
|
|
}
|
|
if (endpoint_type->cluster[cluster_index].generatedCommandList) {
|
|
free((void *)endpoint_type->cluster[cluster_index].generatedCommandList);
|
|
}
|
|
}
|
|
free((void *)endpoint_type->cluster);
|
|
|
|
/* Free data versions */
|
|
if (current_endpoint->data_versions_ptr) {
|
|
free(current_endpoint->data_versions_ptr);
|
|
current_endpoint->data_versions_ptr = NULL;
|
|
}
|
|
|
|
/* Free device types */
|
|
if (current_endpoint->device_types_ptr) {
|
|
free(current_endpoint->device_types_ptr);
|
|
current_endpoint->device_types_ptr = NULL;
|
|
}
|
|
|
|
/* Free endpoint type */
|
|
free(endpoint_type);
|
|
current_endpoint->endpoint_type = NULL;
|
|
return ESP_OK;
|
|
}
|
|
|
|
esp_err_t enable(endpoint_t *endpoint)
|
|
{
|
|
if (!endpoint) {
|
|
ESP_LOGE(TAG, "Endpoint cannot be NULL");
|
|
return ESP_ERR_INVALID_ARG;
|
|
}
|
|
_endpoint_t *current_endpoint = (_endpoint_t *)endpoint;
|
|
|
|
/* Endpoint Type */
|
|
EmberAfEndpointType *endpoint_type = (EmberAfEndpointType *)calloc(1, sizeof(EmberAfEndpointType));
|
|
if (!endpoint_type) {
|
|
ESP_LOGE(TAG, "Couldn't allocate endpoint_type");
|
|
/* goto cleanup is not used here to avoid 'crosses initialization' of data_versions below */
|
|
return ESP_ERR_NO_MEM;
|
|
}
|
|
current_endpoint->endpoint_type = endpoint_type;
|
|
|
|
/* Device types */
|
|
/** TODO: This assumes only 1 device type per endpoint. Also, it is hardcoded for bridge device types. Change it. */
|
|
int default_device_version = 1;
|
|
int device_type_count = 1;
|
|
if (current_endpoint->flags & ENDPOINT_FLAG_BRIDGE) {
|
|
device_type_count++;
|
|
}
|
|
EmberAfDeviceType *device_types_ptr = (EmberAfDeviceType *)calloc(device_type_count, sizeof(EmberAfDeviceType));
|
|
if (!device_types_ptr) {
|
|
ESP_LOGE(TAG, "Couldn't allocate device_types");
|
|
free(endpoint_type);
|
|
current_endpoint->endpoint_type = NULL;
|
|
/* goto cleanup is not used here to avoid 'crosses initialization' of device_types below */
|
|
return ESP_ERR_NO_MEM;
|
|
}
|
|
device_types_ptr[0].deviceId = current_endpoint->device_type_id;
|
|
device_types_ptr[0].deviceVersion = default_device_version;
|
|
if (current_endpoint->flags & ENDPOINT_FLAG_BRIDGE) {
|
|
device_types_ptr[1].deviceId = current_endpoint->endpoint_id == 0 ?
|
|
endpoint::bridge::get_device_type_id() :
|
|
endpoint::bridged_node::get_device_type_id();
|
|
device_types_ptr[1].deviceVersion = default_device_version;
|
|
}
|
|
chip::Span<EmberAfDeviceType> device_types(device_types_ptr, device_type_count);
|
|
current_endpoint->device_types_ptr = device_types_ptr;
|
|
|
|
/* Clusters */
|
|
_cluster_t *cluster = current_endpoint->cluster_list;
|
|
int cluster_count = cluster::get_count(cluster);
|
|
int cluster_index = 0;
|
|
|
|
DataVersion *data_versions_ptr = (DataVersion *)calloc(1, cluster_count * sizeof(DataVersion));
|
|
if (!data_versions_ptr) {
|
|
ESP_LOGE(TAG, "Couldn't allocate data_versions");
|
|
free(data_versions_ptr);
|
|
free(endpoint_type);
|
|
current_endpoint->data_versions_ptr = NULL;
|
|
current_endpoint->endpoint_type = NULL;
|
|
/* goto cleanup is not used here to avoid 'crosses initialization' of data_versions below */
|
|
return ESP_ERR_NO_MEM;
|
|
}
|
|
chip::Span<chip::DataVersion> data_versions(data_versions_ptr, cluster_count);
|
|
current_endpoint->data_versions_ptr = data_versions_ptr;
|
|
|
|
/* Variables */
|
|
/* This is needed to avoid 'crosses initialization' errors because of goto */
|
|
esp_err_t err = ESP_OK;
|
|
lock::status_t lock_status = lock::FAILED;
|
|
EmberAfStatus status = EMBER_ZCL_STATUS_SUCCESS;
|
|
EmberAfCluster *matter_clusters = NULL;
|
|
_attribute_t *attribute = NULL;
|
|
int attribute_count = 0;
|
|
int attribute_index = 0;
|
|
EmberAfAttributeMetadata *matter_attributes = NULL;
|
|
CommandId *accepted_command_ids = NULL;
|
|
CommandId *generated_command_ids = NULL;
|
|
_command_t *command = NULL;
|
|
int command_count = 0;
|
|
int command_index = 0;
|
|
int command_flag = COMMAND_FLAG_NONE;
|
|
int endpoint_index = 0;
|
|
|
|
matter_clusters = (EmberAfCluster *)calloc(1, cluster_count * sizeof(EmberAfCluster));
|
|
if (!matter_clusters) {
|
|
ESP_LOGE(TAG, "Couldn't allocate matter_clusters");
|
|
err = ESP_ERR_NO_MEM;
|
|
goto cleanup;
|
|
}
|
|
|
|
while (cluster) {
|
|
/* Attributes */
|
|
attribute = cluster->attribute_list;
|
|
attribute_count = attribute::get_count(attribute);
|
|
attribute_index = 0;
|
|
matter_attributes = (EmberAfAttributeMetadata *)calloc(1, attribute_count * sizeof(EmberAfAttributeMetadata));
|
|
if (!matter_attributes) {
|
|
if (attribute_count != 0) {
|
|
ESP_LOGE(TAG, "Couldn't allocate matter_attributes");
|
|
err = ESP_ERR_NO_MEM;
|
|
break;
|
|
}
|
|
}
|
|
|
|
while (attribute) {
|
|
matter_attributes[attribute_index].attributeId = attribute->attribute_id;
|
|
matter_attributes[attribute_index].mask = attribute->flags;
|
|
matter_attributes[attribute_index].defaultValue = attribute->default_value;
|
|
attribute::get_data_from_attr_val(&attribute->val, &matter_attributes[attribute_index].attributeType,
|
|
&matter_attributes[attribute_index].size, NULL);
|
|
|
|
matter_clusters[cluster_index].clusterSize += matter_attributes[attribute_index].size;
|
|
attribute = attribute->next;
|
|
attribute_index++;
|
|
}
|
|
|
|
/* Commands */
|
|
command = NULL;
|
|
command_count = 0;
|
|
command_index = 0;
|
|
command_flag = COMMAND_FLAG_NONE;
|
|
accepted_command_ids = NULL;
|
|
generated_command_ids = NULL;
|
|
|
|
/* Client Generated Commands */
|
|
command_flag = COMMAND_FLAG_ACCEPTED;
|
|
command = cluster->command_list;
|
|
command_count = command::get_count(command, command_flag);
|
|
if (command_count > 0) {
|
|
command_index = 0;
|
|
accepted_command_ids = (CommandId *)calloc(1, (command_count + 1) * sizeof(CommandId));
|
|
if (!accepted_command_ids) {
|
|
ESP_LOGE(TAG, "Couldn't allocate accepted_command_ids");
|
|
err = ESP_ERR_NO_MEM;
|
|
break;
|
|
}
|
|
while (command) {
|
|
if (command->flags & command_flag) {
|
|
accepted_command_ids[command_index] = command->command_id;
|
|
command_index++;
|
|
}
|
|
command = command->next;
|
|
}
|
|
accepted_command_ids[command_index] = kInvalidCommandId;
|
|
}
|
|
|
|
/* Server Generated Commands */
|
|
command_flag = COMMAND_FLAG_GENERATED;
|
|
command = cluster->command_list;
|
|
command_count = command::get_count(command, command_flag);
|
|
if (command_count > 0) {
|
|
command_index = 0;
|
|
generated_command_ids = (CommandId *)calloc(1, (command_count + 1) * sizeof(CommandId));
|
|
if (!generated_command_ids) {
|
|
ESP_LOGE(TAG, "Couldn't allocate generated_command_ids");
|
|
err = ESP_ERR_NO_MEM;
|
|
break;
|
|
}
|
|
while (command) {
|
|
if (command->flags & command_flag) {
|
|
generated_command_ids[command_index] = command->command_id;
|
|
command_index++;
|
|
}
|
|
command = command->next;
|
|
}
|
|
generated_command_ids[command_index] = kInvalidCommandId;
|
|
}
|
|
|
|
/* Fill up the cluster */
|
|
matter_clusters[cluster_index].clusterId = cluster->cluster_id;
|
|
matter_clusters[cluster_index].attributes = matter_attributes;
|
|
matter_clusters[cluster_index].attributeCount = attribute_count;
|
|
matter_clusters[cluster_index].mask = cluster->flags;
|
|
matter_clusters[cluster_index].functions = (EmberAfGenericClusterFunction *)cluster->function_list;
|
|
matter_clusters[cluster_index].acceptedCommandList = accepted_command_ids;
|
|
matter_clusters[cluster_index].generatedCommandList = generated_command_ids;
|
|
|
|
/* Get next cluster */
|
|
endpoint_type->endpointSize += matter_clusters[cluster_index].clusterSize;
|
|
cluster = cluster->next;
|
|
cluster_index++;
|
|
|
|
/* This is to avoid double free in case of errors */
|
|
matter_attributes = NULL;
|
|
accepted_command_ids = NULL;
|
|
generated_command_ids = NULL;
|
|
}
|
|
if (err != ESP_OK) {
|
|
goto cleanup;
|
|
}
|
|
|
|
endpoint_type->cluster = matter_clusters;
|
|
endpoint_type->clusterCount = cluster_count;
|
|
|
|
/* Take lock if not already taken */
|
|
lock_status = lock::chip_stack_lock(portMAX_DELAY);
|
|
if (lock_status == lock::FAILED) {
|
|
ESP_LOGE(TAG, "Could not get task context");
|
|
goto cleanup;
|
|
}
|
|
|
|
/* Add Endpoint */
|
|
endpoint_index = endpoint::get_next_index();
|
|
status = emberAfSetDynamicEndpoint(endpoint_index, current_endpoint->endpoint_id, endpoint_type, data_versions,
|
|
device_types);
|
|
if (status != EMBER_ZCL_STATUS_SUCCESS) {
|
|
ESP_LOGE(TAG, "Error adding dynamic endpoint %d: 0x%x", current_endpoint->endpoint_id, status);
|
|
err = ESP_FAIL;
|
|
if (lock_status == lock::SUCCESS) {
|
|
lock::chip_stack_unlock();
|
|
}
|
|
goto cleanup;
|
|
}
|
|
if (lock_status == lock::SUCCESS) {
|
|
lock::chip_stack_unlock();
|
|
}
|
|
ESP_LOGI(TAG, "Dynamic endpoint %d added", current_endpoint->endpoint_id);
|
|
return err;
|
|
|
|
cleanup:
|
|
if (generated_command_ids) {
|
|
free(generated_command_ids);
|
|
}
|
|
if (accepted_command_ids) {
|
|
free(accepted_command_ids);
|
|
}
|
|
if (matter_attributes) {
|
|
free(matter_attributes);
|
|
}
|
|
if (matter_clusters) {
|
|
for (int cluster_index = 0; cluster_index < cluster_count; cluster_index++) {
|
|
/* Free attributes */
|
|
if (matter_clusters[cluster_index].attributes) {
|
|
free((void *)matter_clusters[cluster_index].attributes);
|
|
}
|
|
/* Free commands */
|
|
if (matter_clusters[cluster_index].acceptedCommandList) {
|
|
free((void *)matter_clusters[cluster_index].acceptedCommandList);
|
|
}
|
|
if (matter_clusters[cluster_index].generatedCommandList) {
|
|
free((void *)matter_clusters[cluster_index].generatedCommandList);
|
|
}
|
|
}
|
|
free(matter_clusters);
|
|
}
|
|
if (data_versions_ptr) {
|
|
free(data_versions_ptr);
|
|
current_endpoint->data_versions_ptr = NULL;
|
|
}
|
|
if (device_types_ptr) {
|
|
free(device_types_ptr);
|
|
current_endpoint->device_types_ptr = NULL;
|
|
}
|
|
if (endpoint_type) {
|
|
free(endpoint_type);
|
|
current_endpoint->endpoint_type = NULL;
|
|
}
|
|
return err;
|
|
}
|
|
|
|
static esp_err_t enable_all()
|
|
{
|
|
node_t *node = node::get();
|
|
if (!node) {
|
|
/* Not returning error, since the node will not be initialized for application using the data model from zap */
|
|
return ESP_OK;
|
|
}
|
|
|
|
endpoint_t *endpoint = get_first(node);
|
|
while (endpoint) {
|
|
enable(endpoint);
|
|
endpoint = get_next(endpoint);
|
|
}
|
|
return ESP_OK;
|
|
}
|
|
} /* endpoint */
|
|
|
|
namespace lock {
|
|
#define DEFAULT_TICKS (500 / portTICK_PERIOD_MS) /* 500 ms in ticks */
|
|
status_t chip_stack_lock(uint32_t ticks_to_wait)
|
|
{
|
|
if (PlatformMgr().IsChipStackLockedByCurrentThread()) {
|
|
return ALREADY_TAKEN;
|
|
}
|
|
if (ticks_to_wait == portMAX_DELAY) {
|
|
/* Special handling for max delay */
|
|
PlatformMgr().LockChipStack();
|
|
return SUCCESS;
|
|
}
|
|
uint32_t ticks_remaining = ticks_to_wait;
|
|
uint32_t ticks = DEFAULT_TICKS;
|
|
while (ticks_remaining > 0) {
|
|
if (PlatformMgr().TryLockChipStack()) {
|
|
return SUCCESS;
|
|
}
|
|
ticks = ticks_remaining < DEFAULT_TICKS ? ticks_remaining : DEFAULT_TICKS;
|
|
ticks_remaining -= ticks;
|
|
ESP_LOGI(TAG, "Did not get lock yet. Retrying...");
|
|
vTaskDelay(ticks);
|
|
}
|
|
ESP_LOGE(TAG, "Could not get lock");
|
|
return FAILED;
|
|
}
|
|
|
|
esp_err_t chip_stack_unlock()
|
|
{
|
|
PlatformMgr().UnlockChipStack();
|
|
return ESP_OK;
|
|
}
|
|
} /* lock */
|
|
|
|
static void esp_matter_chip_init_task(intptr_t context)
|
|
{
|
|
xTaskHandle task_to_notify = reinterpret_cast<xTaskHandle>(context);
|
|
|
|
static chip::CommonCaseDeviceServerInitParams initParams;
|
|
initParams.InitializeStaticResourcesBeforeServerInit();
|
|
/** TODO: Add these callbacks and pass them on to the application */
|
|
// initParams.appDelegate = &sCallbacks;
|
|
chip::Server::GetInstance().Init(initParams);
|
|
|
|
/* TODO: Remove the examples DAC provider once we have a concrete
|
|
* way to generate attestation credentials.
|
|
*/
|
|
#if CONFIG_ENABLE_ESP32_FACTORY_DATA_PROVIDER
|
|
SetDeviceAttestationCredentialsProvider(&factory_data_provider);
|
|
#else // CONFIG_ENABLE_ESP32_FACTORY_DATA_PROVIDER
|
|
SetDeviceAttestationCredentialsProvider(GetExampleDACProvider());
|
|
#endif
|
|
|
|
#if CHIP_DEVICE_CONFIG_ENABLE_THREAD
|
|
// If Thread is Provisioned, publish the dns service
|
|
if (chip::DeviceLayer::ConnectivityMgr().IsThreadProvisioned() &&
|
|
(chip::Server::GetInstance().GetFabricTable().FabricCount() != 0)) {
|
|
chip::app::DnssdServer::Instance().StartServer();
|
|
}
|
|
#endif
|
|
if (endpoint::enable_all() != ESP_OK) {
|
|
ESP_LOGE(TAG, "Enable all endpoints failure");
|
|
}
|
|
// The following two events can't be recorded when we start the server because the endpoints are not enabled.
|
|
// TODO: Find a better way to record the events which should be recorded in matter server init
|
|
// Record start up event in basic information cluster.
|
|
PlatformMgr().HandleServerStarted();
|
|
// Record boot reason evnet in general diagnostics cluster.
|
|
chip::app::Clusters::GeneralDiagnostics::BootReasonType bootReason;
|
|
if (GetDiagnosticDataProvider().GetBootReason(bootReason) == CHIP_NO_ERROR) {
|
|
chip::app::Clusters::GeneralDiagnosticsServer::Instance().OnDeviceReboot(bootReason);
|
|
}
|
|
#if CHIP_DEVICE_CONFIG_ENABLE_WIFI
|
|
{
|
|
static chip::app::Clusters::NetworkCommissioning::Instance sWiFiNetworkCommissioningInstance(0,
|
|
&(chip::DeviceLayer::NetworkCommissioning::ESPWiFiDriver::GetInstance()));
|
|
sWiFiNetworkCommissioningInstance.Init();
|
|
}
|
|
#endif
|
|
/* Initialize binding manager */
|
|
client::binding_manager_init();
|
|
xTaskNotifyGive(task_to_notify);
|
|
}
|
|
|
|
static esp_err_t chip_init(event_callback_t callback)
|
|
{
|
|
#if CONFIG_ENABLE_ESP32_FACTORY_DATA_PROVIDER
|
|
SetCommissionableDataProvider(&factory_data_provider);
|
|
#endif // CONFIG_ENABLE_ESP32_FACTORY_DATA_PROVIDER
|
|
|
|
if (chip::Platform::MemoryInit() != CHIP_NO_ERROR) {
|
|
ESP_LOGE(TAG, "Failed to initialize CHIP memory pool");
|
|
return ESP_ERR_NO_MEM;
|
|
}
|
|
if (PlatformMgr().InitChipStack() != CHIP_NO_ERROR) {
|
|
ESP_LOGE(TAG, "Failed to initialize CHIP stack");
|
|
return ESP_FAIL;
|
|
}
|
|
ConnectivityMgr().SetBLEAdvertisingEnabled(true);
|
|
// ConnectivityMgr().SetWiFiAPMode(ConnectivityManager::kWiFiAPMode_Enabled);
|
|
if (PlatformMgr().StartEventLoopTask() != CHIP_NO_ERROR) {
|
|
chip::Platform::MemoryShutdown();
|
|
ESP_LOGE(TAG, "Failed to launch Matter main task");
|
|
return ESP_FAIL;
|
|
}
|
|
PlatformMgr().AddEventHandler(callback, static_cast<intptr_t>(NULL));
|
|
#if CHIP_DEVICE_CONFIG_ENABLE_THREAD
|
|
if (ThreadStackMgr().InitThreadStack() != CHIP_NO_ERROR) {
|
|
ESP_LOGE(TAG, "Failed to initialize Thread stack");
|
|
return ESP_FAIL;
|
|
}
|
|
|
|
if (ThreadStackMgr().StartThreadTask() != CHIP_NO_ERROR) {
|
|
ESP_LOGE(TAG, "Failed to launch Thread task");
|
|
return ESP_FAIL;
|
|
}
|
|
#endif
|
|
PlatformMgr().ScheduleWork(esp_matter_chip_init_task, reinterpret_cast<intptr_t>(xTaskGetCurrentTaskHandle()));
|
|
// Wait for the matter stack to be initialized
|
|
xTaskNotifyWait(0, 0, NULL, portMAX_DELAY);
|
|
return ESP_OK;
|
|
}
|
|
|
|
esp_err_t start(event_callback_t callback)
|
|
{
|
|
esp_err_t err = chip_init(callback);
|
|
if (err != ESP_OK) {
|
|
ESP_LOGE(TAG, "Error initializing matter");
|
|
}
|
|
return err;
|
|
}
|
|
|
|
esp_err_t factory_reset()
|
|
{
|
|
esp_err_t err = ESP_OK;
|
|
node_t *node = node::get();
|
|
if (node) {
|
|
/* ESP Matter data model is used. Erase all the data that we have added in nvs. */
|
|
endpoint_t *endpoint = endpoint::get_first(node);
|
|
while (endpoint) {
|
|
uint16_t endpoint_id = endpoint::get_id(endpoint);
|
|
char nvs_namespace[16] = {0};
|
|
snprintf(nvs_namespace, 16, "endpoint_%X", endpoint_id); /* endpoint_id */
|
|
|
|
nvs_handle_t handle;
|
|
err = nvs_open_from_partition(ESP_MATTER_NVS_PART_NAME, nvs_namespace, NVS_READWRITE, &handle);
|
|
if (err != ESP_OK) {
|
|
ESP_LOGE(TAG, "Error opening partition: %s, %d", nvs_namespace, err);
|
|
continue;
|
|
}
|
|
err = nvs_erase_all(handle);
|
|
if (err != ESP_OK) {
|
|
ESP_LOGE(TAG, "Error erasing partition: %s, %d", nvs_namespace, err);
|
|
continue;
|
|
}
|
|
endpoint = endpoint::get_next(endpoint);
|
|
}
|
|
if (err == ESP_OK) {
|
|
ESP_LOGI(TAG, "Erasing attribute data completed");
|
|
}
|
|
}
|
|
|
|
/* Submodule factory reset. This also restarts after completion. */
|
|
ConfigurationMgr().InitiateFactoryReset();
|
|
return err;
|
|
}
|
|
|
|
namespace attribute {
|
|
attribute_t *create(cluster_t *cluster, uint32_t attribute_id, uint8_t flags, esp_matter_attr_val_t val)
|
|
{
|
|
/* Find */
|
|
if (!cluster) {
|
|
ESP_LOGE(TAG, "Cluster cannot be NULL");
|
|
return NULL;
|
|
}
|
|
_cluster_t *current_cluster = (_cluster_t *)cluster;
|
|
attribute_t *existing_attribute = get(cluster, attribute_id);
|
|
if (existing_attribute) {
|
|
ESP_LOGE(TAG, "Attribute 0x%04x on cluster 0x%04x already exists. Not creating again.", attribute_id,
|
|
current_cluster->cluster_id);
|
|
return NULL;
|
|
}
|
|
|
|
/* Allocate */
|
|
_attribute_t *attribute = (_attribute_t *)calloc(1, sizeof(_attribute_t));
|
|
if (!attribute) {
|
|
ESP_LOGE(TAG, "Couldn't allocate _attribute_t");
|
|
return NULL;
|
|
}
|
|
|
|
/* Set */
|
|
attribute->attribute_id = attribute_id;
|
|
attribute->cluster_id = current_cluster->cluster_id;
|
|
attribute->endpoint_id = current_cluster->endpoint_id;
|
|
attribute->flags = flags;
|
|
attribute->flags |= ATTRIBUTE_FLAG_EXTERNAL_STORAGE;
|
|
if (attribute->flags & ATTRIBUTE_FLAG_NONVOLATILE) {
|
|
esp_matter_attr_val_t val_nvs = esp_matter_invalid(NULL);
|
|
esp_err_t err = get_val_from_nvs((attribute_t *)attribute, &val_nvs);
|
|
if (err == ESP_OK) {
|
|
set_val((attribute_t *)attribute, &val_nvs);
|
|
} else {
|
|
set_val((attribute_t *)attribute, &val);
|
|
}
|
|
} else {
|
|
set_val((attribute_t *)attribute, &val);
|
|
}
|
|
set_default_value_from_current_val((attribute_t *)attribute);
|
|
|
|
/* Add */
|
|
_attribute_t *previous_attribute = NULL;
|
|
_attribute_t *current_attribute = current_cluster->attribute_list;
|
|
while (current_attribute) {
|
|
previous_attribute = current_attribute;
|
|
current_attribute = current_attribute->next;
|
|
}
|
|
if (previous_attribute == NULL) {
|
|
current_cluster->attribute_list = attribute;
|
|
} else {
|
|
previous_attribute->next = attribute;
|
|
}
|
|
|
|
return (attribute_t *)attribute;
|
|
}
|
|
|
|
static esp_err_t destroy(attribute_t *attribute)
|
|
{
|
|
if (!attribute) {
|
|
ESP_LOGE(TAG, "Attribute cannot be NULL");
|
|
return ESP_ERR_INVALID_ARG;
|
|
}
|
|
_attribute_t *current_attribute = (_attribute_t *)attribute;
|
|
|
|
/* Default value needs to be deleted first since it uses the current val. */
|
|
free_default_value(attribute);
|
|
|
|
/* Delete val here, if required */
|
|
if (current_attribute->val.type == ESP_MATTER_VAL_TYPE_CHAR_STRING ||
|
|
current_attribute->val.type == ESP_MATTER_VAL_TYPE_OCTET_STRING ||
|
|
current_attribute->val.type == ESP_MATTER_VAL_TYPE_ARRAY) {
|
|
/* Free buf */
|
|
if (current_attribute->val.val.a.b) {
|
|
free(current_attribute->val.val.a.b);
|
|
}
|
|
}
|
|
|
|
/* Free bounds */
|
|
if (current_attribute->bounds) {
|
|
free(current_attribute->bounds);
|
|
}
|
|
|
|
/* Free */
|
|
free(current_attribute);
|
|
return ESP_OK;
|
|
}
|
|
|
|
attribute_t *get(cluster_t *cluster, uint32_t attribute_id)
|
|
{
|
|
if (!cluster) {
|
|
ESP_LOGE(TAG, "Cluster cannot be NULL");
|
|
return NULL;
|
|
}
|
|
_cluster_t *current_cluster = (_cluster_t *)cluster;
|
|
_attribute_t *current_attribute = (_attribute_t *)current_cluster->attribute_list;
|
|
while (current_attribute) {
|
|
if (current_attribute->attribute_id == attribute_id) {
|
|
break;
|
|
}
|
|
current_attribute = current_attribute->next;
|
|
}
|
|
return (attribute_t *)current_attribute;
|
|
}
|
|
|
|
attribute_t *get_first(cluster_t *cluster)
|
|
{
|
|
if (!cluster) {
|
|
ESP_LOGE(TAG, "Cluster cannot be NULL");
|
|
return NULL;
|
|
}
|
|
_cluster_t *current_cluster = (_cluster_t *)cluster;
|
|
return (attribute_t *)current_cluster->attribute_list;
|
|
}
|
|
|
|
attribute_t *get_next(attribute_t *attribute)
|
|
{
|
|
if (!attribute) {
|
|
ESP_LOGE(TAG, "Attribute cannot be NULL");
|
|
return NULL;
|
|
}
|
|
_attribute_t *current_attribute = (_attribute_t *)attribute;
|
|
return (attribute_t *)current_attribute->next;
|
|
}
|
|
|
|
uint32_t get_id(attribute_t *attribute)
|
|
{
|
|
if (!attribute) {
|
|
ESP_LOGE(TAG, "Attribute cannot be NULL");
|
|
return kInvalidAttributeId;
|
|
}
|
|
_attribute_t *current_attribute = (_attribute_t *)attribute;
|
|
return current_attribute->attribute_id;
|
|
}
|
|
|
|
esp_err_t set_val(attribute_t *attribute, esp_matter_attr_val_t *val)
|
|
{
|
|
if (!attribute) {
|
|
ESP_LOGE(TAG, "Attribute cannot be NULL");
|
|
return ESP_FAIL;
|
|
}
|
|
_attribute_t *current_attribute = (_attribute_t *)attribute;
|
|
if (val->type == ESP_MATTER_VAL_TYPE_CHAR_STRING || val->type == ESP_MATTER_VAL_TYPE_OCTET_STRING ||
|
|
val->type == ESP_MATTER_VAL_TYPE_ARRAY) {
|
|
/* Free old buf */
|
|
if (current_attribute->val.val.a.b) {
|
|
free(current_attribute->val.val.a.b);
|
|
}
|
|
if (val->val.a.s > 0) {
|
|
/* Alloc new buf */
|
|
uint8_t *new_buf = (uint8_t *)calloc(1, val->val.a.s);
|
|
if (!new_buf) {
|
|
ESP_LOGE(TAG, "Could not allocate new buffer");
|
|
return ESP_ERR_NO_MEM;
|
|
}
|
|
/* Copy to new buf and assign */
|
|
memcpy(new_buf, val->val.a.b, val->val.a.s);
|
|
val->val.a.b = new_buf;
|
|
} else {
|
|
ESP_LOGD(TAG, "Set val called with string with size 0");
|
|
val->val.a.b = NULL;
|
|
}
|
|
}
|
|
memcpy((void *)¤t_attribute->val, (void *)val, sizeof(esp_matter_attr_val_t));
|
|
if (current_attribute->flags & ATTRIBUTE_FLAG_NONVOLATILE) {
|
|
store_val_in_nvs(attribute);
|
|
}
|
|
return ESP_OK;
|
|
}
|
|
|
|
esp_err_t get_val(attribute_t *attribute, esp_matter_attr_val_t *val)
|
|
{
|
|
if (!attribute) {
|
|
ESP_LOGE(TAG, "Attribute cannot be NULL");
|
|
return ESP_ERR_INVALID_ARG;
|
|
}
|
|
_attribute_t *current_attribute = (_attribute_t *)attribute;
|
|
memcpy((void *)val, (void *)¤t_attribute->val, sizeof(esp_matter_attr_val_t));
|
|
return ESP_OK;
|
|
}
|
|
|
|
esp_err_t add_bounds(attribute_t *attribute, esp_matter_attr_val_t min, esp_matter_attr_val_t max)
|
|
{
|
|
if (!attribute) {
|
|
ESP_LOGE(TAG, "Attribute cannot be NULL");
|
|
return ESP_ERR_INVALID_ARG;
|
|
}
|
|
_attribute_t *current_attribute = (_attribute_t *)attribute;
|
|
|
|
/* Check if bounds can be set */
|
|
if (current_attribute->val.type == ESP_MATTER_VAL_TYPE_CHAR_STRING ||
|
|
current_attribute->val.type == ESP_MATTER_VAL_TYPE_OCTET_STRING ||
|
|
current_attribute->val.type == ESP_MATTER_VAL_TYPE_ARRAY) {
|
|
ESP_LOGE(TAG, "Bounds cannot be set for string/array type attributes");
|
|
return ESP_ERR_INVALID_ARG;
|
|
}
|
|
if ((current_attribute->val.type != min.type) || (current_attribute->val.type != max.type)) {
|
|
ESP_LOGE(TAG, "Cannot set bounds because of val type mismatch: expected: %d, min: %d, max: %d",
|
|
current_attribute->val.type, min.type, max.type);
|
|
return ESP_ERR_INVALID_ARG;
|
|
}
|
|
|
|
/* Free the default value before setting the new bounds */
|
|
free_default_value(attribute);
|
|
|
|
/* Allocate and set */
|
|
current_attribute->bounds = (esp_matter_attr_bounds_t *)calloc(1, sizeof(esp_matter_attr_bounds_t));
|
|
if (!current_attribute->bounds) {
|
|
ESP_LOGE(TAG, "Could not allocate bounds");
|
|
return ESP_ERR_NO_MEM;
|
|
}
|
|
memcpy((void *)¤t_attribute->bounds->min, (void *)&min, sizeof(esp_matter_attr_val_t));
|
|
memcpy((void *)¤t_attribute->bounds->max, (void *)&max, sizeof(esp_matter_attr_val_t));
|
|
current_attribute->flags |= ATTRIBUTE_FLAG_MIN_MAX;
|
|
|
|
/* Set the default value again after setting the bounds and the flag */
|
|
set_default_value_from_current_val(attribute);
|
|
return ESP_OK;
|
|
}
|
|
|
|
esp_matter_attr_bounds_t *get_bounds(attribute_t *attribute)
|
|
{
|
|
if (!attribute) {
|
|
ESP_LOGE(TAG, "Attribute cannot be NULL");
|
|
return NULL;
|
|
}
|
|
_attribute_t *current_attribute = (_attribute_t *)attribute;
|
|
return current_attribute->bounds;
|
|
}
|
|
|
|
uint16_t get_flags(attribute_t *attribute)
|
|
{
|
|
if (!attribute) {
|
|
ESP_LOGE(TAG, "Attribute cannot be NULL");
|
|
return 0;
|
|
}
|
|
_attribute_t *current_attribute = (_attribute_t *)attribute;
|
|
return current_attribute->flags;
|
|
}
|
|
|
|
esp_err_t set_override_callback(attribute_t *attribute, callback_t callback)
|
|
{
|
|
if (!attribute) {
|
|
ESP_LOGE(TAG, "Attribute cannot be NULL");
|
|
return ESP_ERR_INVALID_ARG;
|
|
}
|
|
_attribute_t *current_attribute = (_attribute_t *)attribute;
|
|
current_attribute->override_callback = callback;
|
|
current_attribute->flags |= ATTRIBUTE_FLAG_OVERRIDE;
|
|
return ESP_OK;
|
|
}
|
|
|
|
callback_t get_override_callback(attribute_t *attribute)
|
|
{
|
|
if (!attribute) {
|
|
ESP_LOGE(TAG, "Attribute cannot be NULL");
|
|
return NULL;
|
|
}
|
|
_attribute_t *current_attribute = (_attribute_t *)attribute;
|
|
return current_attribute->override_callback;
|
|
}
|
|
|
|
esp_err_t store_val_in_nvs(attribute_t *attribute)
|
|
{
|
|
if (!attribute) {
|
|
ESP_LOGE(TAG, "Attribute cannot be NULL");
|
|
return ESP_ERR_INVALID_ARG;
|
|
}
|
|
_attribute_t *current_attribute = (_attribute_t *)attribute;
|
|
|
|
/* Get keys */
|
|
uint32_t attribute_id = current_attribute->attribute_id;
|
|
uint32_t cluster_id = current_attribute->cluster_id;
|
|
uint16_t endpoint_id = current_attribute->endpoint_id;
|
|
char nvs_namespace[16] = {0};
|
|
char attribute_key[16] = {0};
|
|
snprintf(nvs_namespace, 16, "endpoint_%X", endpoint_id); /* endpoint_id */
|
|
snprintf(attribute_key, 16, "%X:%X", cluster_id, attribute_id); /* cluster_id:attribute_id */
|
|
|
|
nvs_handle_t handle;
|
|
esp_err_t err = nvs_open_from_partition(ESP_MATTER_NVS_PART_NAME, nvs_namespace, NVS_READWRITE, &handle);
|
|
if (err != ESP_OK) {
|
|
return err;
|
|
}
|
|
ESP_LOGI(TAG, "strore attribute in nvs: endpoint_id-0x%x, cluster_id-0x%x, attribute_id-0x%x",
|
|
endpoint_id, cluster_id, attribute_id);
|
|
if (current_attribute->val.type == ESP_MATTER_VAL_TYPE_CHAR_STRING ||
|
|
current_attribute->val.type == ESP_MATTER_VAL_TYPE_OCTET_STRING ||
|
|
current_attribute->val.type == ESP_MATTER_VAL_TYPE_ARRAY) {
|
|
/* Store only if value is not NULL */
|
|
if (current_attribute->val.val.a.b) {
|
|
err = nvs_set_blob(handle, attribute_key, current_attribute->val.val.a.b, current_attribute->val.val.a.s);
|
|
nvs_commit(handle);
|
|
} else {
|
|
err = ESP_OK;
|
|
}
|
|
} else {
|
|
err = nvs_set_blob(handle, attribute_key, ¤t_attribute->val, sizeof(esp_matter_attr_val_t));
|
|
nvs_commit(handle);
|
|
}
|
|
nvs_close(handle);
|
|
return err;
|
|
}
|
|
|
|
esp_err_t get_val_from_nvs(attribute_t *attribute, esp_matter_attr_val_t *val)
|
|
{
|
|
if (!attribute) {
|
|
ESP_LOGE(TAG, "Attribute cannot be NULL");
|
|
return ESP_ERR_INVALID_ARG;
|
|
}
|
|
_attribute_t *current_attribute = (_attribute_t *)attribute;
|
|
|
|
/* Get keys */
|
|
uint32_t attribute_id = current_attribute->attribute_id;
|
|
uint32_t cluster_id = current_attribute->cluster_id;
|
|
uint16_t endpoint_id = current_attribute->endpoint_id;
|
|
char nvs_namespace[16] = {0};
|
|
char attribute_key[16] = {0};
|
|
snprintf(nvs_namespace, 16, "endpoint_%X", endpoint_id); /* endpoint_id */
|
|
snprintf(attribute_key, 16, "%X:%X", cluster_id, attribute_id); /* cluster_id:attribute_id */
|
|
|
|
nvs_handle_t handle;
|
|
esp_err_t err = nvs_open_from_partition(ESP_MATTER_NVS_PART_NAME, nvs_namespace, NVS_READONLY, &handle);
|
|
if (err != ESP_OK) {
|
|
return err;
|
|
}
|
|
ESP_LOGI(TAG, "read attribute from nvs: endpoint_id-0x%x, cluster_id-0x%x, attribute_id-0x%x",
|
|
endpoint_id, cluster_id, attribute_id);
|
|
if (current_attribute->val.type == ESP_MATTER_VAL_TYPE_CHAR_STRING ||
|
|
current_attribute->val.type == ESP_MATTER_VAL_TYPE_OCTET_STRING ||
|
|
current_attribute->val.type == ESP_MATTER_VAL_TYPE_ARRAY) {
|
|
size_t len = 0;
|
|
if ((err = nvs_get_blob(handle, attribute_key, NULL, &len)) == ESP_OK) {
|
|
uint8_t *buffer = (uint8_t *)calloc(1, len);
|
|
if (!buffer) {
|
|
err = ESP_ERR_NO_MEM;
|
|
} else {
|
|
nvs_get_blob(handle, attribute_key, buffer, &len);
|
|
val->type = current_attribute->val.type;
|
|
val->val.a.b = buffer;
|
|
val->val.a.s = len;
|
|
val->val.a.n = len;
|
|
val->val.a.t = len + (current_attribute->val.val.a.t - current_attribute->val.val.a.s);
|
|
}
|
|
}
|
|
} else {
|
|
size_t len = sizeof(esp_matter_attr_val_t);
|
|
err = nvs_get_blob(handle, attribute_key, val, &len);
|
|
}
|
|
nvs_close(handle);
|
|
return err;
|
|
}
|
|
|
|
} /* attribute */
|
|
|
|
namespace command {
|
|
command_t *create(cluster_t *cluster, uint32_t command_id, uint8_t flags, callback_t callback)
|
|
{
|
|
/* Find */
|
|
if (!cluster) {
|
|
ESP_LOGE(TAG, "Cluster cannot be NULL");
|
|
return NULL;
|
|
}
|
|
_cluster_t *current_cluster = (_cluster_t *)cluster;
|
|
command_t *existing_command = get(cluster, command_id, flags);
|
|
if (existing_command) {
|
|
ESP_LOGE(TAG, "Command 0x%04x on cluster 0x%04x already exists. Not creating again.", command_id,
|
|
current_cluster->cluster_id);
|
|
return NULL;
|
|
}
|
|
|
|
/* Allocate */
|
|
_command_t *command = (_command_t *)calloc(1, sizeof(_command_t));
|
|
if (!command) {
|
|
ESP_LOGE(TAG, "Couldn't allocate _command_t");
|
|
return NULL;
|
|
}
|
|
|
|
/* Set */
|
|
command->command_id = command_id;
|
|
command->flags = flags;
|
|
command->callback = callback;
|
|
|
|
/* Add */
|
|
_command_t *previous_command = NULL;
|
|
_command_t *current_command = current_cluster->command_list;
|
|
while (current_command) {
|
|
previous_command = current_command;
|
|
current_command = current_command->next;
|
|
}
|
|
if (previous_command == NULL) {
|
|
current_cluster->command_list = command;
|
|
} else {
|
|
previous_command->next = command;
|
|
}
|
|
|
|
return (command_t *)command;
|
|
}
|
|
|
|
static esp_err_t destroy(command_t *command)
|
|
{
|
|
if (!command) {
|
|
ESP_LOGE(TAG, "Command cannot be NULL");
|
|
return ESP_ERR_INVALID_ARG;
|
|
}
|
|
_command_t *current_command = (_command_t *)command;
|
|
|
|
/* Free */
|
|
free(current_command);
|
|
return ESP_OK;
|
|
}
|
|
|
|
command_t *get(cluster_t *cluster, uint32_t command_id, uint16_t flags)
|
|
{
|
|
if (!cluster) {
|
|
ESP_LOGE(TAG, "Cluster cannot be NULL");
|
|
return NULL;
|
|
}
|
|
_cluster_t *current_cluster = (_cluster_t *)cluster;
|
|
_command_t *current_command = (_command_t *)current_cluster->command_list;
|
|
while (current_command) {
|
|
if ((current_command->command_id == command_id) && (current_command->flags & flags)) {
|
|
break;
|
|
}
|
|
current_command = current_command->next;
|
|
}
|
|
return (command_t *)current_command;
|
|
}
|
|
|
|
command_t *get_first(cluster_t *cluster)
|
|
{
|
|
if (!cluster) {
|
|
ESP_LOGE(TAG, "Cluster cannot be NULL");
|
|
return NULL;
|
|
}
|
|
_cluster_t *current_cluster = (_cluster_t *)cluster;
|
|
return (command_t *)current_cluster->command_list;
|
|
}
|
|
|
|
command_t *get_next(command_t *command)
|
|
{
|
|
if (!command) {
|
|
ESP_LOGE(TAG, "Command cannot be NULL");
|
|
return NULL;
|
|
}
|
|
_command_t *current_command = (_command_t *)command;
|
|
return (command_t *)current_command->next;
|
|
}
|
|
|
|
uint32_t get_id(command_t *command)
|
|
{
|
|
if (!command) {
|
|
ESP_LOGE(TAG, "Command cannot be NULL");
|
|
return kInvalidCommandId;
|
|
}
|
|
_command_t *current_command = (_command_t *)command;
|
|
return current_command->command_id;
|
|
}
|
|
|
|
callback_t get_callback(command_t *command)
|
|
{
|
|
if (!command) {
|
|
ESP_LOGE(TAG, "Command cannot be NULL");
|
|
return NULL;
|
|
}
|
|
_command_t *current_command = (_command_t *)command;
|
|
return current_command->callback;
|
|
}
|
|
|
|
uint16_t get_flags(command_t *command)
|
|
{
|
|
if (!command) {
|
|
ESP_LOGE(TAG, "Command cannot be NULL");
|
|
return 0;
|
|
}
|
|
_command_t *current_command = (_command_t *)command;
|
|
return current_command->flags;
|
|
}
|
|
|
|
} /* command */
|
|
|
|
namespace cluster {
|
|
|
|
cluster_t *create(endpoint_t *endpoint, uint32_t cluster_id, uint8_t flags)
|
|
{
|
|
/* Find */
|
|
if (!endpoint) {
|
|
ESP_LOGE(TAG, "Endpoint cannot be NULL");
|
|
return NULL;
|
|
}
|
|
if (!(flags & CLUSTER_FLAG_SERVER) && !(flags & CLUSTER_FLAG_CLIENT)) {
|
|
ESP_LOGE(TAG, "Server or client cluster flag not set");
|
|
return NULL;
|
|
}
|
|
_endpoint_t *current_endpoint = (_endpoint_t *)endpoint;
|
|
cluster_t *existing_cluster = get(endpoint, cluster_id);
|
|
if (existing_cluster) {
|
|
/* If a server already exists, do not create it again */
|
|
_cluster_t *_existing_cluster = (_cluster_t *)existing_cluster;
|
|
if ((_existing_cluster->flags & CLUSTER_FLAG_SERVER) && (flags & CLUSTER_FLAG_SERVER)) {
|
|
ESP_LOGE(TAG, "Server Cluster 0x%04x on endpoint 0x%04x already exists. Not creating again.", cluster_id,
|
|
current_endpoint->endpoint_id);
|
|
return NULL;
|
|
}
|
|
|
|
/* If a client already exists, do not create it again */
|
|
if ((_existing_cluster->flags & CLUSTER_FLAG_CLIENT) && (flags & CLUSTER_FLAG_CLIENT)) {
|
|
ESP_LOGE(TAG, "Client Cluster 0x%04x on endpoint 0x%04x already exists. Not creating again.", cluster_id,
|
|
current_endpoint->endpoint_id);
|
|
return NULL;
|
|
}
|
|
|
|
/* The cluster already exists, but is of a different type. Just update the 'Set' part from below. */
|
|
ESP_LOGI(TAG, "Cluster 0x%04x on endpoint 0x%04x already exists. Updating values.", cluster_id,
|
|
current_endpoint->endpoint_id);
|
|
_existing_cluster->flags |= flags;
|
|
return existing_cluster;
|
|
}
|
|
|
|
/* Allocate */
|
|
_cluster_t *cluster = (_cluster_t *)calloc(1, sizeof(_cluster_t));
|
|
if (!cluster) {
|
|
ESP_LOGE(TAG, "Couldn't allocate _cluster_t");
|
|
return NULL;
|
|
}
|
|
|
|
/* Set */
|
|
cluster->cluster_id = cluster_id;
|
|
cluster->endpoint_id = current_endpoint->endpoint_id;
|
|
cluster->flags = flags;
|
|
|
|
/* Add */
|
|
_cluster_t *previous_cluster = NULL;
|
|
_cluster_t *current_cluster = current_endpoint->cluster_list;
|
|
while (current_cluster) {
|
|
previous_cluster = current_cluster;
|
|
current_cluster = current_cluster->next;
|
|
}
|
|
if (previous_cluster == NULL) {
|
|
current_endpoint->cluster_list = cluster;
|
|
} else {
|
|
previous_cluster->next = cluster;
|
|
}
|
|
|
|
return (cluster_t *)cluster;
|
|
}
|
|
|
|
static esp_err_t destroy(cluster_t *cluster)
|
|
{
|
|
if (!cluster) {
|
|
ESP_LOGE(TAG, "Cluster cannot be NULL");
|
|
return ESP_ERR_INVALID_ARG;
|
|
}
|
|
_cluster_t *current_cluster = (_cluster_t *)cluster;
|
|
|
|
/* Parse and delete all commands */
|
|
_command_t *command = current_cluster->command_list;
|
|
while (command) {
|
|
_command_t *next_command = command->next;
|
|
command::destroy((command_t *)command);
|
|
command = next_command;
|
|
}
|
|
|
|
/* Parse and delete all attributes */
|
|
_attribute_t *attribute = current_cluster->attribute_list;
|
|
while (attribute) {
|
|
_attribute_t *next_attribute = attribute->next;
|
|
attribute::destroy((attribute_t *)attribute);
|
|
attribute = next_attribute;
|
|
}
|
|
|
|
/* Free */
|
|
free(current_cluster);
|
|
return ESP_OK;
|
|
}
|
|
|
|
cluster_t *get(endpoint_t *endpoint, uint32_t cluster_id)
|
|
{
|
|
if (!endpoint) {
|
|
ESP_LOGE(TAG, "Endpoint cannot be NULL");
|
|
return NULL;
|
|
}
|
|
_endpoint_t *current_endpoint = (_endpoint_t *)endpoint;
|
|
_cluster_t *current_cluster = (_cluster_t *)current_endpoint->cluster_list;
|
|
while (current_cluster) {
|
|
if (current_cluster->cluster_id == cluster_id) {
|
|
break;
|
|
}
|
|
current_cluster = current_cluster->next;
|
|
}
|
|
return (cluster_t *)current_cluster;
|
|
}
|
|
|
|
cluster_t *get_first(endpoint_t *endpoint)
|
|
{
|
|
if (!endpoint) {
|
|
ESP_LOGE(TAG, "Endpoint cannot be NULL");
|
|
return NULL;
|
|
}
|
|
_endpoint_t *current_endpoint = (_endpoint_t *)endpoint;
|
|
return (cluster_t *)current_endpoint->cluster_list;
|
|
}
|
|
|
|
cluster_t *get_next(cluster_t *cluster)
|
|
{
|
|
if (!cluster) {
|
|
ESP_LOGE(TAG, "Cluster cannot be NULL");
|
|
return NULL;
|
|
}
|
|
_cluster_t *current_cluster = (_cluster_t *)cluster;
|
|
return (cluster_t *)current_cluster->next;
|
|
}
|
|
|
|
uint32_t get_id(cluster_t *cluster)
|
|
{
|
|
if (!cluster) {
|
|
ESP_LOGE(TAG, "Cluster cannot be NULL");
|
|
return kInvalidClusterId;
|
|
}
|
|
_cluster_t *current_cluster = (_cluster_t *)cluster;
|
|
return current_cluster->cluster_id;
|
|
}
|
|
|
|
esp_err_t set_plugin_server_init_callback(cluster_t *cluster, plugin_server_init_callback_t callback)
|
|
{
|
|
if (!cluster) {
|
|
ESP_LOGE(TAG, "Cluster cannot be NULL");
|
|
return ESP_ERR_INVALID_ARG;
|
|
}
|
|
_cluster_t *current_cluster = (_cluster_t *)cluster;
|
|
current_cluster->plugin_server_init_callback = callback;
|
|
return ESP_OK;
|
|
}
|
|
|
|
esp_err_t set_plugin_client_init_callback(cluster_t *cluster, plugin_client_init_callback_t callback)
|
|
{
|
|
if (!cluster) {
|
|
ESP_LOGE(TAG, "Cluster cannot be NULL");
|
|
return ESP_ERR_INVALID_ARG;
|
|
}
|
|
_cluster_t *current_cluster = (_cluster_t *)cluster;
|
|
current_cluster->plugin_client_init_callback = callback;
|
|
return ESP_OK;
|
|
}
|
|
|
|
plugin_server_init_callback_t get_plugin_server_init_callback(cluster_t *cluster)
|
|
{
|
|
if (!cluster) {
|
|
ESP_LOGE(TAG, "Cluster cannot be NULL");
|
|
return NULL;
|
|
}
|
|
_cluster_t *current_cluster = (_cluster_t *)cluster;
|
|
return current_cluster->plugin_server_init_callback;
|
|
}
|
|
|
|
plugin_client_init_callback_t get_plugin_client_init_callback(cluster_t *cluster)
|
|
{
|
|
if (!cluster) {
|
|
ESP_LOGE(TAG, "Cluster cannot be NULL");
|
|
return NULL;
|
|
}
|
|
_cluster_t *current_cluster = (_cluster_t *)cluster;
|
|
return current_cluster->plugin_client_init_callback;
|
|
}
|
|
|
|
esp_err_t add_function_list(cluster_t *cluster, const function_generic_t *function_list, int function_flags)
|
|
{
|
|
if (!cluster) {
|
|
ESP_LOGE(TAG, "Cluster cannot be NULL");
|
|
return ESP_ERR_INVALID_ARG;
|
|
}
|
|
_cluster_t *current_cluster = (_cluster_t *)cluster;
|
|
current_cluster->function_list = function_list;
|
|
current_cluster->flags |= function_flags;
|
|
return ESP_OK;
|
|
}
|
|
|
|
} /* cluster */
|
|
|
|
namespace endpoint {
|
|
|
|
endpoint_t *create(node_t *node, uint8_t flags)
|
|
{
|
|
/* Find */
|
|
if (!node) {
|
|
ESP_LOGE(TAG, "Node cannot be NULL");
|
|
return NULL;
|
|
}
|
|
_node_t *current_node = (_node_t *)node;
|
|
|
|
/* Allocate */
|
|
_endpoint_t *endpoint = (_endpoint_t *)calloc(1, sizeof(_endpoint_t));
|
|
if (!endpoint) {
|
|
ESP_LOGE(TAG, "Couldn't allocate _endpoint_t");
|
|
return NULL;
|
|
}
|
|
|
|
/* Set */
|
|
endpoint->endpoint_id = current_node->current_endpoint_id++;
|
|
endpoint->device_type_id = 0xFFFF'FFFF;
|
|
endpoint->flags = flags;
|
|
|
|
/* Add */
|
|
_endpoint_t *previous_endpoint = NULL;
|
|
_endpoint_t *current_endpoint = current_node->endpoint_list;
|
|
while (current_endpoint) {
|
|
previous_endpoint = current_endpoint;
|
|
current_endpoint = current_endpoint->next;
|
|
}
|
|
if (previous_endpoint == NULL) {
|
|
current_node->endpoint_list = endpoint;
|
|
} else {
|
|
previous_endpoint->next = endpoint;
|
|
}
|
|
|
|
return (endpoint_t *)endpoint;
|
|
}
|
|
|
|
esp_err_t destroy(node_t *node, endpoint_t *endpoint)
|
|
{
|
|
if (!node || !endpoint) {
|
|
ESP_LOGE(TAG, "Node or endpoint cannot be NULL");
|
|
return ESP_ERR_INVALID_ARG;
|
|
}
|
|
_node_t *current_node = (_node_t *)node;
|
|
_endpoint_t *_endpoint = (_endpoint_t *)endpoint;
|
|
|
|
if (!(_endpoint->flags & ENDPOINT_FLAG_DESTROYABLE)) {
|
|
ESP_LOGE(TAG, "This endpoint cannot be deleted since the ENDPOINT_FLAG_DESTROYABLE is not set");
|
|
return ESP_FAIL;
|
|
}
|
|
|
|
/* Find current endpoint and remove from list */
|
|
_endpoint_t *current_endpoint = current_node->endpoint_list;
|
|
_endpoint_t *previous_endpoint = NULL;
|
|
while (current_endpoint) {
|
|
if (current_endpoint == _endpoint) {
|
|
break;
|
|
}
|
|
previous_endpoint = current_endpoint;
|
|
current_endpoint = current_endpoint->next;
|
|
}
|
|
if (current_endpoint == NULL) {
|
|
ESP_LOGE(TAG, "Could not find the endpoint to delete");
|
|
return ESP_FAIL;
|
|
}
|
|
if (previous_endpoint == NULL) {
|
|
current_node->endpoint_list = current_endpoint->next;
|
|
} else {
|
|
previous_endpoint->next = current_endpoint->next;
|
|
}
|
|
|
|
/* Disable */
|
|
disable(endpoint);
|
|
|
|
/* Parse and delete all clusters */
|
|
_cluster_t *cluster = current_endpoint->cluster_list;
|
|
while (cluster) {
|
|
_cluster_t *next_cluster = cluster->next;
|
|
cluster::destroy((cluster_t *)cluster);
|
|
cluster = next_cluster;
|
|
}
|
|
|
|
/* Free */
|
|
free(current_endpoint);
|
|
return ESP_OK;
|
|
}
|
|
|
|
endpoint_t *get(node_t *node, uint16_t endpoint_id)
|
|
{
|
|
if (!node) {
|
|
ESP_LOGE(TAG, "Node cannot be NULL");
|
|
return NULL;
|
|
}
|
|
_node_t *current_node = (_node_t *)node;
|
|
_endpoint_t *current_endpoint = (_endpoint_t *)current_node->endpoint_list;
|
|
while (current_endpoint) {
|
|
if (current_endpoint->endpoint_id == endpoint_id) {
|
|
break;
|
|
}
|
|
current_endpoint = current_endpoint->next;
|
|
}
|
|
return (endpoint_t *)current_endpoint;
|
|
}
|
|
|
|
endpoint_t *get_first(node_t *node)
|
|
{
|
|
if (!node) {
|
|
ESP_LOGE(TAG, "Node cannot be NULL");
|
|
return NULL;
|
|
}
|
|
_node_t *current_node = (_node_t *)node;
|
|
return (endpoint_t *)current_node->endpoint_list;
|
|
}
|
|
|
|
endpoint_t *get_next(endpoint_t *endpoint)
|
|
{
|
|
if (!endpoint) {
|
|
ESP_LOGE(TAG, "Endpoint cannot be NULL");
|
|
return NULL;
|
|
}
|
|
_endpoint_t *current_endpoint = (_endpoint_t *)endpoint;
|
|
return (endpoint_t *)current_endpoint->next;
|
|
}
|
|
|
|
uint16_t get_id(endpoint_t *endpoint)
|
|
{
|
|
if (!endpoint) {
|
|
ESP_LOGE(TAG, "Endpoint cannot be NULL");
|
|
return kInvalidEndpointId;
|
|
}
|
|
_endpoint_t *current_endpoint = (_endpoint_t *)endpoint;
|
|
return current_endpoint->endpoint_id;
|
|
}
|
|
|
|
esp_err_t set_device_type_id(endpoint_t *endpoint, uint32_t device_type_id)
|
|
{
|
|
if (!endpoint) {
|
|
ESP_LOGE(TAG, "Endpoint cannot be NULL");
|
|
return ESP_ERR_INVALID_ARG;
|
|
}
|
|
_endpoint_t *current_endpoint = (_endpoint_t *)endpoint;
|
|
current_endpoint->device_type_id = device_type_id;
|
|
return ESP_OK;
|
|
}
|
|
|
|
uint32_t get_device_type_id(endpoint_t *endpoint)
|
|
{
|
|
if (!endpoint) {
|
|
ESP_LOGE(TAG, "Endpoint cannot be NULL");
|
|
return 0xFFFF'FFFF;
|
|
}
|
|
_endpoint_t *current_endpoint = (_endpoint_t *)endpoint;
|
|
return current_endpoint->device_type_id;
|
|
}
|
|
|
|
} /* endpoint */
|
|
|
|
namespace node {
|
|
|
|
static _node_t *node = NULL;
|
|
|
|
node_t *create_raw()
|
|
{
|
|
if (node) {
|
|
ESP_LOGE(TAG, "Node already exists");
|
|
return (node_t *)node;
|
|
}
|
|
node = (_node_t *)calloc(1, sizeof(_node_t));
|
|
if (!node) {
|
|
ESP_LOGE(TAG, "Couldn't allocate _node_t");
|
|
return NULL;
|
|
}
|
|
return (node_t *)node;
|
|
}
|
|
|
|
node_t *get()
|
|
{
|
|
return (node_t *)node;
|
|
}
|
|
|
|
} /* node */
|
|
} /* esp_matter */
|