Kevin Kadooka / mbed-dev

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Fork of mbed-dev by mbed official

targets/TARGET_NORDIC/TARGET_NRF5/sdk/ble/peer_manager/pm_mutex.c@167:356ef919c855, 2017-06-20 (annotated)

Committer:
kkado
Date:
Tue Jun 20 11:06:37 2017 +0000
Revision:
167:356ef919c855
Parent:
149:156823d33999 
Build 137 with reduced HSE timeout

Who changed what in which revision?

UserRevisionLine numberNew contents of line
<> 144:ef7eb2e8f9f7 1 /*
<> 144:ef7eb2e8f9f7 2 * Copyright (c) 2015 Nordic Semiconductor ASA
<> 144:ef7eb2e8f9f7 3 * All rights reserved.
<> 144:ef7eb2e8f9f7 4 *
<> 144:ef7eb2e8f9f7 5 * Redistribution and use in source and binary forms, with or without modification,
<> 144:ef7eb2e8f9f7 6 * are permitted provided that the following conditions are met:
<> 144:ef7eb2e8f9f7 7 *
<> 144:ef7eb2e8f9f7 8 * 1. Redistributions of source code must retain the above copyright notice, this list
<> 144:ef7eb2e8f9f7 9 * of conditions and the following disclaimer.
<> 144:ef7eb2e8f9f7 10 *
<> 144:ef7eb2e8f9f7 11 * 2. Redistributions in binary form, except as embedded into a Nordic Semiconductor ASA
<> 144:ef7eb2e8f9f7 12 * integrated circuit in a product or a software update for such product, must reproduce
<> 144:ef7eb2e8f9f7 13 * the above copyright notice, this list of conditions and the following disclaimer in
<> 144:ef7eb2e8f9f7 14 * the documentation and/or other materials provided with the distribution.
<> 144:ef7eb2e8f9f7 15 *
<> 144:ef7eb2e8f9f7 16 * 3. Neither the name of Nordic Semiconductor ASA nor the names of its contributors may be
<> 144:ef7eb2e8f9f7 17 * used to endorse or promote products derived from this software without specific prior
<> 144:ef7eb2e8f9f7 18 * written permission.
<> 144:ef7eb2e8f9f7 19 *
<> 144:ef7eb2e8f9f7 20 * 4. This software, with or without modification, must only be used with a
<> 144:ef7eb2e8f9f7 21 * Nordic Semiconductor ASA integrated circuit.
<> 144:ef7eb2e8f9f7 22 *
<> 144:ef7eb2e8f9f7 23 * 5. Any software provided in binary or object form under this license must not be reverse
<> 144:ef7eb2e8f9f7 24 * engineered, decompiled, modified and/or disassembled.
<> 144:ef7eb2e8f9f7 25 *
<> 144:ef7eb2e8f9f7 26 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
<> 144:ef7eb2e8f9f7 27 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
<> 144:ef7eb2e8f9f7 28 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
<> 144:ef7eb2e8f9f7 29 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR
<> 144:ef7eb2e8f9f7 30 * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
<> 144:ef7eb2e8f9f7 31 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
<> 144:ef7eb2e8f9f7 32 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
<> 144:ef7eb2e8f9f7 33 * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
<> 144:ef7eb2e8f9f7 34 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
<> 144:ef7eb2e8f9f7 35 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
<> 144:ef7eb2e8f9f7 36 *
<> 144:ef7eb2e8f9f7 37 */
<> 144:ef7eb2e8f9f7 38
<> 144:ef7eb2e8f9f7 39
<> 144:ef7eb2e8f9f7 40
<> 144:ef7eb2e8f9f7 41 #include "pm_mutex.h"
<> 144:ef7eb2e8f9f7 42
<> 144:ef7eb2e8f9f7 43 #include <stdbool.h>
<> 144:ef7eb2e8f9f7 44 #include <string.h>
<> 144:ef7eb2e8f9f7 45 #include "nrf_error.h"
<> 144:ef7eb2e8f9f7 46 #include "app_util_platform.h"
<> 144:ef7eb2e8f9f7 47
<> 144:ef7eb2e8f9f7 48
<> 144:ef7eb2e8f9f7 49
<> 144:ef7eb2e8f9f7 50 /**@brief Locks the mutex defined by the mask.
<> 144:ef7eb2e8f9f7 51 *
<> 144:ef7eb2e8f9f7 52 * @param p_mutex pointer to the mutex storage.
<> 144:ef7eb2e8f9f7 53 * @param mutex_mask the mask identifying the mutex position.
<> 144:ef7eb2e8f9f7 54 *
<> 144:ef7eb2e8f9f7 55 * @retval true if the mutex could be locked.
<> 144:ef7eb2e8f9f7 56 * @retval false if the mutex was already locked.
<> 144:ef7eb2e8f9f7 57 */
<> 144:ef7eb2e8f9f7 58 static bool lock_by_mask(uint8_t * p_mutex, uint8_t mutex_mask)
<> 144:ef7eb2e8f9f7 59 {
<> 144:ef7eb2e8f9f7 60 bool success = false;
<> 144:ef7eb2e8f9f7 61
<> 144:ef7eb2e8f9f7 62 if ( (*p_mutex & mutex_mask) == 0 )
<> 144:ef7eb2e8f9f7 63 {
<> 144:ef7eb2e8f9f7 64 CRITICAL_REGION_ENTER();
<> 144:ef7eb2e8f9f7 65 if ( (*p_mutex & mutex_mask) == 0 )
<> 144:ef7eb2e8f9f7 66 {
<> 144:ef7eb2e8f9f7 67 *p_mutex |= mutex_mask;
<> 144:ef7eb2e8f9f7 68
<> 144:ef7eb2e8f9f7 69 success = true;
<> 144:ef7eb2e8f9f7 70 }
<> 144:ef7eb2e8f9f7 71 CRITICAL_REGION_EXIT();
<> 144:ef7eb2e8f9f7 72 }
<> 144:ef7eb2e8f9f7 73
<> 144:ef7eb2e8f9f7 74 return ( success );
<> 144:ef7eb2e8f9f7 75 }
<> 144:ef7eb2e8f9f7 76
<> 144:ef7eb2e8f9f7 77
<> 144:ef7eb2e8f9f7 78 void pm_mutex_init(uint8_t * p_mutex, uint16_t mutex_size)
<> 144:ef7eb2e8f9f7 79 {
<> 144:ef7eb2e8f9f7 80 if (p_mutex != NULL)
<> 144:ef7eb2e8f9f7 81 {
<> 144:ef7eb2e8f9f7 82 memset(&p_mutex[0], 0, MUTEX_STORAGE_SIZE(mutex_size));
<> 144:ef7eb2e8f9f7 83 }
<> 144:ef7eb2e8f9f7 84 }
<> 144:ef7eb2e8f9f7 85
<> 144:ef7eb2e8f9f7 86
<> 144:ef7eb2e8f9f7 87 bool pm_mutex_lock(uint8_t * p_mutex, uint16_t mutex_id)
<> 144:ef7eb2e8f9f7 88 {
<> 144:ef7eb2e8f9f7 89 if (p_mutex != NULL)
<> 144:ef7eb2e8f9f7 90 {
<> 144:ef7eb2e8f9f7 91 return ( lock_by_mask(&(p_mutex[mutex_id >> 3]), (1 << (mutex_id & 0x07))) );
<> 144:ef7eb2e8f9f7 92 }
<> 144:ef7eb2e8f9f7 93 else
<> 144:ef7eb2e8f9f7 94 {
<> 144:ef7eb2e8f9f7 95 return false;
<> 144:ef7eb2e8f9f7 96 }
<> 144:ef7eb2e8f9f7 97 }
<> 144:ef7eb2e8f9f7 98
<> 144:ef7eb2e8f9f7 99
<> 144:ef7eb2e8f9f7 100 void pm_mutex_unlock(uint8_t * p_mutex, uint16_t mutex_id)
<> 144:ef7eb2e8f9f7 101 {
<> 144:ef7eb2e8f9f7 102 uint8_t mutex_base = mutex_id >> 3;
<> 144:ef7eb2e8f9f7 103 uint8_t mutex_mask = (1 << (mutex_id & 0x07));
<> 144:ef7eb2e8f9f7 104
<> 144:ef7eb2e8f9f7 105 if ((p_mutex != NULL)
<> 144:ef7eb2e8f9f7 106 && (p_mutex[mutex_base] & mutex_mask))
<> 144:ef7eb2e8f9f7 107 {
<> 144:ef7eb2e8f9f7 108 CRITICAL_REGION_ENTER();
<> 144:ef7eb2e8f9f7 109 p_mutex[mutex_base] &= ~mutex_mask;
<> 144:ef7eb2e8f9f7 110 CRITICAL_REGION_EXIT();
<> 144:ef7eb2e8f9f7 111 }
<> 144:ef7eb2e8f9f7 112 }
<> 144:ef7eb2e8f9f7 113
<> 144:ef7eb2e8f9f7 114
<> 144:ef7eb2e8f9f7 115 uint16_t pm_mutex_lock_first_available(uint8_t * p_mutex, uint16_t mutex_size)
<> 144:ef7eb2e8f9f7 116 {
<> 144:ef7eb2e8f9f7 117 if (p_mutex != NULL)
<> 144:ef7eb2e8f9f7 118 {
<> 144:ef7eb2e8f9f7 119 for ( uint16_t i = 0; i < mutex_size; i++ )
<> 144:ef7eb2e8f9f7 120 {
<> 144:ef7eb2e8f9f7 121 if ( lock_by_mask(&(p_mutex[i >> 3]), 1 << (i & 0x07)) )
<> 144:ef7eb2e8f9f7 122 {
<> 144:ef7eb2e8f9f7 123 return ( i );
<> 144:ef7eb2e8f9f7 124 }
<> 144:ef7eb2e8f9f7 125 }
<> 144:ef7eb2e8f9f7 126 }
<> 144:ef7eb2e8f9f7 127
<> 144:ef7eb2e8f9f7 128 return ( mutex_size );
<> 144:ef7eb2e8f9f7 129 }
<> 144:ef7eb2e8f9f7 130
<> 144:ef7eb2e8f9f7 131
<> 144:ef7eb2e8f9f7 132 bool pm_mutex_lock_status_get(uint8_t * p_mutex, uint16_t mutex_id)
<> 144:ef7eb2e8f9f7 133 {
<> 144:ef7eb2e8f9f7 134 if (p_mutex != NULL)
<> 144:ef7eb2e8f9f7 135 {
<> 144:ef7eb2e8f9f7 136 return ( (p_mutex[mutex_id >> 3] & (1 << (mutex_id & 0x07))) );
<> 144:ef7eb2e8f9f7 137 }
<> 144:ef7eb2e8f9f7 138 else
<> 144:ef7eb2e8f9f7 139 {
<> 144:ef7eb2e8f9f7 140 return true;
<> 144:ef7eb2e8f9f7 141 }
<> 144:ef7eb2e8f9f7 142 }