Committer:
borlanic
Date:
Tue Apr 24 11:45:18 2018 +0000
Revision:
0:02dd72d1d465
BaBoRo_test2 - backup 1

Who changed what in which revision?

UserRevisionLine numberNew contents of line
borlanic 0:02dd72d1d465 1 /* mbed Microcontroller Library
borlanic 0:02dd72d1d465 2 * Copyright (c) 2006-2012 ARM Limited
borlanic 0:02dd72d1d465 3 *
borlanic 0:02dd72d1d465 4 * Permission is hereby granted, free of charge, to any person obtaining a copy
borlanic 0:02dd72d1d465 5 * of this software and associated documentation files (the "Software"), to deal
borlanic 0:02dd72d1d465 6 * in the Software without restriction, including without limitation the rights
borlanic 0:02dd72d1d465 7 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
borlanic 0:02dd72d1d465 8 * copies of the Software, and to permit persons to whom the Software is
borlanic 0:02dd72d1d465 9 * furnished to do so, subject to the following conditions:
borlanic 0:02dd72d1d465 10 *
borlanic 0:02dd72d1d465 11 * The above copyright notice and this permission notice shall be included in
borlanic 0:02dd72d1d465 12 * all copies or substantial portions of the Software.
borlanic 0:02dd72d1d465 13 *
borlanic 0:02dd72d1d465 14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
borlanic 0:02dd72d1d465 15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
borlanic 0:02dd72d1d465 16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
borlanic 0:02dd72d1d465 17 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
borlanic 0:02dd72d1d465 18 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
borlanic 0:02dd72d1d465 19 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
borlanic 0:02dd72d1d465 20 * SOFTWARE.
borlanic 0:02dd72d1d465 21 */
borlanic 0:02dd72d1d465 22 #include "rtos/Mutex.h"
borlanic 0:02dd72d1d465 23 #include "rtos/Kernel.h"
borlanic 0:02dd72d1d465 24
borlanic 0:02dd72d1d465 25 #include <string.h>
borlanic 0:02dd72d1d465 26 #include "mbed_error.h"
borlanic 0:02dd72d1d465 27 #include "mbed_assert.h"
borlanic 0:02dd72d1d465 28
borlanic 0:02dd72d1d465 29 namespace rtos {
borlanic 0:02dd72d1d465 30
borlanic 0:02dd72d1d465 31 Mutex::Mutex(): _count(0)
borlanic 0:02dd72d1d465 32 {
borlanic 0:02dd72d1d465 33 constructor();
borlanic 0:02dd72d1d465 34 }
borlanic 0:02dd72d1d465 35
borlanic 0:02dd72d1d465 36 Mutex::Mutex(const char *name)
borlanic 0:02dd72d1d465 37 {
borlanic 0:02dd72d1d465 38 constructor(name);
borlanic 0:02dd72d1d465 39 }
borlanic 0:02dd72d1d465 40
borlanic 0:02dd72d1d465 41 void Mutex::constructor(const char *name)
borlanic 0:02dd72d1d465 42 {
borlanic 0:02dd72d1d465 43 memset(&_obj_mem, 0, sizeof(_obj_mem));
borlanic 0:02dd72d1d465 44 osMutexAttr_t attr = { 0 };
borlanic 0:02dd72d1d465 45 attr.name = name ? name : "aplication_unnamed_mutex";
borlanic 0:02dd72d1d465 46 attr.cb_mem = &_obj_mem;
borlanic 0:02dd72d1d465 47 attr.cb_size = sizeof(_obj_mem);
borlanic 0:02dd72d1d465 48 attr.attr_bits = osMutexRecursive | osMutexPrioInherit | osMutexRobust;
borlanic 0:02dd72d1d465 49 _id = osMutexNew(&attr);
borlanic 0:02dd72d1d465 50 MBED_ASSERT(_id);
borlanic 0:02dd72d1d465 51 }
borlanic 0:02dd72d1d465 52
borlanic 0:02dd72d1d465 53 osStatus Mutex::lock(uint32_t millisec) {
borlanic 0:02dd72d1d465 54 osStatus status = osMutexAcquire(_id, millisec);
borlanic 0:02dd72d1d465 55 if (osOK == status) {
borlanic 0:02dd72d1d465 56 _count++;
borlanic 0:02dd72d1d465 57 }
borlanic 0:02dd72d1d465 58 return status;
borlanic 0:02dd72d1d465 59 }
borlanic 0:02dd72d1d465 60
borlanic 0:02dd72d1d465 61 bool Mutex::trylock() {
borlanic 0:02dd72d1d465 62 return trylock_for(0);
borlanic 0:02dd72d1d465 63 }
borlanic 0:02dd72d1d465 64
borlanic 0:02dd72d1d465 65 bool Mutex::trylock_for(uint32_t millisec) {
borlanic 0:02dd72d1d465 66 osStatus status = lock(millisec);
borlanic 0:02dd72d1d465 67 if (status == osOK) {
borlanic 0:02dd72d1d465 68 return true;
borlanic 0:02dd72d1d465 69 }
borlanic 0:02dd72d1d465 70
borlanic 0:02dd72d1d465 71 MBED_ASSERT(status == osErrorTimeout || status == osErrorResource);
borlanic 0:02dd72d1d465 72
borlanic 0:02dd72d1d465 73 return false;
borlanic 0:02dd72d1d465 74 }
borlanic 0:02dd72d1d465 75
borlanic 0:02dd72d1d465 76 bool Mutex::trylock_until(uint64_t millisec) {
borlanic 0:02dd72d1d465 77 uint64_t now = Kernel::get_ms_count();
borlanic 0:02dd72d1d465 78
borlanic 0:02dd72d1d465 79 if (now >= millisec) {
borlanic 0:02dd72d1d465 80 return trylock();
borlanic 0:02dd72d1d465 81 } else if (millisec - now >= osWaitForever) {
borlanic 0:02dd72d1d465 82 // API permits early return
borlanic 0:02dd72d1d465 83 return trylock_for(osWaitForever - 1);
borlanic 0:02dd72d1d465 84 } else {
borlanic 0:02dd72d1d465 85 return trylock_for(millisec - now);
borlanic 0:02dd72d1d465 86 }
borlanic 0:02dd72d1d465 87 }
borlanic 0:02dd72d1d465 88
borlanic 0:02dd72d1d465 89 osStatus Mutex::unlock() {
borlanic 0:02dd72d1d465 90 _count--;
borlanic 0:02dd72d1d465 91 return osMutexRelease(_id);
borlanic 0:02dd72d1d465 92 }
borlanic 0:02dd72d1d465 93
borlanic 0:02dd72d1d465 94 osThreadId Mutex::get_owner() {
borlanic 0:02dd72d1d465 95 return osMutexGetOwner(_id);
borlanic 0:02dd72d1d465 96 }
borlanic 0:02dd72d1d465 97
borlanic 0:02dd72d1d465 98 Mutex::~Mutex() {
borlanic 0:02dd72d1d465 99 osMutexDelete(_id);
borlanic 0:02dd72d1d465 100 }
borlanic 0:02dd72d1d465 101
borlanic 0:02dd72d1d465 102 }