1

Committer:
valeyev
Date:
Tue Mar 13 07:17:50 2018 +0000
Revision:
0:e056ac8fecf8
looking for...

Who changed what in which revision?

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