mirror of https://github.com/ARMmbed/mbed-os.git
				
				
				
			
		
			
				
	
	
		
			103 lines
		
	
	
		
			2.7 KiB
		
	
	
	
		
			C++
		
	
	
			
		
		
	
	
			103 lines
		
	
	
		
			2.7 KiB
		
	
	
	
		
			C++
		
	
	
/* mbed Microcontroller Library
 | 
						|
 * Copyright (c) 2006-2012 ARM Limited
 | 
						|
 *
 | 
						|
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 | 
						|
 * of this software and associated documentation files (the "Software"), to deal
 | 
						|
 * in the Software without restriction, including without limitation the rights
 | 
						|
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 | 
						|
 * copies of the Software, and to permit persons to whom the Software is
 | 
						|
 * furnished to do so, subject to the following conditions:
 | 
						|
 *
 | 
						|
 * The above copyright notice and this permission notice shall be included in
 | 
						|
 * all copies or substantial portions of the Software.
 | 
						|
 *
 | 
						|
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 | 
						|
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 | 
						|
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
 | 
						|
 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 | 
						|
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 | 
						|
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
 | 
						|
 * SOFTWARE.
 | 
						|
 */
 | 
						|
#include "rtos/Mutex.h"
 | 
						|
#include "rtos/Kernel.h"
 | 
						|
 | 
						|
#include <string.h>
 | 
						|
#include "mbed_error.h"
 | 
						|
#include "mbed_assert.h"
 | 
						|
 | 
						|
namespace rtos {
 | 
						|
 | 
						|
Mutex::Mutex(): _count(0)
 | 
						|
{
 | 
						|
    constructor();
 | 
						|
}
 | 
						|
 | 
						|
Mutex::Mutex(const char *name)
 | 
						|
{
 | 
						|
    constructor(name);
 | 
						|
}
 | 
						|
 | 
						|
void Mutex::constructor(const char *name)
 | 
						|
{
 | 
						|
    memset(&_obj_mem, 0, sizeof(_obj_mem));
 | 
						|
    osMutexAttr_t attr = { 0 };
 | 
						|
    attr.name = name ? name : "aplication_unnamed_mutex";
 | 
						|
    attr.cb_mem = &_obj_mem;
 | 
						|
    attr.cb_size = sizeof(_obj_mem);
 | 
						|
    attr.attr_bits = osMutexRecursive | osMutexPrioInherit | osMutexRobust;
 | 
						|
    _id = osMutexNew(&attr);
 | 
						|
    MBED_ASSERT(_id);
 | 
						|
}
 | 
						|
 | 
						|
osStatus Mutex::lock(uint32_t millisec) {
 | 
						|
    osStatus status = osMutexAcquire(_id, millisec);
 | 
						|
    if (osOK == status) {
 | 
						|
        _count++;
 | 
						|
    }
 | 
						|
    return status;
 | 
						|
}
 | 
						|
 | 
						|
bool Mutex::trylock() {
 | 
						|
    return trylock_for(0);
 | 
						|
}
 | 
						|
 | 
						|
bool Mutex::trylock_for(uint32_t millisec) {
 | 
						|
    osStatus status = lock(millisec);
 | 
						|
    if (status == osOK) {
 | 
						|
        return true;
 | 
						|
    }
 | 
						|
 | 
						|
    MBED_ASSERT(status == osErrorTimeout || status == osErrorResource);
 | 
						|
 | 
						|
    return false;
 | 
						|
}
 | 
						|
 | 
						|
bool Mutex::trylock_until(uint64_t millisec) {
 | 
						|
    uint64_t now = Kernel::get_ms_count();
 | 
						|
 | 
						|
    if (now >= millisec) {
 | 
						|
        return trylock();
 | 
						|
    } else if (millisec - now >= osWaitForever) {
 | 
						|
        // API permits early return
 | 
						|
        return trylock_for(osWaitForever - 1);
 | 
						|
    } else {
 | 
						|
        return trylock_for(millisec - now);
 | 
						|
    }
 | 
						|
}
 | 
						|
 | 
						|
osStatus Mutex::unlock() {
 | 
						|
    _count--;
 | 
						|
    return osMutexRelease(_id);
 | 
						|
}
 | 
						|
 | 
						|
osThreadId Mutex::get_owner() {
 | 
						|
    return osMutexGetOwner(_id);
 | 
						|
}
 | 
						|
 | 
						|
Mutex::~Mutex() {
 | 
						|
    osMutexDelete(_id);
 | 
						|
}
 | 
						|
 | 
						|
}
 |