xref: /btstack/src/mesh/mesh_configuration_server.c (revision 2cf2bebb7ecebad249010634881712d32b1a8975)
1f4854a5eSMatthias Ringwald /*
2f4854a5eSMatthias Ringwald  * Copyright (C) 2019 BlueKitchen GmbH
3f4854a5eSMatthias Ringwald  *
4f4854a5eSMatthias Ringwald  * Redistribution and use in source and binary forms, with or without
5f4854a5eSMatthias Ringwald  * modification, are permitted provided that the following conditions
6f4854a5eSMatthias Ringwald  * are met:
7f4854a5eSMatthias Ringwald  *
8f4854a5eSMatthias Ringwald  * 1. Redistributions of source code must retain the above copyright
9f4854a5eSMatthias Ringwald  *    notice, this list of conditions and the following disclaimer.
10f4854a5eSMatthias Ringwald  * 2. Redistributions in binary form must reproduce the above copyright
11f4854a5eSMatthias Ringwald  *    notice, this list of conditions and the following disclaimer in the
12f4854a5eSMatthias Ringwald  *    documentation and/or other materials provided with the distribution.
13f4854a5eSMatthias Ringwald  * 3. Neither the name of the copyright holders nor the names of
14f4854a5eSMatthias Ringwald  *    contributors may be used to endorse or promote products derived
15f4854a5eSMatthias Ringwald  *    from this software without specific prior written permission.
16f4854a5eSMatthias Ringwald  * 4. Any redistribution, use, or modification is done solely for
17f4854a5eSMatthias Ringwald  *    personal benefit and not for any commercial purpose or for
18f4854a5eSMatthias Ringwald  *    monetary gain.
19f4854a5eSMatthias Ringwald  *
20f4854a5eSMatthias Ringwald  * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS
21f4854a5eSMatthias Ringwald  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
22f4854a5eSMatthias Ringwald  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
23f4854a5eSMatthias Ringwald  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS
24f4854a5eSMatthias Ringwald  * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
25f4854a5eSMatthias Ringwald  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
26f4854a5eSMatthias Ringwald  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
27f4854a5eSMatthias Ringwald  * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
28f4854a5eSMatthias Ringwald  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
29f4854a5eSMatthias Ringwald  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
30f4854a5eSMatthias Ringwald  * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31f4854a5eSMatthias Ringwald  * SUCH DAMAGE.
32f4854a5eSMatthias Ringwald  *
33f4854a5eSMatthias Ringwald  * Please inquire about commercial licensing options at
34f4854a5eSMatthias Ringwald  * [email protected]
35f4854a5eSMatthias Ringwald  *
36f4854a5eSMatthias Ringwald  */
37f4854a5eSMatthias Ringwald 
38f4854a5eSMatthias Ringwald #define __BTSTACK_FILE__ "mesh_configuration_server.c"
39f4854a5eSMatthias Ringwald 
40f4854a5eSMatthias Ringwald #include <string.h>
41f4854a5eSMatthias Ringwald #include <stdio.h>
42f4854a5eSMatthias Ringwald 
43f4854a5eSMatthias Ringwald #include "mesh/mesh_configuration_server.h"
44f4854a5eSMatthias Ringwald 
45f4854a5eSMatthias Ringwald #include "bluetooth_company_id.h"
46f4854a5eSMatthias Ringwald #include "btstack_debug.h"
47f4854a5eSMatthias Ringwald #include "btstack_memory.h"
48f4854a5eSMatthias Ringwald #include "btstack_tlv.h"
49f4854a5eSMatthias Ringwald #include "btstack_util.h"
50f4854a5eSMatthias Ringwald 
51f4854a5eSMatthias Ringwald #include "mesh/beacon.h"
52f4854a5eSMatthias Ringwald #include "mesh/gatt_bearer.h"
539d29a5e2SMatthias Ringwald #include "mesh/mesh.h"
54f4854a5eSMatthias Ringwald #include "mesh/mesh_access.h"
55f4854a5eSMatthias Ringwald #include "mesh/mesh_crypto.h"
56f4854a5eSMatthias Ringwald #include "mesh/mesh_foundation.h"
57f4854a5eSMatthias Ringwald #include "mesh/mesh_iv_index_seq_number.h"
58f4854a5eSMatthias Ringwald #include "mesh/mesh_keys.h"
59f4854a5eSMatthias Ringwald #include "mesh/mesh_network.h"
60f4854a5eSMatthias Ringwald #include "mesh/mesh_node.h"
61f4854a5eSMatthias Ringwald #include "mesh/mesh_proxy.h"
62f4854a5eSMatthias Ringwald #include "mesh/mesh_upper_transport.h"
63f4854a5eSMatthias Ringwald #include "mesh/mesh_virtual_addresses.h"
64f4854a5eSMatthias Ringwald 
65f4854a5eSMatthias Ringwald #define MESH_HEARTBEAT_FEATURES_SUPPORTED_MASK 0x000f
66f4854a5eSMatthias Ringwald 
67f4854a5eSMatthias Ringwald // current access pdu
68f4854a5eSMatthias Ringwald static mesh_pdu_t * access_pdu_in_process;
69f4854a5eSMatthias Ringwald 
70f4854a5eSMatthias Ringwald // data from current pdu
71f4854a5eSMatthias Ringwald static uint16_t                     configuration_server_element_address;
72f4854a5eSMatthias Ringwald static uint32_t                     configuration_server_model_identifier;
73f4854a5eSMatthias Ringwald static mesh_model_t               * configuration_server_target_model;
74f4854a5eSMatthias Ringwald static mesh_publication_model_t     configuration_server_publication_model;
75f4854a5eSMatthias Ringwald 
76f4854a5eSMatthias Ringwald // cmac for virtual address hash and netkey derive
77f4854a5eSMatthias Ringwald static btstack_crypto_aes128_cmac_t configuration_server_cmac_request;
78f4854a5eSMatthias Ringwald 
79f4854a5eSMatthias Ringwald // used to setup virtual addresses
80f4854a5eSMatthias Ringwald static uint8_t                      configuration_server_label_uuid[16];
81f4854a5eSMatthias Ringwald static uint16_t                     configuration_server_hash;
82f4854a5eSMatthias Ringwald 
83f4854a5eSMatthias Ringwald // heartbeat publication and subscription state for all Configuration Server models - there is only one
84f4854a5eSMatthias Ringwald // static mesh_heartbeat_subscription_t mesh_heartbeat_subscription;
85f4854a5eSMatthias Ringwald 
86f4854a5eSMatthias Ringwald // for PTS testing
87f4854a5eSMatthias Ringwald static int config_netkey_list_max = 0;
88f4854a5eSMatthias Ringwald 
89f4854a5eSMatthias Ringwald 
90f4854a5eSMatthias Ringwald // Heartbeat (helper)
91f4854a5eSMatthias Ringwald static uint16_t heartbeat_pwr2(uint8_t value){
92be22c60cSMatthias Ringwald     if (value == 0 )                    return 0x0000;
93f4854a5eSMatthias Ringwald     if (value == 0xff || value == 0x11) return 0xffff;
94f4854a5eSMatthias Ringwald     return 1 << (value-1);
95f4854a5eSMatthias Ringwald }
96f4854a5eSMatthias Ringwald 
97f4854a5eSMatthias Ringwald static uint8_t heartbeat_count_log(uint16_t value){
98be22c60cSMatthias Ringwald     if (value == 0)      return 0x00;
99f4854a5eSMatthias Ringwald     if (value == 0xffff) return 0xff;
100f4854a5eSMatthias Ringwald     // count leading zeros, supported by clang and gcc
101cfe25960SMatthias Ringwald     return 32 - __builtin_clz(value);
102f4854a5eSMatthias Ringwald }
103f4854a5eSMatthias Ringwald 
104be22c60cSMatthias Ringwald static uint8_t heartbeat_period_log(uint16_t value){
105be22c60cSMatthias Ringwald     if (value == 0)      return 0x00;
106be22c60cSMatthias Ringwald     // count leading zeros, supported by clang and gcc
107cfe25960SMatthias Ringwald     return 32 - __builtin_clz(value);
108be22c60cSMatthias Ringwald }
109be22c60cSMatthias Ringwald 
110f4854a5eSMatthias Ringwald // TLV
111f4854a5eSMatthias Ringwald 
112f4854a5eSMatthias Ringwald static int mesh_model_is_configuration_server(uint32_t model_identifier){
113f4854a5eSMatthias Ringwald     return mesh_model_is_bluetooth_sig(model_identifier) && (mesh_model_get_model_id(model_identifier) == MESH_SIG_MODEL_ID_CONFIGURATION_SERVER);
114f4854a5eSMatthias Ringwald }
115f4854a5eSMatthias Ringwald 
116f4854a5eSMatthias Ringwald // Configuration Model Subscriptions (helper)
117f4854a5eSMatthias Ringwald 
118f4854a5eSMatthias Ringwald // Model to Appkey List
119f4854a5eSMatthias Ringwald 
120f4854a5eSMatthias Ringwald static uint8_t mesh_model_add_subscription(mesh_model_t * mesh_model, uint16_t address){
1212983fbcbSMatthias Ringwald     uint16_t i;
122f4854a5eSMatthias Ringwald     for (i=0;i<MAX_NR_MESH_SUBSCRIPTION_PER_MODEL;i++){
123f4854a5eSMatthias Ringwald         if (mesh_model->subscriptions[i] == address) return MESH_FOUNDATION_STATUS_SUCCESS;
124f4854a5eSMatthias Ringwald     }
125f4854a5eSMatthias Ringwald     for (i=0;i<MAX_NR_MESH_SUBSCRIPTION_PER_MODEL;i++){
126f4854a5eSMatthias Ringwald         if (mesh_model->subscriptions[i] == MESH_ADDRESS_UNSASSIGNED) {
127f4854a5eSMatthias Ringwald             mesh_model->subscriptions[i] = address;
128f4854a5eSMatthias Ringwald             return MESH_FOUNDATION_STATUS_SUCCESS;
129f4854a5eSMatthias Ringwald         }
130f4854a5eSMatthias Ringwald     }
131f4854a5eSMatthias Ringwald     return MESH_FOUNDATION_STATUS_INSUFFICIENT_RESOURCES;
132f4854a5eSMatthias Ringwald }
133f4854a5eSMatthias Ringwald 
134f4854a5eSMatthias Ringwald static void mesh_model_delete_subscription(mesh_model_t * mesh_model, uint16_t address){
1352983fbcbSMatthias Ringwald     uint16_t i;
136f4854a5eSMatthias Ringwald     for (i=0;i<MAX_NR_MESH_SUBSCRIPTION_PER_MODEL;i++){
137f4854a5eSMatthias Ringwald         if (mesh_model->subscriptions[i] == address) {
138f4854a5eSMatthias Ringwald             mesh_model->subscriptions[i] = MESH_ADDRESS_UNSASSIGNED;
139f4854a5eSMatthias Ringwald         }
140f4854a5eSMatthias Ringwald     }
141f4854a5eSMatthias Ringwald }
142f4854a5eSMatthias Ringwald 
143f4854a5eSMatthias Ringwald static void mesh_model_delete_all_subscriptions(mesh_model_t * mesh_model){
1442983fbcbSMatthias Ringwald     uint16_t i;
145f4854a5eSMatthias Ringwald     for (i=0;i<MAX_NR_MESH_SUBSCRIPTION_PER_MODEL;i++){
146f4854a5eSMatthias Ringwald         mesh_model->subscriptions[i] = MESH_ADDRESS_UNSASSIGNED;
147f4854a5eSMatthias Ringwald     }
148f4854a5eSMatthias Ringwald }
149f4854a5eSMatthias Ringwald 
150f4854a5eSMatthias Ringwald static void mesh_subcription_decrease_virtual_address_ref_count(mesh_model_t *mesh_model){
151f4854a5eSMatthias Ringwald     // decrease ref counts for current virtual subscriptions
152f4854a5eSMatthias Ringwald     uint16_t i;
153b7430106SMatthias Ringwald     for (i = 0; i<MAX_NR_MESH_SUBSCRIPTION_PER_MODEL ; i++){
154f4854a5eSMatthias Ringwald         uint16_t src = mesh_model->subscriptions[i];
155f4854a5eSMatthias Ringwald         if (mesh_network_address_virtual(src)){
156f4854a5eSMatthias Ringwald             mesh_virtual_address_t * virtual_address = mesh_virtual_address_for_pseudo_dst(src);
157f4854a5eSMatthias Ringwald             mesh_virtual_address_decrease_refcount(virtual_address);
158f4854a5eSMatthias Ringwald         }
159f4854a5eSMatthias Ringwald     }
160f4854a5eSMatthias Ringwald }
161fe6aa2c4SMatthias Ringwald static void mesh_configuration_server_stop_publishing_using_appkey(mesh_model_t * mesh_model, uint16_t appkey_index){
162fe6aa2c4SMatthias Ringwald     // stop publishing if this AppKey was used
163fe6aa2c4SMatthias Ringwald     if (mesh_model->publication_model != NULL){
164fe6aa2c4SMatthias Ringwald         mesh_publication_model_t * publication_model = mesh_model->publication_model;
165fe6aa2c4SMatthias Ringwald         if (publication_model->appkey_index == appkey_index){
166fe6aa2c4SMatthias Ringwald             publication_model->address = MESH_ADDRESS_UNSASSIGNED;
167fe6aa2c4SMatthias Ringwald             publication_model->appkey_index = 0;
168fe6aa2c4SMatthias Ringwald             publication_model->period = 0;
169fe6aa2c4SMatthias Ringwald             publication_model->ttl = 0;
170fe6aa2c4SMatthias Ringwald             publication_model->retransmit = 0;
171fe6aa2c4SMatthias Ringwald 
172fe6aa2c4SMatthias Ringwald             mesh_model_store_publication(mesh_model);
173fe6aa2c4SMatthias Ringwald         }
174fe6aa2c4SMatthias Ringwald     }
175fe6aa2c4SMatthias Ringwald }
176f4854a5eSMatthias Ringwald 
177f4854a5eSMatthias Ringwald // AppKeys Helper
178f4854a5eSMatthias Ringwald static void mesh_configuration_server_delete_appkey(mesh_transport_key_t * transport_key){
179f4854a5eSMatthias Ringwald     uint16_t appkey_index = transport_key->appkey_index;
180f4854a5eSMatthias Ringwald 
181f4854a5eSMatthias Ringwald     // iterate over elements and models
182f4854a5eSMatthias Ringwald     mesh_element_iterator_t element_it;
183f4854a5eSMatthias Ringwald     mesh_element_iterator_init(&element_it);
184f4854a5eSMatthias Ringwald     while (mesh_element_iterator_has_next(&element_it)){
185f4854a5eSMatthias Ringwald         mesh_element_t * element = mesh_element_iterator_next(&element_it);
186f4854a5eSMatthias Ringwald         mesh_model_iterator_t model_it;
187f4854a5eSMatthias Ringwald         mesh_model_iterator_init(&model_it, element);
188f4854a5eSMatthias Ringwald         while (mesh_model_iterator_has_next(&model_it)){
189f4854a5eSMatthias Ringwald             mesh_model_t * mesh_model = mesh_model_iterator_next(&model_it);
190f4854a5eSMatthias Ringwald 
191f4854a5eSMatthias Ringwald             // remove from Model to AppKey List
192f4854a5eSMatthias Ringwald             mesh_model_unbind_appkey(mesh_model, appkey_index);
193f4854a5eSMatthias Ringwald 
194fe6aa2c4SMatthias Ringwald             // stop publishing if this appkey is used
195fe6aa2c4SMatthias Ringwald             mesh_configuration_server_stop_publishing_using_appkey(mesh_model, appkey_index);
196f4854a5eSMatthias Ringwald         }
197f4854a5eSMatthias Ringwald     }
198f4854a5eSMatthias Ringwald 
199f4854a5eSMatthias Ringwald     mesh_access_appkey_finalize(transport_key);
200f4854a5eSMatthias Ringwald }
201f4854a5eSMatthias Ringwald 
202f4854a5eSMatthias Ringwald // Foundatiopn Message
203f4854a5eSMatthias Ringwald 
204f4854a5eSMatthias Ringwald const mesh_access_message_t mesh_foundation_config_beacon_status = {
205f4854a5eSMatthias Ringwald         MESH_FOUNDATION_OPERATION_BEACON_STATUS, "1"
206f4854a5eSMatthias Ringwald };
207f4854a5eSMatthias Ringwald const mesh_access_message_t mesh_foundation_config_default_ttl_status = {
208f4854a5eSMatthias Ringwald         MESH_FOUNDATION_OPERATION_DEFAULT_TTL_STATUS, "1"
209f4854a5eSMatthias Ringwald };
210f4854a5eSMatthias Ringwald const mesh_access_message_t mesh_foundation_config_friend_status = {
211f4854a5eSMatthias Ringwald         MESH_FOUNDATION_OPERATION_FRIEND_STATUS, "1"
212f4854a5eSMatthias Ringwald };
213f4854a5eSMatthias Ringwald const mesh_access_message_t mesh_foundation_config_gatt_proxy_status = {
214f4854a5eSMatthias Ringwald         MESH_FOUNDATION_OPERATION_GATT_PROXY_STATUS, "1"
215f4854a5eSMatthias Ringwald };
216f4854a5eSMatthias Ringwald const mesh_access_message_t mesh_foundation_config_relay_status = {
217f4854a5eSMatthias Ringwald         MESH_FOUNDATION_OPERATION_RELAY_STATUS, "11"
218f4854a5eSMatthias Ringwald };
219f4854a5eSMatthias Ringwald const mesh_access_message_t mesh_foundation_config_model_publication_status = {
220f4854a5eSMatthias Ringwald         MESH_FOUNDATION_OPERATION_MODEL_PUBLICATION_STATUS, "1222111m"
221f4854a5eSMatthias Ringwald };
222f4854a5eSMatthias Ringwald const mesh_access_message_t mesh_foundation_config_model_subscription_status = {
223f4854a5eSMatthias Ringwald         MESH_FOUNDATION_OPERATION_MODEL_SUBSCRIPTION_STATUS, "122m"
224f4854a5eSMatthias Ringwald };
225f4854a5eSMatthias Ringwald const mesh_access_message_t mesh_foundation_config_netkey_status = {
226f4854a5eSMatthias Ringwald         MESH_FOUNDATION_OPERATION_NETKEY_STATUS, "12"
227f4854a5eSMatthias Ringwald };
228f4854a5eSMatthias Ringwald const mesh_access_message_t mesh_foundation_config_appkey_status = {
229f4854a5eSMatthias Ringwald         MESH_FOUNDATION_OPERATION_APPKEY_STATUS, "13"
230f4854a5eSMatthias Ringwald };
231f4854a5eSMatthias Ringwald const mesh_access_message_t mesh_foundation_config_model_app_status = {
232f4854a5eSMatthias Ringwald         MESH_FOUNDATION_OPERATION_MODEL_APP_STATUS, "122m"
233f4854a5eSMatthias Ringwald };
234f4854a5eSMatthias Ringwald const mesh_access_message_t mesh_foundation_node_reset_status = {
235f4854a5eSMatthias Ringwald         MESH_FOUNDATION_OPERATION_NODE_RESET_STATUS, ""
236f4854a5eSMatthias Ringwald };
237f4854a5eSMatthias Ringwald const mesh_access_message_t mesh_foundation_config_heartbeat_publication_status = {
238f4854a5eSMatthias Ringwald         MESH_FOUNDATION_OPERATION_HEARTBEAT_PUBLICATION_STATUS, "1211122"
239f4854a5eSMatthias Ringwald };
240f4854a5eSMatthias Ringwald const mesh_access_message_t mesh_foundation_config_network_transmit_status = {
24100f22586SMatthias Ringwald         MESH_FOUNDATION_OPERATION_NETWORK_TRANSMIT_STATUS, "1"
242f4854a5eSMatthias Ringwald };
243f4854a5eSMatthias Ringwald const mesh_access_message_t mesh_foundation_node_identity_status = {
244f4854a5eSMatthias Ringwald         MESH_FOUNDATION_OPERATION_NODE_IDENTITY_STATUS, "121"
245f4854a5eSMatthias Ringwald };
246f4854a5eSMatthias Ringwald const mesh_access_message_t mesh_key_refresh_phase_status = {
247f4854a5eSMatthias Ringwald         MESH_FOUNDATION_OPERATION_KEY_REFRESH_PHASE_STATUS, "121"
248f4854a5eSMatthias Ringwald };
249f4854a5eSMatthias Ringwald const mesh_access_message_t mesh_foundation_low_power_node_poll_timeout_status = {
250f4854a5eSMatthias Ringwald         MESH_FOUNDATION_OPERATION_LOW_POWER_NODE_POLL_TIMEOUT_STATUS, "23"
251f4854a5eSMatthias Ringwald };
252f4854a5eSMatthias Ringwald const mesh_access_message_t mesh_foundation_config_heartbeat_subscription_status = {
253f4854a5eSMatthias Ringwald         MESH_FOUNDATION_OPERATION_HEARTBEAT_SUBSCRIPTION_STATUS, "1221111"
254f4854a5eSMatthias Ringwald };
255f4854a5eSMatthias Ringwald 
256f4854a5eSMatthias Ringwald static void config_server_send_message(uint16_t netkey_index, uint16_t dest, mesh_pdu_t *pdu){
257f4854a5eSMatthias Ringwald     // Configuration Server is on primary element and can only use DeviceKey
258f4854a5eSMatthias Ringwald     uint16_t appkey_index = MESH_DEVICE_KEY_INDEX;
259f4854a5eSMatthias Ringwald     uint16_t src          = mesh_node_get_primary_element_address();
260f4854a5eSMatthias Ringwald     uint8_t  ttl          = mesh_foundation_default_ttl_get();
261f4854a5eSMatthias Ringwald     mesh_upper_transport_setup_access_pdu_header(pdu, netkey_index, appkey_index, ttl, src, dest, 0);
262321e3a3cSMatthias Ringwald     mesh_access_send_unacknowledged_pdu(pdu);
263f4854a5eSMatthias Ringwald }
264f4854a5eSMatthias Ringwald 
2652983fbcbSMatthias Ringwald static void config_composition_data_status(uint16_t netkey_index, uint16_t dest){
266f4854a5eSMatthias Ringwald 
267f4854a5eSMatthias Ringwald     printf("Received Config Composition Data Get -> send Config Composition Data Status\n");
268f4854a5eSMatthias Ringwald 
269f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = mesh_access_transport_init(MESH_FOUNDATION_OPERATION_COMPOSITION_DATA_STATUS);
270f4854a5eSMatthias Ringwald     if (!transport_pdu) return;
271f4854a5eSMatthias Ringwald 
272f4854a5eSMatthias Ringwald     // page 0
273f4854a5eSMatthias Ringwald     mesh_access_transport_add_uint8(transport_pdu, 0);
274f4854a5eSMatthias Ringwald 
275f4854a5eSMatthias Ringwald     // CID
276f4854a5eSMatthias Ringwald     mesh_access_transport_add_uint16(transport_pdu, BLUETOOTH_COMPANY_ID_BLUEKITCHEN_GMBH);
277f4854a5eSMatthias Ringwald     // PID
278f4854a5eSMatthias Ringwald     mesh_access_transport_add_uint16(transport_pdu, 0);
279f4854a5eSMatthias Ringwald     // VID
280f4854a5eSMatthias Ringwald     mesh_access_transport_add_uint16(transport_pdu, 0);
281f4854a5eSMatthias Ringwald     // CRPL - number of protection list entries
282f4854a5eSMatthias Ringwald     mesh_access_transport_add_uint16(transport_pdu, 1);
283f4854a5eSMatthias Ringwald     // Features - Relay, Proxy, Friend, Lower Power, ...
284f4854a5eSMatthias Ringwald     mesh_access_transport_add_uint16(transport_pdu, 0);
285f4854a5eSMatthias Ringwald 
2862983fbcbSMatthias Ringwald     mesh_element_iterator_t element_it;
2872983fbcbSMatthias Ringwald     mesh_element_iterator_init(&element_it);
2882983fbcbSMatthias Ringwald     while (mesh_element_iterator_has_next(&element_it)){
2892983fbcbSMatthias Ringwald         mesh_element_t * element = mesh_element_iterator_next(&element_it);
290f4854a5eSMatthias Ringwald 
291f4854a5eSMatthias Ringwald         // Loc
292f4854a5eSMatthias Ringwald         mesh_access_transport_add_uint16(transport_pdu, element->loc);
293f4854a5eSMatthias Ringwald         // NumS
294f4854a5eSMatthias Ringwald         mesh_access_transport_add_uint8( transport_pdu, element->models_count_sig);
295f4854a5eSMatthias Ringwald         // NumV
296f4854a5eSMatthias Ringwald         mesh_access_transport_add_uint8( transport_pdu, element->models_count_vendor);
297f4854a5eSMatthias Ringwald 
2982983fbcbSMatthias Ringwald         mesh_model_iterator_t model_it;
299f4854a5eSMatthias Ringwald 
300f4854a5eSMatthias Ringwald         // SIG Models
3012983fbcbSMatthias Ringwald         mesh_model_iterator_init(&model_it, element);
3022983fbcbSMatthias Ringwald         while (mesh_model_iterator_has_next(&model_it)){
3032983fbcbSMatthias Ringwald             mesh_model_t * model = mesh_model_iterator_next(&model_it);
304f4854a5eSMatthias Ringwald             if (!mesh_model_is_bluetooth_sig(model->model_identifier)) continue;
305f4854a5eSMatthias Ringwald             mesh_access_transport_add_uint16(transport_pdu, model->model_identifier);
306f4854a5eSMatthias Ringwald         }
307f4854a5eSMatthias Ringwald         // Vendor Models
3082983fbcbSMatthias Ringwald         mesh_model_iterator_init(&model_it, element);
3092983fbcbSMatthias Ringwald         while (mesh_model_iterator_has_next(&model_it)){
3102983fbcbSMatthias Ringwald             mesh_model_t * model = mesh_model_iterator_next(&model_it);
311f4854a5eSMatthias Ringwald             if (mesh_model_is_bluetooth_sig(model->model_identifier)) continue;
312f4854a5eSMatthias Ringwald             mesh_access_transport_add_uint32(transport_pdu, model->model_identifier);
313f4854a5eSMatthias Ringwald         }
314f4854a5eSMatthias Ringwald     }
315f4854a5eSMatthias Ringwald 
316f4854a5eSMatthias Ringwald     // send as segmented access pdu
317f4854a5eSMatthias Ringwald     config_server_send_message(netkey_index, dest, (mesh_pdu_t *) transport_pdu);
318f4854a5eSMatthias Ringwald }
319f4854a5eSMatthias Ringwald 
320f4854a5eSMatthias Ringwald static void config_composition_data_get_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
3212983fbcbSMatthias Ringwald     UNUSED(mesh_model);
3222983fbcbSMatthias Ringwald     config_composition_data_status(mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu));
323f4854a5eSMatthias Ringwald 
324f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
325f4854a5eSMatthias Ringwald }
326f4854a5eSMatthias Ringwald 
327f4854a5eSMatthias Ringwald static void config_model_beacon_status(mesh_model_t * mesh_model, uint16_t netkey_index, uint16_t dest){
3282983fbcbSMatthias Ringwald     UNUSED(mesh_model);
329f4854a5eSMatthias Ringwald     // setup message
330f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = mesh_access_setup_segmented_message(&mesh_foundation_config_beacon_status,
331f4854a5eSMatthias Ringwald                                                                                mesh_foundation_beacon_get());
332f4854a5eSMatthias Ringwald     if (!transport_pdu) return;
333f4854a5eSMatthias Ringwald 
334f4854a5eSMatthias Ringwald     // send as segmented access pdu
335f4854a5eSMatthias Ringwald     config_server_send_message(netkey_index, dest, (mesh_pdu_t *) transport_pdu);
336f4854a5eSMatthias Ringwald }
337f4854a5eSMatthias Ringwald 
338f4854a5eSMatthias Ringwald static void config_beacon_get_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
339f4854a5eSMatthias Ringwald     config_model_beacon_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu));
340f4854a5eSMatthias Ringwald 
341f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
342f4854a5eSMatthias Ringwald }
343f4854a5eSMatthias Ringwald 
344f4854a5eSMatthias Ringwald static void config_beacon_set_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
345f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
346f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
347f4854a5eSMatthias Ringwald 
348f4854a5eSMatthias Ringwald     uint8_t beacon_enabled = mesh_access_parser_get_u8(&parser);
349f4854a5eSMatthias Ringwald 
350f4854a5eSMatthias Ringwald     // beacon valid
351848dbc95SMatthias Ringwald     if (beacon_enabled < MESH_FOUNDATION_STATE_NOT_SUPPORTED) {
352848dbc95SMatthias Ringwald         // set and store new value
353f4854a5eSMatthias Ringwald         mesh_foundation_beacon_set(beacon_enabled);
354f4854a5eSMatthias Ringwald         mesh_foundation_state_store();
355f4854a5eSMatthias Ringwald 
356848dbc95SMatthias Ringwald         // send status
357f4854a5eSMatthias Ringwald         config_model_beacon_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu));
358848dbc95SMatthias Ringwald     }
359f4854a5eSMatthias Ringwald 
360f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
361f4854a5eSMatthias Ringwald }
362f4854a5eSMatthias Ringwald 
363f4854a5eSMatthias Ringwald static void config_model_default_ttl_status(mesh_model_t * mesh_model, uint16_t netkey_index, uint16_t dest){
3642983fbcbSMatthias Ringwald     UNUSED(mesh_model);
365f4854a5eSMatthias Ringwald     // setup message
366f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = mesh_access_setup_segmented_message(
367f4854a5eSMatthias Ringwald             &mesh_foundation_config_default_ttl_status, mesh_foundation_default_ttl_get());
368f4854a5eSMatthias Ringwald     if (!transport_pdu) return;
369f4854a5eSMatthias Ringwald 
370f4854a5eSMatthias Ringwald     // send as segmented access pdu
371f4854a5eSMatthias Ringwald     config_server_send_message(netkey_index, dest, (mesh_pdu_t *) transport_pdu);
372f4854a5eSMatthias Ringwald }
373f4854a5eSMatthias Ringwald 
374f4854a5eSMatthias Ringwald static void config_default_ttl_get_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
375f4854a5eSMatthias Ringwald     config_model_default_ttl_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu));
376f4854a5eSMatthias Ringwald 
377f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
378f4854a5eSMatthias Ringwald }
379f4854a5eSMatthias Ringwald 
380f4854a5eSMatthias Ringwald static void config_default_ttl_set_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
381f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
382f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
383f4854a5eSMatthias Ringwald 
384f4854a5eSMatthias Ringwald     uint8_t new_ttl = mesh_access_parser_get_u8(&parser);
385f4854a5eSMatthias Ringwald 
386848dbc95SMatthias Ringwald     // validate (0x01 and > 0x7f are prohibited)
387848dbc95SMatthias Ringwald     if (new_ttl <= 0x7f && new_ttl != 0x01) {
388848dbc95SMatthias Ringwald 
389848dbc95SMatthias Ringwald         // set and store
390f4854a5eSMatthias Ringwald         mesh_foundation_default_ttl_set(new_ttl);
391f4854a5eSMatthias Ringwald         mesh_foundation_state_store();
392f4854a5eSMatthias Ringwald 
393848dbc95SMatthias Ringwald         // send status
394f4854a5eSMatthias Ringwald         config_model_default_ttl_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu));
395848dbc95SMatthias Ringwald     }
396f4854a5eSMatthias Ringwald 
397f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
398f4854a5eSMatthias Ringwald }
399f4854a5eSMatthias Ringwald 
400f4854a5eSMatthias Ringwald static void config_friend_status(mesh_model_t * mesh_model, uint16_t netkey_index, uint16_t dest){
4012983fbcbSMatthias Ringwald     UNUSED(mesh_model);
4022983fbcbSMatthias Ringwald 
403f4854a5eSMatthias Ringwald     // setup message
404f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = mesh_access_setup_segmented_message(
405f4854a5eSMatthias Ringwald             &mesh_foundation_config_friend_status, mesh_foundation_friend_get());
406f4854a5eSMatthias Ringwald     if (!transport_pdu) return;
407f4854a5eSMatthias Ringwald 
408f4854a5eSMatthias Ringwald     // send as segmented access pdu
409f4854a5eSMatthias Ringwald     config_server_send_message(netkey_index, dest, (mesh_pdu_t *) transport_pdu);
410f4854a5eSMatthias Ringwald }
411f4854a5eSMatthias Ringwald 
412f4854a5eSMatthias Ringwald static void config_friend_get_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
413f4854a5eSMatthias Ringwald     config_friend_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu));
414f4854a5eSMatthias Ringwald 
415f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
416f4854a5eSMatthias Ringwald }
417f4854a5eSMatthias Ringwald 
418f4854a5eSMatthias Ringwald static void config_friend_set_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
419f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
420f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
421f4854a5eSMatthias Ringwald 
422f4854a5eSMatthias Ringwald     uint8_t new_friend_state = mesh_access_parser_get_u8(&parser);
423f4854a5eSMatthias Ringwald 
424f4854a5eSMatthias Ringwald     // validate
425848dbc95SMatthias Ringwald     if (new_friend_state < MESH_FOUNDATION_STATE_NOT_SUPPORTED) {
426f4854a5eSMatthias Ringwald 
427848dbc95SMatthias Ringwald         // set and store
428f4854a5eSMatthias Ringwald         if (mesh_foundation_friend_get() != MESH_FOUNDATION_STATE_NOT_SUPPORTED){
429f4854a5eSMatthias Ringwald             mesh_foundation_friend_set(new_friend_state);
430f4854a5eSMatthias Ringwald             mesh_foundation_state_store();
431f4854a5eSMatthias Ringwald         }
432f4854a5eSMatthias Ringwald 
433848dbc95SMatthias Ringwald         // send status
434f4854a5eSMatthias Ringwald         config_friend_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu));
435848dbc95SMatthias Ringwald     }
436f4854a5eSMatthias Ringwald 
437f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
438f4854a5eSMatthias Ringwald }
439f4854a5eSMatthias Ringwald 
440f4854a5eSMatthias Ringwald static void config_model_gatt_proxy_status(mesh_model_t * mesh_model, uint16_t netkey_index, uint16_t dest){
4412983fbcbSMatthias Ringwald     UNUSED(mesh_model);
442f4854a5eSMatthias Ringwald     // setup message
443848dbc95SMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = mesh_access_setup_segmented_message(&mesh_foundation_config_gatt_proxy_status, mesh_foundation_gatt_proxy_get());
444f4854a5eSMatthias Ringwald     if (!transport_pdu) return;
445f4854a5eSMatthias Ringwald 
446f4854a5eSMatthias Ringwald     // send as segmented access pdu
447f4854a5eSMatthias Ringwald     config_server_send_message(netkey_index, dest, (mesh_pdu_t *) transport_pdu);
448f4854a5eSMatthias Ringwald }
449f4854a5eSMatthias Ringwald 
450f4854a5eSMatthias Ringwald static void config_gatt_proxy_get_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
451f4854a5eSMatthias Ringwald     config_model_gatt_proxy_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu));
452f4854a5eSMatthias Ringwald 
453f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
454f4854a5eSMatthias Ringwald }
455f4854a5eSMatthias Ringwald 
456f4854a5eSMatthias Ringwald static void config_gatt_proxy_set_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
457f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
458f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
459f4854a5eSMatthias Ringwald 
460f4854a5eSMatthias Ringwald     uint8_t enabled = mesh_access_parser_get_u8(&parser);
461f4854a5eSMatthias Ringwald 
462848dbc95SMatthias Ringwald     // validate
463848dbc95SMatthias Ringwald     if (enabled <  MESH_FOUNDATION_STATE_NOT_SUPPORTED) {
464848dbc95SMatthias Ringwald         // set and store
465f4854a5eSMatthias Ringwald         mesh_foundation_gatt_proxy_set(enabled);
466f4854a5eSMatthias Ringwald         mesh_foundation_state_store();
467f4854a5eSMatthias Ringwald 
468848dbc95SMatthias Ringwald         // send status
469f4854a5eSMatthias Ringwald         config_model_gatt_proxy_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu));
470848dbc95SMatthias Ringwald     }
471f4854a5eSMatthias Ringwald 
472f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
473f4854a5eSMatthias Ringwald 
474f4854a5eSMatthias Ringwald     // trigger heartbeat emit on change
475f4854a5eSMatthias Ringwald     mesh_configuration_server_feature_changed();
476f4854a5eSMatthias Ringwald }
477f4854a5eSMatthias Ringwald 
478f4854a5eSMatthias Ringwald static void config_model_relay_status(mesh_model_t * mesh_model, uint16_t netkey_index, uint16_t dest){
4792983fbcbSMatthias Ringwald     UNUSED(mesh_model);
4802983fbcbSMatthias Ringwald 
481f4854a5eSMatthias Ringwald     // setup message
482f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = mesh_access_setup_segmented_message(&mesh_foundation_config_relay_status,
483f4854a5eSMatthias Ringwald                                                                                mesh_foundation_relay_get(),
484f4854a5eSMatthias Ringwald                                                                                mesh_foundation_relay_retransmit_get());
485f4854a5eSMatthias Ringwald     if (!transport_pdu) return;
486f4854a5eSMatthias Ringwald 
487f4854a5eSMatthias Ringwald     // send as segmented access pdu
488f4854a5eSMatthias Ringwald     config_server_send_message(netkey_index, dest, (mesh_pdu_t *) transport_pdu);
489f4854a5eSMatthias Ringwald }
490f4854a5eSMatthias Ringwald 
491f4854a5eSMatthias Ringwald static void config_relay_get_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
492f4854a5eSMatthias Ringwald     config_model_relay_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu));
493f4854a5eSMatthias Ringwald 
494f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
495f4854a5eSMatthias Ringwald }
496f4854a5eSMatthias Ringwald 
497f4854a5eSMatthias Ringwald static void config_relay_set_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
498f4854a5eSMatthias Ringwald 
499f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
500f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
501f4854a5eSMatthias Ringwald 
502f4854a5eSMatthias Ringwald     // check if valid
503f4854a5eSMatthias Ringwald     uint8_t relay            = mesh_access_parser_get_u8(&parser);
504f4854a5eSMatthias Ringwald     uint8_t relay_retransmit = mesh_access_parser_get_u8(&parser);
505f4854a5eSMatthias Ringwald 
506f4854a5eSMatthias Ringwald     // check if valid
507848dbc95SMatthias Ringwald     if (relay <= 1) {
508f4854a5eSMatthias Ringwald         // only update if supported
509f4854a5eSMatthias Ringwald         if (mesh_foundation_relay_get() != MESH_FOUNDATION_STATE_NOT_SUPPORTED){
510f4854a5eSMatthias Ringwald             mesh_foundation_relay_set(relay);
511f4854a5eSMatthias Ringwald             mesh_foundation_relay_retransmit_set(relay_retransmit);
512f4854a5eSMatthias Ringwald             mesh_foundation_state_store();
513f4854a5eSMatthias Ringwald         }
514f4854a5eSMatthias Ringwald 
515848dbc95SMatthias Ringwald         // send status
516f4854a5eSMatthias Ringwald         config_model_relay_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu));
517848dbc95SMatthias Ringwald     }
518f4854a5eSMatthias Ringwald 
519f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
520f4854a5eSMatthias Ringwald 
521f4854a5eSMatthias Ringwald     // trigger heartbeat emit on change
522f4854a5eSMatthias Ringwald     mesh_configuration_server_feature_changed();
523f4854a5eSMatthias Ringwald }
524f4854a5eSMatthias Ringwald 
525f4854a5eSMatthias Ringwald static void config_model_network_transmit_status(mesh_model_t * mesh_model, uint16_t netkey_index, uint16_t dest){
5262983fbcbSMatthias Ringwald     UNUSED(mesh_model);
5272983fbcbSMatthias Ringwald 
528f4854a5eSMatthias Ringwald     // setup message
529f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = mesh_access_setup_segmented_message(
530f4854a5eSMatthias Ringwald             &mesh_foundation_config_network_transmit_status, mesh_foundation_network_transmit_get());
531f4854a5eSMatthias Ringwald     if (!transport_pdu) return;
532f4854a5eSMatthias Ringwald 
533f4854a5eSMatthias Ringwald     // send as segmented access pdu
534f4854a5eSMatthias Ringwald     config_server_send_message(netkey_index, dest, (mesh_pdu_t *) transport_pdu);
535f4854a5eSMatthias Ringwald }
536f4854a5eSMatthias Ringwald 
537f4854a5eSMatthias Ringwald static void config_model_network_transmit_get_handler(mesh_model_t * mesh_model, mesh_pdu_t * pdu){
538f4854a5eSMatthias Ringwald     config_model_network_transmit_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu));
539f4854a5eSMatthias Ringwald 
540f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
541f4854a5eSMatthias Ringwald }
542f4854a5eSMatthias Ringwald 
543f4854a5eSMatthias Ringwald static void config_model_network_transmit_set_handler(mesh_model_t * mesh_model, mesh_pdu_t * pdu){
544f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
545f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
546f4854a5eSMatthias Ringwald 
547f4854a5eSMatthias Ringwald     uint8_t new_ttl = mesh_access_parser_get_u8(&parser);
548f4854a5eSMatthias Ringwald 
549f4854a5eSMatthias Ringwald     // store
550f4854a5eSMatthias Ringwald     mesh_foundation_network_transmit_set(new_ttl);
551f4854a5eSMatthias Ringwald     mesh_foundation_state_store();
552f4854a5eSMatthias Ringwald 
553f4854a5eSMatthias Ringwald     //
554f4854a5eSMatthias Ringwald     config_model_network_transmit_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu));
555f4854a5eSMatthias Ringwald 
556f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
557f4854a5eSMatthias Ringwald }
558f4854a5eSMatthias Ringwald 
559f4854a5eSMatthias Ringwald // NetKey List
560f4854a5eSMatthias Ringwald 
561f4854a5eSMatthias Ringwald void config_nekey_list_set_max(uint16_t max){
562f4854a5eSMatthias Ringwald     config_netkey_list_max = max;
563f4854a5eSMatthias Ringwald }
564f4854a5eSMatthias Ringwald 
565f4854a5eSMatthias Ringwald static void config_netkey_status(mesh_model_t * mesh_model, uint16_t netkey_index, uint16_t dest, uint8_t status, uint16_t new_netkey_index){
5662983fbcbSMatthias Ringwald     UNUSED(mesh_model);
5672983fbcbSMatthias Ringwald 
568f4854a5eSMatthias Ringwald     // setup message
569f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = mesh_access_setup_segmented_message(
570f4854a5eSMatthias Ringwald             &mesh_foundation_config_netkey_status, status, new_netkey_index);
571f4854a5eSMatthias Ringwald     if (!transport_pdu) return;
572f4854a5eSMatthias Ringwald 
573f4854a5eSMatthias Ringwald     // send as segmented access pdu
574f4854a5eSMatthias Ringwald     config_server_send_message(netkey_index, dest, (mesh_pdu_t *) transport_pdu);
575f4854a5eSMatthias Ringwald }
576f4854a5eSMatthias Ringwald 
577f4854a5eSMatthias Ringwald static void config_netkey_list(mesh_model_t * mesh_model, uint16_t netkey_index, uint16_t dest) {
5782983fbcbSMatthias Ringwald     UNUSED(mesh_model);
5792983fbcbSMatthias Ringwald 
580f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = mesh_access_transport_init(MESH_FOUNDATION_OPERATION_NETKEY_LIST);
581f4854a5eSMatthias Ringwald     if (!transport_pdu) return;
582f4854a5eSMatthias Ringwald 
583f4854a5eSMatthias Ringwald     // add list of netkey indexes
584f4854a5eSMatthias Ringwald     mesh_network_key_iterator_t it;
585f4854a5eSMatthias Ringwald     mesh_network_key_iterator_init(&it);
586f4854a5eSMatthias Ringwald     while (mesh_network_key_iterator_has_more(&it)){
587f4854a5eSMatthias Ringwald         mesh_network_key_t * network_key = mesh_network_key_iterator_get_next(&it);
588f4854a5eSMatthias Ringwald         mesh_access_transport_add_uint16(transport_pdu, network_key->netkey_index);
589f4854a5eSMatthias Ringwald     }
590f4854a5eSMatthias Ringwald 
591f4854a5eSMatthias Ringwald     // send as segmented access pdu
592f4854a5eSMatthias Ringwald     config_server_send_message(netkey_index, dest, (mesh_pdu_t *) transport_pdu);
593f4854a5eSMatthias Ringwald }
594f4854a5eSMatthias Ringwald 
595f4854a5eSMatthias Ringwald static void config_netkey_add_derived(void * arg){
596f4854a5eSMatthias Ringwald     mesh_subnet_t * subnet = (mesh_subnet_t *) arg;
597f4854a5eSMatthias Ringwald 
598f4854a5eSMatthias Ringwald     // store network key
599f4854a5eSMatthias Ringwald     mesh_store_network_key(subnet->old_key);
600f4854a5eSMatthias Ringwald 
601f4854a5eSMatthias Ringwald     // add key to NetKey List
602f4854a5eSMatthias Ringwald     mesh_network_key_add(subnet->old_key);
603f4854a5eSMatthias Ringwald 
604f4854a5eSMatthias Ringwald     // add subnet
605f4854a5eSMatthias Ringwald     mesh_subnet_add(subnet);
606f4854a5eSMatthias Ringwald 
607f4854a5eSMatthias Ringwald #ifdef ENABLE_MESH_PROXY_SERVER
608f4854a5eSMatthias Ringwald     mesh_proxy_start_advertising_with_network_id();
609f4854a5eSMatthias Ringwald #endif
610f4854a5eSMatthias Ringwald 
611f4854a5eSMatthias Ringwald     config_netkey_status(mesh_model_get_configuration_server(), mesh_pdu_netkey_index(access_pdu_in_process), mesh_pdu_src(access_pdu_in_process), MESH_FOUNDATION_STATUS_SUCCESS, subnet->netkey_index);
612f4854a5eSMatthias Ringwald     mesh_access_message_processed(access_pdu_in_process);
613f4854a5eSMatthias Ringwald }
614f4854a5eSMatthias Ringwald 
615f4854a5eSMatthias Ringwald static void config_netkey_add_handler(mesh_model_t * mesh_model, mesh_pdu_t * pdu){
616f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
617f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
618f4854a5eSMatthias Ringwald 
619f4854a5eSMatthias Ringwald     // get params
620f4854a5eSMatthias Ringwald     uint8_t new_netkey[16];
621f4854a5eSMatthias Ringwald     uint16_t new_netkey_index = mesh_access_parser_get_u16(&parser);
622f4854a5eSMatthias Ringwald     mesh_access_parser_get_key(&parser, new_netkey);
623f4854a5eSMatthias Ringwald 
624f4854a5eSMatthias Ringwald     uint8_t status;
625f4854a5eSMatthias Ringwald 
626f4854a5eSMatthias Ringwald     const mesh_subnet_t * existing_subnet = mesh_subnet_get_by_netkey_index(new_netkey_index);
627f4854a5eSMatthias Ringwald     if (existing_subnet == NULL){
628f4854a5eSMatthias Ringwald 
629f4854a5eSMatthias Ringwald         // check limit for pts
630f4854a5eSMatthias Ringwald         uint16_t internal_index = mesh_network_key_get_free_index();
6310500a934SMatthias Ringwald         if (internal_index == MESH_KEYS_INVALID_INDEX || (config_netkey_list_max && mesh_network_key_list_count() >= config_netkey_list_max)){
632f4854a5eSMatthias Ringwald             status = MESH_FOUNDATION_STATUS_INSUFFICIENT_RESOURCES;
633f4854a5eSMatthias Ringwald         } else {
634f4854a5eSMatthias Ringwald 
635f4854a5eSMatthias Ringwald             // allocate new key and subnet
636f4854a5eSMatthias Ringwald             mesh_network_key_t * new_network_key = btstack_memory_mesh_network_key_get();
637f4854a5eSMatthias Ringwald             mesh_subnet_t * new_subnet = btstack_memory_mesh_subnet_get();
638f4854a5eSMatthias Ringwald 
639f4854a5eSMatthias Ringwald             if (new_network_key == NULL || new_subnet == NULL){
640f4854a5eSMatthias Ringwald                 if (new_network_key != NULL){
641f4854a5eSMatthias Ringwald                     btstack_memory_mesh_network_key_free(new_network_key);
642f4854a5eSMatthias Ringwald                 }
643f4854a5eSMatthias Ringwald                 if (new_subnet != NULL){
644f4854a5eSMatthias Ringwald                     btstack_memory_mesh_subnet_free(new_subnet);
645f4854a5eSMatthias Ringwald                 }
646f4854a5eSMatthias Ringwald                 status = MESH_FOUNDATION_STATUS_INSUFFICIENT_RESOURCES;
647f4854a5eSMatthias Ringwald 
648f4854a5eSMatthias Ringwald             } else {
649f4854a5eSMatthias Ringwald 
650f4854a5eSMatthias Ringwald                 // setup key
651f4854a5eSMatthias Ringwald                 new_network_key->internal_index = internal_index;
652f4854a5eSMatthias Ringwald                 new_network_key->netkey_index   = new_netkey_index;
653f4854a5eSMatthias Ringwald                 memcpy(new_network_key->net_key, new_netkey, 16);
654f4854a5eSMatthias Ringwald 
655f4854a5eSMatthias Ringwald                 // setup subnet
656f4854a5eSMatthias Ringwald                 new_subnet->old_key = new_network_key;
657f4854a5eSMatthias Ringwald                 new_subnet->netkey_index = new_netkey_index;
658f4854a5eSMatthias Ringwald                 new_subnet->key_refresh = MESH_KEY_REFRESH_NOT_ACTIVE;
659f4854a5eSMatthias Ringwald 
660f4854a5eSMatthias Ringwald                 // derive other keys
661f4854a5eSMatthias Ringwald                 access_pdu_in_process = pdu;
662e6fd81e5SMatthias Ringwald                 mesh_network_key_derive(&configuration_server_cmac_request, new_network_key, config_netkey_add_derived, new_subnet);
663f4854a5eSMatthias Ringwald                 return;
664f4854a5eSMatthias Ringwald             }
665f4854a5eSMatthias Ringwald         }
666f4854a5eSMatthias Ringwald 
667f4854a5eSMatthias Ringwald     } else {
668f4854a5eSMatthias Ringwald         // network key for netkey index already exists
669f4854a5eSMatthias Ringwald         if (memcmp(existing_subnet->old_key->net_key, new_netkey, 16) == 0){
670f4854a5eSMatthias Ringwald             // same netkey
671f4854a5eSMatthias Ringwald             status = MESH_FOUNDATION_STATUS_SUCCESS;
672f4854a5eSMatthias Ringwald         } else {
673f4854a5eSMatthias Ringwald             // different netkey
674f4854a5eSMatthias Ringwald             status = MESH_FOUNDATION_STATUS_KEY_INDEX_ALREADY_STORED;
675f4854a5eSMatthias Ringwald         }
676f4854a5eSMatthias Ringwald     }
677f4854a5eSMatthias Ringwald 
678f4854a5eSMatthias Ringwald     // report status
679f4854a5eSMatthias Ringwald     config_netkey_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), status, new_netkey_index);
680669b33c9SMatthias Ringwald     mesh_access_message_processed(pdu);
681f4854a5eSMatthias Ringwald }
682f4854a5eSMatthias Ringwald 
683f4854a5eSMatthias Ringwald static void config_netkey_update_derived(void * arg){
684f4854a5eSMatthias Ringwald     mesh_subnet_t * subnet = (mesh_subnet_t *) arg;
685f4854a5eSMatthias Ringwald 
686f4854a5eSMatthias Ringwald     // store network key
687f4854a5eSMatthias Ringwald     mesh_store_network_key(subnet->new_key);
688f4854a5eSMatthias Ringwald 
689f4854a5eSMatthias Ringwald     // add key to NetKey List
690f4854a5eSMatthias Ringwald     mesh_network_key_add(subnet->new_key);
691f4854a5eSMatthias Ringwald 
692f4854a5eSMatthias Ringwald     // update subnet - Key Refresh Phase 1
693f4854a5eSMatthias Ringwald     subnet->key_refresh = MESH_KEY_REFRESH_FIRST_PHASE;
694f4854a5eSMatthias Ringwald 
695f4854a5eSMatthias Ringwald     // report status
696f4854a5eSMatthias Ringwald     config_netkey_status(mesh_model_get_configuration_server(), mesh_pdu_netkey_index(access_pdu_in_process), mesh_pdu_src(access_pdu_in_process), MESH_FOUNDATION_STATUS_SUCCESS, subnet->netkey_index);
697f4854a5eSMatthias Ringwald     mesh_access_message_processed(access_pdu_in_process);
698f4854a5eSMatthias Ringwald }
699f4854a5eSMatthias Ringwald 
700f4854a5eSMatthias Ringwald static void config_netkey_update_handler(mesh_model_t * mesh_model, mesh_pdu_t * pdu) {
701f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
702f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t *) pdu);
703f4854a5eSMatthias Ringwald 
704f4854a5eSMatthias Ringwald     // get params
705f4854a5eSMatthias Ringwald     uint8_t new_netkey[16];
706f4854a5eSMatthias Ringwald     uint16_t netkey_index = mesh_access_parser_get_u16(&parser);
707f4854a5eSMatthias Ringwald     mesh_access_parser_get_key(&parser, new_netkey);
708f4854a5eSMatthias Ringwald 
709f4854a5eSMatthias Ringwald     // get existing subnet
710f4854a5eSMatthias Ringwald     mesh_subnet_t * subnet = mesh_subnet_get_by_netkey_index(netkey_index);
711f4854a5eSMatthias Ringwald     if (subnet == NULL){
712f4854a5eSMatthias Ringwald         config_netkey_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), MESH_FOUNDATION_STATUS_INVALID_NETKEY_INDEX, netkey_index);
713f4854a5eSMatthias Ringwald         mesh_access_message_processed(access_pdu_in_process);
714f4854a5eSMatthias Ringwald         return;
715f4854a5eSMatthias Ringwald     }
716f4854a5eSMatthias Ringwald 
7170500a934SMatthias Ringwald     // get index for new key
718f4854a5eSMatthias Ringwald     uint16_t internal_index = mesh_network_key_get_free_index();
7190500a934SMatthias Ringwald     if (internal_index == MESH_KEYS_INVALID_INDEX){
7200500a934SMatthias Ringwald         config_netkey_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), MESH_FOUNDATION_STATUS_INSUFFICIENT_RESOURCES, netkey_index);
7210500a934SMatthias Ringwald         mesh_access_message_processed(access_pdu_in_process);
7220500a934SMatthias Ringwald         return;
7230500a934SMatthias Ringwald     }
7240500a934SMatthias Ringwald 
7250500a934SMatthias Ringwald     // get new key
726f4854a5eSMatthias Ringwald     mesh_network_key_t * new_network_key = btstack_memory_mesh_network_key_get();
7270500a934SMatthias Ringwald     if (new_network_key == NULL){
728f4854a5eSMatthias Ringwald         config_netkey_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), MESH_FOUNDATION_STATUS_INSUFFICIENT_RESOURCES, netkey_index);
729f4854a5eSMatthias Ringwald         mesh_access_message_processed(access_pdu_in_process);
730f4854a5eSMatthias Ringwald         return;
731f4854a5eSMatthias Ringwald     }
732f4854a5eSMatthias Ringwald 
733f4854a5eSMatthias Ringwald     // setup new key
734f4854a5eSMatthias Ringwald     new_network_key->internal_index = internal_index;
735f4854a5eSMatthias Ringwald     new_network_key->netkey_index   = netkey_index;
736f4854a5eSMatthias Ringwald     new_network_key->version        = (uint8_t)(subnet->old_key->version + 1);
737f4854a5eSMatthias Ringwald     memcpy(new_network_key->net_key, new_netkey, 16);
738f4854a5eSMatthias Ringwald 
739f4854a5eSMatthias Ringwald     // store in subnet (not active yet)
740f4854a5eSMatthias Ringwald     subnet->new_key = new_network_key;
741f4854a5eSMatthias Ringwald 
742f4854a5eSMatthias Ringwald     // derive other keys
743f4854a5eSMatthias Ringwald     access_pdu_in_process = pdu;
744f4854a5eSMatthias Ringwald     mesh_network_key_derive(&configuration_server_cmac_request, new_network_key, config_netkey_update_derived, subnet);
745f4854a5eSMatthias Ringwald }
746f4854a5eSMatthias Ringwald 
747f4854a5eSMatthias Ringwald static void config_netkey_delete_handler(mesh_model_t * mesh_model, mesh_pdu_t * pdu) {
748f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
749f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t *) pdu);
750f4854a5eSMatthias Ringwald 
751f4854a5eSMatthias Ringwald     // get params
752f4854a5eSMatthias Ringwald     uint16_t netkey_index = mesh_access_parser_get_u16(&parser);
753f4854a5eSMatthias Ringwald 
754f4854a5eSMatthias Ringwald     // get existing network_key
755f4854a5eSMatthias Ringwald     uint8_t status = MESH_FOUNDATION_STATUS_SUCCESS;
756f4854a5eSMatthias Ringwald 
757f4854a5eSMatthias Ringwald     // remove subnet
758f4854a5eSMatthias Ringwald     mesh_subnet_t * subnet = mesh_subnet_get_by_netkey_index(netkey_index);
759f4854a5eSMatthias Ringwald     if (subnet != NULL){
760f4854a5eSMatthias Ringwald         // A NetKey shall not be deleted from the NetKey List using a message secured with this NetKey.
76185f51b64SMatthias Ringwald         // Also prevents deleting the last network key
76285f51b64SMatthias Ringwald         if (netkey_index != mesh_pdu_netkey_index(pdu)){
763f4854a5eSMatthias Ringwald 
764f4854a5eSMatthias Ringwald             // remove all appkeys for this netkey
765f4854a5eSMatthias Ringwald             mesh_transport_key_iterator_t it;
766f4854a5eSMatthias Ringwald             mesh_transport_key_iterator_init(&it, netkey_index);
767f4854a5eSMatthias Ringwald             while (mesh_transport_key_iterator_has_more(&it)){
768f4854a5eSMatthias Ringwald                 mesh_transport_key_t * transport_key = mesh_transport_key_iterator_get_next(&it);
769f4854a5eSMatthias Ringwald                 mesh_configuration_server_delete_appkey(transport_key);
770f4854a5eSMatthias Ringwald             }
771f4854a5eSMatthias Ringwald 
772f4854a5eSMatthias Ringwald             // delete old/current key
773f4854a5eSMatthias Ringwald             mesh_access_netkey_finalize(subnet->old_key);
774f4854a5eSMatthias Ringwald             subnet->old_key = NULL;
775f4854a5eSMatthias Ringwald 
776f4854a5eSMatthias Ringwald             // delete new key
777f4854a5eSMatthias Ringwald             if (subnet->new_key != NULL){
778f4854a5eSMatthias Ringwald                 mesh_access_netkey_finalize(subnet->new_key);
779f4854a5eSMatthias Ringwald                 subnet->new_key = NULL;
780f4854a5eSMatthias Ringwald             }
781f4854a5eSMatthias Ringwald 
782f4854a5eSMatthias Ringwald             // remove subnet
783f4854a5eSMatthias Ringwald             mesh_subnet_remove(subnet);
784f4854a5eSMatthias Ringwald             btstack_memory_mesh_subnet_free(subnet);
785f4854a5eSMatthias Ringwald 
786f4854a5eSMatthias Ringwald         } else {
787f4854a5eSMatthias Ringwald             status = MESH_FOUNDATION_STATUS_CANNOT_REMOVE;
788f4854a5eSMatthias Ringwald         }
789f4854a5eSMatthias Ringwald     }
790f4854a5eSMatthias Ringwald     config_netkey_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), status, netkey_index);
791f4854a5eSMatthias Ringwald }
792f4854a5eSMatthias Ringwald 
793f4854a5eSMatthias Ringwald static void config_netkey_get_handler(mesh_model_t * mesh_model, mesh_pdu_t * pdu){
794f4854a5eSMatthias Ringwald     config_netkey_list(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu));
795f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
796f4854a5eSMatthias Ringwald }
797f4854a5eSMatthias Ringwald 
798f4854a5eSMatthias Ringwald // AppKey List
799f4854a5eSMatthias Ringwald 
800f4854a5eSMatthias Ringwald static void config_appkey_status(mesh_model_t * mesh_model, uint16_t netkey_index, uint16_t dest, uint32_t netkey_and_appkey_index, uint8_t status){
8012983fbcbSMatthias Ringwald     UNUSED(mesh_model);
8022983fbcbSMatthias Ringwald 
803f4854a5eSMatthias Ringwald     // setup message
804f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = mesh_access_setup_segmented_message(&mesh_foundation_config_appkey_status,
805f4854a5eSMatthias Ringwald                                                                                status, netkey_and_appkey_index);
806f4854a5eSMatthias Ringwald     if (!transport_pdu) return;
807f4854a5eSMatthias Ringwald 
808f4854a5eSMatthias Ringwald     // send as segmented access pdu
809f4854a5eSMatthias Ringwald     config_server_send_message(netkey_index, dest, (mesh_pdu_t *) transport_pdu);
810f4854a5eSMatthias Ringwald }
811f4854a5eSMatthias Ringwald 
812f4854a5eSMatthias Ringwald static void config_appkey_list(mesh_model_t * mesh_model, uint16_t netkey_index, uint16_t dest, uint32_t netkey_index_of_list){
8132983fbcbSMatthias Ringwald     UNUSED(mesh_model);
8142983fbcbSMatthias Ringwald 
815f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = mesh_access_transport_init(MESH_FOUNDATION_OPERATION_APPKEY_LIST);
816f4854a5eSMatthias Ringwald     if (!transport_pdu) return;
817f4854a5eSMatthias Ringwald 
818f4854a5eSMatthias Ringwald     // check netkey_index is valid
819f4854a5eSMatthias Ringwald     mesh_network_key_t * network_key = mesh_network_key_list_get(netkey_index_of_list);
820f4854a5eSMatthias Ringwald     uint8_t status;
821f4854a5eSMatthias Ringwald     if (network_key == NULL){
822f4854a5eSMatthias Ringwald         status = MESH_FOUNDATION_STATUS_INVALID_NETKEY_INDEX;
823f4854a5eSMatthias Ringwald     } else {
824f4854a5eSMatthias Ringwald         status = MESH_FOUNDATION_STATUS_SUCCESS;
825f4854a5eSMatthias Ringwald     }
826f4854a5eSMatthias Ringwald     mesh_access_transport_add_uint8(transport_pdu, status);
827f4854a5eSMatthias Ringwald     mesh_access_transport_add_uint16(transport_pdu, netkey_index_of_list);
828f4854a5eSMatthias Ringwald 
829f4854a5eSMatthias Ringwald     // add list of appkey indexes
830f4854a5eSMatthias Ringwald     mesh_transport_key_iterator_t it;
831f4854a5eSMatthias Ringwald     mesh_transport_key_iterator_init(&it, netkey_index_of_list);
832f4854a5eSMatthias Ringwald     while (mesh_transport_key_iterator_has_more(&it)){
833f4854a5eSMatthias Ringwald         mesh_transport_key_t * transport_key = mesh_transport_key_iterator_get_next(&it);
834f4854a5eSMatthias Ringwald         mesh_access_transport_add_uint16(transport_pdu, transport_key->appkey_index);
835f4854a5eSMatthias Ringwald     }
836f4854a5eSMatthias Ringwald 
837f4854a5eSMatthias Ringwald     // send as segmented access pdu
838f4854a5eSMatthias Ringwald     config_server_send_message(netkey_index, dest, (mesh_pdu_t *) transport_pdu);
839f4854a5eSMatthias Ringwald }
840f4854a5eSMatthias Ringwald 
841f4854a5eSMatthias Ringwald static void config_appkey_add_or_update_aid(void *arg){
842f4854a5eSMatthias Ringwald     mesh_transport_key_t * transport_key = (mesh_transport_key_t *) arg;
843f4854a5eSMatthias Ringwald 
844f4854a5eSMatthias Ringwald     printf("Config Appkey Add/Update: NetKey Index 0x%04x, AppKey Index 0x%04x, AID %02x: ", transport_key->netkey_index, transport_key->appkey_index, transport_key->aid);
845f4854a5eSMatthias Ringwald     printf_hexdump(transport_key->key, 16);
846f4854a5eSMatthias Ringwald 
847f4854a5eSMatthias Ringwald     // store in TLV
848f4854a5eSMatthias Ringwald     mesh_store_app_key(transport_key);
849f4854a5eSMatthias Ringwald 
850f4854a5eSMatthias Ringwald     // add app key
851f4854a5eSMatthias Ringwald     mesh_transport_key_add(transport_key);
852f4854a5eSMatthias Ringwald 
853f4854a5eSMatthias Ringwald     uint32_t netkey_and_appkey_index = (transport_key->appkey_index << 12) | transport_key->netkey_index;
854f4854a5eSMatthias Ringwald     config_appkey_status(mesh_model_get_configuration_server(),  mesh_pdu_netkey_index(access_pdu_in_process), mesh_pdu_src(access_pdu_in_process), netkey_and_appkey_index, MESH_FOUNDATION_STATUS_SUCCESS);
855f4854a5eSMatthias Ringwald 
856f4854a5eSMatthias Ringwald     mesh_access_message_processed(access_pdu_in_process);
857f4854a5eSMatthias Ringwald }
858f4854a5eSMatthias Ringwald 
859f4854a5eSMatthias Ringwald static void config_appkey_add_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu) {
860f4854a5eSMatthias Ringwald 
861f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
862f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
863f4854a5eSMatthias Ringwald 
864f4854a5eSMatthias Ringwald     // netkey and appkey index
865f4854a5eSMatthias Ringwald     uint32_t netkey_and_appkey_index = mesh_access_parser_get_u24(&parser);
866f4854a5eSMatthias Ringwald     uint16_t netkey_index = netkey_and_appkey_index & 0xfff;
867f4854a5eSMatthias Ringwald     uint16_t appkey_index = netkey_and_appkey_index >> 12;
868f4854a5eSMatthias Ringwald 
869f4854a5eSMatthias Ringwald     // actual key
870f4854a5eSMatthias Ringwald     uint8_t  appkey[16];
871f4854a5eSMatthias Ringwald     mesh_access_parser_get_key(&parser, appkey);
872f4854a5eSMatthias Ringwald 
873f4854a5eSMatthias Ringwald     // check netkey_index is valid
874f4854a5eSMatthias Ringwald     mesh_network_key_t * network_key = mesh_network_key_list_get(netkey_index);
875f4854a5eSMatthias Ringwald     if (network_key == NULL){
876f4854a5eSMatthias Ringwald         config_appkey_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), netkey_and_appkey_index, MESH_FOUNDATION_STATUS_INVALID_NETKEY_INDEX);
877f4854a5eSMatthias Ringwald         mesh_access_message_processed(pdu);
878f4854a5eSMatthias Ringwald         return;
879f4854a5eSMatthias Ringwald     }
880f4854a5eSMatthias Ringwald 
881f4854a5eSMatthias Ringwald     // check if appkey already exists
882f4854a5eSMatthias Ringwald     mesh_transport_key_t * transport_key = mesh_transport_key_get(appkey_index);
883f4854a5eSMatthias Ringwald     if (transport_key){
884f4854a5eSMatthias Ringwald         uint8_t status;
885f4854a5eSMatthias Ringwald         if (transport_key->netkey_index != netkey_index){
886f4854a5eSMatthias Ringwald             // already stored but with different netkey
887f4854a5eSMatthias Ringwald             status = MESH_FOUNDATION_STATUS_INVALID_NETKEY_INDEX;
888f4854a5eSMatthias Ringwald         } else if (memcmp(transport_key->key, appkey, 16) == 0){
889f4854a5eSMatthias Ringwald             // key identical
890f4854a5eSMatthias Ringwald             status = MESH_FOUNDATION_STATUS_SUCCESS;
891f4854a5eSMatthias Ringwald         } else {
892f4854a5eSMatthias Ringwald             // key differs
893f4854a5eSMatthias Ringwald             status = MESH_FOUNDATION_STATUS_KEY_INDEX_ALREADY_STORED;
894f4854a5eSMatthias Ringwald         }
895f4854a5eSMatthias Ringwald         config_appkey_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), netkey_and_appkey_index, status);
896f4854a5eSMatthias Ringwald         mesh_access_message_processed(pdu);
897f4854a5eSMatthias Ringwald         return;
898f4854a5eSMatthias Ringwald     }
899f4854a5eSMatthias Ringwald 
900f4854a5eSMatthias Ringwald     // create app key (first get free slot in transport key table)
901f4854a5eSMatthias Ringwald     mesh_transport_key_t * app_key = NULL;
902f4854a5eSMatthias Ringwald     uint16_t internal_index = mesh_transport_key_get_free_index();
903f4854a5eSMatthias Ringwald     if (internal_index > 0){
904f4854a5eSMatthias Ringwald         app_key = btstack_memory_mesh_transport_key_get();
905f4854a5eSMatthias Ringwald     }
906f4854a5eSMatthias Ringwald     if (app_key == NULL) {
907f4854a5eSMatthias Ringwald         config_appkey_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), netkey_and_appkey_index, MESH_FOUNDATION_STATUS_INSUFFICIENT_RESOURCES);
908f4854a5eSMatthias Ringwald         mesh_access_message_processed(pdu);
909f4854a5eSMatthias Ringwald         return;
910f4854a5eSMatthias Ringwald     }
911f4854a5eSMatthias Ringwald 
912f4854a5eSMatthias Ringwald     // store data
913f4854a5eSMatthias Ringwald     app_key->internal_index = internal_index;
914f4854a5eSMatthias Ringwald     app_key->akf = 1;
915f4854a5eSMatthias Ringwald     app_key->appkey_index = appkey_index;
916f4854a5eSMatthias Ringwald     app_key->netkey_index = netkey_index;
917f4854a5eSMatthias Ringwald     app_key->version = 0;
918f4854a5eSMatthias Ringwald     app_key->old_key = 0;
919f4854a5eSMatthias Ringwald 
920f4854a5eSMatthias Ringwald     memcpy(app_key->key, appkey, 16);
921f4854a5eSMatthias Ringwald 
922f4854a5eSMatthias Ringwald     // calculate AID
923f4854a5eSMatthias Ringwald     access_pdu_in_process = pdu;
924f4854a5eSMatthias Ringwald     mesh_transport_key_calc_aid(&configuration_server_cmac_request, app_key, config_appkey_add_or_update_aid, app_key);
925f4854a5eSMatthias Ringwald }
926f4854a5eSMatthias Ringwald 
927f4854a5eSMatthias Ringwald static void config_appkey_update_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu) {
928f4854a5eSMatthias Ringwald 
929f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
930f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
931f4854a5eSMatthias Ringwald 
932f4854a5eSMatthias Ringwald     // netkey and appkey index
933f4854a5eSMatthias Ringwald     uint32_t netkey_and_appkey_index = mesh_access_parser_get_u24(&parser);
934f4854a5eSMatthias Ringwald     uint16_t netkey_index = netkey_and_appkey_index & 0xfff;
935f4854a5eSMatthias Ringwald     uint16_t appkey_index = netkey_and_appkey_index >> 12;
936f4854a5eSMatthias Ringwald 
937f4854a5eSMatthias Ringwald     // actual key
938f4854a5eSMatthias Ringwald     uint8_t  appkey[16];
939f4854a5eSMatthias Ringwald     mesh_access_parser_get_key(&parser, appkey);
940f4854a5eSMatthias Ringwald 
941f4854a5eSMatthias Ringwald 
942f4854a5eSMatthias Ringwald // for PTS testing
943f4854a5eSMatthias Ringwald     // check netkey_index is valid
944f4854a5eSMatthias Ringwald     mesh_network_key_t * network_key = mesh_network_key_list_get(netkey_index);
945f4854a5eSMatthias Ringwald     if (network_key == NULL){
946f4854a5eSMatthias Ringwald         config_appkey_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), netkey_and_appkey_index, MESH_FOUNDATION_STATUS_INVALID_NETKEY_INDEX);
947f4854a5eSMatthias Ringwald         mesh_access_message_processed(pdu);
948f4854a5eSMatthias Ringwald         return;
949f4854a5eSMatthias Ringwald     }
950f4854a5eSMatthias Ringwald 
951f4854a5eSMatthias Ringwald     // check if appkey already exists
952f4854a5eSMatthias Ringwald     mesh_transport_key_t * existing_app_key = mesh_transport_key_get(appkey_index);
953f4854a5eSMatthias Ringwald     if (!existing_app_key) {
954f4854a5eSMatthias Ringwald         config_appkey_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), netkey_and_appkey_index, MESH_FOUNDATION_STATUS_INVALID_APPKEY_INDEX);
955f4854a5eSMatthias Ringwald         mesh_access_message_processed(pdu);
956f4854a5eSMatthias Ringwald         return;
957f4854a5eSMatthias Ringwald     }
958f4854a5eSMatthias Ringwald 
959f4854a5eSMatthias Ringwald     if (existing_app_key->netkey_index != netkey_index){
960f4854a5eSMatthias Ringwald         // already stored but with different netkey
961f4854a5eSMatthias Ringwald         config_appkey_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), netkey_and_appkey_index, MESH_FOUNDATION_STATUS_INVALID_BINDING);
962f4854a5eSMatthias Ringwald         mesh_access_message_processed(pdu);
963f4854a5eSMatthias Ringwald         return;
964f4854a5eSMatthias Ringwald     }
965f4854a5eSMatthias Ringwald 
966f4854a5eSMatthias Ringwald     if (memcmp(existing_app_key->key, appkey, 16) == 0){
967f4854a5eSMatthias Ringwald         // key identical
968f4854a5eSMatthias Ringwald         config_appkey_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), netkey_and_appkey_index, MESH_FOUNDATION_STATUS_SUCCESS);
969f4854a5eSMatthias Ringwald         mesh_access_message_processed(pdu);
970f4854a5eSMatthias Ringwald         return;
971f4854a5eSMatthias Ringwald     }
972f4854a5eSMatthias Ringwald 
973f4854a5eSMatthias Ringwald     // create app key
974f4854a5eSMatthias Ringwald     mesh_transport_key_t * new_app_key = NULL;
975f4854a5eSMatthias Ringwald     uint16_t internal_index = mesh_transport_key_get_free_index();
976f4854a5eSMatthias Ringwald     if (internal_index > 0){
977f4854a5eSMatthias Ringwald         new_app_key = btstack_memory_mesh_transport_key_get();
978f4854a5eSMatthias Ringwald     }
979f4854a5eSMatthias Ringwald     if (new_app_key == NULL) {
980f4854a5eSMatthias Ringwald         config_appkey_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), netkey_and_appkey_index, MESH_FOUNDATION_STATUS_INSUFFICIENT_RESOURCES);
981f4854a5eSMatthias Ringwald         mesh_access_message_processed(pdu);
982f4854a5eSMatthias Ringwald         return;
983f4854a5eSMatthias Ringwald     }
984f4854a5eSMatthias Ringwald 
985f4854a5eSMatthias Ringwald     // store data
986f4854a5eSMatthias Ringwald     new_app_key->internal_index = internal_index;
987f4854a5eSMatthias Ringwald     new_app_key->appkey_index = appkey_index;
988f4854a5eSMatthias Ringwald     new_app_key->netkey_index = netkey_index;
989f4854a5eSMatthias Ringwald     new_app_key->key_refresh  = 1;
990b7430106SMatthias Ringwald     new_app_key->version = (uint8_t)(existing_app_key->version + 1);
991f4854a5eSMatthias Ringwald     memcpy(new_app_key->key, appkey, 16);
992f4854a5eSMatthias Ringwald 
993f4854a5eSMatthias Ringwald     // mark old key
994f4854a5eSMatthias Ringwald     existing_app_key->old_key = 1;
995f4854a5eSMatthias Ringwald 
996f4854a5eSMatthias Ringwald     // calculate AID
997f4854a5eSMatthias Ringwald     access_pdu_in_process = pdu;
998f4854a5eSMatthias Ringwald     mesh_transport_key_calc_aid(&configuration_server_cmac_request, new_app_key, config_appkey_add_or_update_aid, new_app_key);
999f4854a5eSMatthias Ringwald }
1000f4854a5eSMatthias Ringwald 
1001f4854a5eSMatthias Ringwald static void config_appkey_delete_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu) {
1002f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
1003f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t *) pdu);
1004f4854a5eSMatthias Ringwald 
1005f4854a5eSMatthias Ringwald     // netkey and appkey index
1006f4854a5eSMatthias Ringwald     uint32_t netkey_and_appkey_index = mesh_access_parser_get_u24(&parser);
1007f4854a5eSMatthias Ringwald     uint16_t netkey_index = netkey_and_appkey_index & 0xfff;
1008f4854a5eSMatthias Ringwald     uint16_t appkey_index = netkey_and_appkey_index >> 12;
1009f4854a5eSMatthias Ringwald 
1010f4854a5eSMatthias Ringwald     // check netkey_index is valid
1011f4854a5eSMatthias Ringwald     mesh_network_key_t * network_key = mesh_network_key_list_get(netkey_index);
1012f4854a5eSMatthias Ringwald     if (network_key == NULL){
1013f4854a5eSMatthias Ringwald         config_appkey_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), netkey_and_appkey_index, MESH_FOUNDATION_STATUS_INVALID_NETKEY_INDEX);
1014f4854a5eSMatthias Ringwald         mesh_access_message_processed(pdu);
1015f4854a5eSMatthias Ringwald         return;
1016f4854a5eSMatthias Ringwald     }
1017f4854a5eSMatthias Ringwald 
1018f4854a5eSMatthias Ringwald     // check if appkey already exists
1019f4854a5eSMatthias Ringwald     mesh_transport_key_t * transport_key = mesh_transport_key_get(appkey_index);
1020f4854a5eSMatthias Ringwald     if (transport_key){
1021f4854a5eSMatthias Ringwald         mesh_configuration_server_delete_appkey(transport_key);
1022f4854a5eSMatthias Ringwald     }
1023f4854a5eSMatthias Ringwald 
1024f4854a5eSMatthias Ringwald     config_appkey_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), netkey_and_appkey_index, MESH_FOUNDATION_STATUS_SUCCESS);
1025f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
1026f4854a5eSMatthias Ringwald }
1027f4854a5eSMatthias Ringwald 
1028f4854a5eSMatthias Ringwald static void config_appkey_get_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu) {
1029f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
1030f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t *) pdu);
1031f4854a5eSMatthias Ringwald     uint16_t netkey_index = mesh_access_parser_get_u16(&parser);
1032f4854a5eSMatthias Ringwald 
1033f4854a5eSMatthias Ringwald     config_appkey_list(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), netkey_index);
1034f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
1035f4854a5eSMatthias Ringwald }
1036f4854a5eSMatthias Ringwald 
1037f4854a5eSMatthias Ringwald // Configuration Model Subscriptions (messages)
1038f4854a5eSMatthias Ringwald 
1039cd11d287SMatthias Ringwald static void config_model_subscription_list(mesh_model_t * mesh_model, uint16_t netkey_index, uint16_t dest, uint8_t status, uint16_t element_address, uint32_t model_identifier, mesh_model_t * target_model){
10402983fbcbSMatthias Ringwald     UNUSED(mesh_model);
10412983fbcbSMatthias Ringwald 
1042f4854a5eSMatthias Ringwald     uint16_t opcode;
1043f4854a5eSMatthias Ringwald     if (mesh_model_is_bluetooth_sig(model_identifier)){
1044f4854a5eSMatthias Ringwald         opcode = MESH_FOUNDATION_OPERATION_SIG_MODEL_SUBSCRIPTION_LIST;
1045f4854a5eSMatthias Ringwald     } else {
1046f4854a5eSMatthias Ringwald         opcode = MESH_FOUNDATION_OPERATION_VENDOR_MODEL_SUBSCRIPTION_LIST;
1047f4854a5eSMatthias Ringwald     }
1048f4854a5eSMatthias Ringwald 
1049f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = mesh_access_transport_init(opcode);
1050f4854a5eSMatthias Ringwald     if (!transport_pdu) return;
1051f4854a5eSMatthias Ringwald 
1052f4854a5eSMatthias Ringwald     // setup segmented message
1053f4854a5eSMatthias Ringwald     mesh_access_transport_add_uint8(transport_pdu, status);
1054f4854a5eSMatthias Ringwald     mesh_access_transport_add_uint16(transport_pdu, element_address);
1055f4854a5eSMatthias Ringwald     mesh_access_transport_add_model_identifier(transport_pdu, model_identifier);
1056f4854a5eSMatthias Ringwald 
1057f4854a5eSMatthias Ringwald     if (target_model != NULL){
10582983fbcbSMatthias Ringwald         uint16_t i;
1059f4854a5eSMatthias Ringwald         for (i = 0; i < MAX_NR_MESH_SUBSCRIPTION_PER_MODEL; i++){
1060cd11d287SMatthias Ringwald             uint16_t address = target_model->subscriptions[i];
1061cd11d287SMatthias Ringwald             if (address == MESH_ADDRESS_UNSASSIGNED) continue;
1062cd11d287SMatthias Ringwald             if (mesh_network_address_virtual(address)) {
1063cd11d287SMatthias Ringwald                 mesh_virtual_address_t * virtual_address = mesh_virtual_address_for_pseudo_dst(address);
1064cd11d287SMatthias Ringwald                 if (virtual_address == NULL) continue;
1065cd11d287SMatthias Ringwald                 address = virtual_address->hash;
1066cd11d287SMatthias Ringwald             }
1067cd11d287SMatthias Ringwald             mesh_access_transport_add_uint16(transport_pdu, address);
1068f4854a5eSMatthias Ringwald         }
1069f4854a5eSMatthias Ringwald     }
1070f4854a5eSMatthias Ringwald     config_server_send_message(netkey_index, dest, (mesh_pdu_t *) transport_pdu);
1071f4854a5eSMatthias Ringwald }
1072f4854a5eSMatthias Ringwald 
1073f4854a5eSMatthias Ringwald static void config_model_subscription_get_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
1074f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
1075f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
1076f4854a5eSMatthias Ringwald 
1077f4854a5eSMatthias Ringwald     uint16_t element_address  = mesh_access_parser_get_u16(&parser);
1078f4854a5eSMatthias Ringwald     uint32_t model_identifier = mesh_access_parser_get_model_identifier(&parser);
1079f4854a5eSMatthias Ringwald 
1080f4854a5eSMatthias Ringwald     uint8_t status = MESH_FOUNDATION_STATUS_SUCCESS;
1081f4854a5eSMatthias Ringwald     mesh_model_t * target_model = mesh_access_model_for_address_and_model_identifier(element_address, model_identifier, &status);
1082f4854a5eSMatthias Ringwald 
1083cd11d287SMatthias Ringwald     config_model_subscription_list(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), status, element_address, model_identifier, target_model);
1084f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
1085f4854a5eSMatthias Ringwald }
1086f4854a5eSMatthias Ringwald 
1087f4854a5eSMatthias Ringwald static void config_model_subscription_status(mesh_model_t * mesh_model, uint16_t netkey_index, uint16_t dest, uint8_t status, uint16_t element_address, uint16_t address, uint32_t model_identifier){
10882983fbcbSMatthias Ringwald     UNUSED(mesh_model);
10892983fbcbSMatthias Ringwald 
1090f4854a5eSMatthias Ringwald     // setup message
1091f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = mesh_access_setup_segmented_message(&mesh_foundation_config_model_subscription_status,
1092f4854a5eSMatthias Ringwald                                                                                 status, element_address, address, model_identifier);
1093f4854a5eSMatthias Ringwald     if (!transport_pdu) return;
1094f4854a5eSMatthias Ringwald     // send as segmented access pdu
1095f4854a5eSMatthias Ringwald     config_server_send_message(netkey_index, dest, (mesh_pdu_t *) transport_pdu);
1096f4854a5eSMatthias Ringwald }
1097f4854a5eSMatthias Ringwald 
1098f4854a5eSMatthias Ringwald static void config_model_subscription_add_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu) {
1099f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
1100f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
1101f4854a5eSMatthias Ringwald 
1102f4854a5eSMatthias Ringwald     uint16_t element_address  = mesh_access_parser_get_u16(&parser);
1103f4854a5eSMatthias Ringwald     uint16_t address          = mesh_access_parser_get_u16(&parser);
1104f4854a5eSMatthias Ringwald     uint32_t model_identifier = mesh_access_parser_get_model_identifier(&parser);
1105f4854a5eSMatthias Ringwald 
1106f4854a5eSMatthias Ringwald     uint8_t status = MESH_FOUNDATION_STATUS_SUCCESS;
1107f4854a5eSMatthias Ringwald     mesh_model_t * target_model = mesh_access_model_for_address_and_model_identifier(element_address, model_identifier, &status);
1108f4854a5eSMatthias Ringwald 
1109f4854a5eSMatthias Ringwald     if (target_model != NULL){
1110f4854a5eSMatthias Ringwald         if (mesh_network_address_group(address) && !mesh_network_address_all_nodes(address)){
1111f4854a5eSMatthias Ringwald             status = mesh_model_add_subscription(target_model, address);
1112f4854a5eSMatthias Ringwald             if (status == MESH_FOUNDATION_STATUS_SUCCESS){
1113f4854a5eSMatthias Ringwald                 mesh_model_store_subscriptions(target_model);
1114f4854a5eSMatthias Ringwald             }
1115f4854a5eSMatthias Ringwald         } else {
1116f4854a5eSMatthias Ringwald             status = MESH_FOUNDATION_STATUS_INVALID_ADDRESS;
1117f4854a5eSMatthias Ringwald         }
1118f4854a5eSMatthias Ringwald     }
1119f4854a5eSMatthias Ringwald 
1120f4854a5eSMatthias Ringwald     config_model_subscription_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), status, element_address, address, model_identifier);
1121f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
1122f4854a5eSMatthias Ringwald }
1123f4854a5eSMatthias Ringwald 
1124f4854a5eSMatthias Ringwald static void config_model_subscription_virtual_address_add_hash(void *arg){
1125f4854a5eSMatthias Ringwald     mesh_model_t * target_model = (mesh_model_t*) arg;
1126f4854a5eSMatthias Ringwald     mesh_model_t * mesh_model = mesh_model_get_configuration_server();
1127f4854a5eSMatthias Ringwald 
1128f4854a5eSMatthias Ringwald     // add if not exists
1129f4854a5eSMatthias Ringwald     mesh_virtual_address_t * virtual_address = mesh_virtual_address_for_label_uuid(configuration_server_label_uuid);
1130f4854a5eSMatthias Ringwald     if (virtual_address == NULL){
1131f4854a5eSMatthias Ringwald         virtual_address = mesh_virtual_address_register(configuration_server_label_uuid, configuration_server_hash);
1132f4854a5eSMatthias Ringwald     }
1133f4854a5eSMatthias Ringwald 
1134f4854a5eSMatthias Ringwald     uint8_t status = MESH_FOUNDATION_STATUS_SUCCESS;
1135cd11d287SMatthias Ringwald     uint16_t hash_dst   = MESH_ADDRESS_UNSASSIGNED;
1136f4854a5eSMatthias Ringwald     if (virtual_address == NULL){
1137f4854a5eSMatthias Ringwald         status = MESH_FOUNDATION_STATUS_INSUFFICIENT_RESOURCES;
1138f4854a5eSMatthias Ringwald     } else {
1139cd11d287SMatthias Ringwald         if (!mesh_model_contains_subscription(target_model,  virtual_address->pseudo_dst)){
1140cd11d287SMatthias Ringwald             status = mesh_model_add_subscription(target_model,  virtual_address->pseudo_dst);
1141f4854a5eSMatthias Ringwald             if (status == MESH_FOUNDATION_STATUS_SUCCESS){
1142cd11d287SMatthias Ringwald                 hash_dst = virtual_address->hash;
1143f4854a5eSMatthias Ringwald                 mesh_virtual_address_increase_refcount(virtual_address);
1144f4854a5eSMatthias Ringwald                 mesh_model_store_subscriptions(target_model);
1145f4854a5eSMatthias Ringwald             }
1146f4854a5eSMatthias Ringwald         }
1147f4854a5eSMatthias Ringwald     }
1148f4854a5eSMatthias Ringwald 
1149cd11d287SMatthias Ringwald     config_model_subscription_status(mesh_model, mesh_pdu_netkey_index(access_pdu_in_process), mesh_pdu_src(access_pdu_in_process), status, configuration_server_element_address, hash_dst, target_model->model_identifier);
1150f4854a5eSMatthias Ringwald     mesh_access_message_processed(access_pdu_in_process);
1151f4854a5eSMatthias Ringwald     return;
1152f4854a5eSMatthias Ringwald }
1153f4854a5eSMatthias Ringwald 
1154f4854a5eSMatthias Ringwald static void config_model_subscription_virtual_address_add_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu) {
1155f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
1156f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
1157f4854a5eSMatthias Ringwald 
1158f4854a5eSMatthias Ringwald     // ElementAddress - Address of the element - should be us
1159f4854a5eSMatthias Ringwald     configuration_server_element_address = mesh_access_parser_get_u16(&parser);
1160f4854a5eSMatthias Ringwald 
1161f4854a5eSMatthias Ringwald     // store label uuid
1162f4854a5eSMatthias Ringwald     mesh_access_parser_get_label_uuid(&parser, configuration_server_label_uuid);
1163f4854a5eSMatthias Ringwald 
1164f4854a5eSMatthias Ringwald     // Model Identifier
1165f4854a5eSMatthias Ringwald     uint32_t model_identifier = mesh_access_parser_get_model_identifier(&parser);
1166f4854a5eSMatthias Ringwald 
1167f4854a5eSMatthias Ringwald     uint8_t status = MESH_FOUNDATION_STATUS_SUCCESS;
1168f4854a5eSMatthias Ringwald     mesh_model_t * target_model = mesh_access_model_for_address_and_model_identifier(configuration_server_element_address, model_identifier, &status);
1169f4854a5eSMatthias Ringwald 
1170f4854a5eSMatthias Ringwald     if (target_model == NULL){
1171f4854a5eSMatthias Ringwald         config_model_subscription_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), status, configuration_server_element_address, MESH_ADDRESS_UNSASSIGNED, model_identifier);
1172f4854a5eSMatthias Ringwald         mesh_access_message_processed(pdu);
1173f4854a5eSMatthias Ringwald         return;
1174f4854a5eSMatthias Ringwald     }
1175f4854a5eSMatthias Ringwald 
1176f4854a5eSMatthias Ringwald     access_pdu_in_process = pdu;
1177f4854a5eSMatthias Ringwald     mesh_virtual_address(&configuration_server_cmac_request, configuration_server_label_uuid, &configuration_server_hash, &config_model_subscription_virtual_address_add_hash, target_model);
1178f4854a5eSMatthias Ringwald }
1179f4854a5eSMatthias Ringwald 
1180f4854a5eSMatthias Ringwald static void config_model_subscription_overwrite_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
1181f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
1182f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
1183f4854a5eSMatthias Ringwald 
1184f4854a5eSMatthias Ringwald     uint16_t element_address  = mesh_access_parser_get_u16(&parser);
1185f4854a5eSMatthias Ringwald     uint16_t address          = mesh_access_parser_get_u16(&parser);
1186f4854a5eSMatthias Ringwald     uint32_t model_identifier = mesh_access_parser_get_model_identifier(&parser);
1187f4854a5eSMatthias Ringwald 
1188f4854a5eSMatthias Ringwald     uint8_t status = MESH_FOUNDATION_STATUS_SUCCESS;
1189f4854a5eSMatthias Ringwald     mesh_model_t * target_model = mesh_access_model_for_address_and_model_identifier(element_address, model_identifier, &status);
1190f4854a5eSMatthias Ringwald 
1191f4854a5eSMatthias Ringwald     if (target_model != NULL){
1192f4854a5eSMatthias Ringwald         if (mesh_network_address_group(address) && !mesh_network_address_all_nodes(address)){
1193f4854a5eSMatthias Ringwald             mesh_subcription_decrease_virtual_address_ref_count(target_model);
119440157dccSMatthias Ringwald             mesh_model_delete_all_subscriptions(target_model);
119540157dccSMatthias Ringwald             mesh_model_add_subscription(target_model, address);
1196f4854a5eSMatthias Ringwald             mesh_model_store_subscriptions(target_model);
1197f4854a5eSMatthias Ringwald         } else {
1198f4854a5eSMatthias Ringwald             status = MESH_FOUNDATION_STATUS_INVALID_ADDRESS;
1199f4854a5eSMatthias Ringwald         }
1200f4854a5eSMatthias Ringwald     }
1201f4854a5eSMatthias Ringwald 
1202f4854a5eSMatthias Ringwald     config_model_subscription_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), status, element_address, address, model_identifier);
1203f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
1204f4854a5eSMatthias Ringwald }
1205f4854a5eSMatthias Ringwald 
1206f4854a5eSMatthias Ringwald static void config_model_subscription_virtual_address_overwrite_hash(void *arg){
1207f4854a5eSMatthias Ringwald     mesh_model_t * target_model = (mesh_model_t*) arg;
1208f4854a5eSMatthias Ringwald     mesh_model_t * mesh_model = mesh_model_get_configuration_server();
1209f4854a5eSMatthias Ringwald 
1210f4854a5eSMatthias Ringwald     // add if not exists
1211f4854a5eSMatthias Ringwald     mesh_virtual_address_t * virtual_address = mesh_virtual_address_for_label_uuid(configuration_server_label_uuid);
1212f4854a5eSMatthias Ringwald     if (virtual_address == NULL){
1213f4854a5eSMatthias Ringwald         virtual_address = mesh_virtual_address_register(configuration_server_label_uuid, configuration_server_hash);
1214f4854a5eSMatthias Ringwald     }
1215f4854a5eSMatthias Ringwald 
1216f4854a5eSMatthias Ringwald     uint8_t status = MESH_FOUNDATION_STATUS_SUCCESS;
1217792aee03SMatthias Ringwald     uint16_t address = MESH_ADDRESS_UNSASSIGNED;;
1218f4854a5eSMatthias Ringwald     if (virtual_address == NULL){
1219f4854a5eSMatthias Ringwald         status = MESH_FOUNDATION_STATUS_INSUFFICIENT_RESOURCES;
1220f4854a5eSMatthias Ringwald     } else {
1221792aee03SMatthias Ringwald         address = configuration_server_hash;
1222f4854a5eSMatthias Ringwald 
1223f4854a5eSMatthias Ringwald         // increase refcount first to avoid flash delete + add in a row
1224f4854a5eSMatthias Ringwald         mesh_virtual_address_increase_refcount(virtual_address);
1225f4854a5eSMatthias Ringwald 
1226f4854a5eSMatthias Ringwald         // decrease ref counts for virtual addresses in subscription
1227f4854a5eSMatthias Ringwald         mesh_subcription_decrease_virtual_address_ref_count(target_model);
1228f4854a5eSMatthias Ringwald 
1229f4854a5eSMatthias Ringwald         // clear subscriptions
1230f4854a5eSMatthias Ringwald         mesh_model_delete_all_subscriptions(target_model);
1231f4854a5eSMatthias Ringwald 
1232f4854a5eSMatthias Ringwald         // add new subscription (successfull if MAX_NR_MESH_SUBSCRIPTION_PER_MODEL > 0)
1233792aee03SMatthias Ringwald         mesh_model_add_subscription(target_model, virtual_address->pseudo_dst);
1234f4854a5eSMatthias Ringwald 
1235f4854a5eSMatthias Ringwald         mesh_model_store_subscriptions(target_model);
1236f4854a5eSMatthias Ringwald     }
1237f4854a5eSMatthias Ringwald 
1238792aee03SMatthias Ringwald     config_model_subscription_status(mesh_model, mesh_pdu_netkey_index(access_pdu_in_process), mesh_pdu_src(access_pdu_in_process), status, configuration_server_element_address, address, target_model->model_identifier);
1239f4854a5eSMatthias Ringwald     mesh_access_message_processed(access_pdu_in_process);
1240f4854a5eSMatthias Ringwald     return;
1241f4854a5eSMatthias Ringwald }
1242f4854a5eSMatthias Ringwald 
1243f4854a5eSMatthias Ringwald static void config_model_subscription_virtual_address_overwrite_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu) {
1244f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
1245f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
1246f4854a5eSMatthias Ringwald 
1247f4854a5eSMatthias Ringwald     // ElementAddress - Address of the element - should be us
1248f4854a5eSMatthias Ringwald     configuration_server_element_address = mesh_access_parser_get_u16(&parser);
1249f4854a5eSMatthias Ringwald 
1250f4854a5eSMatthias Ringwald     // store label uuid
1251f4854a5eSMatthias Ringwald     mesh_access_parser_get_label_uuid(&parser, configuration_server_label_uuid);
1252f4854a5eSMatthias Ringwald 
1253f4854a5eSMatthias Ringwald     // Model Identifier
1254f4854a5eSMatthias Ringwald     uint32_t model_identifier = mesh_access_parser_get_model_identifier(&parser);
1255f4854a5eSMatthias Ringwald 
1256f4854a5eSMatthias Ringwald     uint8_t status = MESH_FOUNDATION_STATUS_SUCCESS;
1257f4854a5eSMatthias Ringwald     mesh_model_t * target_model = mesh_access_model_for_address_and_model_identifier(configuration_server_element_address, model_identifier, &status);
1258f4854a5eSMatthias Ringwald 
1259f4854a5eSMatthias Ringwald     if (target_model == NULL){
1260f4854a5eSMatthias Ringwald         config_model_subscription_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), status, configuration_server_element_address, MESH_ADDRESS_UNSASSIGNED, model_identifier);
1261f4854a5eSMatthias Ringwald         mesh_access_message_processed(pdu);
1262f4854a5eSMatthias Ringwald         return;
1263f4854a5eSMatthias Ringwald     }
1264f4854a5eSMatthias Ringwald     access_pdu_in_process = pdu;
1265f4854a5eSMatthias Ringwald     mesh_virtual_address(&configuration_server_cmac_request, configuration_server_label_uuid, &configuration_server_hash, &config_model_subscription_virtual_address_overwrite_hash, target_model);
1266f4854a5eSMatthias Ringwald }
1267f4854a5eSMatthias Ringwald 
1268f4854a5eSMatthias Ringwald static void config_model_subscription_delete_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
1269f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
1270f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
1271f4854a5eSMatthias Ringwald 
1272f4854a5eSMatthias Ringwald     uint16_t element_address  = mesh_access_parser_get_u16(&parser);
1273f4854a5eSMatthias Ringwald     uint16_t address          = mesh_access_parser_get_u16(&parser);
1274f4854a5eSMatthias Ringwald     uint32_t model_identifier = mesh_access_parser_get_model_identifier(&parser);
1275f4854a5eSMatthias Ringwald 
1276f4854a5eSMatthias Ringwald     uint8_t status = MESH_FOUNDATION_STATUS_SUCCESS;
1277f4854a5eSMatthias Ringwald     mesh_model_t * target_model = mesh_access_model_for_address_and_model_identifier(element_address, model_identifier, &status);
1278f4854a5eSMatthias Ringwald 
1279f4854a5eSMatthias Ringwald     if (target_model != NULL){
1280f4854a5eSMatthias Ringwald         if (mesh_network_address_group(address) && !mesh_network_address_all_nodes(address)){
1281f4854a5eSMatthias Ringwald             mesh_model_delete_subscription(target_model, address);
1282f4854a5eSMatthias Ringwald             mesh_model_store_subscriptions(target_model);
1283f4854a5eSMatthias Ringwald         } else {
1284f4854a5eSMatthias Ringwald             status = MESH_FOUNDATION_STATUS_INVALID_ADDRESS;
1285f4854a5eSMatthias Ringwald         }
1286f4854a5eSMatthias Ringwald     }
1287f4854a5eSMatthias Ringwald 
1288f4854a5eSMatthias Ringwald     config_model_subscription_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), status, element_address, address, model_identifier);
1289f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
1290f4854a5eSMatthias Ringwald }
1291f4854a5eSMatthias Ringwald 
1292f4854a5eSMatthias Ringwald static void config_model_subscription_virtual_address_delete_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
1293f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
1294f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
1295f4854a5eSMatthias Ringwald 
1296f4854a5eSMatthias Ringwald     uint16_t element_address  = mesh_access_parser_get_u16(&parser);
1297f4854a5eSMatthias Ringwald     mesh_access_parser_get_label_uuid(&parser, configuration_server_label_uuid);
1298f4854a5eSMatthias Ringwald     uint32_t model_identifier = mesh_access_parser_get_model_identifier(&parser);
1299f4854a5eSMatthias Ringwald 
1300f4854a5eSMatthias Ringwald     mesh_virtual_address_t * virtual_address = mesh_virtual_address_for_label_uuid(configuration_server_label_uuid);
1301f4854a5eSMatthias Ringwald     uint8_t status = MESH_FOUNDATION_STATUS_SUCCESS;
1302f4854a5eSMatthias Ringwald     mesh_model_t * target_model = mesh_access_model_for_address_and_model_identifier(element_address, model_identifier, &status);
1303cd11d287SMatthias Ringwald     uint16_t address = MESH_ADDRESS_UNSASSIGNED;
1304f4854a5eSMatthias Ringwald 
1305f4854a5eSMatthias Ringwald     if ((target_model != NULL) && (virtual_address != NULL) && mesh_model_contains_subscription(target_model, virtual_address->pseudo_dst)){
1306cd11d287SMatthias Ringwald         address = virtual_address->hash;
1307f4854a5eSMatthias Ringwald         mesh_model_delete_subscription(target_model, virtual_address->pseudo_dst);
1308f4854a5eSMatthias Ringwald         mesh_model_store_subscriptions(target_model);
1309cd11d287SMatthias Ringwald         mesh_virtual_address_decrease_refcount(virtual_address);
1310f4854a5eSMatthias Ringwald      }
1311f4854a5eSMatthias Ringwald 
1312cd11d287SMatthias Ringwald     config_model_subscription_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), status, element_address,address, model_identifier);
1313f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
1314f4854a5eSMatthias Ringwald }
1315f4854a5eSMatthias Ringwald 
1316f4854a5eSMatthias Ringwald static void config_model_subscription_delete_all_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
1317f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
1318f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
1319f4854a5eSMatthias Ringwald 
1320f4854a5eSMatthias Ringwald     uint16_t element_address  = mesh_access_parser_get_u16(&parser);
1321f4854a5eSMatthias Ringwald     uint32_t model_identifier = mesh_access_parser_get_model_identifier(&parser);
1322f4854a5eSMatthias Ringwald 
1323f4854a5eSMatthias Ringwald     uint8_t status = MESH_FOUNDATION_STATUS_SUCCESS;
1324f4854a5eSMatthias Ringwald     mesh_model_t * target_model = mesh_access_model_for_address_and_model_identifier(element_address, model_identifier, &status);
1325f4854a5eSMatthias Ringwald 
1326f4854a5eSMatthias Ringwald     if (target_model != NULL){
1327f4854a5eSMatthias Ringwald         mesh_subcription_decrease_virtual_address_ref_count(target_model);
1328f4854a5eSMatthias Ringwald         mesh_model_delete_all_subscriptions(target_model);
1329f4854a5eSMatthias Ringwald         mesh_model_store_subscriptions(target_model);
1330f4854a5eSMatthias Ringwald     }
1331f4854a5eSMatthias Ringwald 
1332f4854a5eSMatthias Ringwald     config_model_subscription_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), status, element_address, MESH_ADDRESS_UNSASSIGNED, model_identifier);
1333f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
1334f4854a5eSMatthias Ringwald }
1335f4854a5eSMatthias Ringwald 
1336f4854a5eSMatthias Ringwald // Configuration Model to AppKey List
1337f4854a5eSMatthias Ringwald 
1338f4854a5eSMatthias Ringwald static void config_model_app_status(mesh_model_t * mesh_model, uint16_t netkey_index, uint16_t dest, uint8_t status, uint16_t element_address, uint16_t appkey_index, uint32_t model_identifier){
13392983fbcbSMatthias Ringwald     UNUSED(mesh_model);
13402983fbcbSMatthias Ringwald 
1341f4854a5eSMatthias Ringwald     // setup message
1342f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = mesh_access_setup_segmented_message(&mesh_foundation_config_model_app_status,
1343f4854a5eSMatthias Ringwald                                                             status, element_address, appkey_index, model_identifier);
1344f4854a5eSMatthias Ringwald     if (!transport_pdu) return;
1345f4854a5eSMatthias Ringwald 
1346f4854a5eSMatthias Ringwald     // send as segmented access pdu
1347f4854a5eSMatthias Ringwald     config_server_send_message(netkey_index, dest, (mesh_pdu_t *) transport_pdu);
1348f4854a5eSMatthias Ringwald }
1349f4854a5eSMatthias Ringwald 
1350f4854a5eSMatthias Ringwald static void config_model_app_list(mesh_model_t * config_server_model, uint16_t netkey_index, uint16_t dest, uint8_t status, uint16_t element_address, uint32_t model_identifier, mesh_model_t * mesh_model){
13512983fbcbSMatthias Ringwald     UNUSED(config_server_model);
13522983fbcbSMatthias Ringwald 
1353f4854a5eSMatthias Ringwald     uint16_t opcode;
1354f4854a5eSMatthias Ringwald     if (mesh_model_is_bluetooth_sig(model_identifier)){
1355f4854a5eSMatthias Ringwald         opcode = MESH_FOUNDATION_OPERATION_SIG_MODEL_APP_LIST;
1356f4854a5eSMatthias Ringwald     } else {
1357f4854a5eSMatthias Ringwald         opcode = MESH_FOUNDATION_OPERATION_VENDOR_MODEL_APP_LIST;
1358f4854a5eSMatthias Ringwald     }
1359f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = mesh_access_transport_init(opcode);
1360f4854a5eSMatthias Ringwald     if (!transport_pdu) return;
1361f4854a5eSMatthias Ringwald 
1362f4854a5eSMatthias Ringwald     mesh_access_transport_add_uint8(transport_pdu, status);
1363f4854a5eSMatthias Ringwald     mesh_access_transport_add_uint16(transport_pdu, element_address);
1364f4854a5eSMatthias Ringwald     if (mesh_model_is_bluetooth_sig(model_identifier)) {
1365f4854a5eSMatthias Ringwald         mesh_access_transport_add_uint16(transport_pdu, mesh_model_get_model_id(model_identifier));
1366f4854a5eSMatthias Ringwald     } else {
1367f4854a5eSMatthias Ringwald         mesh_access_transport_add_uint32(transport_pdu, model_identifier);
1368f4854a5eSMatthias Ringwald     }
1369f4854a5eSMatthias Ringwald 
1370f4854a5eSMatthias Ringwald     // add list of appkey indexes
1371f4854a5eSMatthias Ringwald     if (mesh_model){
13722983fbcbSMatthias Ringwald         uint16_t i;
1373f4854a5eSMatthias Ringwald         for (i=0;i<MAX_NR_MESH_APPKEYS_PER_MODEL;i++){
1374f4854a5eSMatthias Ringwald             uint16_t appkey_index = mesh_model->appkey_indices[i];
1375f4854a5eSMatthias Ringwald             if (appkey_index == MESH_APPKEY_INVALID) continue;
1376f4854a5eSMatthias Ringwald             mesh_access_transport_add_uint16(transport_pdu, appkey_index);
1377f4854a5eSMatthias Ringwald         }
1378f4854a5eSMatthias Ringwald     }
1379f4854a5eSMatthias Ringwald 
1380f4854a5eSMatthias Ringwald     // send as segmented access pdu
1381f4854a5eSMatthias Ringwald     config_server_send_message(netkey_index, dest, (mesh_pdu_t *) transport_pdu);
1382f4854a5eSMatthias Ringwald }
1383f4854a5eSMatthias Ringwald 
1384f4854a5eSMatthias Ringwald static void config_model_app_bind_handler(mesh_model_t *config_server_model, mesh_pdu_t * pdu) {
1385f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
1386f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
1387f4854a5eSMatthias Ringwald 
1388f4854a5eSMatthias Ringwald     uint16_t element_address = mesh_access_parser_get_u16(&parser);
1389f4854a5eSMatthias Ringwald     uint16_t appkey_index    = mesh_access_parser_get_u16(&parser);
1390f4854a5eSMatthias Ringwald     uint32_t model_identifier = mesh_access_parser_get_model_identifier(&parser);
1391f4854a5eSMatthias Ringwald 
1392f4854a5eSMatthias Ringwald     uint8_t status;
1393f4854a5eSMatthias Ringwald     do {
1394f4854a5eSMatthias Ringwald         // validate address and look up model
1395f4854a5eSMatthias Ringwald         mesh_model_t * target_model = mesh_access_model_for_address_and_model_identifier(element_address, model_identifier, &status);
1396f4854a5eSMatthias Ringwald         if (target_model == NULL) break;
1397f4854a5eSMatthias Ringwald 
1398f4854a5eSMatthias Ringwald         // validate app key exists
1399f4854a5eSMatthias Ringwald         mesh_transport_key_t * app_key = mesh_transport_key_get(appkey_index);
1400f4854a5eSMatthias Ringwald         if (!app_key){
1401f4854a5eSMatthias Ringwald             status = MESH_FOUNDATION_STATUS_INVALID_APPKEY_INDEX;
1402f4854a5eSMatthias Ringwald             break;
1403f4854a5eSMatthias Ringwald         }
1404f4854a5eSMatthias Ringwald 
1405f4854a5eSMatthias Ringwald         // Configuration Server only allows device keys
1406f4854a5eSMatthias Ringwald         if (mesh_model_is_configuration_server(model_identifier)){
1407f4854a5eSMatthias Ringwald             status = MESH_FOUNDATION_STATUS_CANNOT_BIND;
1408f4854a5eSMatthias Ringwald             break;
1409f4854a5eSMatthias Ringwald         }
1410f4854a5eSMatthias Ringwald         status = mesh_model_bind_appkey(target_model, appkey_index);
1411f4854a5eSMatthias Ringwald 
1412f4854a5eSMatthias Ringwald     } while (0);
1413f4854a5eSMatthias Ringwald 
1414f4854a5eSMatthias Ringwald     config_model_app_status(config_server_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), status, element_address, appkey_index, model_identifier);
1415f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
1416f4854a5eSMatthias Ringwald }
1417f4854a5eSMatthias Ringwald 
1418f4854a5eSMatthias Ringwald static void config_model_app_unbind_handler(mesh_model_t *config_server_model, mesh_pdu_t * pdu) {
1419f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
1420f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
1421f4854a5eSMatthias Ringwald 
1422f4854a5eSMatthias Ringwald     uint16_t element_address = mesh_access_parser_get_u16(&parser);
1423f4854a5eSMatthias Ringwald     uint16_t appkey_index    = mesh_access_parser_get_u16(&parser);
1424f4854a5eSMatthias Ringwald     uint32_t model_identifier = mesh_access_parser_get_model_identifier(&parser);
1425f4854a5eSMatthias Ringwald 
1426f4854a5eSMatthias Ringwald     uint8_t status;
1427f4854a5eSMatthias Ringwald     do {
1428f4854a5eSMatthias Ringwald         // validate address and look up model
1429f4854a5eSMatthias Ringwald         mesh_model_t * target_model = mesh_access_model_for_address_and_model_identifier(element_address, model_identifier, &status);
1430f4854a5eSMatthias Ringwald         if (target_model == NULL) break;
1431f4854a5eSMatthias Ringwald 
1432f4854a5eSMatthias Ringwald         // validate app key exists
1433f4854a5eSMatthias Ringwald         mesh_transport_key_t * app_key = mesh_transport_key_get(appkey_index);
1434f4854a5eSMatthias Ringwald         if (!app_key){
1435f4854a5eSMatthias Ringwald             status = MESH_FOUNDATION_STATUS_INVALID_APPKEY_INDEX;
1436f4854a5eSMatthias Ringwald             break;
1437f4854a5eSMatthias Ringwald         }
1438fe6aa2c4SMatthias Ringwald 
1439fe6aa2c4SMatthias Ringwald         // stop publishing
1440fe6aa2c4SMatthias Ringwald         mesh_configuration_server_stop_publishing_using_appkey(target_model, appkey_index);
1441fe6aa2c4SMatthias Ringwald 
1442fe6aa2c4SMatthias Ringwald         // unbind appkey
1443f4854a5eSMatthias Ringwald         mesh_model_unbind_appkey(target_model, appkey_index);
1444fe6aa2c4SMatthias Ringwald 
1445f4854a5eSMatthias Ringwald         status = MESH_FOUNDATION_STATUS_SUCCESS;
1446f4854a5eSMatthias Ringwald     } while (0);
1447f4854a5eSMatthias Ringwald 
1448f4854a5eSMatthias Ringwald     config_model_app_status(config_server_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), status, element_address, appkey_index, model_identifier);
1449f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
1450f4854a5eSMatthias Ringwald }
1451f4854a5eSMatthias Ringwald 
14522983fbcbSMatthias Ringwald static void config_model_app_get_handler(mesh_model_t *config_server_model, mesh_pdu_t * pdu){
1453f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
1454f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
1455f4854a5eSMatthias Ringwald 
1456f4854a5eSMatthias Ringwald     uint16_t element_address = mesh_access_parser_get_u16(&parser);
1457f4854a5eSMatthias Ringwald     uint32_t model_identifier = mesh_access_parser_get_model_identifier(&parser);
1458f4854a5eSMatthias Ringwald 
1459f4854a5eSMatthias Ringwald     uint8_t status;
1460f4854a5eSMatthias Ringwald     mesh_model_t * target_model = mesh_access_model_for_address_and_model_identifier(element_address, model_identifier, &status);
1461f4854a5eSMatthias Ringwald     config_model_app_list(config_server_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), status, element_address, model_identifier, target_model);
1462f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
1463f4854a5eSMatthias Ringwald }
1464f4854a5eSMatthias Ringwald 
1465f4854a5eSMatthias Ringwald // Model Publication
1466f4854a5eSMatthias Ringwald static void config_model_publication_changed(mesh_model_t *mesh_model, mesh_publication_model_t * new_publication_model){
1467f4854a5eSMatthias Ringwald 
1468f4854a5eSMatthias Ringwald     // stop publication
1469f4854a5eSMatthias Ringwald     mesh_model_publication_stop(mesh_model);
1470f4854a5eSMatthias Ringwald 
14713ee0698eSMatthias Ringwald     if (new_publication_model->address == MESH_ADDRESS_UNSASSIGNED) {
14723ee0698eSMatthias Ringwald         // "When the PublishAddress is set to the unassigned address, the values of the AppKeyIndex, CredentialFlag, PublishTTL, PublishPeriod, PublishRetransmitCount, and PublishRetransmitIntervalSteps fields shall be set to 0x00.
14733ee0698eSMatthias Ringwald         mesh_model->publication_model->address = MESH_ADDRESS_UNSASSIGNED;
14743ee0698eSMatthias Ringwald         mesh_model->publication_model->appkey_index = 0;
14753ee0698eSMatthias Ringwald         mesh_model->publication_model->friendship_credential_flag = 0;
14763ee0698eSMatthias Ringwald         mesh_model->publication_model->period = 0;
14773ee0698eSMatthias Ringwald         mesh_model->publication_model->ttl = 0;
14783ee0698eSMatthias Ringwald         mesh_model->publication_model->retransmit = 0;
14793ee0698eSMatthias Ringwald     } else {
1480f4854a5eSMatthias Ringwald         // update model publication state
14813ee0698eSMatthias Ringwald         mesh_model->publication_model->address = new_publication_model->address;
14823ee0698eSMatthias Ringwald         mesh_model->publication_model->appkey_index = new_publication_model->appkey_index;
14833ee0698eSMatthias Ringwald         mesh_model->publication_model->friendship_credential_flag = new_publication_model->friendship_credential_flag;
14843ee0698eSMatthias Ringwald         mesh_model->publication_model->period = new_publication_model->period;
14853ee0698eSMatthias Ringwald         mesh_model->publication_model->ttl = new_publication_model->ttl;
14863ee0698eSMatthias Ringwald         mesh_model->publication_model->retransmit = new_publication_model->retransmit;
14873ee0698eSMatthias Ringwald     }
1488f4854a5eSMatthias Ringwald 
1489f4854a5eSMatthias Ringwald     // store
1490f4854a5eSMatthias Ringwald     mesh_model_store_publication(mesh_model);
1491f4854a5eSMatthias Ringwald 
1492f4854a5eSMatthias Ringwald     // start publication if address is set (nothing happens if period = 0 and retransmit = 0)
1493f4854a5eSMatthias Ringwald     if (new_publication_model->address == MESH_ADDRESS_UNSASSIGNED) return;
1494f4854a5eSMatthias Ringwald 
1495f4854a5eSMatthias Ringwald     // start to publish
1496f4854a5eSMatthias Ringwald     mesh_model_publication_start(mesh_model);
1497f4854a5eSMatthias Ringwald }
1498f4854a5eSMatthias Ringwald 
1499f4854a5eSMatthias Ringwald 
1500f4854a5eSMatthias Ringwald static void
1501f4854a5eSMatthias Ringwald config_model_publication_status(mesh_model_t *mesh_model, uint16_t netkey_index, uint16_t dest, uint8_t status,
1502f4854a5eSMatthias Ringwald                                     uint16_t element_address, uint32_t model_identifier, mesh_publication_model_t *publication_model) {
15032983fbcbSMatthias Ringwald     UNUSED(mesh_model);
15042983fbcbSMatthias Ringwald 
1505f4854a5eSMatthias Ringwald     // setup message
15068935b776SMatthias Ringwald     uint16_t app_key_index_and_credential_flag = 0;
15078935b776SMatthias Ringwald     uint16_t publish_address = 0;
15088935b776SMatthias Ringwald     uint8_t ttl = 0;
15098935b776SMatthias Ringwald     uint8_t period = 0;
15108935b776SMatthias Ringwald     uint8_t retransmit = 0;
15118935b776SMatthias Ringwald     if (status == MESH_FOUNDATION_STATUS_SUCCESS){
15128935b776SMatthias Ringwald         app_key_index_and_credential_flag = (publication_model->friendship_credential_flag << 12) | publication_model->appkey_index;
15138935b776SMatthias Ringwald         ttl = publication_model->ttl;
15148935b776SMatthias Ringwald         period = publication_model->period;
15158935b776SMatthias Ringwald         retransmit = publication_model->retransmit;
151632cecee0SMatthias Ringwald 
15178935b776SMatthias Ringwald         publish_address = publication_model->address;
151832cecee0SMatthias Ringwald         if (mesh_network_address_virtual(publish_address)){
151932cecee0SMatthias Ringwald             mesh_virtual_address_t * virtual_address = mesh_virtual_address_for_pseudo_dst(publish_address);
152032cecee0SMatthias Ringwald             if (virtual_address){
152132cecee0SMatthias Ringwald                 publish_address = virtual_address->hash;
152232cecee0SMatthias Ringwald             }
152332cecee0SMatthias Ringwald         }
15248935b776SMatthias Ringwald     }
15258935b776SMatthias Ringwald 
1526f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = mesh_access_setup_segmented_message(
152732cecee0SMatthias Ringwald             &mesh_foundation_config_model_publication_status, status, element_address, publish_address,
15288935b776SMatthias Ringwald             app_key_index_and_credential_flag, ttl, period, retransmit, model_identifier);
1529f4854a5eSMatthias Ringwald     if (!transport_pdu) return;
1530f4854a5eSMatthias Ringwald 
1531f4854a5eSMatthias Ringwald     // send as segmented access pdu
1532f4854a5eSMatthias Ringwald     config_server_send_message(netkey_index, dest, (mesh_pdu_t *) transport_pdu);
1533f4854a5eSMatthias Ringwald }
1534f4854a5eSMatthias Ringwald 
1535f4854a5eSMatthias Ringwald static void
1536f4854a5eSMatthias Ringwald config_model_publication_set_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu) {
1537f4854a5eSMatthias Ringwald 
1538f4854a5eSMatthias Ringwald     // set defaults
1539f4854a5eSMatthias Ringwald     memset(&configuration_server_publication_model, 0, sizeof(mesh_publication_model_t));
1540f4854a5eSMatthias Ringwald 
1541f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
1542f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
1543f4854a5eSMatthias Ringwald 
15447e7c4c9aSMatthias Ringwald     // ElementAddress
1545f4854a5eSMatthias Ringwald     uint16_t element_address = mesh_access_parser_get_u16(&parser);
1546f4854a5eSMatthias Ringwald 
1547f4854a5eSMatthias Ringwald     // PublishAddress, 16 bit
1548f4854a5eSMatthias Ringwald     configuration_server_publication_model.address = mesh_access_parser_get_u16(&parser);
1549f4854a5eSMatthias Ringwald 
1550f4854a5eSMatthias Ringwald     // AppKeyIndex (12), CredentialFlag (1), RFU (3)
1551f4854a5eSMatthias Ringwald     uint16_t temp = mesh_access_parser_get_u16(&parser);
1552f4854a5eSMatthias Ringwald     configuration_server_publication_model.appkey_index = temp & 0x0fff;
1553f4854a5eSMatthias Ringwald     configuration_server_publication_model.friendship_credential_flag = (temp >> 12) & 1;
1554f4854a5eSMatthias Ringwald 
1555f4854a5eSMatthias Ringwald     // TTL
1556f4854a5eSMatthias Ringwald     configuration_server_publication_model.ttl        = mesh_access_parser_get_u8(&parser);
1557f4854a5eSMatthias Ringwald 
1558f4854a5eSMatthias Ringwald     // Period
1559f4854a5eSMatthias Ringwald     configuration_server_publication_model.period     = mesh_access_parser_get_u8(&parser);
1560f4854a5eSMatthias Ringwald 
1561f4854a5eSMatthias Ringwald     // Retransmit
1562f4854a5eSMatthias Ringwald     configuration_server_publication_model.retransmit = mesh_access_parser_get_u8(&parser);
1563f4854a5eSMatthias Ringwald 
1564f4854a5eSMatthias Ringwald     // Model Identifier
1565f4854a5eSMatthias Ringwald     uint32_t model_identifier = mesh_access_parser_get_model_identifier(&parser);
15667e7c4c9aSMatthias Ringwald 
15677e7c4c9aSMatthias Ringwald     // Get Model for Element + Model Identifier
1568f4854a5eSMatthias Ringwald     uint8_t status;
1569f4854a5eSMatthias Ringwald     mesh_model_t * target_model = mesh_access_model_for_address_and_model_identifier(element_address, model_identifier, &status);
1570f4854a5eSMatthias Ringwald 
15717e7c4c9aSMatthias Ringwald     // Check if publicatation model struct provided
15727e7c4c9aSMatthias Ringwald     if (status == MESH_FOUNDATION_STATUS_SUCCESS) {
1573f4854a5eSMatthias Ringwald         if (target_model->publication_model == NULL){
1574f4854a5eSMatthias Ringwald             status = MESH_FOUNDATION_STATUS_CANNOT_SET;
15757e7c4c9aSMatthias Ringwald         }
15767e7c4c9aSMatthias Ringwald     }
1577f4854a5eSMatthias Ringwald 
15787e7c4c9aSMatthias Ringwald     // Check AppKey
15797e7c4c9aSMatthias Ringwald     if (status == MESH_FOUNDATION_STATUS_SUCCESS){
15807e7c4c9aSMatthias Ringwald         // check if appkey already exists
15817e7c4c9aSMatthias Ringwald         mesh_transport_key_t * app_key = mesh_transport_key_get(configuration_server_publication_model.appkey_index);
15827e7c4c9aSMatthias Ringwald         if (app_key == NULL) {
15837e7c4c9aSMatthias Ringwald             status = MESH_FOUNDATION_STATUS_INVALID_APPKEY_INDEX;
15847e7c4c9aSMatthias Ringwald         }
15857e7c4c9aSMatthias Ringwald     }
15867e7c4c9aSMatthias Ringwald 
15877e7c4c9aSMatthias Ringwald     // Accept set
15887e7c4c9aSMatthias Ringwald     if (status == MESH_FOUNDATION_STATUS_SUCCESS){
1589f4854a5eSMatthias Ringwald         // decrease ref count if old virtual address
1590f4854a5eSMatthias Ringwald         if (mesh_network_address_virtual(configuration_server_publication_model.address)) {
1591f4854a5eSMatthias Ringwald             mesh_virtual_address_t * current_virtual_address = mesh_virtual_address_for_pseudo_dst(configuration_server_publication_model.address);
1592f4854a5eSMatthias Ringwald             mesh_virtual_address_decrease_refcount(current_virtual_address);
1593f4854a5eSMatthias Ringwald         }
1594f4854a5eSMatthias Ringwald 
1595f4854a5eSMatthias Ringwald         // restart publication
1596f4854a5eSMatthias Ringwald         config_model_publication_changed(target_model, &configuration_server_publication_model);
1597f4854a5eSMatthias Ringwald     }
1598f4854a5eSMatthias Ringwald 
1599f4854a5eSMatthias Ringwald     // send status
1600f4854a5eSMatthias Ringwald     config_model_publication_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), status, element_address, model_identifier, &configuration_server_publication_model);
1601f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
1602f4854a5eSMatthias Ringwald }
1603f4854a5eSMatthias Ringwald 
1604f4854a5eSMatthias Ringwald static void config_model_publication_virtual_address_set_hash(void *arg){
1605f4854a5eSMatthias Ringwald     mesh_model_t *mesh_model = (mesh_model_t*) arg;
1606f4854a5eSMatthias Ringwald 
1607f4854a5eSMatthias Ringwald     // add if not exist
1608f4854a5eSMatthias Ringwald     mesh_virtual_address_t * virtual_address = mesh_virtual_address_for_label_uuid(configuration_server_label_uuid);
1609f4854a5eSMatthias Ringwald     if (virtual_address == NULL){
1610f4854a5eSMatthias Ringwald         virtual_address = mesh_virtual_address_register(configuration_server_label_uuid, configuration_server_hash);
1611f4854a5eSMatthias Ringwald     }
1612f4854a5eSMatthias Ringwald 
1613f4854a5eSMatthias Ringwald     uint8_t status = MESH_FOUNDATION_STATUS_SUCCESS;
1614f4854a5eSMatthias Ringwald     if (virtual_address == NULL){
1615f4854a5eSMatthias Ringwald         status = MESH_FOUNDATION_STATUS_INSUFFICIENT_RESOURCES;
1616f4854a5eSMatthias Ringwald     } else {
1617f4854a5eSMatthias Ringwald 
1618f4854a5eSMatthias Ringwald         // increase ref count if new virtual address
1619f4854a5eSMatthias Ringwald         mesh_virtual_address_increase_refcount(virtual_address);
1620f4854a5eSMatthias Ringwald 
1621f4854a5eSMatthias Ringwald         // decrease ref count if old virtual address
1622f4854a5eSMatthias Ringwald         if (mesh_network_address_virtual(configuration_server_publication_model.address)) {
1623f4854a5eSMatthias Ringwald             mesh_virtual_address_t * current_virtual_address = mesh_virtual_address_for_pseudo_dst(configuration_server_publication_model.address);
162432cecee0SMatthias Ringwald             if (current_virtual_address){
1625f4854a5eSMatthias Ringwald                 mesh_virtual_address_decrease_refcount(current_virtual_address);
1626f4854a5eSMatthias Ringwald             }
162732cecee0SMatthias Ringwald         }
1628f4854a5eSMatthias Ringwald 
1629f4854a5eSMatthias Ringwald         configuration_server_publication_model.address = virtual_address->pseudo_dst;
1630f4854a5eSMatthias Ringwald         mesh_virtual_address_increase_refcount(virtual_address);
1631f4854a5eSMatthias Ringwald 
1632f4854a5eSMatthias Ringwald         // restart publication
1633f4854a5eSMatthias Ringwald         config_model_publication_changed(configuration_server_target_model, &configuration_server_publication_model);
1634f4854a5eSMatthias Ringwald     }
1635f4854a5eSMatthias Ringwald 
1636f4854a5eSMatthias Ringwald     // send status
1637f4854a5eSMatthias Ringwald     config_model_publication_status(mesh_model, mesh_pdu_netkey_index(access_pdu_in_process), mesh_pdu_src(access_pdu_in_process), status, configuration_server_element_address, configuration_server_model_identifier, &configuration_server_publication_model);
1638f4854a5eSMatthias Ringwald 
1639f4854a5eSMatthias Ringwald     mesh_access_message_processed(access_pdu_in_process);
1640f4854a5eSMatthias Ringwald }
1641f4854a5eSMatthias Ringwald 
1642f4854a5eSMatthias Ringwald static void
1643f4854a5eSMatthias Ringwald config_model_publication_virtual_address_set_handler(mesh_model_t *mesh_model,
1644f4854a5eSMatthias Ringwald                                                      mesh_pdu_t * pdu) {
1645f4854a5eSMatthias Ringwald 
1646f4854a5eSMatthias Ringwald     // set defaults
1647f4854a5eSMatthias Ringwald     memset(&configuration_server_publication_model, 0, sizeof(mesh_publication_model_t));
1648f4854a5eSMatthias Ringwald 
1649f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
1650f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
1651f4854a5eSMatthias Ringwald 
1652f4854a5eSMatthias Ringwald     // ElementAddress - Address of the element
1653f4854a5eSMatthias Ringwald     configuration_server_element_address = mesh_access_parser_get_u16(&parser);
1654f4854a5eSMatthias Ringwald 
1655f4854a5eSMatthias Ringwald     // store label uuid
1656f4854a5eSMatthias Ringwald     mesh_access_parser_get_label_uuid(&parser, configuration_server_label_uuid);
1657f4854a5eSMatthias Ringwald 
1658f4854a5eSMatthias Ringwald     // AppKeyIndex (12), CredentialFlag (1), RFU (3)
1659f4854a5eSMatthias Ringwald     uint16_t temp = mesh_access_parser_get_u16(&parser);
1660f4854a5eSMatthias Ringwald     configuration_server_publication_model.appkey_index = temp & 0x0fff;
1661f4854a5eSMatthias Ringwald     configuration_server_publication_model.friendship_credential_flag = (temp >> 12) & 1;
1662f4854a5eSMatthias Ringwald     configuration_server_publication_model.ttl        = mesh_access_parser_get_u8(&parser);
1663f4854a5eSMatthias Ringwald     configuration_server_publication_model.period     = mesh_access_parser_get_u8(&parser);
1664f4854a5eSMatthias Ringwald     configuration_server_publication_model.retransmit = mesh_access_parser_get_u8(&parser);
1665f4854a5eSMatthias Ringwald 
1666f4854a5eSMatthias Ringwald     // Model Identifier
1667f4854a5eSMatthias Ringwald     configuration_server_model_identifier = mesh_access_parser_get_model_identifier(&parser);
1668f4854a5eSMatthias Ringwald 
16697e7c4c9aSMatthias Ringwald     // Get Model for Element + Model Identifier
1670f4854a5eSMatthias Ringwald     uint8_t status;
1671f4854a5eSMatthias Ringwald     configuration_server_target_model = mesh_access_model_for_address_and_model_identifier(configuration_server_element_address, configuration_server_model_identifier, &status);
1672f4854a5eSMatthias Ringwald 
16737e7c4c9aSMatthias Ringwald      // Check if publicatation model struct provided
16747e7c4c9aSMatthias Ringwald      if (status == MESH_FOUNDATION_STATUS_SUCCESS) {
16757e7c4c9aSMatthias Ringwald         if (configuration_server_target_model->publication_model == NULL){
1676f4854a5eSMatthias Ringwald             status = MESH_FOUNDATION_STATUS_CANNOT_SET;
1677f4854a5eSMatthias Ringwald         }
16787e7c4c9aSMatthias Ringwald      }
16797e7c4c9aSMatthias Ringwald 
16807e7c4c9aSMatthias Ringwald      // Check AppKey
16817e7c4c9aSMatthias Ringwald      if (status == MESH_FOUNDATION_STATUS_SUCCESS){
16827e7c4c9aSMatthias Ringwald          // check if appkey already exists
16837e7c4c9aSMatthias Ringwald          mesh_transport_key_t * app_key = mesh_transport_key_get(configuration_server_publication_model.appkey_index);
16847e7c4c9aSMatthias Ringwald          if (app_key == NULL) {
16857e7c4c9aSMatthias Ringwald              status = MESH_FOUNDATION_STATUS_INVALID_APPKEY_INDEX;
16867e7c4c9aSMatthias Ringwald          }
16877e7c4c9aSMatthias Ringwald      }
1688f4854a5eSMatthias Ringwald 
1689f4854a5eSMatthias Ringwald     // on error, no need to calculate virtual address hash
1690f4854a5eSMatthias Ringwald     if (status != MESH_FOUNDATION_STATUS_SUCCESS){
1691f4854a5eSMatthias Ringwald         config_model_publication_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), status, configuration_server_element_address, configuration_server_model_identifier, &configuration_server_publication_model);
1692f4854a5eSMatthias Ringwald         mesh_access_message_processed(pdu);
1693f4854a5eSMatthias Ringwald         return;
1694f4854a5eSMatthias Ringwald     }
1695f4854a5eSMatthias Ringwald 
1696f4854a5eSMatthias Ringwald     access_pdu_in_process = pdu;
169732cecee0SMatthias Ringwald     mesh_virtual_address(&configuration_server_cmac_request, configuration_server_label_uuid, &configuration_server_hash, &config_model_publication_virtual_address_set_hash, mesh_model);
1698f4854a5eSMatthias Ringwald }
1699f4854a5eSMatthias Ringwald 
1700f4854a5eSMatthias Ringwald static void
1701f4854a5eSMatthias Ringwald config_model_publication_get_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu) {
1702f4854a5eSMatthias Ringwald 
1703f4854a5eSMatthias Ringwald 
1704f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
1705f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
1706f4854a5eSMatthias Ringwald 
1707f4854a5eSMatthias Ringwald     // ElementAddress - Address of the element - should be us
1708f4854a5eSMatthias Ringwald     uint16_t element_address = mesh_access_parser_get_u16(&parser);
1709f4854a5eSMatthias Ringwald 
1710f4854a5eSMatthias Ringwald     // Model Identifier
1711f4854a5eSMatthias Ringwald     uint32_t model_identifier = mesh_access_parser_get_model_identifier(&parser);
1712f4854a5eSMatthias Ringwald 
17137e7c4c9aSMatthias Ringwald     // Get Model for Element + Model Identifier
1714f4854a5eSMatthias Ringwald     uint8_t status;
1715f4854a5eSMatthias Ringwald     mesh_model_t * target_model = mesh_access_model_for_address_and_model_identifier(element_address, model_identifier, &status);
1716f4854a5eSMatthias Ringwald 
1717f4854a5eSMatthias Ringwald     mesh_publication_model_t * publication_model;
1718f4854a5eSMatthias Ringwald     if (target_model == NULL){
1719f4854a5eSMatthias Ringwald         // use defaults
1720f4854a5eSMatthias Ringwald         memset(&configuration_server_publication_model, 0, sizeof(mesh_publication_model_t));
1721f4854a5eSMatthias Ringwald         publication_model = &configuration_server_publication_model;
1722f4854a5eSMatthias Ringwald     } else {
1723f4854a5eSMatthias Ringwald         publication_model = target_model->publication_model;
1724f4854a5eSMatthias Ringwald     }
1725f4854a5eSMatthias Ringwald 
172632cecee0SMatthias Ringwald     config_model_publication_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), status, element_address, model_identifier, publication_model);
1727f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
1728f4854a5eSMatthias Ringwald }
1729f4854a5eSMatthias Ringwald 
1730f4854a5eSMatthias Ringwald // Heartbeat Publication
1731f4854a5eSMatthias Ringwald 
1732f4854a5eSMatthias Ringwald static void config_heartbeat_publication_emit(mesh_heartbeat_publication_t * mesh_heartbeat_publication){
1733f4854a5eSMatthias Ringwald 
1734f4854a5eSMatthias Ringwald     printf("CONFIG_SERVER_HEARTBEAT: Emit (dest %04x, count %u, period %u ms)\n",
1735f4854a5eSMatthias Ringwald         mesh_heartbeat_publication->destination,
1736f4854a5eSMatthias Ringwald         mesh_heartbeat_publication->count,
1737f4854a5eSMatthias Ringwald         mesh_heartbeat_publication->period_ms);
1738f4854a5eSMatthias Ringwald 
1739f4854a5eSMatthias Ringwald     // active features
1740f4854a5eSMatthias Ringwald     mesh_heartbeat_publication->active_features = mesh_foundation_get_features();
1741f4854a5eSMatthias Ringwald 
1742f4854a5eSMatthias Ringwald     mesh_network_pdu_t * network_pdu = mesh_network_pdu_get();
1743f4854a5eSMatthias Ringwald     if (network_pdu){
1744f4854a5eSMatthias Ringwald         uint8_t data[3];
1745f4854a5eSMatthias Ringwald         data[0] = mesh_heartbeat_publication->ttl;
1746f4854a5eSMatthias Ringwald         big_endian_store_16(data, 1, mesh_heartbeat_publication->active_features);
1747*2cf2bebbSMatthias Ringwald         uint8_t status = mesh_upper_transport_setup_control_pdu((mesh_pdu_t *) network_pdu, mesh_heartbeat_publication->netkey_index,
1748f4854a5eSMatthias Ringwald                 mesh_heartbeat_publication->ttl, mesh_node_get_primary_element_address(), mesh_heartbeat_publication->destination,
1749f4854a5eSMatthias Ringwald                 MESH_TRANSPORT_OPCODE_HEARTBEAT, data, sizeof(data));
1750*2cf2bebbSMatthias Ringwald         if (status){
1751*2cf2bebbSMatthias Ringwald             // stop periodic emit on error (netkey got invalid)
1752*2cf2bebbSMatthias Ringwald             mesh_heartbeat_publication->period_ms = 0;
1753*2cf2bebbSMatthias Ringwald             mesh_network_pdu_free(network_pdu);
1754*2cf2bebbSMatthias Ringwald         } else {
1755f4854a5eSMatthias Ringwald             mesh_upper_transport_send_control_pdu((mesh_pdu_t *) network_pdu);
1756f4854a5eSMatthias Ringwald         }
1757*2cf2bebbSMatthias Ringwald     }
1758f4854a5eSMatthias Ringwald 
1759f4854a5eSMatthias Ringwald     // forever
1760c41b074aSMatthias Ringwald     if (mesh_heartbeat_publication->count > 0 && mesh_heartbeat_publication->count < 0xffffu) {
1761f4854a5eSMatthias Ringwald         mesh_heartbeat_publication->count--;
1762f4854a5eSMatthias Ringwald     }
1763f4854a5eSMatthias Ringwald }
1764f4854a5eSMatthias Ringwald void mesh_configuration_server_feature_changed(void){
1765f4854a5eSMatthias Ringwald     mesh_model_t * mesh_model = mesh_model_get_configuration_server();
1766f4854a5eSMatthias Ringwald     mesh_heartbeat_publication_t * mesh_heartbeat_publication = &((mesh_configuration_server_model_context_t*) mesh_model->model_data)->heartbeat_publication;
1767f4854a5eSMatthias Ringwald 
1768c41b074aSMatthias Ringwald     // filter features by observed features for heartbeats
1769c41b074aSMatthias Ringwald     uint16_t current_features  = mesh_foundation_get_features()              & mesh_heartbeat_publication->features;
1770c41b074aSMatthias Ringwald     uint16_t previous_features = mesh_heartbeat_publication->active_features & mesh_heartbeat_publication->features;
1771c41b074aSMatthias Ringwald 
1772c41b074aSMatthias Ringwald     // changes?
1773c41b074aSMatthias Ringwald     if (current_features == previous_features) return;
1774848dbc95SMatthias Ringwald 
1775f4854a5eSMatthias Ringwald     config_heartbeat_publication_emit(mesh_heartbeat_publication);
1776f4854a5eSMatthias Ringwald }
1777f4854a5eSMatthias Ringwald 
1778f4854a5eSMatthias Ringwald static void config_heartbeat_publication_timeout_handler(btstack_timer_source_t * ts){
1779f4854a5eSMatthias Ringwald 
1780f4854a5eSMatthias Ringwald     mesh_heartbeat_publication_t * mesh_heartbeat_publication = (mesh_heartbeat_publication_t*) ts;
1781f4854a5eSMatthias Ringwald 
1782f4854a5eSMatthias Ringwald     // emit beat
1783f4854a5eSMatthias Ringwald     config_heartbeat_publication_emit(mesh_heartbeat_publication);
1784f4854a5eSMatthias Ringwald 
1785f4854a5eSMatthias Ringwald     // all sent?
1786f4854a5eSMatthias Ringwald     if (mesh_heartbeat_publication->count == 0) return;
1787f4854a5eSMatthias Ringwald 
1788f4854a5eSMatthias Ringwald     // periodic publication?
1789f4854a5eSMatthias Ringwald     if (mesh_heartbeat_publication->period_ms == 0) return;
1790f4854a5eSMatthias Ringwald 
1791f4854a5eSMatthias Ringwald     btstack_run_loop_set_timer(ts, mesh_heartbeat_publication->period_ms);
1792f4854a5eSMatthias Ringwald     btstack_run_loop_add_timer(ts);
1793f4854a5eSMatthias Ringwald }
1794f4854a5eSMatthias Ringwald 
1795f4854a5eSMatthias Ringwald static void config_heartbeat_publication_status(mesh_model_t *mesh_model, uint16_t netkey_index, uint16_t dest, uint8_t status, mesh_heartbeat_publication_t * mesh_heartbeat_publication){
17962983fbcbSMatthias Ringwald     UNUSED(mesh_model);
1797f4854a5eSMatthias Ringwald 
1798f4854a5eSMatthias Ringwald     // setup message
1799f4854a5eSMatthias Ringwald     uint8_t count_log = heartbeat_count_log(mesh_heartbeat_publication->count);
1800f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = mesh_access_setup_segmented_message(
1801f4854a5eSMatthias Ringwald             &mesh_foundation_config_heartbeat_publication_status,
1802f4854a5eSMatthias Ringwald             status,
1803f4854a5eSMatthias Ringwald             mesh_heartbeat_publication->destination,
1804f4854a5eSMatthias Ringwald             count_log,
1805f4854a5eSMatthias Ringwald             mesh_heartbeat_publication->period_log,
1806f4854a5eSMatthias Ringwald             mesh_heartbeat_publication->ttl,
1807f4854a5eSMatthias Ringwald             mesh_heartbeat_publication->features,
1808f4854a5eSMatthias Ringwald             mesh_heartbeat_publication->netkey_index);
1809f4854a5eSMatthias Ringwald     if (!transport_pdu) return;
1810848dbc95SMatthias Ringwald 
1811f4854a5eSMatthias Ringwald     printf("MESH config_heartbeat_publication_status count = %u => count_log = %u\n", mesh_heartbeat_publication->count, count_log);
1812f4854a5eSMatthias Ringwald 
1813f4854a5eSMatthias Ringwald     // send as segmented access pdu
1814f4854a5eSMatthias Ringwald     config_server_send_message(netkey_index, dest, (mesh_pdu_t *) transport_pdu);
1815f4854a5eSMatthias Ringwald }
1816f4854a5eSMatthias Ringwald 
1817f4854a5eSMatthias Ringwald static void config_heartbeat_publication_set_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu) {
1818f4854a5eSMatthias Ringwald 
1819f4854a5eSMatthias Ringwald     mesh_heartbeat_publication_t requested_publication;
1820f4854a5eSMatthias Ringwald 
1821f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
1822f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
1823f4854a5eSMatthias Ringwald 
1824f4854a5eSMatthias Ringwald     // Destination address for Heartbeat messages
1825f4854a5eSMatthias Ringwald     requested_publication.destination = mesh_access_parser_get_u16(&parser);
1826f4854a5eSMatthias Ringwald     // Number of Heartbeat messages to be sent
1827f4854a5eSMatthias Ringwald     requested_publication.count = heartbeat_pwr2(mesh_access_parser_get_u8(&parser));
1828f4854a5eSMatthias Ringwald     //  Period for sending Heartbeat messages
1829f4854a5eSMatthias Ringwald     requested_publication.period_log = mesh_access_parser_get_u8(&parser);
1830f4854a5eSMatthias Ringwald     //  TTL to be used when sending Heartbeat messages
1831f4854a5eSMatthias Ringwald     requested_publication.ttl = mesh_access_parser_get_u8(&parser);
1832f4854a5eSMatthias Ringwald     // Bit field indicating features that trigger Heartbeat messages when changed
1833f4854a5eSMatthias Ringwald     requested_publication.features = mesh_access_parser_get_u16(&parser) & MESH_HEARTBEAT_FEATURES_SUPPORTED_MASK;
1834f4854a5eSMatthias Ringwald     // NetKey Index
1835f4854a5eSMatthias Ringwald     requested_publication.netkey_index = mesh_access_parser_get_u16(&parser);
1836f4854a5eSMatthias Ringwald 
1837f4854a5eSMatthias Ringwald     // store period as ms
1838f4854a5eSMatthias Ringwald     requested_publication.period_ms = heartbeat_pwr2(requested_publication.period_log) * 1000;
1839f4854a5eSMatthias Ringwald 
1840f4854a5eSMatthias Ringwald     mesh_heartbeat_publication_t * mesh_heartbeat_publication = &((mesh_configuration_server_model_context_t*) mesh_model->model_data)->heartbeat_publication;
1841f4854a5eSMatthias Ringwald 
1842f4854a5eSMatthias Ringwald     // validate fields
1843f4854a5eSMatthias Ringwald     uint8_t status = MESH_FOUNDATION_STATUS_SUCCESS;
1844f4854a5eSMatthias Ringwald     mesh_network_key_t * network_key = mesh_network_key_list_get(requested_publication.netkey_index);
1845f4854a5eSMatthias Ringwald     if (network_key == NULL){
1846f4854a5eSMatthias Ringwald         status = MESH_FOUNDATION_STATUS_INVALID_NETKEY_INDEX;
1847f4854a5eSMatthias Ringwald     } else {
1848f4854a5eSMatthias Ringwald         printf("MESH config_heartbeat_publication_set, destination %x, count = %x, period = %u s\n",
1849f4854a5eSMatthias Ringwald             requested_publication.destination, requested_publication.count, requested_publication.period_ms);
1850f4854a5eSMatthias Ringwald 
1851f4854a5eSMatthias Ringwald         // accept update
1852f4854a5eSMatthias Ringwald         memcpy(mesh_heartbeat_publication, &requested_publication, sizeof(mesh_heartbeat_publication_t));
1853f4854a5eSMatthias Ringwald     }
1854f4854a5eSMatthias Ringwald 
1855f4854a5eSMatthias Ringwald     config_heartbeat_publication_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), status, mesh_heartbeat_publication);
1856f4854a5eSMatthias Ringwald 
1857f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
1858f4854a5eSMatthias Ringwald 
1859f4854a5eSMatthias Ringwald     if (status != MESH_FOUNDATION_STATUS_SUCCESS) return;
1860f4854a5eSMatthias Ringwald 
1861f4854a5eSMatthias Ringwald     // check if heartbeats should be disabled
1862f4854a5eSMatthias Ringwald     if (mesh_heartbeat_publication->destination == MESH_ADDRESS_UNSASSIGNED || mesh_heartbeat_publication->period_log == 0) {
1863f4854a5eSMatthias Ringwald         btstack_run_loop_remove_timer(&mesh_heartbeat_publication->timer);
1864c41b074aSMatthias Ringwald         printf("MESH config_heartbeat_publication_set, disable periodic sending\n");
1865f4854a5eSMatthias Ringwald         return;
1866f4854a5eSMatthias Ringwald     }
1867f4854a5eSMatthias Ringwald 
1868f4854a5eSMatthias Ringwald     // NOTE: defer first heartbeat to allow config status getting sent first
1869f4854a5eSMatthias Ringwald     btstack_run_loop_set_timer_handler(&mesh_heartbeat_publication->timer, config_heartbeat_publication_timeout_handler);
1870f4854a5eSMatthias Ringwald     btstack_run_loop_set_timer_context(&mesh_heartbeat_publication->timer, mesh_heartbeat_publication);
1871f4854a5eSMatthias Ringwald     btstack_run_loop_set_timer(&mesh_heartbeat_publication->timer, 2000);
1872f4854a5eSMatthias Ringwald     btstack_run_loop_add_timer(&mesh_heartbeat_publication->timer);
1873f4854a5eSMatthias Ringwald }
1874f4854a5eSMatthias Ringwald 
1875f4854a5eSMatthias Ringwald static void config_heartbeat_publication_get_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu) {
1876f4854a5eSMatthias Ringwald     mesh_heartbeat_publication_t * mesh_heartbeat_publication = &((mesh_configuration_server_model_context_t*) mesh_model->model_data)->heartbeat_publication;
1877f4854a5eSMatthias Ringwald     config_heartbeat_publication_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), MESH_FOUNDATION_STATUS_SUCCESS, mesh_heartbeat_publication);
1878f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
1879f4854a5eSMatthias Ringwald }
1880f4854a5eSMatthias Ringwald 
1881f4854a5eSMatthias Ringwald // Heartbeat Subscription
1882f4854a5eSMatthias Ringwald 
1883f4854a5eSMatthias Ringwald static void config_heartbeat_subscription_status(mesh_model_t *mesh_model, uint16_t netkey_index, uint16_t dest, uint8_t status, mesh_heartbeat_subscription_t * mesh_heartbeat_subscription){
18842983fbcbSMatthias Ringwald     UNUSED(mesh_model);
1885f4854a5eSMatthias Ringwald 
1886f4854a5eSMatthias Ringwald     // setup message
18875983f5c9SMatthias Ringwald     uint8_t count_log = heartbeat_count_log(mesh_heartbeat_subscription->count);
1888f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = mesh_access_setup_segmented_message(
1889f4854a5eSMatthias Ringwald             &mesh_foundation_config_heartbeat_subscription_status,
1890f4854a5eSMatthias Ringwald             status,
1891f4854a5eSMatthias Ringwald             mesh_heartbeat_subscription->source,
1892f4854a5eSMatthias Ringwald             mesh_heartbeat_subscription->destination,
1893f4854a5eSMatthias Ringwald             mesh_heartbeat_subscription->period_log,
1894f4854a5eSMatthias Ringwald             count_log,
1895f4854a5eSMatthias Ringwald             mesh_heartbeat_subscription->min_hops,
1896f4854a5eSMatthias Ringwald             mesh_heartbeat_subscription->max_hops);
1897f4854a5eSMatthias Ringwald     if (!transport_pdu) return;
18985983f5c9SMatthias Ringwald     printf("MESH config_heartbeat_subscription_status count = %u => count_log = %u\n", mesh_heartbeat_subscription->count, count_log);
1899f4854a5eSMatthias Ringwald 
1900f4854a5eSMatthias Ringwald     // send as segmented access pdu
1901f4854a5eSMatthias Ringwald     config_server_send_message(netkey_index, dest, (mesh_pdu_t *) transport_pdu);
1902f4854a5eSMatthias Ringwald }
1903f4854a5eSMatthias Ringwald static int config_heartbeat_subscription_enabled(mesh_heartbeat_subscription_t * mesh_heartbeat_subscription){
1904f4854a5eSMatthias Ringwald     return mesh_network_address_unicast(mesh_heartbeat_subscription->source) && mesh_heartbeat_subscription->period_log > 0 &&
1905f4854a5eSMatthias Ringwald         (mesh_network_address_unicast(mesh_heartbeat_subscription->destination) || mesh_network_address_group(mesh_heartbeat_subscription->destination));
1906f4854a5eSMatthias Ringwald }
1907f4854a5eSMatthias Ringwald 
1908f4854a5eSMatthias Ringwald static void config_heartbeat_subscription_set_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu) {
1909f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
1910f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
1911f4854a5eSMatthias Ringwald 
1912f4854a5eSMatthias Ringwald     mesh_heartbeat_subscription_t requested_subscription;
1913f4854a5eSMatthias Ringwald 
1914f4854a5eSMatthias Ringwald     // Destination address for Heartbeat messages
1915f4854a5eSMatthias Ringwald     requested_subscription.source = mesh_access_parser_get_u16(&parser);
1916f4854a5eSMatthias Ringwald     // Destination address for Heartbeat messages
1917f4854a5eSMatthias Ringwald     requested_subscription.destination = mesh_access_parser_get_u16(&parser);
1918f4854a5eSMatthias Ringwald     //  Period for sending Heartbeat messages
1919f4854a5eSMatthias Ringwald     requested_subscription.period_log = mesh_access_parser_get_u8(&parser);
1920f4854a5eSMatthias Ringwald 
19215bd1d5c3SMatthias Ringwald 
19225bd1d5c3SMatthias Ringwald     // Hearbeat Subscription Soure must be unassigned or a unicast address
19235bd1d5c3SMatthias Ringwald     int source_address_valid =
19245bd1d5c3SMatthias Ringwald          (requested_subscription.source == MESH_ADDRESS_UNSASSIGNED)    ||
19255bd1d5c3SMatthias Ringwald          (mesh_network_address_unicast(requested_subscription.source));
19265bd1d5c3SMatthias Ringwald 
19275bd1d5c3SMatthias Ringwald     // Heartbeat Subscription Destination must be unassigned, unicast (== our primary address), or a group address)
19285bd1d5c3SMatthias Ringwald     int destination_address_valid =
19295bd1d5c3SMatthias Ringwald          (requested_subscription.destination == MESH_ADDRESS_UNSASSIGNED)  ||
19305bd1d5c3SMatthias Ringwald          (mesh_network_address_unicast(requested_subscription.destination) && requested_subscription.destination == mesh_node_get_primary_element_address()) ||
19315bd1d5c3SMatthias Ringwald          (mesh_network_address_group(requested_subscription.destination));
19325bd1d5c3SMatthias Ringwald 
19335bd1d5c3SMatthias Ringwald     if (!source_address_valid || !destination_address_valid){
19345bd1d5c3SMatthias Ringwald         printf("MESH config_heartbeat_subscription_set, source %x or destination %x invalid\n", requested_subscription.source, requested_subscription.destination);
193500740393SMatthias Ringwald         mesh_access_message_processed(pdu);
193600740393SMatthias Ringwald         return;
193700740393SMatthias Ringwald     }
193800740393SMatthias Ringwald 
19395bd1d5c3SMatthias Ringwald     int subscription_enabled = config_heartbeat_subscription_enabled(&requested_subscription);
19405bd1d5c3SMatthias Ringwald     printf("MESH config_heartbeat_subscription_set, source %x destination %x, period = %u s => enabled %u \n", requested_subscription.source,
19415bd1d5c3SMatthias Ringwald             requested_subscription.destination, heartbeat_pwr2(requested_subscription.period_log), subscription_enabled);
19425bd1d5c3SMatthias Ringwald 
19435bd1d5c3SMatthias Ringwald     // ignore messages
1944f4854a5eSMatthias Ringwald     uint8_t status = MESH_FOUNDATION_STATUS_SUCCESS;
1945f4854a5eSMatthias Ringwald     if (requested_subscription.period_log > 0x11u){
1946f4854a5eSMatthias Ringwald         status = MESH_FOUNDATION_STATUS_CANNOT_SET;
1947f4854a5eSMatthias Ringwald     } else if ((requested_subscription.destination != MESH_ADDRESS_UNSASSIGNED)  &&
1948f4854a5eSMatthias Ringwald                !mesh_network_address_unicast(requested_subscription.destination) &&
1949f4854a5eSMatthias Ringwald                !mesh_network_address_group(requested_subscription.destination)){
1950f4854a5eSMatthias Ringwald         status = MESH_FOUNDATION_STATUS_INVALID_ADDRESS;
1951f4854a5eSMatthias Ringwald     }
1952f4854a5eSMatthias Ringwald 
1953f4854a5eSMatthias Ringwald     if (status != MESH_FOUNDATION_STATUS_SUCCESS){
1954f4854a5eSMatthias Ringwald         config_heartbeat_subscription_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), status, &requested_subscription);
1955f4854a5eSMatthias Ringwald         mesh_access_message_processed(pdu);
1956f4854a5eSMatthias Ringwald         return;
1957f4854a5eSMatthias Ringwald     }
1958f4854a5eSMatthias Ringwald 
1959f4854a5eSMatthias Ringwald     mesh_heartbeat_subscription_t * mesh_heartbeat_subscription = &((mesh_configuration_server_model_context_t*) mesh_model->model_data)->heartbeat_subscription;
1960f4854a5eSMatthias Ringwald 
19615983f5c9SMatthias Ringwald     if (config_heartbeat_subscription_enabled(&requested_subscription)){
19625983f5c9SMatthias Ringwald         mesh_heartbeat_subscription->source          = requested_subscription.source;
19635983f5c9SMatthias Ringwald         mesh_heartbeat_subscription->destination     = requested_subscription.destination;
19645983f5c9SMatthias Ringwald         mesh_heartbeat_subscription->period_log      = requested_subscription.period_log;
19655983f5c9SMatthias Ringwald         mesh_heartbeat_subscription->count           = 0;
19665983f5c9SMatthias Ringwald         mesh_heartbeat_subscription->min_hops        = 0x7Fu;
19675983f5c9SMatthias Ringwald         mesh_heartbeat_subscription->max_hops        = 0u;
1968be22c60cSMatthias Ringwald         mesh_heartbeat_subscription->period_start_ms = btstack_run_loop_get_time_ms();
1969f4854a5eSMatthias Ringwald     } else {
1970be22c60cSMatthias Ringwald #if 0
1971be22c60cSMatthias Ringwald         // code according to Mesh Spec v1.0.1
1972be22c60cSMatthias Ringwald         // "When an element receives a Config Heartbeat Subscription Set message, it shall ... respond with a Config Heartbeat Subscription Status message, setting ...
1973be22c60cSMatthias Ringwald         //  If the Source or the Destination field is set to the unassigned address, or the PeriodLog field is set to 0x00, [then]
1974be22c60cSMatthias Ringwald         //  - the processing of received Heartbeat messages shall be disabled,
1975be22c60cSMatthias Ringwald         //  - the Heartbeat Subscription Source state shall be set to the unassigned address,
1976be22c60cSMatthias Ringwald         //  - the Heartbeat Subscription Destination state shall be set to the unassigned address,
1977be22c60cSMatthias Ringwald         //  - the Heartbeat Subscription MinHops state shall be unchanged,
1978be22c60cSMatthias Ringwald         //  - the Heartbeat Subscription MaxHops state shall be unchanged,
1979be22c60cSMatthias Ringwald         //  - and the Heartbeat Subscription Count state shall be unchanged."
1980be22c60cSMatthias Ringwald         // If period_log == 0, then set src + dest to unassigned. If src or dest are unsigned, get triggers status mit count_log == 0
19815983f5c9SMatthias Ringwald         mesh_heartbeat_subscription->source          = MESH_ADDRESS_UNSASSIGNED;
19825983f5c9SMatthias Ringwald         mesh_heartbeat_subscription->destination     = MESH_ADDRESS_UNSASSIGNED;
1983be22c60cSMatthias Ringwald #else
1984be22c60cSMatthias Ringwald         // code to satisfy MESH/NODE/CFG/HBS/BV-02-C from PTS 7.4.1 / Mesh TS 1.0.2
19855bd1d5c3SMatthias Ringwald         if (requested_subscription.source == MESH_ADDRESS_UNSASSIGNED || requested_subscription.destination == MESH_ADDRESS_UNSASSIGNED){
1986be22c60cSMatthias Ringwald             mesh_heartbeat_subscription->source          = MESH_ADDRESS_UNSASSIGNED;
1987be22c60cSMatthias Ringwald             mesh_heartbeat_subscription->destination     = MESH_ADDRESS_UNSASSIGNED;
1988be22c60cSMatthias Ringwald         }
1989be22c60cSMatthias Ringwald #endif
19905983f5c9SMatthias Ringwald         mesh_heartbeat_subscription->period_log      = 0u;
1991f4854a5eSMatthias Ringwald     }
1992f4854a5eSMatthias Ringwald 
1993f4854a5eSMatthias Ringwald     config_heartbeat_subscription_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), status, mesh_heartbeat_subscription);
1994f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
1995f4854a5eSMatthias Ringwald }
1996f4854a5eSMatthias Ringwald 
1997be22c60cSMatthias Ringwald static uint32_t config_heartbeat_subscription_get_period_remaining_s(mesh_heartbeat_subscription_t * heartbeat_subscription){
1998be22c60cSMatthias Ringwald     // calculate period_log
1999be22c60cSMatthias Ringwald     int32_t time_since_start_s = btstack_time_delta(btstack_run_loop_get_time_ms(), heartbeat_subscription->period_start_ms) / 1000;
2000be22c60cSMatthias Ringwald     int32_t period_s = heartbeat_pwr2(heartbeat_subscription->period_log);
2001be22c60cSMatthias Ringwald     uint32_t period_remaining_s = 0;
2002be22c60cSMatthias Ringwald     if (time_since_start_s < period_s){
2003be22c60cSMatthias Ringwald         period_remaining_s = period_s - time_since_start_s;
2004be22c60cSMatthias Ringwald     }
2005be22c60cSMatthias Ringwald     printf("Heartbeat: time since start %d s, period %u s, period remaining %u s\n", time_since_start_s, period_s, period_remaining_s);
2006be22c60cSMatthias Ringwald     return period_remaining_s;
2007be22c60cSMatthias Ringwald }
2008f4854a5eSMatthias Ringwald 
2009f4854a5eSMatthias Ringwald static void config_heartbeat_subscription_get_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu) {
2010f4854a5eSMatthias Ringwald     mesh_heartbeat_subscription_t * mesh_heartbeat_subscription = &((mesh_configuration_server_model_context_t*) mesh_model->model_data)->heartbeat_subscription;
2011124babceSMatthias Ringwald     mesh_heartbeat_subscription_t subscription;
2012be22c60cSMatthias Ringwald     memcpy(&subscription, mesh_heartbeat_subscription, sizeof(subscription));
2013124babceSMatthias Ringwald     if (mesh_heartbeat_subscription->source == MESH_ADDRESS_UNSASSIGNED || mesh_heartbeat_subscription->destination == MESH_ADDRESS_UNSASSIGNED){
2014124babceSMatthias Ringwald         memset(&subscription, 0, sizeof(subscription));
2015be22c60cSMatthias Ringwald     } else {
2016be22c60cSMatthias Ringwald         // calculate period_log
2017be22c60cSMatthias Ringwald         uint32_t period_remaining_s = config_heartbeat_subscription_get_period_remaining_s(&subscription);
2018be22c60cSMatthias Ringwald         subscription.period_log = heartbeat_period_log(period_remaining_s);
2019124babceSMatthias Ringwald     }
2020be22c60cSMatthias Ringwald     config_heartbeat_subscription_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), MESH_FOUNDATION_STATUS_SUCCESS, &subscription);
2021f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
2022f4854a5eSMatthias Ringwald }
2023f4854a5eSMatthias Ringwald 
2024f4854a5eSMatthias Ringwald // KeyRefresh Phase
2025f4854a5eSMatthias Ringwald 
2026f4854a5eSMatthias Ringwald static void config_key_refresh_phase_status(mesh_model_t *mesh_model, uint16_t netkey_index_dest, uint16_t dest, uint8_t status, uint16_t netkey_index,
2027f4854a5eSMatthias Ringwald     mesh_key_refresh_state_t key_refresh_state){
20282983fbcbSMatthias Ringwald     UNUSED(mesh_model);
20292983fbcbSMatthias Ringwald 
2030f4854a5eSMatthias Ringwald     // setup message
2031f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = mesh_access_setup_segmented_message(
2032f4854a5eSMatthias Ringwald         &mesh_key_refresh_phase_status,
2033f4854a5eSMatthias Ringwald         status,
20342983fbcbSMatthias Ringwald         netkey_index,
2035f4854a5eSMatthias Ringwald         key_refresh_state);
2036f4854a5eSMatthias Ringwald     if (!transport_pdu) return;
2037f4854a5eSMatthias Ringwald 
2038f4854a5eSMatthias Ringwald     // send as segmented access pdu
2039f4854a5eSMatthias Ringwald     config_server_send_message(netkey_index_dest, dest, (mesh_pdu_t *) transport_pdu);
2040f4854a5eSMatthias Ringwald }
2041f4854a5eSMatthias Ringwald 
2042f4854a5eSMatthias Ringwald static void config_key_refresh_phase_get_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
2043f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
2044f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
2045f4854a5eSMatthias Ringwald     uint16_t netkey_index = mesh_access_parser_get_u16(&parser);
2046f4854a5eSMatthias Ringwald     mesh_subnet_t * subnet = mesh_subnet_get_by_netkey_index(netkey_index);
2047f4854a5eSMatthias Ringwald 
2048f4854a5eSMatthias Ringwald     uint8_t status = MESH_FOUNDATION_STATUS_INVALID_NETKEY_INDEX;
2049f4854a5eSMatthias Ringwald     mesh_key_refresh_state_t key_refresh_state = MESH_KEY_REFRESH_NOT_ACTIVE;
2050f4854a5eSMatthias Ringwald 
2051f4854a5eSMatthias Ringwald     if (subnet != NULL){
2052f4854a5eSMatthias Ringwald         status = MESH_FOUNDATION_STATUS_SUCCESS;
2053f4854a5eSMatthias Ringwald         key_refresh_state = subnet->key_refresh;
2054f4854a5eSMatthias Ringwald     }
2055f4854a5eSMatthias Ringwald 
2056f4854a5eSMatthias Ringwald     config_key_refresh_phase_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), status, netkey_index, key_refresh_state);
2057f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
2058f4854a5eSMatthias Ringwald }
2059f4854a5eSMatthias Ringwald 
2060f4854a5eSMatthias Ringwald static void config_key_refresh_phase_set_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
2061f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
2062f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
2063f4854a5eSMatthias Ringwald     uint16_t netkey_index = mesh_access_parser_get_u16(&parser);
2064f4854a5eSMatthias Ringwald     uint8_t  key_refresh_phase_transition = mesh_access_parser_get_u8(&parser);
2065f4854a5eSMatthias Ringwald     mesh_subnet_t * subnet = mesh_subnet_get_by_netkey_index(netkey_index);
2066f4854a5eSMatthias Ringwald 
2067f4854a5eSMatthias Ringwald     uint8_t status = MESH_FOUNDATION_STATUS_INVALID_NETKEY_INDEX;
2068f4854a5eSMatthias Ringwald 
2069f4854a5eSMatthias Ringwald     if (subnet != NULL){
2070f4854a5eSMatthias Ringwald         status = MESH_FOUNDATION_STATUS_SUCCESS;
2071f4854a5eSMatthias Ringwald 
2072f4854a5eSMatthias Ringwald         switch (key_refresh_phase_transition){
2073f4854a5eSMatthias Ringwald             case 0x02:
2074f4854a5eSMatthias Ringwald                 switch (subnet->key_refresh){
2075f4854a5eSMatthias Ringwald                     case MESH_KEY_REFRESH_FIRST_PHASE:
2076f4854a5eSMatthias Ringwald                     case MESH_KEY_REFRESH_SECOND_PHASE:
2077f4854a5eSMatthias Ringwald                         subnet->key_refresh = MESH_KEY_REFRESH_SECOND_PHASE;
2078f4854a5eSMatthias Ringwald                         break;
2079f4854a5eSMatthias Ringwald                     default:
2080f4854a5eSMatthias Ringwald                         break;
2081f4854a5eSMatthias Ringwald                 }
2082f4854a5eSMatthias Ringwald                 break;
2083f4854a5eSMatthias Ringwald             case 0x03:
2084f4854a5eSMatthias Ringwald                 switch (subnet->key_refresh){
2085f4854a5eSMatthias Ringwald                     case MESH_KEY_REFRESH_FIRST_PHASE:
2086f4854a5eSMatthias Ringwald                     case MESH_KEY_REFRESH_SECOND_PHASE:
2087f4854a5eSMatthias Ringwald                         // key refresh phase 3 entered
2088f4854a5eSMatthias Ringwald                         mesh_access_key_refresh_revoke_keys(subnet);
2089f4854a5eSMatthias Ringwald                         subnet->key_refresh = MESH_KEY_REFRESH_NOT_ACTIVE;
2090f4854a5eSMatthias Ringwald                         break;
2091f4854a5eSMatthias Ringwald                     default:
2092f4854a5eSMatthias Ringwald                         break;
2093f4854a5eSMatthias Ringwald                 }
2094f4854a5eSMatthias Ringwald                 break;
2095f4854a5eSMatthias Ringwald             default:
2096f4854a5eSMatthias Ringwald                 status = MESH_FOUNDATION_STATUS_CANNOT_SET;
2097f4854a5eSMatthias Ringwald                 break;
2098f4854a5eSMatthias Ringwald         }
2099f4854a5eSMatthias Ringwald     }
2100f4854a5eSMatthias Ringwald 
2101f4854a5eSMatthias Ringwald     config_key_refresh_phase_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), status, netkey_index, subnet->key_refresh);
2102f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
2103f4854a5eSMatthias Ringwald }
2104f4854a5eSMatthias Ringwald 
2105f4854a5eSMatthias Ringwald 
2106f4854a5eSMatthias Ringwald static void config_node_reset_status(mesh_model_t *mesh_model, uint16_t netkey_index, uint16_t dest){
21072983fbcbSMatthias Ringwald     UNUSED(mesh_model);
21082983fbcbSMatthias Ringwald 
2109f4854a5eSMatthias Ringwald     // setup message
2110f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = mesh_access_setup_segmented_message(&mesh_foundation_node_reset_status);
2111f4854a5eSMatthias Ringwald     if (!transport_pdu) return;
2112f4854a5eSMatthias Ringwald 
2113f4854a5eSMatthias Ringwald     // send as segmented access pdu
2114f4854a5eSMatthias Ringwald     config_server_send_message(netkey_index, dest, (mesh_pdu_t *) transport_pdu);
2115f4854a5eSMatthias Ringwald }
2116f4854a5eSMatthias Ringwald 
2117f4854a5eSMatthias Ringwald static void config_node_reset_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
2118f4854a5eSMatthias Ringwald     mesh_node_reset();
2119f4854a5eSMatthias Ringwald     config_node_reset_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu));
2120f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
2121f4854a5eSMatthias Ringwald }
2122f4854a5eSMatthias Ringwald 
2123f4854a5eSMatthias Ringwald static void low_power_node_poll_timeout_status(mesh_model_t *mesh_model, uint16_t netkey_index_dest, uint16_t dest, uint8_t status){
21242983fbcbSMatthias Ringwald     UNUSED(mesh_model);
21252983fbcbSMatthias Ringwald 
2126f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = mesh_access_setup_segmented_message(
2127f4854a5eSMatthias Ringwald         &mesh_foundation_low_power_node_poll_timeout_status,
2128f4854a5eSMatthias Ringwald         status,
2129f4854a5eSMatthias Ringwald         0,  // The unicast address of the Low Power node
2130f4854a5eSMatthias Ringwald         0); // The current value of the PollTimeout timer of the Low Power node
2131f4854a5eSMatthias Ringwald     if (!transport_pdu) return;
2132f4854a5eSMatthias Ringwald     printf("TODO: send unicast address of the Low Power node and the current value of the PollTimeout timer, instead of 0s\n");
2133f4854a5eSMatthias Ringwald     // send as segmented access pdu
2134f4854a5eSMatthias Ringwald     config_server_send_message(netkey_index_dest, dest, (mesh_pdu_t *) transport_pdu);
2135f4854a5eSMatthias Ringwald }
2136f4854a5eSMatthias Ringwald 
2137f4854a5eSMatthias Ringwald static void config_low_power_node_poll_timeout_get_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
2138f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
2139f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
2140f4854a5eSMatthias Ringwald     printf("TODO: implement get the current value of PollTimeout timer of the Low Power node within a Friend node\n");
2141f4854a5eSMatthias Ringwald     low_power_node_poll_timeout_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), MESH_FOUNDATION_STATUS_SUCCESS);
2142848dbc95SMatthias Ringwald 
2143f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
2144f4854a5eSMatthias Ringwald }
2145f4854a5eSMatthias Ringwald 
2146f4854a5eSMatthias Ringwald static void config_node_identity_status(mesh_model_t *mesh_model, uint16_t netkey_index_dest, uint16_t dest, uint8_t status, uint16_t netkey_index,
2147f4854a5eSMatthias Ringwald     mesh_node_identity_state_t node_identity_state){
21482983fbcbSMatthias Ringwald     UNUSED(mesh_model);
21492983fbcbSMatthias Ringwald 
2150f4854a5eSMatthias Ringwald     // setup message
2151f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = mesh_access_setup_segmented_message(
2152f4854a5eSMatthias Ringwald         &mesh_foundation_node_identity_status,
2153f4854a5eSMatthias Ringwald         status,
21542983fbcbSMatthias Ringwald         netkey_index,
2155f4854a5eSMatthias Ringwald         node_identity_state);
2156f4854a5eSMatthias Ringwald     if (!transport_pdu) return;
2157f4854a5eSMatthias Ringwald 
2158f4854a5eSMatthias Ringwald     // send as segmented access pdu
2159f4854a5eSMatthias Ringwald     config_server_send_message(netkey_index_dest, dest, (mesh_pdu_t *) transport_pdu);
2160f4854a5eSMatthias Ringwald }
2161f4854a5eSMatthias Ringwald 
2162f4854a5eSMatthias Ringwald static void config_node_identity_get_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
2163f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
2164f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
2165f4854a5eSMatthias Ringwald     uint16_t netkey_index = mesh_access_parser_get_u16(&parser);
2166f4854a5eSMatthias Ringwald 
2167f4854a5eSMatthias Ringwald     mesh_node_identity_state_t node_identity_state = MESH_NODE_IDENTITY_STATE_ADVERTISING_NOT_SUPPORTED;
216889b2d435SMatthias Ringwald     uint8_t status = mesh_proxy_get_advertising_with_node_id_status(netkey_index, &node_identity_state);
2169f4854a5eSMatthias Ringwald     config_node_identity_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), status, netkey_index, node_identity_state);
2170848dbc95SMatthias Ringwald 
2171f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
2172f4854a5eSMatthias Ringwald }
2173f4854a5eSMatthias Ringwald 
2174f4854a5eSMatthias Ringwald static void config_node_identity_set_handler(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
2175f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
2176f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
2177f4854a5eSMatthias Ringwald     uint16_t netkey_index = mesh_access_parser_get_u16(&parser);
2178f4854a5eSMatthias Ringwald     mesh_node_identity_state_t node_identity_state = (mesh_node_identity_state_t) mesh_access_parser_get_u8(&parser);
2179f4854a5eSMatthias Ringwald 
21800694a632SMatthias Ringwald     // ignore invalid state
21810694a632SMatthias Ringwald     if (node_identity_state >= MESH_NODE_IDENTITY_STATE_ADVERTISING_NOT_SUPPORTED) {
21820694a632SMatthias Ringwald         mesh_access_message_processed(pdu);
21830694a632SMatthias Ringwald         return;
21840694a632SMatthias Ringwald     }
21850694a632SMatthias Ringwald 
21863db24e72SMatthias Ringwald     uint8_t status = MESH_FOUNDATION_STATUS_SUCCESS;
21873db24e72SMatthias Ringwald #ifdef ENABLE_MESH_PROXY_SERVER
21883db24e72SMatthias Ringwald     status = mesh_proxy_set_advertising_with_node_id(netkey_index, node_identity_state);
21890694a632SMatthias Ringwald #else
21900694a632SMatthias Ringwald     mesh_subnet_t * network_key = mesh_subnet_get_by_netkey_index(netkey_index);
21910694a632SMatthias Ringwald     if (network_key == NULL){
21920694a632SMatthias Ringwald         status = MESH_FOUNDATION_STATUS_INVALID_NETKEY_INDEX;
21930694a632SMatthias Ringwald     }
21943db24e72SMatthias Ringwald #endif
2195f4854a5eSMatthias Ringwald 
2196f4854a5eSMatthias Ringwald     config_node_identity_status(mesh_model, mesh_pdu_netkey_index(pdu), mesh_pdu_src(pdu), status, netkey_index, node_identity_state);
2197848dbc95SMatthias Ringwald 
2198f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
2199f4854a5eSMatthias Ringwald }
2200f4854a5eSMatthias Ringwald 
2201f4854a5eSMatthias Ringwald //
2202f4854a5eSMatthias Ringwald 
2203f4854a5eSMatthias Ringwald const static mesh_operation_t mesh_configuration_server_model_operations[] = {
2204f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_APPKEY_ADD,                                  19, config_appkey_add_handler },
2205f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_APPKEY_DELETE,                                3, config_appkey_delete_handler },
2206f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_APPKEY_GET,                                   2, config_appkey_get_handler },
2207f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_APPKEY_UPDATE,                               19, config_appkey_update_handler },
2208f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_NETKEY_ADD,                                  18, config_netkey_add_handler },
2209f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_NETKEY_UPDATE,                               18, config_netkey_update_handler },
2210f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_NETKEY_DELETE,                                2, config_netkey_delete_handler },
2211f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_NETKEY_GET,                                   0, config_netkey_get_handler },
2212f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_COMPOSITION_DATA_GET,                         1, config_composition_data_get_handler },
2213f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_BEACON_GET,                                   0, config_beacon_get_handler },
2214f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_BEACON_SET,                                   1, config_beacon_set_handler },
2215f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_DEFAULT_TTL_GET,                              0, config_default_ttl_get_handler },
2216f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_DEFAULT_TTL_SET,                              1, config_default_ttl_set_handler },
2217f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_FRIEND_GET,                                   0, config_friend_get_handler },
2218f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_FRIEND_SET,                                   1, config_friend_set_handler },
2219f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_NETWORK_TRANSMIT_GET,                         0, config_model_network_transmit_get_handler },
2220f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_NETWORK_TRANSMIT_SET,                         1, config_model_network_transmit_set_handler },
2221f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_GATT_PROXY_GET,                               0, config_gatt_proxy_get_handler },
2222f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_GATT_PROXY_SET,                               1, config_gatt_proxy_set_handler },
2223f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_RELAY_GET,                                    0, config_relay_get_handler },
2224f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_RELAY_SET,                                    1, config_relay_set_handler },
2225f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_MODEL_SUBSCRIPTION_ADD,                       6, config_model_subscription_add_handler },
2226f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_MODEL_SUBSCRIPTION_VIRTUAL_ADDRESS_ADD,      20, config_model_subscription_virtual_address_add_handler },
2227f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_MODEL_SUBSCRIPTION_DELETE,                    6, config_model_subscription_delete_handler },
2228f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_MODEL_SUBSCRIPTION_VIRTUAL_ADDRESS_DELETE,   20, config_model_subscription_virtual_address_delete_handler },
2229f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_MODEL_SUBSCRIPTION_OVERWRITE,                 6, config_model_subscription_overwrite_handler },
2230f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_MODEL_SUBSCRIPTION_VIRTUAL_ADDRESS_OVERWRITE,20, config_model_subscription_virtual_address_overwrite_handler },
2231f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_MODEL_SUBSCRIPTION_DELETE_ALL,                4, config_model_subscription_delete_all_handler },
2232f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_SIG_MODEL_SUBSCRIPTION_GET,                   4, config_model_subscription_get_handler },
2233f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_VENDOR_MODEL_SUBSCRIPTION_GET,                6, config_model_subscription_get_handler },
22342983fbcbSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_SIG_MODEL_APP_GET,                            4, config_model_app_get_handler },
22352983fbcbSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_VENDOR_MODEL_APP_GET,                         6, config_model_app_get_handler },
2236f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_MODEL_PUBLICATION_SET,                       11, config_model_publication_set_handler },
2237f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_MODEL_PUBLICATION_VIRTUAL_ADDRESS_SET,       25, config_model_publication_virtual_address_set_handler },
2238f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_MODEL_PUBLICATION_GET,                        4, config_model_publication_get_handler },
2239f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_MODEL_APP_BIND,                               6, config_model_app_bind_handler },
2240f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_MODEL_APP_UNBIND,                             6, config_model_app_unbind_handler },
2241f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_HEARTBEAT_PUBLICATION_GET,                    0, config_heartbeat_publication_get_handler },
2242f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_HEARTBEAT_PUBLICATION_SET,                    9, config_heartbeat_publication_set_handler },
2243f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_HEARTBEAT_SUBSCRIPTION_GET,                   0, config_heartbeat_subscription_get_handler},
2244f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_HEARTBEAT_SUBSCRIPTION_SET,                   5, config_heartbeat_subscription_set_handler},
2245f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_KEY_REFRESH_PHASE_GET,                        2, config_key_refresh_phase_get_handler },
2246f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_KEY_REFRESH_PHASE_SET,                        3, config_key_refresh_phase_set_handler },
2247f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_NODE_RESET,                                   0, config_node_reset_handler },
2248f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_LOW_POWER_NODE_POLL_TIMEOUT_GET,              2, config_low_power_node_poll_timeout_get_handler },
2249f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_NODE_IDENTITY_GET,                            2, config_node_identity_get_handler },
2250f4854a5eSMatthias Ringwald     { MESH_FOUNDATION_OPERATION_NODE_IDENTITY_SET,                            3, config_node_identity_set_handler },
2251f4854a5eSMatthias Ringwald     { 0, 0, NULL }
2252f4854a5eSMatthias Ringwald };
2253f4854a5eSMatthias Ringwald 
2254f4854a5eSMatthias Ringwald const mesh_operation_t * mesh_configuration_server_get_operations(void){
2255f4854a5eSMatthias Ringwald     return mesh_configuration_server_model_operations;
2256f4854a5eSMatthias Ringwald }
2257f4854a5eSMatthias Ringwald 
2258cf858fe0SMatthias Ringwald void mesh_configuration_server_process_heartbeat(mesh_model_t * configuration_server_model, uint16_t src, uint16_t dest, uint8_t hops, uint16_t features){
22595bd1d5c3SMatthias Ringwald     UNUSED(features);
2260124babceSMatthias Ringwald     mesh_heartbeat_subscription_t * mesh_heartbeat_subscription = &((mesh_configuration_server_model_context_t*) configuration_server_model->model_data)->heartbeat_subscription;
2261be22c60cSMatthias Ringwald     if (config_heartbeat_subscription_get_period_remaining_s(mesh_heartbeat_subscription) == 0) return;
2262cf858fe0SMatthias Ringwald     if (mesh_heartbeat_subscription->source != src) return;
2263cf858fe0SMatthias Ringwald     if (mesh_heartbeat_subscription->destination != dest) return;
2264cf858fe0SMatthias Ringwald     // update count
2265124babceSMatthias Ringwald     if (mesh_heartbeat_subscription->count != 0xffff){
2266124babceSMatthias Ringwald         mesh_heartbeat_subscription->count++;
2267124babceSMatthias Ringwald     }
22685bd1d5c3SMatthias Ringwald     // update min/max hops
22695bd1d5c3SMatthias Ringwald     mesh_heartbeat_subscription->min_hops = (uint8_t) btstack_min(mesh_heartbeat_subscription->min_hops, hops);
22705bd1d5c3SMatthias Ringwald     mesh_heartbeat_subscription->max_hops = (uint8_t) btstack_max(mesh_heartbeat_subscription->max_hops, hops);
22715bd1d5c3SMatthias Ringwald 
22725bd1d5c3SMatthias Ringwald     printf("HEARTBEAT, count %u, min %u, max %u hops\n", mesh_heartbeat_subscription->count, mesh_heartbeat_subscription->min_hops, mesh_heartbeat_subscription->max_hops);
2273b77439a1SMatthias Ringwald }
2274