ESP32 Forum

Code: Select all

void custom_ble_mesh_send_sensor_readings(int8_t state) {
	// Set the new Motion State
	net_buf_simple_reset(&sensor_data_0);
	net_buf_simple_add_u8(&sensor_data_0, state);
	ESP_LOGI(TAG, "Sensor Reading: %d", state);
	
	// Prep the data to be sent
	uint8_t *status = NULL;
    uint16_t buf_size = 0;
    uint16_t length = 0;    
    esp_err_t err;
    int i;
	
	/**
     * Sensor Data state from Mesh Model Spec
     * |--------Field--------|-Size (octets)-|------------------------Notes-------------------------|
     * |----Property ID 1----|-------2-------|--ID of the 1st device property of the sensor---------|
     * |-----Raw Value 1-----|----variable---|--Raw Value field defined by the 1st device property--|
     * |----Property ID 2----|-------2-------|--ID of the 2nd device property of the sensor---------|
     * |-----Raw Value 2-----|----variable---|--Raw Value field defined by the 2nd device property--|
     * | ...... |
     * |----Property ID n----|-------2-------|--ID of the nth device property of the sensor---------|
     * |-----Raw Value n-----|----variable---|--Raw Value field defined by the nth device property--|
     */
    for (i = 0; i < ARRAY_SIZE(sensor_states); i++) {
        esp_ble_mesh_sensor_state_t *state = &sensor_states[i];
        if (state->sensor_data.length == ESP_BLE_MESH_SENSOR_DATA_ZERO_LEN) {
            buf_size += ESP_BLE_MESH_SENSOR_DATA_FORMAT_B_MPID_LEN;
        } else {
            /* Use "state->sensor_data.length + 1" because the length of sensor data is zero-based. */
            if (state->sensor_data.format == ESP_BLE_MESH_SENSOR_DATA_FORMAT_A) {
                buf_size += ESP_BLE_MESH_SENSOR_DATA_FORMAT_A_MPID_LEN + state->sensor_data.length + 1;
            } else {
                buf_size += ESP_BLE_MESH_SENSOR_DATA_FORMAT_B_MPID_LEN + state->sensor_data.length + 1;
            }
        }
    }

    status = calloc(1, buf_size);
    if (!status) {
        ESP_LOGE(TAG, "No memory for sensor status!");
        return;
    }
	
	for (i = 0; i < ARRAY_SIZE(sensor_states); i++) {
		length += example_ble_mesh_get_sensor_data(&sensor_states[i], status + length);
	}
	
	ESP_LOG_BUFFER_HEX("Sensor Data", status, length);	
    err = esp_ble_mesh_model_publish(sensor_server.model, ESP_BLE_MESH_MODEL_OP_SENSOR_STATUS, length, status, ROLE_NODE);
    if (err != ESP_OK) {
        ESP_LOGE(TAG, "Failed to publish Sensor Status, err %d", err);
    }
    free(status);
    esp_deep_sleep_start();
}