Marco Mayer / Mbed OS Queue

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

mbed-os/events/equeue/equeue_mbed.cpp@2:c7897a3f5f11, 2020-04-22 (annotated)

Committer:
demayer
Date:
Wed Apr 22 11:50:00 2020 +0000
Revision:
2:c7897a3f5f11
Parent:
0:6bf0743ece18 
test

Who changed what in which revision?

UserRevisionLine numberNew contents of line
demayer 0:6bf0743ece18 1 /*
demayer 0:6bf0743ece18 2 * Implementation for the mbed library
demayer 0:6bf0743ece18 3 * https://github.com/mbedmicro/mbed
demayer 0:6bf0743ece18 4 *
demayer 0:6bf0743ece18 5 * Copyright (c) 2016 Christopher Haster
demayer 0:6bf0743ece18 6 *
demayer 0:6bf0743ece18 7 * Licensed under the Apache License, Version 2.0 (the "License");
demayer 0:6bf0743ece18 8 * you may not use this file except in compliance with the License.
demayer 0:6bf0743ece18 9 * You may obtain a copy of the License at
demayer 0:6bf0743ece18 10 *
demayer 0:6bf0743ece18 11 * http://www.apache.org/licenses/LICENSE-2.0
demayer 0:6bf0743ece18 12 *
demayer 0:6bf0743ece18 13 * Unless required by applicable law or agreed to in writing, software
demayer 0:6bf0743ece18 14 * distributed under the License is distributed on an "AS IS" BASIS,
demayer 0:6bf0743ece18 15 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
demayer 0:6bf0743ece18 16 * See the License for the specific language governing permissions and
demayer 0:6bf0743ece18 17 * limitations under the License.
demayer 0:6bf0743ece18 18 */
demayer 0:6bf0743ece18 19 #include "equeue/equeue_platform.h"
demayer 0:6bf0743ece18 20
demayer 0:6bf0743ece18 21 #if defined(EQUEUE_PLATFORM_MBED)
demayer 0:6bf0743ece18 22
demayer 0:6bf0743ece18 23 #include <stdbool.h>
demayer 0:6bf0743ece18 24 #include "mbed.h"
demayer 0:6bf0743ece18 25
demayer 0:6bf0743ece18 26 #if MBED_CONF_EVENTS_USE_LOWPOWER_TIMER_TICKER
demayer 0:6bf0743ece18 27 #define ALIAS_TIMER LowPowerTimer
demayer 0:6bf0743ece18 28 #define ALIAS_TICKER LowPowerTicker
demayer 0:6bf0743ece18 29 #define ALIAS_TIMEOUT LowPowerTimeout
demayer 0:6bf0743ece18 30 #else
demayer 0:6bf0743ece18 31 #define ALIAS_TIMER Timer
demayer 0:6bf0743ece18 32 #define ALIAS_TICKER Ticker
demayer 0:6bf0743ece18 33 #define ALIAS_TIMEOUT Timeout
demayer 0:6bf0743ece18 34 #endif
demayer 0:6bf0743ece18 35
demayer 0:6bf0743ece18 36 // Ticker operations
demayer 0:6bf0743ece18 37 static bool equeue_tick_inited = false;
demayer 0:6bf0743ece18 38 static volatile unsigned equeue_minutes = 0;
demayer 0:6bf0743ece18 39 static unsigned equeue_timer[
demayer 0:6bf0743ece18 40 (sizeof(ALIAS_TIMER)+sizeof(unsigned)-1)/sizeof(unsigned)];
demayer 0:6bf0743ece18 41 static unsigned equeue_ticker[
demayer 0:6bf0743ece18 42 (sizeof(ALIAS_TICKER)+sizeof(unsigned)-1)/sizeof(unsigned)];
demayer 0:6bf0743ece18 43
demayer 0:6bf0743ece18 44 static void equeue_tick_update() {
demayer 0:6bf0743ece18 45 equeue_minutes += reinterpret_cast<ALIAS_TIMER*>(equeue_timer)->read_ms();
demayer 0:6bf0743ece18 46 reinterpret_cast<ALIAS_TIMER*>(equeue_timer)->reset();
demayer 0:6bf0743ece18 47 }
demayer 0:6bf0743ece18 48
demayer 0:6bf0743ece18 49 static void equeue_tick_init() {
demayer 0:6bf0743ece18 50 MBED_STATIC_ASSERT(sizeof(equeue_timer) >= sizeof(ALIAS_TIMER),
demayer 0:6bf0743ece18 51 "The equeue_timer buffer must fit the class Timer");
demayer 0:6bf0743ece18 52 MBED_STATIC_ASSERT(sizeof(equeue_ticker) >= sizeof(ALIAS_TICKER),
demayer 0:6bf0743ece18 53 "The equeue_ticker buffer must fit the class Ticker");
demayer 0:6bf0743ece18 54 ALIAS_TIMER *timer = new (equeue_timer) ALIAS_TIMER;
demayer 0:6bf0743ece18 55 ALIAS_TICKER *ticker = new (equeue_ticker) ALIAS_TICKER;
demayer 0:6bf0743ece18 56
demayer 0:6bf0743ece18 57 equeue_minutes = 0;
demayer 0:6bf0743ece18 58 timer->start();
demayer 0:6bf0743ece18 59 ticker->attach_us(equeue_tick_update, 1000 << 16);
demayer 0:6bf0743ece18 60
demayer 0:6bf0743ece18 61 equeue_tick_inited = true;
demayer 0:6bf0743ece18 62 }
demayer 0:6bf0743ece18 63
demayer 0:6bf0743ece18 64 unsigned equeue_tick() {
demayer 0:6bf0743ece18 65 if (!equeue_tick_inited) {
demayer 0:6bf0743ece18 66 equeue_tick_init();
demayer 0:6bf0743ece18 67 }
demayer 0:6bf0743ece18 68
demayer 0:6bf0743ece18 69 unsigned minutes;
demayer 0:6bf0743ece18 70 unsigned ms;
demayer 0:6bf0743ece18 71
demayer 0:6bf0743ece18 72 do {
demayer 0:6bf0743ece18 73 minutes = equeue_minutes;
demayer 0:6bf0743ece18 74 ms = reinterpret_cast<ALIAS_TIMER*>(equeue_timer)->read_ms();
demayer 0:6bf0743ece18 75 } while (minutes != equeue_minutes);
demayer 0:6bf0743ece18 76
demayer 0:6bf0743ece18 77 return minutes + ms;
demayer 0:6bf0743ece18 78 }
demayer 0:6bf0743ece18 79
demayer 0:6bf0743ece18 80
demayer 0:6bf0743ece18 81 // Mutex operations
demayer 0:6bf0743ece18 82 int equeue_mutex_create(equeue_mutex_t *m) { return 0; }
demayer 0:6bf0743ece18 83 void equeue_mutex_destroy(equeue_mutex_t *m) { }
demayer 0:6bf0743ece18 84
demayer 0:6bf0743ece18 85 void equeue_mutex_lock(equeue_mutex_t *m) {
demayer 0:6bf0743ece18 86 core_util_critical_section_enter();
demayer 0:6bf0743ece18 87 }
demayer 0:6bf0743ece18 88
demayer 0:6bf0743ece18 89 void equeue_mutex_unlock(equeue_mutex_t *m) {
demayer 0:6bf0743ece18 90 core_util_critical_section_exit();
demayer 0:6bf0743ece18 91 }
demayer 0:6bf0743ece18 92
demayer 0:6bf0743ece18 93
demayer 0:6bf0743ece18 94 // Semaphore operations
demayer 0:6bf0743ece18 95 #ifdef MBED_CONF_RTOS_PRESENT
demayer 0:6bf0743ece18 96
demayer 0:6bf0743ece18 97 int equeue_sema_create(equeue_sema_t *s) {
demayer 0:6bf0743ece18 98 osEventFlagsAttr_t attr;
demayer 0:6bf0743ece18 99 memset(&attr, 0, sizeof(attr));
demayer 0:6bf0743ece18 100 attr.cb_mem = &s->mem;
demayer 0:6bf0743ece18 101 attr.cb_size = sizeof(s->mem);
demayer 0:6bf0743ece18 102
demayer 0:6bf0743ece18 103 s->id = osEventFlagsNew(&attr);
demayer 0:6bf0743ece18 104 return !s->id ? -1 : 0;
demayer 0:6bf0743ece18 105 }
demayer 0:6bf0743ece18 106
demayer 0:6bf0743ece18 107 void equeue_sema_destroy(equeue_sema_t *s) {
demayer 0:6bf0743ece18 108 osEventFlagsDelete(s->id);
demayer 0:6bf0743ece18 109 }
demayer 0:6bf0743ece18 110
demayer 0:6bf0743ece18 111 void equeue_sema_signal(equeue_sema_t *s) {
demayer 0:6bf0743ece18 112 osEventFlagsSet(s->id, 1);
demayer 0:6bf0743ece18 113 }
demayer 0:6bf0743ece18 114
demayer 0:6bf0743ece18 115 bool equeue_sema_wait(equeue_sema_t *s, int ms) {
demayer 0:6bf0743ece18 116 if (ms < 0) {
demayer 0:6bf0743ece18 117 ms = osWaitForever;
demayer 0:6bf0743ece18 118 }
demayer 0:6bf0743ece18 119
demayer 0:6bf0743ece18 120 return (osEventFlagsWait(s->id, 1, osFlagsWaitAny, ms) == 1);
demayer 0:6bf0743ece18 121 }
demayer 0:6bf0743ece18 122
demayer 0:6bf0743ece18 123 #else
demayer 0:6bf0743ece18 124
demayer 0:6bf0743ece18 125 // Semaphore operations
demayer 0:6bf0743ece18 126 int equeue_sema_create(equeue_sema_t *s) {
demayer 0:6bf0743ece18 127 *s = false;
demayer 0:6bf0743ece18 128 return 0;
demayer 0:6bf0743ece18 129 }
demayer 0:6bf0743ece18 130
demayer 0:6bf0743ece18 131 void equeue_sema_destroy(equeue_sema_t *s) {
demayer 0:6bf0743ece18 132 }
demayer 0:6bf0743ece18 133
demayer 0:6bf0743ece18 134 void equeue_sema_signal(equeue_sema_t *s) {
demayer 0:6bf0743ece18 135 *s = 1;
demayer 0:6bf0743ece18 136 }
demayer 0:6bf0743ece18 137
demayer 0:6bf0743ece18 138 static void equeue_sema_timeout(equeue_sema_t *s) {
demayer 0:6bf0743ece18 139 *s = -1;
demayer 0:6bf0743ece18 140 }
demayer 0:6bf0743ece18 141
demayer 0:6bf0743ece18 142 bool equeue_sema_wait(equeue_sema_t *s, int ms) {
demayer 0:6bf0743ece18 143 int signal = 0;
demayer 0:6bf0743ece18 144 ALIAS_TIMEOUT timeout;
demayer 0:6bf0743ece18 145 if (ms == 0) {
demayer 0:6bf0743ece18 146 return false;
demayer 0:6bf0743ece18 147 } else if (ms > 0) {
demayer 0:6bf0743ece18 148 timeout.attach_us(callback(equeue_sema_timeout, s), ms*1000);
demayer 0:6bf0743ece18 149 }
demayer 0:6bf0743ece18 150
demayer 0:6bf0743ece18 151 core_util_critical_section_enter();
demayer 0:6bf0743ece18 152 while (!*s) {
demayer 0:6bf0743ece18 153 sleep();
demayer 0:6bf0743ece18 154 core_util_critical_section_exit();
demayer 0:6bf0743ece18 155 core_util_critical_section_enter();
demayer 0:6bf0743ece18 156 }
demayer 0:6bf0743ece18 157
demayer 0:6bf0743ece18 158 signal = *s;
demayer 0:6bf0743ece18 159 *s = false;
demayer 0:6bf0743ece18 160 core_util_critical_section_exit();
demayer 0:6bf0743ece18 161
demayer 0:6bf0743ece18 162 return (signal > 0);
demayer 0:6bf0743ece18 163 }
demayer 0:6bf0743ece18 164
demayer 0:6bf0743ece18 165 #endif
demayer 0:6bf0743ece18 166
demayer 0:6bf0743ece18 167 #endif