Kev Mann / mbed-dev-OS5_10_4
Committer:
kevman
Date:
Wed Nov 28 15:10:15 2018 +0000
Revision:
0:38ceb79fef03
RTC modified

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kevman 0:38ceb79fef03 1 /*
kevman 0:38ceb79fef03 2 * Copyright (c) 2014-2015 ARM Limited. All rights reserved.
kevman 0:38ceb79fef03 3 * SPDX-License-Identifier: Apache-2.0
kevman 0:38ceb79fef03 4 * Licensed under the Apache License, Version 2.0 (the License); you may
kevman 0:38ceb79fef03 5 * not use this file except in compliance with the License.
kevman 0:38ceb79fef03 6 * You may obtain a copy of the License at
kevman 0:38ceb79fef03 7 *
kevman 0:38ceb79fef03 8 * http://www.apache.org/licenses/LICENSE-2.0
kevman 0:38ceb79fef03 9 *
kevman 0:38ceb79fef03 10 * Unless required by applicable law or agreed to in writing, software
kevman 0:38ceb79fef03 11 * distributed under the License is distributed on an AS IS BASIS, WITHOUT
kevman 0:38ceb79fef03 12 * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
kevman 0:38ceb79fef03 13 * See the License for the specific language governing permissions and
kevman 0:38ceb79fef03 14 * limitations under the License.
kevman 0:38ceb79fef03 15 */
kevman 0:38ceb79fef03 16 #include "eventOS_event.h"
kevman 0:38ceb79fef03 17 #include "eventOS_event_timer.h"
kevman 0:38ceb79fef03 18 #include "nsdynmemLIB.h"
kevman 0:38ceb79fef03 19 #include "ns_list.h"
kevman 0:38ceb79fef03 20 #include "timer_sys.h"
kevman 0:38ceb79fef03 21
kevman 0:38ceb79fef03 22 #define STARTUP_EVENT 0
kevman 0:38ceb79fef03 23 #define TIMER_EVENT 1
kevman 0:38ceb79fef03 24
kevman 0:38ceb79fef03 25 // Timeout structure, already typedefed to timeout_t
kevman 0:38ceb79fef03 26 struct timeout_entry_t {
kevman 0:38ceb79fef03 27 void (*callback)(void *);
kevman 0:38ceb79fef03 28 void *arg;
kevman 0:38ceb79fef03 29 arm_event_storage_t *event;
kevman 0:38ceb79fef03 30 };
kevman 0:38ceb79fef03 31
kevman 0:38ceb79fef03 32 static int8_t timeout_tasklet_id = -1;
kevman 0:38ceb79fef03 33
kevman 0:38ceb79fef03 34 static void timeout_tasklet(arm_event_s *event)
kevman 0:38ceb79fef03 35 {
kevman 0:38ceb79fef03 36 if (TIMER_EVENT != event->event_type) {
kevman 0:38ceb79fef03 37 return;
kevman 0:38ceb79fef03 38 }
kevman 0:38ceb79fef03 39
kevman 0:38ceb79fef03 40 timeout_t *t = event->data_ptr;
kevman 0:38ceb79fef03 41 arm_event_storage_t *storage = t->event;
kevman 0:38ceb79fef03 42 sys_timer_struct_s *timer = NS_CONTAINER_OF(storage, sys_timer_struct_s, event);
kevman 0:38ceb79fef03 43
kevman 0:38ceb79fef03 44 t->callback(t->arg);
kevman 0:38ceb79fef03 45
kevman 0:38ceb79fef03 46
kevman 0:38ceb79fef03 47 // Check if this was periodic timer
kevman 0:38ceb79fef03 48 if (timer->period == 0) {
kevman 0:38ceb79fef03 49 ns_dyn_mem_free(event->data_ptr);
kevman 0:38ceb79fef03 50 }
kevman 0:38ceb79fef03 51 }
kevman 0:38ceb79fef03 52
kevman 0:38ceb79fef03 53 static timeout_t *eventOS_timeout_at_(void (*callback)(void *), void *arg, uint32_t at, uint32_t period)
kevman 0:38ceb79fef03 54 {
kevman 0:38ceb79fef03 55 arm_event_storage_t *storage;
kevman 0:38ceb79fef03 56
kevman 0:38ceb79fef03 57 timeout_t *timeout = ns_dyn_mem_alloc(sizeof(timeout_t));
kevman 0:38ceb79fef03 58 if (!timeout) {
kevman 0:38ceb79fef03 59 return NULL;
kevman 0:38ceb79fef03 60 }
kevman 0:38ceb79fef03 61 timeout->callback = callback;
kevman 0:38ceb79fef03 62 timeout->arg = arg;
kevman 0:38ceb79fef03 63
kevman 0:38ceb79fef03 64 // Start timeout taskled if it is not running
kevman 0:38ceb79fef03 65 if (-1 == timeout_tasklet_id) {
kevman 0:38ceb79fef03 66 timeout_tasklet_id = eventOS_event_handler_create(timeout_tasklet, STARTUP_EVENT);
kevman 0:38ceb79fef03 67 if (timeout_tasklet_id < 0) {
kevman 0:38ceb79fef03 68 timeout_tasklet_id = -1;
kevman 0:38ceb79fef03 69 goto FAIL;
kevman 0:38ceb79fef03 70 }
kevman 0:38ceb79fef03 71 }
kevman 0:38ceb79fef03 72
kevman 0:38ceb79fef03 73 arm_event_t event = {
kevman 0:38ceb79fef03 74 .receiver = timeout_tasklet_id,
kevman 0:38ceb79fef03 75 .sender = timeout_tasklet_id,
kevman 0:38ceb79fef03 76 .event_type = TIMER_EVENT,
kevman 0:38ceb79fef03 77 .event_id = TIMER_EVENT,
kevman 0:38ceb79fef03 78 .data_ptr = timeout
kevman 0:38ceb79fef03 79 };
kevman 0:38ceb79fef03 80
kevman 0:38ceb79fef03 81 if (period)
kevman 0:38ceb79fef03 82 storage = eventOS_event_timer_request_every(&event, period);
kevman 0:38ceb79fef03 83 else
kevman 0:38ceb79fef03 84 storage = eventOS_event_timer_request_at(&event, at);
kevman 0:38ceb79fef03 85
kevman 0:38ceb79fef03 86 timeout->event = storage;
kevman 0:38ceb79fef03 87 if (storage)
kevman 0:38ceb79fef03 88 return timeout;
kevman 0:38ceb79fef03 89 FAIL:
kevman 0:38ceb79fef03 90 ns_dyn_mem_free(timeout);
kevman 0:38ceb79fef03 91 return NULL;
kevman 0:38ceb79fef03 92 }
kevman 0:38ceb79fef03 93
kevman 0:38ceb79fef03 94 timeout_t *eventOS_timeout_ms(void (*callback)(void *), uint32_t ms, void *arg)
kevman 0:38ceb79fef03 95 {
kevman 0:38ceb79fef03 96 return eventOS_timeout_at_(callback, arg, eventOS_event_timer_ms_to_ticks(ms)+eventOS_event_timer_ticks(), 0);
kevman 0:38ceb79fef03 97 }
kevman 0:38ceb79fef03 98
kevman 0:38ceb79fef03 99 timeout_t *eventOS_timeout_every_ms(void (*callback)(void *), uint32_t every, void *arg)
kevman 0:38ceb79fef03 100 {
kevman 0:38ceb79fef03 101 return eventOS_timeout_at_(callback, arg, 0, eventOS_event_timer_ms_to_ticks(every));
kevman 0:38ceb79fef03 102 }
kevman 0:38ceb79fef03 103
kevman 0:38ceb79fef03 104 void eventOS_timeout_cancel(timeout_t *t)
kevman 0:38ceb79fef03 105 {
kevman 0:38ceb79fef03 106 if (!t)
kevman 0:38ceb79fef03 107 return;
kevman 0:38ceb79fef03 108
kevman 0:38ceb79fef03 109 eventOS_cancel(t->event);
kevman 0:38ceb79fef03 110
kevman 0:38ceb79fef03 111 // Defer the freeing until returning from the callback
kevman 0:38ceb79fef03 112 if (t->event->state != ARM_LIB_EVENT_RUNNING) {
kevman 0:38ceb79fef03 113 ns_dyn_mem_free(t);
kevman 0:38ceb79fef03 114 }
kevman 0:38ceb79fef03 115 }