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 52*016e9464SMatthias Ringwald #include <inttypes.h> 53*016e9464SMatthias 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 71796f7837SMatthias Ringwald void btstack_run_loop_base_add_data_source(btstack_data_source_t *ds){ 72796f7837SMatthias Ringwald btstack_linked_list_add(&btstack_run_loop_base_data_sources, (btstack_linked_item_t *) ds); 73796f7837SMatthias Ringwald } 74796f7837SMatthias Ringwald 75796f7837SMatthias Ringwald bool btstack_run_loop_base_remove_data_source(btstack_data_source_t *ds){ 76796f7837SMatthias Ringwald return btstack_linked_list_remove(&btstack_run_loop_base_data_sources, (btstack_linked_item_t *) ds); 77796f7837SMatthias Ringwald } 78796f7837SMatthias Ringwald 79796f7837SMatthias Ringwald void btstack_run_loop_base_enable_data_source_callbacks(btstack_data_source_t * ds, uint16_t callback_types){ 80796f7837SMatthias Ringwald ds->flags |= callback_types; 81796f7837SMatthias Ringwald } 82796f7837SMatthias Ringwald 83796f7837SMatthias Ringwald void btstack_run_loop_base_disable_data_source_callbacks(btstack_data_source_t * ds, uint16_t callback_types){ 84796f7837SMatthias Ringwald ds->flags &= ~callback_types; 85796f7837SMatthias Ringwald } 86796f7837SMatthias Ringwald 87796f7837SMatthias Ringwald bool btstack_run_loop_base_remove_timer(btstack_timer_source_t *ts){ 88796f7837SMatthias Ringwald return btstack_linked_list_remove(&btstack_run_loop_base_timers, (btstack_linked_item_t *) ts); 89796f7837SMatthias Ringwald } 90796f7837SMatthias Ringwald 91796f7837SMatthias Ringwald void btstack_run_loop_base_add_timer(btstack_timer_source_t *ts){ 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; 95796f7837SMatthias Ringwald btstack_assert(next != ts); 96796f7837SMatthias Ringwald int32_t delta = btstack_time_delta(ts->timeout, next->timeout); 97796f7837SMatthias Ringwald if (delta < 0) break; 98796f7837SMatthias Ringwald } 99796f7837SMatthias Ringwald ts->item.next = it->next; 100796f7837SMatthias Ringwald it->next = (btstack_linked_item_t *) ts; 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) { 106796f7837SMatthias Ringwald btstack_timer_source_t * ts = (btstack_timer_source_t *) btstack_run_loop_base_timers; 107796f7837SMatthias Ringwald int32_t delta = btstack_time_delta(ts->timeout, now); 108796f7837SMatthias Ringwald if (delta > 0) break; 109796f7837SMatthias Ringwald btstack_run_loop_base_remove_timer(ts); 110796f7837SMatthias Ringwald ts->process(ts); 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){ 119796f7837SMatthias Ringwald btstack_timer_source_t *ts = (btstack_timer_source_t*) it; 120*016e9464SMatthias Ringwald log_info("timer %u (%p): timeout %" PRIu32 "u\n", i, ts, ts->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; 131796f7837SMatthias Ringwald btstack_timer_source_t * ts = (btstack_timer_source_t *) btstack_run_loop_base_timers; 132796f7837SMatthias Ringwald uint32_t list_timeout = ts->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 158ec820d77SMatthias Ringwald void btstack_run_loop_set_timer_handler(btstack_timer_source_t *ts, void (*process)(btstack_timer_source_t *_ts)){ 15915d50271SMatthias Ringwald ts->process = process; 16015d50271SMatthias Ringwald }; 16115d50271SMatthias Ringwald 162896424b7SMatthias Ringwald void btstack_run_loop_set_data_source_handler(btstack_data_source_t *ds, void (*process)(btstack_data_source_t *_ds, btstack_data_source_callback_type_t callback_type)){ 16315d50271SMatthias Ringwald ds->process = process; 16415d50271SMatthias Ringwald }; 16515d50271SMatthias Ringwald 1663a5c43eeSMatthias Ringwald void btstack_run_loop_set_data_source_fd(btstack_data_source_t *ds, int fd){ 167398a95ecSMatthias Ringwald ds->source.fd = fd; 1683a5c43eeSMatthias Ringwald } 1693a5c43eeSMatthias Ringwald 1703a5c43eeSMatthias Ringwald int btstack_run_loop_get_data_source_fd(btstack_data_source_t *ds){ 171398a95ecSMatthias Ringwald return ds->source.fd; 1723a5c43eeSMatthias Ringwald } 1733a5c43eeSMatthias Ringwald 174f04a41aeSMatthias Ringwald void btstack_run_loop_set_data_source_handle(btstack_data_source_t *ds, void * handle){ 175398a95ecSMatthias Ringwald ds->source.handle = handle; 176f04a41aeSMatthias Ringwald } 177f04a41aeSMatthias Ringwald 178f04a41aeSMatthias Ringwald void * btstack_run_loop_get_data_source_handle(btstack_data_source_t *ds){ 179398a95ecSMatthias Ringwald return ds->source.handle; 180f04a41aeSMatthias Ringwald } 181f04a41aeSMatthias Ringwald 1820d70dd62SMatthias Ringwald void btstack_run_loop_enable_data_source_callbacks(btstack_data_source_t *ds, uint16_t callbacks){ 18327e05778SMatthias Ringwald btstack_assert(the_run_loop != NULL); 184141177f8SMatthias Ringwald btstack_assert(the_run_loop->enable_data_source_callbacks != NULL); 1854ea196a4SMatthias Ringwald the_run_loop->enable_data_source_callbacks(ds, callbacks); 186896424b7SMatthias Ringwald } 187896424b7SMatthias Ringwald 1880d70dd62SMatthias Ringwald void btstack_run_loop_disable_data_source_callbacks(btstack_data_source_t *ds, uint16_t callbacks){ 18927e05778SMatthias Ringwald btstack_assert(the_run_loop != NULL); 190141177f8SMatthias Ringwald btstack_assert(the_run_loop->enable_data_source_callbacks != NULL); 1914ea196a4SMatthias Ringwald the_run_loop->disable_data_source_callbacks(ds, callbacks); 192896424b7SMatthias Ringwald } 19315d50271SMatthias Ringwald 19415d50271SMatthias Ringwald /** 19515d50271SMatthias Ringwald * Add data_source to run_loop 19615d50271SMatthias Ringwald */ 197ec820d77SMatthias Ringwald void btstack_run_loop_add_data_source(btstack_data_source_t *ds){ 19827e05778SMatthias Ringwald btstack_assert(the_run_loop != NULL); 199141177f8SMatthias Ringwald btstack_assert(the_run_loop->enable_data_source_callbacks != NULL); 2000ad702f3SMatthias Ringwald btstack_assert(ds->process != NULL); 20115d50271SMatthias Ringwald the_run_loop->add_data_source(ds); 20215d50271SMatthias Ringwald } 20315d50271SMatthias Ringwald 20415d50271SMatthias Ringwald /** 20515d50271SMatthias Ringwald * Remove data_source from run loop 20615d50271SMatthias Ringwald */ 207ec820d77SMatthias Ringwald int btstack_run_loop_remove_data_source(btstack_data_source_t *ds){ 20827e05778SMatthias Ringwald btstack_assert(the_run_loop != NULL); 2090ad702f3SMatthias Ringwald btstack_assert(the_run_loop->disable_data_source_callbacks != NULL); 2100ad702f3SMatthias Ringwald btstack_assert(ds->process != NULL); 21115d50271SMatthias Ringwald return the_run_loop->remove_data_source(ds); 21215d50271SMatthias Ringwald } 21315d50271SMatthias Ringwald 214ec820d77SMatthias Ringwald void btstack_run_loop_set_timer(btstack_timer_source_t *a, uint32_t timeout_in_ms){ 21527e05778SMatthias Ringwald btstack_assert(the_run_loop != NULL); 21615d50271SMatthias Ringwald the_run_loop->set_timer(a, timeout_in_ms); 21715d50271SMatthias Ringwald } 21815d50271SMatthias Ringwald 21915d50271SMatthias Ringwald /** 220fd939756SMatthias Ringwald * @brief Set context for this timer 221fd939756SMatthias Ringwald */ 222fd939756SMatthias Ringwald void btstack_run_loop_set_timer_context(btstack_timer_source_t *ts, void * context){ 223fd939756SMatthias Ringwald ts->context = context; 224fd939756SMatthias Ringwald } 225fd939756SMatthias Ringwald 226fd939756SMatthias Ringwald /** 227fd939756SMatthias Ringwald * @brief Get context for this timer 228fd939756SMatthias Ringwald */ 229fd939756SMatthias Ringwald void * btstack_run_loop_get_timer_context(btstack_timer_source_t *ts){ 230fd939756SMatthias Ringwald return ts->context; 231fd939756SMatthias Ringwald } 232fd939756SMatthias Ringwald 233fd939756SMatthias Ringwald /** 23415d50271SMatthias Ringwald * Add timer to run_loop (keep list sorted) 23515d50271SMatthias Ringwald */ 236ec820d77SMatthias Ringwald void btstack_run_loop_add_timer(btstack_timer_source_t *ts){ 23727e05778SMatthias Ringwald btstack_assert(the_run_loop != NULL); 2380ad702f3SMatthias Ringwald btstack_assert(ts->process != NULL); 23915d50271SMatthias Ringwald the_run_loop->add_timer(ts); 24015d50271SMatthias Ringwald } 24115d50271SMatthias Ringwald 24215d50271SMatthias Ringwald /** 24315d50271SMatthias Ringwald * Remove timer from run loop 24415d50271SMatthias Ringwald */ 245ec820d77SMatthias Ringwald int btstack_run_loop_remove_timer(btstack_timer_source_t *ts){ 24627e05778SMatthias Ringwald btstack_assert(the_run_loop != NULL); 24715d50271SMatthias Ringwald return the_run_loop->remove_timer(ts); 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