xref: /btstack/src/mesh/mesh_generic_level_server.c (revision e8b9b724a617d3ec903bbd9a7884aa3cb31ebe0e)
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 
382d4000d1SMatthias Ringwald #define BTSTACK_FILE__ "mesh_generic_level_server.c"
39f4854a5eSMatthias Ringwald 
40f4854a5eSMatthias Ringwald #include <string.h>
41f4854a5eSMatthias Ringwald #include <stdio.h>
42f4854a5eSMatthias Ringwald 
43f4854a5eSMatthias Ringwald #include "mesh/mesh_generic_level_server.h"
44f4854a5eSMatthias Ringwald 
45f4854a5eSMatthias Ringwald #include "bluetooth_company_id.h"
46321e3a3cSMatthias Ringwald #include "btstack_debug.h"
47321e3a3cSMatthias Ringwald #include "btstack_memory.h"
48321e3a3cSMatthias Ringwald #include "btstack_util.h"
49f4854a5eSMatthias Ringwald 
50f4854a5eSMatthias Ringwald #include "mesh/mesh_access.h"
51f4854a5eSMatthias Ringwald #include "mesh/mesh_foundation.h"
52f4854a5eSMatthias Ringwald #include "mesh/mesh_generic_model.h"
53f4854a5eSMatthias Ringwald #include "mesh/mesh_keys.h"
54f4854a5eSMatthias Ringwald #include "mesh/mesh_network.h"
55f4854a5eSMatthias Ringwald #include "mesh/mesh_upper_transport.h"
56f4854a5eSMatthias Ringwald 
57f4854a5eSMatthias Ringwald static void generic_server_send_message(uint16_t src, uint16_t dest, uint16_t netkey_index, uint16_t appkey_index, mesh_pdu_t *pdu){
58f4854a5eSMatthias Ringwald     uint8_t  ttl  = mesh_foundation_default_ttl_get();
59f4854a5eSMatthias Ringwald     mesh_upper_transport_setup_access_pdu_header(pdu, netkey_index, appkey_index, ttl, src, dest, 0);
60321e3a3cSMatthias Ringwald     mesh_access_send_unacknowledged_pdu(pdu);
61f4854a5eSMatthias Ringwald }
62f4854a5eSMatthias Ringwald 
63f4854a5eSMatthias Ringwald // Transition
64753e6a2cSMatthias Ringwald static int16_t add_and_clip_int16(int16_t current_value, int32_t increment){
65f4854a5eSMatthias Ringwald     int32_t value = current_value + increment;
66f4854a5eSMatthias Ringwald     if (value < -32768){
67f4854a5eSMatthias Ringwald         value = -32768;
68f4854a5eSMatthias Ringwald     } else if (value > 32767){
69f4854a5eSMatthias Ringwald         value = 32767;
70f4854a5eSMatthias Ringwald     }
71f4854a5eSMatthias Ringwald    return (int16_t) value;
72f4854a5eSMatthias Ringwald }
73f4854a5eSMatthias Ringwald 
74f4854a5eSMatthias Ringwald static mesh_transition_t * generic_level_server_get_base_transition(mesh_model_t * mesh_model) {
75f4854a5eSMatthias Ringwald      mesh_generic_level_state_t * generic_level_server_state = (mesh_generic_level_state_t *)mesh_model->model_data;
76f4854a5eSMatthias Ringwald     return &generic_level_server_state->transition_data.base_transition;
77f4854a5eSMatthias Ringwald }
78f4854a5eSMatthias Ringwald 
7985bee781SMatthias Ringwald static void mesh_server_transition_state_emit_change(mesh_transition_int16_t * transition, model_state_update_reason_t reason){
80f4854a5eSMatthias Ringwald     mesh_model_t * generic_level_server_model = transition->base_transition.mesh_model;
8185bee781SMatthias Ringwald     mesh_access_emit_state_update_int16(generic_level_server_model->model_packet_handler,
8285bee781SMatthias Ringwald         mesh_access_get_element_index(generic_level_server_model),
8385bee781SMatthias Ringwald         generic_level_server_model->model_identifier,
8485bee781SMatthias Ringwald         MODEL_STATE_ID_GENERIC_LEVEL,
8585bee781SMatthias Ringwald         reason,
8685bee781SMatthias Ringwald         transition->current_value);
8785bee781SMatthias Ringwald }
88f4854a5eSMatthias Ringwald 
89*e8b9b724SMatthias Ringwald static void mesh_server_transition_state_started(mesh_transition_int16_t * transition, uint32_t current_timestamp_ms){
90*e8b9b724SMatthias Ringwald     transition->base_transition.state = MESH_TRANSITION_STATE_ACTIVE;
91*e8b9b724SMatthias Ringwald     transition->base_transition.remaining_delay_time_ms = 0;
92*e8b9b724SMatthias Ringwald     transition->base_transition.phase_start_ms = current_timestamp_ms;
93*e8b9b724SMatthias Ringwald 
94*e8b9b724SMatthias Ringwald     // notify transition completed
95*e8b9b724SMatthias Ringwald     mesh_server_transition_state_emit_change(transition, MODEL_STATE_UPDATE_REASON_TRANSITION_START);
96*e8b9b724SMatthias Ringwald }
97*e8b9b724SMatthias Ringwald 
9885bee781SMatthias Ringwald static void mesh_server_transition_state_update_stepwise_value(mesh_transition_int16_t * transition){
99f4854a5eSMatthias Ringwald     transition->current_value = add_and_clip_int16(transition->current_value, transition->stepwise_value_increment);
100d3b33bfbSMatthias Ringwald 
10185bee781SMatthias Ringwald     // publish new value
10285bee781SMatthias Ringwald     mesh_access_state_changed(transition->base_transition.mesh_model);
10385bee781SMatthias Ringwald 
10485bee781SMatthias Ringwald     // notify transition update
10585bee781SMatthias Ringwald     mesh_server_transition_state_emit_change(transition, MODEL_STATE_UPDATE_REASON_TRANSITION_ACTIVE);
106f4854a5eSMatthias Ringwald }
107f4854a5eSMatthias Ringwald 
10885bee781SMatthias Ringwald static void mesh_server_transition_state_done(mesh_transition_int16_t * transition, uint32_t current_timestamp_ms){
10985bee781SMatthias Ringwald     transition->base_transition.state = MESH_TRANSITION_STATE_IDLE;
110f4854a5eSMatthias Ringwald     transition->base_transition.remaining_transition_time_ms = 0;
11185bee781SMatthias Ringwald     transition->current_value = transition->target_value;
112f4854a5eSMatthias Ringwald 
11385bee781SMatthias Ringwald     // publish new value
11485bee781SMatthias Ringwald     mesh_access_state_changed(transition->base_transition.mesh_model);
11585bee781SMatthias Ringwald 
11685bee781SMatthias Ringwald     // notify transition completed
11785bee781SMatthias Ringwald     mesh_server_transition_state_emit_change(transition, MODEL_STATE_UPDATE_REASON_TRANSITION_END);
118f4854a5eSMatthias Ringwald 
119f4854a5eSMatthias Ringwald     // done, stop transition
120f4854a5eSMatthias Ringwald     mesh_access_transitions_remove((mesh_transition_t *)transition);
121f4854a5eSMatthias Ringwald }
122f4854a5eSMatthias Ringwald 
123ac8dd887SMatthias Ringwald static void mesh_server_transition_state_set(mesh_transition_int16_t * transition, uint32_t current_timestamp_ms){
124ac8dd887SMatthias Ringwald     UNUSED(current_timestamp_ms);
125ac8dd887SMatthias Ringwald 
126ac8dd887SMatthias Ringwald     transition->base_transition.state = MESH_TRANSITION_STATE_IDLE;
127ac8dd887SMatthias Ringwald     transition->base_transition.remaining_transition_time_ms = 0;
128ac8dd887SMatthias Ringwald     transition->current_value = transition->target_value;
129ac8dd887SMatthias Ringwald 
130ac8dd887SMatthias Ringwald     // publish new value
131ac8dd887SMatthias Ringwald     mesh_access_state_changed(transition->base_transition.mesh_model);
132ac8dd887SMatthias Ringwald 
133ac8dd887SMatthias Ringwald     // instantaneous update
134ac8dd887SMatthias Ringwald     mesh_server_transition_state_emit_change(transition, MODEL_STATE_UPDATE_REASON_SET);
135ac8dd887SMatthias Ringwald }
136ac8dd887SMatthias Ringwald 
137*e8b9b724SMatthias Ringwald static void mesh_server_transition_handler(mesh_transition_t * base_transition, model_state_update_reason_t event){
138*e8b9b724SMatthias Ringwald     mesh_transition_int16_t * transition = (mesh_transition_int16_t*) base_transition;
139*e8b9b724SMatthias Ringwald     uint32_t current_timestamp_ms = btstack_run_loop_get_time_ms();
140*e8b9b724SMatthias Ringwald     switch (event){
141*e8b9b724SMatthias Ringwald         case MODEL_STATE_UPDATE_REASON_SET:
142*e8b9b724SMatthias Ringwald             mesh_server_transition_state_set(transition, current_timestamp_ms);
143*e8b9b724SMatthias Ringwald             break;
144*e8b9b724SMatthias Ringwald         case MODEL_STATE_UPDATE_REASON_TRANSITION_START:
145*e8b9b724SMatthias Ringwald             mesh_server_transition_state_started(transition, current_timestamp_ms);
146*e8b9b724SMatthias Ringwald             break;
147*e8b9b724SMatthias Ringwald         case MODEL_STATE_UPDATE_REASON_TRANSITION_ACTIVE:
148*e8b9b724SMatthias Ringwald             mesh_server_transition_state_update_stepwise_value(transition);
149*e8b9b724SMatthias Ringwald             break;
150*e8b9b724SMatthias Ringwald         case MODEL_STATE_UPDATE_REASON_TRANSITION_END:
151*e8b9b724SMatthias Ringwald             mesh_server_transition_state_done(transition, current_timestamp_ms);
152*e8b9b724SMatthias Ringwald             break;
153*e8b9b724SMatthias Ringwald         case MODEL_STATE_UPDATE_REASON_TRANSITION_ABORT:
154*e8b9b724SMatthias Ringwald             break;
155*e8b9b724SMatthias Ringwald         default:
156*e8b9b724SMatthias Ringwald             break;
157*e8b9b724SMatthias Ringwald     }
158*e8b9b724SMatthias Ringwald }
159*e8b9b724SMatthias Ringwald 
16085bee781SMatthias Ringwald static void mesh_server_transition_step(mesh_transition_t * base_transition, transition_event_t event, uint32_t current_timestamp_ms){
161f4854a5eSMatthias Ringwald     uint32_t time_step_ms;
162f4854a5eSMatthias Ringwald 
163f4854a5eSMatthias Ringwald     mesh_transition_int16_t * transition = (mesh_transition_int16_t*) base_transition;
164f4854a5eSMatthias Ringwald 
165f4854a5eSMatthias Ringwald     switch (transition->base_transition.state){
166f4854a5eSMatthias Ringwald         case MESH_TRANSITION_STATE_IDLE:
167f4854a5eSMatthias Ringwald             if (event != TRANSITION_START) break;
168*e8b9b724SMatthias Ringwald             transition->base_transition.state = MESH_TRANSITION_STATE_DELAYED;
169*e8b9b724SMatthias Ringwald             transition->base_transition.phase_start_ms = current_timestamp_ms;
17085bee781SMatthias Ringwald             if (transition->base_transition.remaining_delay_time_ms != 0) break;
171*e8b9b724SMatthias Ringwald             mesh_server_transition_handler(base_transition, MODEL_STATE_UPDATE_REASON_TRANSITION_START);
17285bee781SMatthias Ringwald             if (transition->base_transition.remaining_transition_time_ms != 0) break;
173*e8b9b724SMatthias Ringwald             mesh_server_transition_handler(base_transition, MODEL_STATE_UPDATE_REASON_TRANSITION_END);
174f4854a5eSMatthias Ringwald             break;
17585bee781SMatthias Ringwald 
176f4854a5eSMatthias Ringwald         case MESH_TRANSITION_STATE_DELAYED:
177f4854a5eSMatthias Ringwald             if (event != TRANSITION_UPDATE) break;
17885bee781SMatthias Ringwald             time_step_ms = current_timestamp_ms - transition->base_transition.phase_start_ms;
17985bee781SMatthias Ringwald             if (transition->base_transition.remaining_delay_time_ms > time_step_ms){
180f4854a5eSMatthias Ringwald                 transition->base_transition.remaining_delay_time_ms -= time_step_ms;
18185bee781SMatthias Ringwald                 transition->base_transition.phase_start_ms += time_step_ms;
18285bee781SMatthias Ringwald                 break;
183f4854a5eSMatthias Ringwald             }
184*e8b9b724SMatthias Ringwald             mesh_server_transition_handler(base_transition, MODEL_STATE_UPDATE_REASON_TRANSITION_START);
18585bee781SMatthias Ringwald             if (transition->base_transition.remaining_transition_time_ms != 0) break;
186*e8b9b724SMatthias Ringwald             mesh_server_transition_handler(base_transition, MODEL_STATE_UPDATE_REASON_TRANSITION_END);
187f4854a5eSMatthias Ringwald             break;
188f4854a5eSMatthias Ringwald         case MESH_TRANSITION_STATE_ACTIVE:
189f4854a5eSMatthias Ringwald             if (event != TRANSITION_UPDATE) break;
19085bee781SMatthias Ringwald             time_step_ms = current_timestamp_ms - transition->base_transition.phase_start_ms;
191b66ef5c9SMatthias Ringwald             if (transition->base_transition.num_steps == MESH_TRANSITION_NUM_STEPS_INFINITE){
192*e8b9b724SMatthias Ringwald                 mesh_server_transition_handler(base_transition, MODEL_STATE_UPDATE_REASON_TRANSITION_ACTIVE);
193b66ef5c9SMatthias Ringwald                 // done when max value reached
194b66ef5c9SMatthias Ringwald                 if (transition->current_value > - 32768 && transition->current_value < 32767) break;
195b66ef5c9SMatthias Ringwald             } else if (transition->base_transition.remaining_transition_time_ms > time_step_ms){
196f4854a5eSMatthias Ringwald                 transition->base_transition.remaining_transition_time_ms -= time_step_ms;
19785bee781SMatthias Ringwald                 transition->base_transition.phase_start_ms += time_step_ms;
198*e8b9b724SMatthias Ringwald                 mesh_server_transition_handler(base_transition, MODEL_STATE_UPDATE_REASON_TRANSITION_ACTIVE);
19985bee781SMatthias Ringwald                 break;
200f4854a5eSMatthias Ringwald             }
201*e8b9b724SMatthias Ringwald             mesh_server_transition_handler(base_transition, MODEL_STATE_UPDATE_REASON_TRANSITION_END);
202f4854a5eSMatthias Ringwald             break;
203f4854a5eSMatthias Ringwald         default:
204f4854a5eSMatthias Ringwald             break;
205f4854a5eSMatthias Ringwald     }
206f4854a5eSMatthias Ringwald }
207f4854a5eSMatthias Ringwald 
208c5df3df4SMatthias Ringwald static void mesh_server_transition_setup_transition_or_instantaneous_update_int16(mesh_model_t *mesh_model, uint8_t transition_time_gdtt, uint8_t delay_time_gdtt, uint32_t delta_value, model_state_update_reason_t reason){
209f4854a5eSMatthias Ringwald     mesh_generic_level_state_t * generic_level_server_state = (mesh_generic_level_state_t *)mesh_model->model_data;
210618a5fc3SMatthias Ringwald     mesh_transition_t * transition = &generic_level_server_state->transition_data.base_transition;
211f4854a5eSMatthias Ringwald 
212c5df3df4SMatthias Ringwald     // calc step increment
213c5df3df4SMatthias Ringwald     int num_steps = mesh_access_transitions_num_steps_from_gdtt(transition_time_gdtt);
214c5df3df4SMatthias Ringwald     if (num_steps > 0){
215c5df3df4SMatthias Ringwald         generic_level_server_state->transition_data.stepwise_value_increment = delta_value / num_steps;
216c5df3df4SMatthias Ringwald     } else {
217c5df3df4SMatthias Ringwald         generic_level_server_state->transition_data.stepwise_value_increment = 0;
218c5df3df4SMatthias Ringwald     }
219c5df3df4SMatthias Ringwald 
220f4854a5eSMatthias Ringwald     if (transition_time_gdtt != 0 || delay_time_gdtt != 0) {
221ac8dd887SMatthias Ringwald         // transition
222618a5fc3SMatthias Ringwald         mesh_access_transitions_setup(transition, mesh_model, transition_time_gdtt, delay_time_gdtt, &mesh_server_transition_step);
223618a5fc3SMatthias Ringwald         mesh_access_transitions_add(transition);
224f4854a5eSMatthias Ringwald     } else {
225f4854a5eSMatthias Ringwald         // instantaneous update
226*e8b9b724SMatthias Ringwald         mesh_server_transition_handler(transition, MODEL_STATE_UPDATE_REASON_SET);
227f4854a5eSMatthias Ringwald     }
228f4854a5eSMatthias Ringwald }
229f4854a5eSMatthias Ringwald // Generic Level State
230f4854a5eSMatthias Ringwald 
231f4854a5eSMatthias Ringwald void mesh_generic_level_server_register_packet_handler(mesh_model_t *generic_level_server_model, btstack_packet_handler_t transition_events_packet_handler){
2327ee2bdaeSMatthias Ringwald     btstack_assert(generic_level_server_model != NULL);
2337ee2bdaeSMatthias Ringwald     btstack_assert(transition_events_packet_handler != NULL);
2340c98c714SMatthias Ringwald     generic_level_server_model->model_packet_handler = transition_events_packet_handler;
235f4854a5eSMatthias Ringwald }
236f4854a5eSMatthias Ringwald 
237f4854a5eSMatthias Ringwald const mesh_access_message_t mesh_generic_level_status_transition = {
238f4854a5eSMatthias Ringwald         MESH_GENERIC_LEVEL_STATUS, "221"
239f4854a5eSMatthias Ringwald };
240f4854a5eSMatthias Ringwald 
241f4854a5eSMatthias Ringwald const mesh_access_message_t mesh_generic_level_status_instantaneous = {
242f4854a5eSMatthias Ringwald         MESH_GENERIC_LEVEL_STATUS, "2"
243f4854a5eSMatthias Ringwald };
244f4854a5eSMatthias Ringwald 
245f4854a5eSMatthias Ringwald static mesh_pdu_t * mesh_generic_level_status_message(mesh_model_t *generic_level_server_model){
246f4854a5eSMatthias Ringwald     mesh_generic_level_state_t * state = (mesh_generic_level_state_t *) generic_level_server_model->model_data;
2477ee2bdaeSMatthias Ringwald     btstack_assert(state != NULL);
248f4854a5eSMatthias Ringwald 
249f4854a5eSMatthias Ringwald     // setup message
250f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = NULL;
251f4854a5eSMatthias Ringwald     if (state->transition_data.base_transition.remaining_transition_time_ms != 0) {
252b66ef5c9SMatthias Ringwald         uint8_t remaining_time;
253b66ef5c9SMatthias Ringwald         if (state->transition_data.base_transition.num_steps == MESH_TRANSITION_NUM_STEPS_INFINITE){
254b66ef5c9SMatthias Ringwald             remaining_time = MESH_TRANSITION_NUM_STEPS_INFINITE;
255b66ef5c9SMatthias Ringwald         } else {
256b66ef5c9SMatthias Ringwald             remaining_time = mesh_access_time_as_gdtt(state->transition_data.base_transition.step_duration_ms, state->transition_data.base_transition.remaining_transition_time_ms);
257b66ef5c9SMatthias Ringwald         }
258f4854a5eSMatthias Ringwald         transport_pdu = mesh_access_setup_segmented_message(&mesh_generic_level_status_transition, state->transition_data.current_value,
25985bee781SMatthias Ringwald             state->transition_data.target_value, remaining_time);
260f4854a5eSMatthias Ringwald     } else {
261f4854a5eSMatthias Ringwald         transport_pdu = mesh_access_setup_segmented_message(&mesh_generic_level_status_instantaneous, state->transition_data.current_value);
262f4854a5eSMatthias Ringwald     }
263f4854a5eSMatthias Ringwald     return (mesh_pdu_t *)transport_pdu;
264f4854a5eSMatthias Ringwald }
265f4854a5eSMatthias Ringwald 
266f4854a5eSMatthias Ringwald static void generic_level_handle_set_target_level_message(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
267f4854a5eSMatthias Ringwald     mesh_generic_level_state_t * generic_level_server_state = (mesh_generic_level_state_t *)mesh_model->model_data;
2687ee2bdaeSMatthias Ringwald     btstack_assert(generic_level_server_state != NULL);
269f4854a5eSMatthias Ringwald 
270f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
271f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
272f4854a5eSMatthias Ringwald     int16_t level_value = (int16_t)mesh_access_parser_get_u16(&parser);
273f4854a5eSMatthias Ringwald     // The TID field is a transaction identifier indicating whether the message is
274f4854a5eSMatthias Ringwald     // a new message or a retransmission of a previously sent message
275f4854a5eSMatthias Ringwald     uint8_t tid = mesh_access_parser_get_u8(&parser);
276f4854a5eSMatthias Ringwald 
277f4854a5eSMatthias Ringwald     uint8_t transition_time_gdtt = 0;
278f4854a5eSMatthias Ringwald     uint8_t delay_time_gdtt = 0;
2790dcabf4cSMatthias Ringwald     if (mesh_access_parser_available(&parser) == 2){
2800dcabf4cSMatthias Ringwald         //  Generic Default Transition Time format - num_steps (higher 6 bits), step_resolution (lower 2 bits)
2810dcabf4cSMatthias Ringwald         transition_time_gdtt = mesh_access_parser_get_u8(&parser);
2820dcabf4cSMatthias Ringwald         delay_time_gdtt = mesh_access_parser_get_u8(&parser);
2830dcabf4cSMatthias Ringwald     }
2840dcabf4cSMatthias Ringwald 
285f4854a5eSMatthias Ringwald     mesh_transition_t * base_transition = generic_level_server_get_base_transition(mesh_model);
286f4854a5eSMatthias Ringwald 
287f4854a5eSMatthias Ringwald     switch (mesh_access_transitions_transaction_status(base_transition, tid, mesh_pdu_src(pdu), mesh_pdu_dst(pdu))){
288f4854a5eSMatthias Ringwald         case MESH_TRANSACTION_STATUS_RETRANSMISSION:
289f4854a5eSMatthias Ringwald             // ignore
290f4854a5eSMatthias Ringwald             break;
291f4854a5eSMatthias Ringwald         default:
292f4854a5eSMatthias Ringwald             mesh_access_transitions_setup_transaction(base_transition, tid, mesh_pdu_src(pdu), mesh_pdu_dst(pdu));
293f4854a5eSMatthias Ringwald 
294f4854a5eSMatthias Ringwald             generic_level_server_state->transition_data.initial_value = generic_level_server_state->transition_data.current_value;
295f4854a5eSMatthias Ringwald             generic_level_server_state->transition_data.target_value = level_value;
296f4854a5eSMatthias Ringwald 
297c5df3df4SMatthias Ringwald             int32_t delta_value = level_value - generic_level_server_state->transition_data.current_value;
298c5df3df4SMatthias Ringwald             mesh_server_transition_setup_transition_or_instantaneous_update_int16(mesh_model, transition_time_gdtt, delay_time_gdtt, delta_value, MODEL_STATE_UPDATE_REASON_SET);
299f4854a5eSMatthias Ringwald             mesh_access_state_changed(mesh_model);
300f4854a5eSMatthias Ringwald             break;
301f4854a5eSMatthias Ringwald     }
302f4854a5eSMatthias Ringwald 
303f4854a5eSMatthias Ringwald }
304f4854a5eSMatthias Ringwald 
305c5df3df4SMatthias Ringwald static void generic_level_handle_set_delta_message(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
306c5df3df4SMatthias Ringwald     mesh_generic_level_state_t * generic_level_server_state = (mesh_generic_level_state_t *)mesh_model->model_data;
307c5df3df4SMatthias Ringwald     btstack_assert(generic_level_server_state != NULL);
308c5df3df4SMatthias Ringwald 
309c5df3df4SMatthias Ringwald     mesh_access_parser_state_t parser;
310c5df3df4SMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
311c5df3df4SMatthias Ringwald     int32_t delta_value = mesh_access_parser_get_u32(&parser);
312c5df3df4SMatthias Ringwald 
313c5df3df4SMatthias Ringwald     // The TID field is a transaction identifier indicating whether the message is
314c5df3df4SMatthias Ringwald     // a new message or a retransmission of a previously sent message
315c5df3df4SMatthias Ringwald     uint8_t tid = mesh_access_parser_get_u8(&parser);
316c5df3df4SMatthias Ringwald 
317c5df3df4SMatthias Ringwald     uint8_t transition_time_gdtt = 0;
318c5df3df4SMatthias Ringwald     uint8_t delay_time_gdtt = 0;
319c5df3df4SMatthias Ringwald     if (mesh_access_parser_available(&parser) == 2){
320c5df3df4SMatthias Ringwald         //  Generic Default Transition Time format - num_steps (higher 6 bits), step_resolution (lower 2 bits)
321c5df3df4SMatthias Ringwald         transition_time_gdtt = mesh_access_parser_get_u8(&parser);
322c5df3df4SMatthias Ringwald         delay_time_gdtt = mesh_access_parser_get_u8(&parser);
323c5df3df4SMatthias Ringwald     }
324c5df3df4SMatthias Ringwald 
325c5df3df4SMatthias Ringwald     mesh_transition_t * base_transition = generic_level_server_get_base_transition(mesh_model);
326c5df3df4SMatthias Ringwald 
327c5df3df4SMatthias Ringwald     switch (mesh_access_transitions_transaction_status(base_transition, tid, mesh_pdu_src(pdu), mesh_pdu_dst(pdu))){
328c5df3df4SMatthias Ringwald         case MESH_TRANSACTION_STATUS_DIFFERENT_DST_OR_SRC:
329c5df3df4SMatthias Ringwald             // abort transaction
330c5df3df4SMatthias Ringwald             printf("Transaction abort\n");
331c5df3df4SMatthias Ringwald             mesh_access_transitions_abort_transaction(base_transition);
332c5df3df4SMatthias Ringwald             generic_level_server_state->transition_data.current_value = generic_level_server_state->transition_data.initial_value;
333c5df3df4SMatthias Ringwald             mesh_server_transition_setup_transition_or_instantaneous_update_int16(mesh_model, 0, 0, 0, MODEL_STATE_UPDATE_REASON_TRANSITION_ABORT);
334c5df3df4SMatthias Ringwald             break;
335c5df3df4SMatthias Ringwald         case MESH_TRANSACTION_STATUS_NEW:
336c5df3df4SMatthias Ringwald             // start transaction with current value
337c5df3df4SMatthias Ringwald             mesh_access_transitions_setup_transaction(base_transition, tid, mesh_pdu_src(pdu), mesh_pdu_dst(pdu));
338c5df3df4SMatthias Ringwald             generic_level_server_state->transition_data.initial_value = generic_level_server_state->transition_data.current_value;
339c5df3df4SMatthias Ringwald             generic_level_server_state->transition_data.target_value = add_and_clip_int16(generic_level_server_state->transition_data.initial_value, delta_value);
340c5df3df4SMatthias Ringwald             printf("Transaction %u, new, init %x, target %x\n", tid, generic_level_server_state->transition_data.initial_value, generic_level_server_state->transition_data.target_value);
341c5df3df4SMatthias Ringwald             mesh_server_transition_setup_transition_or_instantaneous_update_int16(mesh_model, transition_time_gdtt, delay_time_gdtt, delta_value, MODEL_STATE_UPDATE_REASON_SET);
342c5df3df4SMatthias Ringwald             mesh_access_state_changed(mesh_model);
343c5df3df4SMatthias Ringwald             break;
344c5df3df4SMatthias Ringwald         case MESH_TRANSACTION_STATUS_RETRANSMISSION:
345c5df3df4SMatthias Ringwald             // replace last delta message
346c5df3df4SMatthias Ringwald             mesh_access_transitions_setup_transaction(base_transition, tid, mesh_pdu_src(pdu), mesh_pdu_dst(pdu));
347c5df3df4SMatthias Ringwald             generic_level_server_state->transition_data.target_value = add_and_clip_int16(generic_level_server_state->transition_data.initial_value, delta_value);
348c5df3df4SMatthias Ringwald             printf("Transaction %u, retransmission, init %x, target %x\n", tid, generic_level_server_state->transition_data.initial_value, generic_level_server_state->transition_data.target_value);
349c5df3df4SMatthias Ringwald             mesh_server_transition_setup_transition_or_instantaneous_update_int16(mesh_model, transition_time_gdtt, delay_time_gdtt, delta_value, MODEL_STATE_UPDATE_REASON_SET);
350c5df3df4SMatthias Ringwald             mesh_access_state_changed(mesh_model);
351c5df3df4SMatthias Ringwald             break;
352c5df3df4SMatthias Ringwald         default:
353c5df3df4SMatthias Ringwald             break;
354c5df3df4SMatthias Ringwald     }
355c5df3df4SMatthias Ringwald }
356c5df3df4SMatthias Ringwald 
357f4854a5eSMatthias Ringwald static void generic_level_handle_set_move_message(mesh_model_t *mesh_model, mesh_pdu_t * pdu){
358f4854a5eSMatthias Ringwald     mesh_generic_level_state_t * generic_level_server_state = (mesh_generic_level_state_t *)mesh_model->model_data;
3597ee2bdaeSMatthias Ringwald     btstack_assert(generic_level_server_state != NULL);
360f4854a5eSMatthias Ringwald 
361f4854a5eSMatthias Ringwald     mesh_access_parser_state_t parser;
362f4854a5eSMatthias Ringwald     mesh_access_parser_init(&parser, (mesh_pdu_t*) pdu);
363b66ef5c9SMatthias Ringwald     int32_t delta_value = (int32_t) mesh_access_parser_get_u16(&parser);
364f4854a5eSMatthias Ringwald 
365f4854a5eSMatthias Ringwald     // The TID field is a transaction identifier indicating whether the message is
366f4854a5eSMatthias Ringwald     // a new message or a retransmission of a previously sent message
367f4854a5eSMatthias Ringwald     uint8_t tid = mesh_access_parser_get_u8(&parser);
368f4854a5eSMatthias Ringwald 
369f4854a5eSMatthias Ringwald     uint8_t transition_time_gdtt = 0;
370f4854a5eSMatthias Ringwald     uint8_t delay_time_gdtt = 0;
371753e6a2cSMatthias Ringwald     if (mesh_access_parser_available(&parser) == 2){
372753e6a2cSMatthias Ringwald         //  Generic Default Transition Time format - num_steps (higher 6 bits), step_resolution (lower 2 bits)
373753e6a2cSMatthias Ringwald         transition_time_gdtt = mesh_access_parser_get_u8(&parser);
374753e6a2cSMatthias Ringwald         delay_time_gdtt = mesh_access_parser_get_u8(&parser);
375b66ef5c9SMatthias Ringwald     } else {
376b66ef5c9SMatthias Ringwald         // transition speed is delta / num steps, without num steps, and without a default transition time, we cannot do this
377b66ef5c9SMatthias Ringwald         return;
378753e6a2cSMatthias Ringwald     }
379753e6a2cSMatthias Ringwald 
380f4854a5eSMatthias Ringwald     mesh_transition_t * base_transition = generic_level_server_get_base_transition(mesh_model);
381f4854a5eSMatthias Ringwald 
382f4854a5eSMatthias Ringwald     switch (mesh_access_transitions_transaction_status(base_transition, tid, mesh_pdu_src(pdu), mesh_pdu_dst(pdu))){
383f4854a5eSMatthias Ringwald         case MESH_TRANSACTION_STATUS_RETRANSMISSION:
384f4854a5eSMatthias Ringwald             // ignore retransmission
385f4854a5eSMatthias Ringwald             break;
386f4854a5eSMatthias Ringwald         default:
387f4854a5eSMatthias Ringwald             mesh_access_transitions_setup_transaction(base_transition, tid, mesh_pdu_src(pdu), mesh_pdu_dst(pdu));
388f4854a5eSMatthias Ringwald 
389f4854a5eSMatthias Ringwald             generic_level_server_state->transition_data.initial_value = generic_level_server_state->transition_data.current_value;
390b66ef5c9SMatthias Ringwald             generic_level_server_state->transition_data.target_value = add_and_clip_int16(generic_level_server_state->transition_data.current_value, delta_value);
391b66ef5c9SMatthias Ringwald             if (delta_value > 0){
392b66ef5c9SMatthias Ringwald                 generic_level_server_state->transition_data.target_value = 32767;
393b66ef5c9SMatthias Ringwald             } else {
394b66ef5c9SMatthias Ringwald                 generic_level_server_state->transition_data.target_value = -32768;
395f4854a5eSMatthias Ringwald             }
396753e6a2cSMatthias Ringwald 
397c5df3df4SMatthias Ringwald             mesh_server_transition_setup_transition_or_instantaneous_update_int16(mesh_model, transition_time_gdtt, delay_time_gdtt, delta_value, MODEL_STATE_UPDATE_REASON_SET);
398b66ef5c9SMatthias Ringwald             generic_level_server_state->transition_data.base_transition.num_steps = MESH_TRANSITION_NUM_STEPS_INFINITE;
399f4854a5eSMatthias Ringwald             break;
400f4854a5eSMatthias Ringwald     }
401f4854a5eSMatthias Ringwald }
402f4854a5eSMatthias Ringwald 
403f4854a5eSMatthias Ringwald static void generic_level_get_handler(mesh_model_t *generic_level_server_model, mesh_pdu_t * pdu){
404f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = (mesh_transport_pdu_t *) mesh_generic_level_status_message(generic_level_server_model);
4057ee2bdaeSMatthias Ringwald     if (transport_pdu != NULL) {
406f4854a5eSMatthias Ringwald         generic_server_send_message(mesh_access_get_element_address(generic_level_server_model), mesh_pdu_src(pdu), mesh_pdu_netkey_index(pdu), mesh_pdu_appkey_index(pdu), (mesh_pdu_t *) transport_pdu);
4077ee2bdaeSMatthias Ringwald     }
408f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
409f4854a5eSMatthias Ringwald }
410f4854a5eSMatthias Ringwald 
411f4854a5eSMatthias Ringwald static void generic_level_set_handler(mesh_model_t *generic_level_server_model, mesh_pdu_t * pdu){
412f4854a5eSMatthias Ringwald     generic_level_handle_set_target_level_message(generic_level_server_model, pdu);
413f4854a5eSMatthias Ringwald 
414f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = (mesh_transport_pdu_t *) mesh_generic_level_status_message(generic_level_server_model);
4157ee2bdaeSMatthias Ringwald     if (transport_pdu != NULL) {
416f4854a5eSMatthias Ringwald         generic_server_send_message(mesh_access_get_element_address(generic_level_server_model), mesh_pdu_src(pdu), mesh_pdu_netkey_index(pdu), mesh_pdu_appkey_index(pdu), (mesh_pdu_t *) transport_pdu);
4177ee2bdaeSMatthias Ringwald     }
418f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
419f4854a5eSMatthias Ringwald }
420f4854a5eSMatthias Ringwald 
421f4854a5eSMatthias Ringwald static void generic_level_set_unacknowledged_handler(mesh_model_t *generic_level_server_model, mesh_pdu_t * pdu){
422f4854a5eSMatthias Ringwald     generic_level_handle_set_target_level_message(generic_level_server_model, pdu);
4237ee2bdaeSMatthias Ringwald     mesh_access_message_processed(pdu);
424f4854a5eSMatthias Ringwald }
425f4854a5eSMatthias Ringwald 
426f4854a5eSMatthias Ringwald static void generic_delta_set_handler(mesh_model_t *generic_level_server_model, mesh_pdu_t * pdu){
427f4854a5eSMatthias Ringwald     generic_level_handle_set_delta_message(generic_level_server_model, pdu);
428f4854a5eSMatthias Ringwald 
429f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = (mesh_transport_pdu_t *) mesh_generic_level_status_message(generic_level_server_model);
4307ee2bdaeSMatthias Ringwald     if (transport_pdu != NULL) {
431f4854a5eSMatthias Ringwald         generic_server_send_message(mesh_access_get_element_address(generic_level_server_model), mesh_pdu_src(pdu), mesh_pdu_netkey_index(pdu), mesh_pdu_appkey_index(pdu), (mesh_pdu_t *) transport_pdu);
4327ee2bdaeSMatthias Ringwald     }
433f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
434f4854a5eSMatthias Ringwald }
435f4854a5eSMatthias Ringwald 
436f4854a5eSMatthias Ringwald static void generic_delta_set_unacknowledged_handler(mesh_model_t *generic_level_server_model, mesh_pdu_t * pdu){
437f4854a5eSMatthias Ringwald     generic_level_handle_set_delta_message(generic_level_server_model, pdu);
4387ee2bdaeSMatthias Ringwald     mesh_access_message_processed(pdu);
439f4854a5eSMatthias Ringwald }
440f4854a5eSMatthias Ringwald 
441f4854a5eSMatthias Ringwald static void generic_move_get_handler(mesh_model_t *generic_level_server_model, mesh_pdu_t * pdu){
442f4854a5eSMatthias Ringwald     generic_level_handle_set_move_message(generic_level_server_model, pdu);
443f4854a5eSMatthias Ringwald 
444f4854a5eSMatthias Ringwald     mesh_transport_pdu_t * transport_pdu = (mesh_transport_pdu_t *) mesh_generic_level_status_message(generic_level_server_model);
4457ee2bdaeSMatthias Ringwald     if (transport_pdu != NULL) {
446f4854a5eSMatthias Ringwald         generic_server_send_message(mesh_access_get_element_address(generic_level_server_model), mesh_pdu_src(pdu), mesh_pdu_netkey_index(pdu), mesh_pdu_appkey_index(pdu), (mesh_pdu_t *) transport_pdu);
4477ee2bdaeSMatthias Ringwald     }
448f4854a5eSMatthias Ringwald     mesh_access_message_processed(pdu);
449f4854a5eSMatthias Ringwald }
450f4854a5eSMatthias Ringwald 
451f4854a5eSMatthias Ringwald static void generic_move_set_unacknowledged_handler(mesh_model_t *generic_level_server_model, mesh_pdu_t * pdu){
452f4854a5eSMatthias Ringwald     generic_level_handle_set_move_message(generic_level_server_model, pdu);
4537ee2bdaeSMatthias Ringwald     mesh_access_message_processed(pdu);
454f4854a5eSMatthias Ringwald }
455f4854a5eSMatthias Ringwald 
456f4854a5eSMatthias Ringwald // Generic On Off Message
457f4854a5eSMatthias Ringwald const static mesh_operation_t mesh_generic_level_model_operations[] = {
458f4854a5eSMatthias Ringwald     { MESH_GENERIC_LEVEL_GET,                                   0, generic_level_get_handler },
459f4854a5eSMatthias Ringwald     { MESH_GENERIC_LEVEL_SET,                                   3, generic_level_set_handler },
460f4854a5eSMatthias Ringwald     { MESH_GENERIC_LEVEL_SET_UNACKNOWLEDGED,                    3, generic_level_set_unacknowledged_handler },
461f4854a5eSMatthias Ringwald     { MESH_GENERIC_DELTA_SET,                                   3, generic_delta_set_handler },
462f4854a5eSMatthias Ringwald     { MESH_GENERIC_DELTA_SET_UNACKNOWLEDGED,                    3, generic_delta_set_unacknowledged_handler },
463f4854a5eSMatthias Ringwald     { MESH_GENERIC_MOVE_SET,                                    3, generic_move_get_handler },
464f4854a5eSMatthias Ringwald     { MESH_GENERIC_MOVE_SET_UNACKNOWLEDGED,                     3, generic_move_set_unacknowledged_handler },
465f4854a5eSMatthias Ringwald     { 0, 0, NULL }
466f4854a5eSMatthias Ringwald };
467f4854a5eSMatthias Ringwald 
468f4854a5eSMatthias Ringwald const mesh_operation_t * mesh_generic_level_server_get_operations(void){
469f4854a5eSMatthias Ringwald     return mesh_generic_level_model_operations;
470f4854a5eSMatthias Ringwald }
471f4854a5eSMatthias Ringwald 
472f4854a5eSMatthias Ringwald void mesh_generic_level_server_set_publication_model(mesh_model_t *generic_level_server_model, mesh_publication_model_t * publication_model){
473f4854a5eSMatthias Ringwald     if (generic_level_server_model == NULL) return;
474f4854a5eSMatthias Ringwald     if (publication_model == NULL) return;
475f4854a5eSMatthias Ringwald     publication_model->publish_state_fn = &mesh_generic_level_status_message;
476f4854a5eSMatthias Ringwald     generic_level_server_model->publication_model = publication_model;
477f4854a5eSMatthias Ringwald }
478