1 /* 2 * Copyright (C) 2015 BlueKitchen GmbH 3 * 4 * Redistribution and use in source and binary forms, with or without 5 * modification, are permitted provided that the following conditions 6 * are met: 7 * 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 3. Neither the name of the copyright holders nor the names of 14 * contributors may be used to endorse or promote products derived 15 * from this software without specific prior written permission. 16 * 4. Any redistribution, use, or modification is done solely for 17 * personal benefit and not for any commercial purpose or for 18 * monetary gain. 19 * 20 * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS 21 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 22 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 23 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS 24 * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 25 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 26 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 27 * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 28 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 29 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 30 * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 31 * SUCH DAMAGE. 32 * 33 * Please inquire about commercial licensing options at 34 * [email protected] 35 * 36 */ 37 38 #define BTSTACK_FILE__ "btstack_run_loop_wiced.c" 39 40 /* 41 * btstack_run_loop_wiced.c 42 * 43 * Run loop for Broadcom WICED SDK which currently supports FreeRTOS and ThreadX 44 * WICED 3.3.1 does not support Event Flags on FreeRTOS so a queue is used instead 45 */ 46 47 #include "wiced.h" 48 49 #include "btstack_run_loop_wiced.h" 50 51 #include "btstack_linked_list.h" 52 #include "btstack_debug.h" 53 #include "btstack_util.h" 54 #include "btstack_run_loop.h" 55 56 #include <stddef.h> // NULL 57 58 typedef struct function_call { 59 wiced_result_t (*fn)(void * arg); 60 void * arg; 61 } function_call_t; 62 63 static const btstack_run_loop_t btstack_run_loop_wiced; 64 65 static wiced_queue_t btstack_run_loop_queue; 66 67 // the run loop 68 static btstack_linked_list_t timers; 69 70 static uint32_t btstack_run_loop_wiced_get_time_ms(void){ 71 wiced_time_t time; 72 wiced_time_get_time(&time); 73 return time; 74 } 75 76 // set timer 77 static void btstack_run_loop_wiced_set_timer(btstack_timer_source_t *ts, uint32_t timeout_in_ms){ 78 ts->timeout = btstack_run_loop_wiced_get_time_ms() + timeout_in_ms + 1; 79 } 80 81 /** 82 * Add timer to run_loop (keep list sorted) 83 */ 84 static void btstack_run_loop_wiced_add_timer(btstack_timer_source_t *ts){ 85 btstack_linked_item_t *it; 86 for (it = (btstack_linked_item_t *) &timers; it->next ; it = it->next){ 87 // don't add timer that's already in there 88 btstack_timer_source_t * next = (btstack_timer_source_t *) it->next; 89 if (next == ts){ 90 log_error( "btstack_run_loop_timer_add error: timer to add already in list!"); 91 return; 92 } 93 // exit if new timeout before list timeout 94 int32_t delta = btstack_time_delta(ts->timeout, next->timeout); 95 if (delta < 0) break; 96 } 97 ts->item.next = it->next; 98 it->next = (btstack_linked_item_t *) ts; 99 } 100 101 /** 102 * Remove timer from run loop 103 */ 104 static bool btstack_run_loop_wiced_remove_timer(btstack_timer_source_t *ts){ 105 return btstack_linked_list_remove(&timers, (btstack_linked_item_t *) ts); 106 } 107 108 static void btstack_run_loop_wiced_dump_timer(void){ 109 #ifdef ENABLE_LOG_INFO 110 btstack_linked_item_t *it; 111 int i = 0; 112 for (it = (btstack_linked_item_t *) timers; it ; it = it->next){ 113 btstack_timer_source_t *ts = (btstack_timer_source_t*) it; 114 log_info("timer %u, timeout %u\n", i, (unsigned int) ts->timeout); 115 } 116 #endif 117 } 118 119 // schedules execution similar to wiced_rtos_send_asynchronous_event for worker threads 120 void btstack_run_loop_wiced_execute_code_on_main_thread(wiced_result_t (*fn)(void *arg), void * arg){ 121 function_call_t message; 122 message.fn = fn; 123 message.arg = arg; 124 wiced_rtos_push_to_queue(&btstack_run_loop_queue, &message, WICED_NEVER_TIMEOUT); 125 } 126 127 /** 128 * Execute run_loop 129 */ 130 static void btstack_run_loop_wiced_execute(void) { 131 while (1) { 132 // get next timeout 133 uint32_t timeout_ms = WICED_NEVER_TIMEOUT; 134 if (timers) { 135 btstack_timer_source_t * ts = (btstack_timer_source_t *) timers; 136 uint32_t now = btstack_run_loop_wiced_get_time_ms(); 137 int32_t delta_ms = btstack_time_delta(ts->timeout, now); 138 if (delta_ms <= 0){ 139 // remove timer before processing it to allow handler to re-register with run loop 140 btstack_run_loop_wiced_remove_timer(ts); 141 ts->process(ts); 142 continue; 143 } 144 timeout_ms = delta_ms; 145 } 146 147 // pop function call 148 function_call_t message = { NULL, NULL }; 149 wiced_rtos_pop_from_queue( &btstack_run_loop_queue, &message, timeout_ms); 150 if (message.fn){ 151 // execute code on run loop 152 message.fn(message.arg); 153 } 154 } 155 } 156 157 static void btstack_run_loop_wiced_btstack_run_loop_init(void){ 158 timers = NULL; 159 160 // queue to receive events: up to 2 calls from transport, up to 3 for app 161 wiced_rtos_init_queue(&btstack_run_loop_queue, "BTstack Run Loop", sizeof(function_call_t), 5); 162 } 163 164 /** 165 * @brief Provide btstack_run_loop_posix instance for use with btstack_run_loop_init 166 */ 167 const btstack_run_loop_t * btstack_run_loop_wiced_get_instance(void){ 168 return &btstack_run_loop_wiced; 169 } 170 171 static const btstack_run_loop_t btstack_run_loop_wiced = { 172 &btstack_run_loop_wiced_btstack_run_loop_init, 173 NULL, 174 NULL, 175 NULL, 176 NULL, 177 &btstack_run_loop_wiced_set_timer, 178 &btstack_run_loop_wiced_add_timer, 179 &btstack_run_loop_wiced_remove_timer, 180 &btstack_run_loop_wiced_execute, 181 &btstack_run_loop_wiced_dump_timer, 182 &btstack_run_loop_wiced_get_time_ms, 183 }; 184