xref: /btstack/src/btstack_run_loop.c (revision 016e946421f227d27d3677b6058570959ef1b462)
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