mbed-os

Dependents:   cobaLCDJoyMotor_Thread odometry_omni_3roda_v3 odometry_omni_3roda_v1 odometry_omni_3roda_v2 ... more

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