Kev Mann / mbed-dev-OS5_10_4

RTC auf true

rtos/Semaphore.cpp@2:7aab896b1a3b, 2019-03-13 (annotated)

Committer:
kevman
Date:
Wed Mar 13 11:03:24 2019 +0000
Revision:
2:7aab896b1a3b
Parent:
0:38ceb79fef03 
2019-03-13

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kevman 0:38ceb79fef03 1 /* mbed Microcontroller Library
kevman 0:38ceb79fef03 2 * Copyright (c) 2006-2012 ARM Limited
kevman 0:38ceb79fef03 3 *
kevman 0:38ceb79fef03 4 * Permission is hereby granted, free of charge, to any person obtaining a copy
kevman 0:38ceb79fef03 5 * of this software and associated documentation files (the "Software"), to deal
kevman 0:38ceb79fef03 6 * in the Software without restriction, including without limitation the rights
kevman 0:38ceb79fef03 7 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
kevman 0:38ceb79fef03 8 * copies of the Software, and to permit persons to whom the Software is
kevman 0:38ceb79fef03 9 * furnished to do so, subject to the following conditions:
kevman 0:38ceb79fef03 10 *
kevman 0:38ceb79fef03 11 * The above copyright notice and this permission notice shall be included in
kevman 0:38ceb79fef03 12 * all copies or substantial portions of the Software.
kevman 0:38ceb79fef03 13 *
kevman 0:38ceb79fef03 14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
kevman 0:38ceb79fef03 15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
kevman 0:38ceb79fef03 16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
kevman 0:38ceb79fef03 17 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
kevman 0:38ceb79fef03 18 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
kevman 0:38ceb79fef03 19 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
kevman 0:38ceb79fef03 20 * SOFTWARE.
kevman 0:38ceb79fef03 21 */
kevman 0:38ceb79fef03 22 #include "rtos/Semaphore.h"
kevman 0:38ceb79fef03 23 #include "rtos/Kernel.h"
kevman 0:38ceb79fef03 24 #include "platform/mbed_assert.h"
kevman 0:38ceb79fef03 25
kevman 0:38ceb79fef03 26 #include <string.h>
kevman 0:38ceb79fef03 27
kevman 0:38ceb79fef03 28 namespace rtos {
kevman 0:38ceb79fef03 29
kevman 0:38ceb79fef03 30 Semaphore::Semaphore(int32_t count) {
kevman 0:38ceb79fef03 31 constructor(count, 0xffff);
kevman 0:38ceb79fef03 32 }
kevman 0:38ceb79fef03 33
kevman 0:38ceb79fef03 34 Semaphore::Semaphore(int32_t count, uint16_t max_count) {
kevman 0:38ceb79fef03 35 constructor(count, max_count);
kevman 0:38ceb79fef03 36 }
kevman 0:38ceb79fef03 37
kevman 0:38ceb79fef03 38 void Semaphore::constructor(int32_t count, uint16_t max_count) {
kevman 0:38ceb79fef03 39 memset(&_obj_mem, 0, sizeof(_obj_mem));
kevman 0:38ceb79fef03 40 osSemaphoreAttr_t attr = { 0 };
kevman 0:38ceb79fef03 41 attr.cb_mem = &_obj_mem;
kevman 0:38ceb79fef03 42 attr.cb_size = sizeof(_obj_mem);
kevman 0:38ceb79fef03 43 _id = osSemaphoreNew(max_count, count, &attr);
kevman 0:38ceb79fef03 44 MBED_ASSERT(_id != NULL);
kevman 0:38ceb79fef03 45 }
kevman 0:38ceb79fef03 46
kevman 0:38ceb79fef03 47 int32_t Semaphore::wait(uint32_t millisec) {
kevman 0:38ceb79fef03 48 osStatus_t stat = osSemaphoreAcquire(_id, millisec);
kevman 0:38ceb79fef03 49 switch (stat) {
kevman 0:38ceb79fef03 50 case osOK:
kevman 0:38ceb79fef03 51 return osSemaphoreGetCount(_id) + 1;
kevman 0:38ceb79fef03 52 case osErrorTimeout:
kevman 0:38ceb79fef03 53 case osErrorResource:
kevman 0:38ceb79fef03 54 return 0;
kevman 0:38ceb79fef03 55 case osErrorParameter:
kevman 0:38ceb79fef03 56 default:
kevman 0:38ceb79fef03 57 return -1;
kevman 0:38ceb79fef03 58 }
kevman 0:38ceb79fef03 59 }
kevman 0:38ceb79fef03 60
kevman 0:38ceb79fef03 61 int32_t Semaphore::wait_until(uint64_t millisec) {
kevman 0:38ceb79fef03 62 uint64_t now = Kernel::get_ms_count();
kevman 0:38ceb79fef03 63
kevman 0:38ceb79fef03 64 if (now >= millisec) {
kevman 0:38ceb79fef03 65 return wait(0);
kevman 0:38ceb79fef03 66 } else if (millisec - now >= osWaitForever) {
kevman 0:38ceb79fef03 67 // API permits early return
kevman 0:38ceb79fef03 68 return wait(osWaitForever - 1);
kevman 0:38ceb79fef03 69 } else {
kevman 0:38ceb79fef03 70 return wait(millisec - now);
kevman 0:38ceb79fef03 71 }
kevman 0:38ceb79fef03 72 }
kevman 0:38ceb79fef03 73
kevman 0:38ceb79fef03 74 osStatus Semaphore::release(void) {
kevman 0:38ceb79fef03 75 return osSemaphoreRelease(_id);
kevman 0:38ceb79fef03 76 }
kevman 0:38ceb79fef03 77
kevman 0:38ceb79fef03 78 Semaphore::~Semaphore() {
kevman 0:38ceb79fef03 79 osSemaphoreDelete(_id);
kevman 0:38ceb79fef03 80 }
kevman 0:38ceb79fef03 81
kevman 0:38ceb79fef03 82 }