115d50271SMatthias Ringwald /* 215d50271SMatthias Ringwald * Copyright (C) 2014 BlueKitchen GmbH 315d50271SMatthias Ringwald * 415d50271SMatthias Ringwald * Redistribution and use in source and binary forms, with or without 515d50271SMatthias Ringwald * modification, are permitted provided that the following conditions 615d50271SMatthias Ringwald * are met: 715d50271SMatthias Ringwald * 815d50271SMatthias Ringwald * 1. Redistributions of source code must retain the above copyright 915d50271SMatthias Ringwald * notice, this list of conditions and the following disclaimer. 1015d50271SMatthias Ringwald * 2. Redistributions in binary form must reproduce the above copyright 1115d50271SMatthias Ringwald * notice, this list of conditions and the following disclaimer in the 1215d50271SMatthias Ringwald * documentation and/or other materials provided with the distribution. 1315d50271SMatthias Ringwald * 3. Neither the name of the copyright holders nor the names of 1415d50271SMatthias Ringwald * contributors may be used to endorse or promote products derived 1515d50271SMatthias Ringwald * from this software without specific prior written permission. 1615d50271SMatthias Ringwald * 4. Any redistribution, use, or modification is done solely for 1715d50271SMatthias Ringwald * personal benefit and not for any commercial purpose or for 1815d50271SMatthias Ringwald * monetary gain. 1915d50271SMatthias Ringwald * 2015d50271SMatthias Ringwald * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS 2115d50271SMatthias Ringwald * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 2215d50271SMatthias Ringwald * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 2315d50271SMatthias Ringwald * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS 2415d50271SMatthias Ringwald * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 2515d50271SMatthias Ringwald * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 2615d50271SMatthias Ringwald * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 2715d50271SMatthias Ringwald * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 2815d50271SMatthias Ringwald * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 2915d50271SMatthias Ringwald * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 3015d50271SMatthias Ringwald * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 3115d50271SMatthias Ringwald * SUCH DAMAGE. 3215d50271SMatthias Ringwald * 3315d50271SMatthias Ringwald * Please inquire about commercial licensing options at 3415d50271SMatthias Ringwald * [email protected] 3515d50271SMatthias Ringwald * 3615d50271SMatthias Ringwald */ 3715d50271SMatthias Ringwald 38e501bae0SMatthias Ringwald #define BTSTACK_FILE__ "btstack_run_loop.c" 39ab2c6ae4SMatthias Ringwald 4015d50271SMatthias Ringwald /* 4115d50271SMatthias Ringwald * run_loop.c 4215d50271SMatthias Ringwald * 4315d50271SMatthias Ringwald * Created by Matthias Ringwald on 6/6/09. 4415d50271SMatthias Ringwald */ 4515d50271SMatthias Ringwald 4615d50271SMatthias Ringwald #include "btstack_run_loop.h" 4715d50271SMatthias Ringwald 4815d50271SMatthias Ringwald #include "btstack_debug.h" 497907f069SMatthias Ringwald #include "btstack_config.h" 50796f7837SMatthias Ringwald #include "btstack_util.h" 5115d50271SMatthias Ringwald 52016e9464SMatthias Ringwald #include <inttypes.h> 53016e9464SMatthias Ringwald 54528a4a3bSMatthias Ringwald static const btstack_run_loop_t * the_run_loop = NULL; 5515d50271SMatthias Ringwald 56528a4a3bSMatthias Ringwald extern const btstack_run_loop_t btstack_run_loop_embedded; 5715d50271SMatthias Ringwald 58796f7837SMatthias Ringwald /* 59796f7837SMatthias Ringwald * Portable implementation of timer and data source management as base for platform specific implementations 60796f7837SMatthias Ringwald */ 61796f7837SMatthias Ringwald 62796f7837SMatthias Ringwald // private data (access only by run loop implementations) 63796f7837SMatthias Ringwald btstack_linked_list_t btstack_run_loop_base_timers; 64796f7837SMatthias Ringwald btstack_linked_list_t btstack_run_loop_base_data_sources; 65796f7837SMatthias Ringwald 66796f7837SMatthias Ringwald void btstack_run_loop_base_init(void){ 67796f7837SMatthias Ringwald btstack_run_loop_base_timers = NULL; 68796f7837SMatthias Ringwald btstack_run_loop_base_data_sources = NULL; 69796f7837SMatthias Ringwald } 70796f7837SMatthias Ringwald 71*b45b7749SMilanka Ringwald void btstack_run_loop_base_add_data_source(btstack_data_source_t * data_source){ 72*b45b7749SMilanka Ringwald btstack_linked_list_add(&btstack_run_loop_base_data_sources, (btstack_linked_item_t *) data_source); 73796f7837SMatthias Ringwald } 74796f7837SMatthias Ringwald 75*b45b7749SMilanka Ringwald bool btstack_run_loop_base_remove_data_source(btstack_data_source_t * data_source){ 76*b45b7749SMilanka Ringwald return btstack_linked_list_remove(&btstack_run_loop_base_data_sources, (btstack_linked_item_t *) data_source); 77796f7837SMatthias Ringwald } 78796f7837SMatthias Ringwald 79*b45b7749SMilanka Ringwald void btstack_run_loop_base_enable_data_source_callbacks(btstack_data_source_t * data_source, uint16_t callback_types){ 80*b45b7749SMilanka Ringwald data_source->flags |= callback_types; 81796f7837SMatthias Ringwald } 82796f7837SMatthias Ringwald 83*b45b7749SMilanka Ringwald void btstack_run_loop_base_disable_data_source_callbacks(btstack_data_source_t * data_source, uint16_t callback_types){ 84*b45b7749SMilanka Ringwald data_source->flags &= ~callback_types; 85796f7837SMatthias Ringwald } 86796f7837SMatthias Ringwald 87*b45b7749SMilanka Ringwald bool btstack_run_loop_base_remove_timer(btstack_timer_source_t * timer){ 88*b45b7749SMilanka Ringwald return btstack_linked_list_remove(&btstack_run_loop_base_timers, (btstack_linked_item_t *) timer); 89796f7837SMatthias Ringwald } 90796f7837SMatthias Ringwald 91*b45b7749SMilanka Ringwald void btstack_run_loop_base_add_timer(btstack_timer_source_t * timer){ 92796f7837SMatthias Ringwald btstack_linked_item_t *it; 93796f7837SMatthias Ringwald for (it = (btstack_linked_item_t *) &btstack_run_loop_base_timers; it->next ; it = it->next){ 94796f7837SMatthias Ringwald btstack_timer_source_t * next = (btstack_timer_source_t *) it->next; 95*b45b7749SMilanka Ringwald btstack_assert(next != timer); 96*b45b7749SMilanka Ringwald int32_t delta = btstack_time_delta(timer->timeout, next->timeout); 97796f7837SMatthias Ringwald if (delta < 0) break; 98796f7837SMatthias Ringwald } 99*b45b7749SMilanka Ringwald timer->item.next = it->next; 100*b45b7749SMilanka Ringwald it->next = (btstack_linked_item_t *) timer; 101796f7837SMatthias Ringwald } 102796f7837SMatthias Ringwald 103796f7837SMatthias Ringwald void btstack_run_loop_base_process_timers(uint32_t now){ 104796f7837SMatthias Ringwald // process timers, exit when timeout is in the future 105796f7837SMatthias Ringwald while (btstack_run_loop_base_timers) { 106*b45b7749SMilanka Ringwald btstack_timer_source_t * timer = (btstack_timer_source_t *) btstack_run_loop_base_timers; 107*b45b7749SMilanka Ringwald int32_t delta = btstack_time_delta(timer->timeout, now); 108796f7837SMatthias Ringwald if (delta > 0) break; 109*b45b7749SMilanka Ringwald btstack_run_loop_base_remove_timer(timer); 110*b45b7749SMilanka Ringwald timer->process(timer); 111796f7837SMatthias Ringwald } 112796f7837SMatthias Ringwald } 113796f7837SMatthias Ringwald 114796f7837SMatthias Ringwald void btstack_run_loop_base_dump_timer(void){ 115796f7837SMatthias Ringwald #ifdef ENABLE_LOG_INFO 116796f7837SMatthias Ringwald btstack_linked_item_t *it; 117796f7837SMatthias Ringwald uint16_t i = 0; 118796f7837SMatthias Ringwald for (it = (btstack_linked_item_t *) btstack_run_loop_base_timers; it ; it = it->next){ 119*b45b7749SMilanka Ringwald btstack_timer_source_t * timer = (btstack_timer_source_t*) it; 120*b45b7749SMilanka Ringwald log_info("timer %u (%p): timeout %" PRIu32 "u\n", i, timer, timer->timeout); 121796f7837SMatthias Ringwald } 122796f7837SMatthias Ringwald #endif 123796f7837SMatthias Ringwald 124796f7837SMatthias Ringwald } 125796f7837SMatthias Ringwald /** 126796f7837SMatthias Ringwald * @brief Get time until first timer fires 127796f7837SMatthias Ringwald * @returns -1 if no timers, time until next timeout otherwise 128796f7837SMatthias Ringwald */ 129796f7837SMatthias Ringwald int32_t btstack_run_loop_base_get_time_until_timeout(uint32_t now){ 130796f7837SMatthias Ringwald if (btstack_run_loop_base_timers == NULL) return -1; 131*b45b7749SMilanka Ringwald btstack_timer_source_t * timer = (btstack_timer_source_t *) btstack_run_loop_base_timers; 132*b45b7749SMilanka Ringwald uint32_t list_timeout = timer->timeout; 133796f7837SMatthias Ringwald int32_t delta = btstack_time_delta(list_timeout, now); 134796f7837SMatthias Ringwald if (delta < 0){ 135796f7837SMatthias Ringwald delta = 0; 136796f7837SMatthias Ringwald } 137796f7837SMatthias Ringwald return delta; 138796f7837SMatthias Ringwald } 139796f7837SMatthias Ringwald 140796f7837SMatthias Ringwald void btstack_run_loop_base_poll_data_sources(void){ 141796f7837SMatthias Ringwald // poll data sources 142796f7837SMatthias Ringwald btstack_data_source_t *ds; 143796f7837SMatthias Ringwald btstack_data_source_t *next; 144796f7837SMatthias Ringwald for (ds = (btstack_data_source_t *) btstack_run_loop_base_data_sources; ds != NULL ; ds = next){ 145796f7837SMatthias Ringwald next = (btstack_data_source_t *) ds->item.next; // cache pointer to next data_source to allow data source to remove itself 146796f7837SMatthias Ringwald if (ds->flags & DATA_SOURCE_CALLBACK_POLL){ 147796f7837SMatthias Ringwald ds->process(ds, DATA_SOURCE_CALLBACK_POLL); 148796f7837SMatthias Ringwald } 149796f7837SMatthias Ringwald } 150796f7837SMatthias Ringwald } 151796f7837SMatthias Ringwald 152796f7837SMatthias Ringwald /** 153796f7837SMatthias Ringwald * BTstack Run Loop Implementation, mainly dispatches to port-specific implementation 154796f7837SMatthias Ringwald */ 155796f7837SMatthias Ringwald 156796f7837SMatthias Ringwald // main implementation 157796f7837SMatthias Ringwald 158*b45b7749SMilanka Ringwald void btstack_run_loop_set_timer_handler(btstack_timer_source_t * timer, void (*process)(btstack_timer_source_t * _timer)){ 159*b45b7749SMilanka Ringwald timer->process = process; 16015d50271SMatthias Ringwald }; 16115d50271SMatthias Ringwald 162*b45b7749SMilanka Ringwald void btstack_run_loop_set_data_source_handler(btstack_data_source_t * data_source, void (*process)(btstack_data_source_t *_data_source, btstack_data_source_callback_type_t callback_type)){ 163*b45b7749SMilanka Ringwald data_source->process = process; 16415d50271SMatthias Ringwald }; 16515d50271SMatthias Ringwald 166*b45b7749SMilanka Ringwald void btstack_run_loop_set_data_source_fd(btstack_data_source_t * data_source, int fd){ 167*b45b7749SMilanka Ringwald data_source->source.fd = fd; 1683a5c43eeSMatthias Ringwald } 1693a5c43eeSMatthias Ringwald 170*b45b7749SMilanka Ringwald int btstack_run_loop_get_data_source_fd(btstack_data_source_t * data_source){ 171*b45b7749SMilanka Ringwald return data_source->source.fd; 1723a5c43eeSMatthias Ringwald } 1733a5c43eeSMatthias Ringwald 174*b45b7749SMilanka Ringwald void btstack_run_loop_set_data_source_handle(btstack_data_source_t * data_source, void * handle){ 175*b45b7749SMilanka Ringwald data_source->source.handle = handle; 176f04a41aeSMatthias Ringwald } 177f04a41aeSMatthias Ringwald 178*b45b7749SMilanka Ringwald void * btstack_run_loop_get_data_source_handle(btstack_data_source_t * data_source){ 179*b45b7749SMilanka Ringwald return data_source->source.handle; 180f04a41aeSMatthias Ringwald } 181f04a41aeSMatthias Ringwald 182*b45b7749SMilanka Ringwald void btstack_run_loop_enable_data_source_callbacks(btstack_data_source_t * data_source, uint16_t callbacks){ 18327e05778SMatthias Ringwald btstack_assert(the_run_loop != NULL); 184141177f8SMatthias Ringwald btstack_assert(the_run_loop->enable_data_source_callbacks != NULL); 185*b45b7749SMilanka Ringwald the_run_loop->enable_data_source_callbacks(data_source, callbacks); 186896424b7SMatthias Ringwald } 187896424b7SMatthias Ringwald 188*b45b7749SMilanka Ringwald void btstack_run_loop_disable_data_source_callbacks(btstack_data_source_t * data_source, uint16_t callbacks){ 18927e05778SMatthias Ringwald btstack_assert(the_run_loop != NULL); 190141177f8SMatthias Ringwald btstack_assert(the_run_loop->enable_data_source_callbacks != NULL); 191*b45b7749SMilanka Ringwald the_run_loop->disable_data_source_callbacks(data_source, callbacks); 192896424b7SMatthias Ringwald } 19315d50271SMatthias Ringwald 19415d50271SMatthias Ringwald /** 19515d50271SMatthias Ringwald * Add data_source to run_loop 19615d50271SMatthias Ringwald */ 197*b45b7749SMilanka Ringwald void btstack_run_loop_add_data_source(btstack_data_source_t * data_source){ 19827e05778SMatthias Ringwald btstack_assert(the_run_loop != NULL); 199141177f8SMatthias Ringwald btstack_assert(the_run_loop->enable_data_source_callbacks != NULL); 200*b45b7749SMilanka Ringwald btstack_assert(data_source->process != NULL); 201*b45b7749SMilanka Ringwald the_run_loop->add_data_source(data_source); 20215d50271SMatthias Ringwald } 20315d50271SMatthias Ringwald 20415d50271SMatthias Ringwald /** 20515d50271SMatthias Ringwald * Remove data_source from run loop 20615d50271SMatthias Ringwald */ 207*b45b7749SMilanka Ringwald int btstack_run_loop_remove_data_source(btstack_data_source_t * data_source){ 20827e05778SMatthias Ringwald btstack_assert(the_run_loop != NULL); 2090ad702f3SMatthias Ringwald btstack_assert(the_run_loop->disable_data_source_callbacks != NULL); 210*b45b7749SMilanka Ringwald btstack_assert(data_source->process != NULL); 211*b45b7749SMilanka Ringwald return the_run_loop->remove_data_source(data_source); 21215d50271SMatthias Ringwald } 21315d50271SMatthias Ringwald 214*b45b7749SMilanka Ringwald void btstack_run_loop_set_timer(btstack_timer_source_t * timer, uint32_t timeout_in_ms){ 21527e05778SMatthias Ringwald btstack_assert(the_run_loop != NULL); 216*b45b7749SMilanka Ringwald the_run_loop->set_timer(timer, timeout_in_ms); 21715d50271SMatthias Ringwald } 21815d50271SMatthias Ringwald 21915d50271SMatthias Ringwald /** 220fd939756SMatthias Ringwald * @brief Set context for this timer 221fd939756SMatthias Ringwald */ 222*b45b7749SMilanka Ringwald void btstack_run_loop_set_timer_context(btstack_timer_source_t * timer, void * context){ 223*b45b7749SMilanka Ringwald timer->context = context; 224fd939756SMatthias Ringwald } 225fd939756SMatthias Ringwald 226fd939756SMatthias Ringwald /** 227fd939756SMatthias Ringwald * @brief Get context for this timer 228fd939756SMatthias Ringwald */ 229*b45b7749SMilanka Ringwald void * btstack_run_loop_get_timer_context(btstack_timer_source_t * timer){ 230*b45b7749SMilanka Ringwald return timer->context; 231fd939756SMatthias Ringwald } 232fd939756SMatthias Ringwald 233fd939756SMatthias Ringwald /** 23415d50271SMatthias Ringwald * Add timer to run_loop (keep list sorted) 23515d50271SMatthias Ringwald */ 236*b45b7749SMilanka Ringwald void btstack_run_loop_add_timer(btstack_timer_source_t * timer){ 23727e05778SMatthias Ringwald btstack_assert(the_run_loop != NULL); 238*b45b7749SMilanka Ringwald btstack_assert(timer->process != NULL); 239*b45b7749SMilanka Ringwald the_run_loop->add_timer(timer); 24015d50271SMatthias Ringwald } 24115d50271SMatthias Ringwald 24215d50271SMatthias Ringwald /** 24315d50271SMatthias Ringwald * Remove timer from run loop 24415d50271SMatthias Ringwald */ 245*b45b7749SMilanka Ringwald int btstack_run_loop_remove_timer(btstack_timer_source_t * timer){ 24627e05778SMatthias Ringwald btstack_assert(the_run_loop != NULL); 247*b45b7749SMilanka Ringwald return the_run_loop->remove_timer(timer); 24815d50271SMatthias Ringwald } 24915d50271SMatthias Ringwald 25015d50271SMatthias Ringwald /** 25115d50271SMatthias Ringwald * @brief Get current time in ms 25215d50271SMatthias Ringwald */ 253528a4a3bSMatthias Ringwald uint32_t btstack_run_loop_get_time_ms(void){ 25427e05778SMatthias Ringwald btstack_assert(the_run_loop != NULL); 25515d50271SMatthias Ringwald return the_run_loop->get_time_ms(); 25615d50271SMatthias Ringwald } 25715d50271SMatthias Ringwald 25815d50271SMatthias Ringwald 259528a4a3bSMatthias Ringwald void btstack_run_loop_timer_dump(void){ 26027e05778SMatthias Ringwald btstack_assert(the_run_loop != NULL); 26115d50271SMatthias Ringwald the_run_loop->dump_timer(); 26215d50271SMatthias Ringwald } 26315d50271SMatthias Ringwald 26415d50271SMatthias Ringwald /** 26515d50271SMatthias Ringwald * Execute run_loop 26615d50271SMatthias Ringwald */ 267528a4a3bSMatthias Ringwald void btstack_run_loop_execute(void){ 26827e05778SMatthias Ringwald btstack_assert(the_run_loop != NULL); 26915d50271SMatthias Ringwald the_run_loop->execute(); 27015d50271SMatthias Ringwald } 27115d50271SMatthias Ringwald 27215d50271SMatthias Ringwald // init must be called before any other run_loop call 273528a4a3bSMatthias Ringwald void btstack_run_loop_init(const btstack_run_loop_t * run_loop){ 27427e05778SMatthias Ringwald btstack_assert(the_run_loop == NULL); 27515d50271SMatthias Ringwald the_run_loop = run_loop; 27615d50271SMatthias Ringwald the_run_loop->init(); 27715d50271SMatthias Ringwald } 27815d50271SMatthias Ringwald 2793a2e2107SMatthias Ringwald void btstack_run_loop_deinit(void){ 2803a2e2107SMatthias Ringwald the_run_loop = NULL; 2813a2e2107SMatthias Ringwald } 2823a2e2107SMatthias Ringwald 283