Nordic stack and drivers for the mbed BLE API
Dependents: Sensen-classic-v8-IAQ_copy_4
Fork of nRF51822 by
TARGET_MCU_NRF51822/sdk/source/ble/peer_manager/pm_mutex.c
- Committer:
- amithy
- Date:
- 2017-11-10
- Revision:
- 639:7f459d371b75
- Parent:
- 638:c90ae1400bf2
File content as of revision 639:7f459d371b75:
/* * Copyright (c) Nordic Semiconductor ASA * All rights reserved. * * Redistribution and use in source and binary forms, with or without modification, * are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, this * list of conditions and the following disclaimer. * * 2. Redistributions in binary form must reproduce the above copyright notice, this * list of conditions and the following disclaimer in the documentation and/or * other materials provided with the distribution. * * 3. Neither the name of Nordic Semiconductor ASA nor the names of other * contributors to this software may be used to endorse or promote products * derived from this software without specific prior written permission. * * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. * */ #include "pm_mutex.h" #include <stdbool.h> #include <string.h> #include "nrf_error.h" #include "app_util_platform.h" /**@brief Locks the mutex defined by the mask. * * @param p_mutex pointer to the mutex storage. * @param mutex_mask the mask identifying the mutex position. * * @retval true if the mutex could be locked. * @retval false if the mutex was already locked. */ static bool lock_by_mask(uint8_t * p_mutex, uint8_t mutex_mask) { bool success = false; if ( (*p_mutex & mutex_mask) == 0 ) { CRITICAL_REGION_ENTER(); if ( (*p_mutex & mutex_mask) == 0 ) { *p_mutex |= mutex_mask; success = true; } CRITICAL_REGION_EXIT(); } return ( success ); } void pm_mutex_init(uint8_t * p_mutex, uint16_t mutex_size) { if (p_mutex != NULL) { memset(&p_mutex[0], 0, MUTEX_STORAGE_SIZE(mutex_size)); } } bool pm_mutex_lock(uint8_t * p_mutex, uint16_t mutex_id) { if (p_mutex != NULL) { return ( lock_by_mask(&(p_mutex[mutex_id >> 3]), (1 << (mutex_id & 0x07))) ); } else { return false; } } void pm_mutex_unlock(uint8_t * p_mutex, uint16_t mutex_id) { uint8_t mutex_base = mutex_id >> 3; uint8_t mutex_mask = (1 << (mutex_id & 0x07)); if ((p_mutex != NULL) && (p_mutex[mutex_base] & mutex_mask)) { CRITICAL_REGION_ENTER(); p_mutex[mutex_base] &= ~mutex_mask; CRITICAL_REGION_EXIT(); } } uint16_t pm_mutex_lock_first_available(uint8_t * p_mutex, uint16_t mutex_size) { if (p_mutex != NULL) { for ( uint16_t i = 0; i < mutex_size; i++ ) { if ( lock_by_mask(&(p_mutex[i >> 3]), 1 << (i & 0x07)) ) { return ( i ); } } } return ( mutex_size ); } bool pm_mutex_lock_status_get(uint8_t * p_mutex, uint16_t mutex_id) { if (p_mutex != NULL) { return ( (p_mutex[mutex_id >> 3] & (1 << (mutex_id & 0x07))) ); } else { return true; } }