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