1 /*
2 * Copyright (c) 2020 - 2023, 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 Nordic Semiconductor ASA 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 */
34
35 /**@file nrf_802154_buffer_mgr_dst.c
36 * @brief Buffer management for destination peer of a nRF 802.15.4 serialization.
37 */
38
39 #include "nrf_802154_buffer_mgr_dst.h"
40
41 #include <assert.h>
42 #include <string.h>
43
nrf_802154_buffer_mgr_dst_init(nrf_802154_buffer_mgr_dst_t * p_obj,void * p_map_memory,void * p_allocator_memory,size_t buffers_count)44 void nrf_802154_buffer_mgr_dst_init(
45 nrf_802154_buffer_mgr_dst_t * p_obj,
46 void * p_map_memory,
47 void * p_allocator_memory,
48 size_t buffers_count)
49 {
50 nrf_802154_kvmap_init(&p_obj->map,
51 p_map_memory,
52 NRF_802154_BUFFER_MGR_DST_MAP_MEMSIZE(buffers_count),
53 sizeof(void *),
54 sizeof(uint32_t));
55
56 nrf_802154_buffer_allocator_init(&p_obj->allocator,
57 p_allocator_memory,
58 NRF_802154_BUFFER_ALLOCATOR_MEMORY_SIZE(buffers_count));
59 }
60
nrf_802154_buffer_mgr_dst_add(nrf_802154_buffer_mgr_dst_t * p_obj,uint32_t buffer_handle,const void * p_data,size_t data_size,void ** pp_local_pointer)61 bool nrf_802154_buffer_mgr_dst_add(
62 nrf_802154_buffer_mgr_dst_t * p_obj,
63 uint32_t buffer_handle,
64 const void * p_data,
65 size_t data_size,
66 void ** pp_local_pointer)
67 {
68 bool result = false;
69
70 *pp_local_pointer = nrf_802154_buffer_allocator_alloc(&p_obj->allocator);
71
72 if (*pp_local_pointer != NULL)
73 {
74 memcpy(*pp_local_pointer, p_data, data_size);
75 result = nrf_802154_kvmap_add(&p_obj->map, pp_local_pointer, &buffer_handle);
76
77 /* Allocator is a pool allocator of fixed size.
78 * If allocator managed to allocate, there must be place in the map.
79 */
80 assert(result);
81 }
82
83 return result;
84 }
85
nrf_802154_buffer_mgr_dst_search_by_local_pointer(nrf_802154_buffer_mgr_dst_t * p_obj,void * p_local_pointer,uint32_t * p_buffer_handle)86 bool nrf_802154_buffer_mgr_dst_search_by_local_pointer(
87 nrf_802154_buffer_mgr_dst_t * p_obj,
88 void * p_local_pointer,
89 uint32_t * p_buffer_handle)
90 {
91 return nrf_802154_kvmap_search(&p_obj->map, &p_local_pointer, p_buffer_handle);
92 }
93
nrf_802154_buffer_mgr_dst_remove_by_local_pointer(nrf_802154_buffer_mgr_dst_t * p_obj,void * p_local_pointer)94 bool nrf_802154_buffer_mgr_dst_remove_by_local_pointer(
95 nrf_802154_buffer_mgr_dst_t * p_obj,
96 void * p_local_pointer)
97 {
98 bool result;
99
100 result = nrf_802154_kvmap_remove(&p_obj->map, &p_local_pointer);
101 if (result)
102 {
103 nrf_802154_buffer_allocator_free(&p_obj->allocator, p_local_pointer);
104 }
105
106 return result;
107 }
108
