EL4121 Embedded System / mbed-os

mbed-os

Dependents:   cobaLCDJoyMotor_Thread odometry_omni_3roda_v3 odometry_omni_3roda_v1 odometry_omni_3roda_v2 ... more

events/equeue/equeue_mbed.cpp@0:b74591d5ab33, 2017-12-11 (annotated)

Committer:
be_bryan
Date:
Mon Dec 11 17:54:04 2017 +0000
Revision:
0:b74591d5ab33
motor ++

Who changed what in which revision?

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