Daniel Vizcaya / Mbed OS 04_RTOS_Embebidos

Entrega 3er corte - sistemas embebidos

mbed-os/rtos/Semaphore.cpp@0:6ad07c9019fd, 2018-05-30 (annotated)

Committer:
Bethory
Date:
Wed May 30 00:01:50 2018 +0000
Revision:
0:6ad07c9019fd
Codigo de tales para todos los pasculaes

Who changed what in which revision?

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