Kenji Arai / mbed-os_TYBLE16

mbed-os5 only for TYBLE16

Dependents:   TYBLE16_simple_data_logger TYBLE16_MP3_Air

features/netsocket/NetStackMemoryManager.cpp@1:9db0e321a9f4, 2019-12-31 (annotated)

Committer:
kenjiArai
Date:
Tue Dec 31 06:02:27 2019 +0000
Revision:
1:9db0e321a9f4
Parent:
0:5b88d5760320 
updated based on mbed-os5.15.0

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kenjiArai 0:5b88d5760320 1 /*
kenjiArai 0:5b88d5760320 2 * Copyright (c) 2018 ARM Limited
kenjiArai 0:5b88d5760320 3 * SPDX-License-Identifier: Apache-2.0
kenjiArai 0:5b88d5760320 4 *
kenjiArai 0:5b88d5760320 5 * Licensed under the Apache License, Version 2.0 (the "License");
kenjiArai 0:5b88d5760320 6 * you may not use this file except in compliance with the License.
kenjiArai 0:5b88d5760320 7 * You may obtain a copy of the License at
kenjiArai 0:5b88d5760320 8 *
kenjiArai 0:5b88d5760320 9 * http://www.apache.org/licenses/LICENSE-2.0
kenjiArai 0:5b88d5760320 10 *
kenjiArai 0:5b88d5760320 11 * Unless required by applicable law or agreed to in writing, software
kenjiArai 0:5b88d5760320 12 * distributed under the License is distributed on an "AS IS" BASIS,
kenjiArai 0:5b88d5760320 13 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
kenjiArai 0:5b88d5760320 14 * See the License for the specific language governing permissions and
kenjiArai 0:5b88d5760320 15 * limitations under the License.
kenjiArai 0:5b88d5760320 16 */
kenjiArai 0:5b88d5760320 17
kenjiArai 0:5b88d5760320 18 #include "NetStackMemoryManager.h"
kenjiArai 0:5b88d5760320 19
kenjiArai 0:5b88d5760320 20 void NetStackMemoryManager::copy_to_buf(net_stack_mem_buf_t *to_buf, const void *ptr, uint32_t len)
kenjiArai 0:5b88d5760320 21 {
kenjiArai 0:5b88d5760320 22 while (to_buf && len) {
kenjiArai 0:5b88d5760320 23 void *copy_to_ptr = get_ptr(to_buf);
kenjiArai 0:5b88d5760320 24 uint32_t copy_to_len = get_len(to_buf);
kenjiArai 0:5b88d5760320 25
kenjiArai 0:5b88d5760320 26 if (copy_to_len > len) {
kenjiArai 0:5b88d5760320 27 copy_to_len = len;
kenjiArai 0:5b88d5760320 28 len = 0;
kenjiArai 0:5b88d5760320 29 } else {
kenjiArai 0:5b88d5760320 30 len -= copy_to_len;
kenjiArai 0:5b88d5760320 31 }
kenjiArai 0:5b88d5760320 32
kenjiArai 0:5b88d5760320 33 memcpy(copy_to_ptr, ptr, copy_to_len);
kenjiArai 0:5b88d5760320 34 ptr = static_cast<const uint8_t *>(ptr) + copy_to_len;
kenjiArai 0:5b88d5760320 35
kenjiArai 0:5b88d5760320 36 to_buf = get_next(to_buf);
kenjiArai 0:5b88d5760320 37 }
kenjiArai 0:5b88d5760320 38 }
kenjiArai 0:5b88d5760320 39
kenjiArai 0:5b88d5760320 40 uint32_t NetStackMemoryManager::copy_from_buf(void *ptr, uint32_t len, const net_stack_mem_buf_t *from_buf) const
kenjiArai 0:5b88d5760320 41 {
kenjiArai 0:5b88d5760320 42 uint32_t copied_len = 0;
kenjiArai 0:5b88d5760320 43
kenjiArai 0:5b88d5760320 44 while (from_buf && len) {
kenjiArai 0:5b88d5760320 45 void *copy_from_ptr = get_ptr(from_buf);
kenjiArai 0:5b88d5760320 46 uint32_t copy_from_len = get_len(from_buf);
kenjiArai 0:5b88d5760320 47
kenjiArai 0:5b88d5760320 48 if (copy_from_len > len) {
kenjiArai 0:5b88d5760320 49 copy_from_len = len;
kenjiArai 0:5b88d5760320 50 len = 0;
kenjiArai 0:5b88d5760320 51 } else {
kenjiArai 0:5b88d5760320 52 len -= copy_from_len;
kenjiArai 0:5b88d5760320 53 }
kenjiArai 0:5b88d5760320 54
kenjiArai 0:5b88d5760320 55 memcpy(ptr, copy_from_ptr, copy_from_len);
kenjiArai 0:5b88d5760320 56 ptr = static_cast<uint8_t *>(ptr) + copy_from_len;
kenjiArai 0:5b88d5760320 57 copied_len += copy_from_len;
kenjiArai 0:5b88d5760320 58
kenjiArai 0:5b88d5760320 59 from_buf = get_next(from_buf);
kenjiArai 0:5b88d5760320 60 }
kenjiArai 0:5b88d5760320 61
kenjiArai 0:5b88d5760320 62 return copied_len;
kenjiArai 0:5b88d5760320 63 }
kenjiArai 0:5b88d5760320 64