LCOV - code coverage report
Current view: top level - home/jason/ncs-2.0.0/modules/hal/nordic/nrfx/helpers - nrfx_flag32_allocator.c (source / functions) Hit Total Coverage
Test: coverage.info Lines: 8 18 44.4 %
Date: 2022-08-18 11:36:24 Functions: 1 3 33.3 %
Legend: Lines: hit not hit | Branches: + taken - not taken # not executed Branches: 2 8 25.0 %

           Branch data     Line data    Source code
       1                 :            : /*
       2                 :            :  * Copyright (c) 2021 - 2022, Nordic Semiconductor ASA
       3                 :            :  * All rights reserved.
       4                 :            :  *
       5                 :            :  * SPDX-License-Identifier: BSD-3-Clause
       6                 :            :  *
       7                 :            :  * Redistribution and use in source and binary forms, with or without
       8                 :            :  * modification, are permitted provided that the following conditions are met:
       9                 :            :  *
      10                 :            :  * 1. Redistributions of source code must retain the above copyright notice, this
      11                 :            :  *    list of conditions and the following disclaimer.
      12                 :            :  *
      13                 :            :  * 2. Redistributions in binary form must reproduce the above copyright
      14                 :            :  *    notice, this list of conditions and the following disclaimer in the
      15                 :            :  *    documentation and/or other materials provided with the distribution.
      16                 :            :  *
      17                 :            :  * 3. Neither the name of the copyright holder nor the names of its
      18                 :            :  *    contributors may be used to endorse or promote products derived from this
      19                 :            :  *    software without specific prior written permission.
      20                 :            :  *
      21                 :            :  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
      22                 :            :  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
      23                 :            :  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
      24                 :            :  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
      25                 :            :  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
      26                 :            :  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
      27                 :            :  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
      28                 :            :  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
      29                 :            :  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
      30                 :            :  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
      31                 :            :  * POSSIBILITY OF SUCH DAMAGE.
      32                 :            :  */
      33                 :            : #include <helpers/nrfx_flag32_allocator.h>
      34                 :            : 
      35                 :            : #if !defined(NRFX_ATOMIC_CAS)
      36                 :            : static bool nrfx_flag32_atomic_cas(nrfx_atomic_t * p_data, uint32_t old_value, uint32_t new_value)
      37                 :            : {
      38                 :            :     bool status = false;
      39                 :            :     NRFX_CRITICAL_SECTION_ENTER();
      40                 :            :     if (*p_data == old_value)
      41                 :            :     {
      42                 :            :         *p_data = new_value;
      43                 :            :         status = true;
      44                 :            :     }
      45                 :            :     NRFX_CRITICAL_SECTION_EXIT();
      46                 :            :     return status;
      47                 :            : }
      48                 :            : 
      49                 :            : #define NRFX_ATOMIC_CAS(p_data, old_value, new_value) \
      50                 :            :     nrfx_flag32_atomic_cas(p_data, old_value, new_value)
      51                 :            : #endif // !defined(NRFX_ATOMIC_CAS)
      52                 :            : 
      53                 :          0 : bool nrfx_flag32_is_allocated(nrfx_atomic_t mask, uint8_t bitpos)
      54                 :            : {
      55                 :          0 :     return (mask & NRFX_BIT(bitpos)) ? false : true;
      56                 :            : }
      57                 :            : 
      58                 :          1 : nrfx_err_t nrfx_flag32_alloc(nrfx_atomic_t * p_mask, uint8_t *p_flag)
      59                 :            : {
      60                 :            :     int8_t idx;
      61                 :            :     uint32_t new_mask, prev_mask;
      62                 :            : 
      63                 :            :     do {
      64                 :          1 :         prev_mask = *p_mask;
      65                 :          1 :         idx = 31 - NRF_CLZ(prev_mask);
      66         [ -  + ]:          1 :         if (idx < 0) {
      67                 :          0 :             return NRFX_ERROR_NO_MEM;
      68                 :            :         }
      69                 :            : 
      70                 :          1 :         new_mask = prev_mask & ~NRFX_BIT(idx);
      71         [ -  + ]:          1 :     } while (!NRFX_ATOMIC_CAS(p_mask, prev_mask, new_mask));
      72                 :            : 
      73                 :          1 :     *p_flag = idx;
      74                 :            : 
      75                 :          1 :     return NRFX_SUCCESS;
      76                 :            : }
      77                 :            : 
      78                 :          0 : nrfx_err_t nrfx_flag32_free(nrfx_atomic_t * p_mask, uint8_t flag)
      79                 :            : {
      80                 :            :     uint32_t new_mask, prev_mask;
      81                 :            : 
      82         [ #  # ]:          0 :     if ((NRFX_BIT(flag) & *p_mask))
      83                 :            :     {
      84                 :          0 :         return NRFX_ERROR_INVALID_PARAM;
      85                 :            :     }
      86                 :            : 
      87                 :            :     do {
      88                 :          0 :         prev_mask = *p_mask;
      89                 :          0 :         new_mask = prev_mask | NRFX_BIT(flag);
      90         [ #  # ]:          0 :     } while (!NRFX_ATOMIC_CAS(p_mask, prev_mask, new_mask));
      91                 :            : 
      92                 :          0 :     return NRFX_SUCCESS;
      93                 :            : }

Generated by: LCOV version 1.14