mirror of https://github.com/ARMmbed/mbed-os.git
84 lines
2.7 KiB
C++
84 lines
2.7 KiB
C++
|
/*
|
||
|
|
* Copyright (c) 2017, ARM Limited, All Rights Reserved
|
||
|
|
* SPDX-License-Identifier: Apache-2.0
|
||
|
|
*
|
||
|
|
* Licensed under the Apache License, Version 2.0 (the "License"); you may
|
||
|
|
* not use this file except in compliance with the License.
|
||
|
|
* You may obtain a copy of the License at
|
||
|
|
*
|
||
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
||
|
|
*
|
||
|
|
* Unless required by applicable law or agreed to in writing, software
|
||
|
|
* distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
|
||
|
|
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||
|
|
* See the License for the specific language governing permissions and
|
||
|
|
* limitations under the License.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include "mbed.h"
|
||
|
|
#include "greentea-client/test_env.h"
|
||
|
|
#include "unity.h"
|
||
|
|
#include "utest.h"
|
||
|
|
|
||
|
|
#if MBED_CONF_APP_TEST_WIFI || MBED_CONF_APP_TEST_ETHERNET
|
||
|
|
|
||
|
|
#include "lwip/opt.h" /* ETH_PAD_SIZE */
|
||
|
|
|
||
|
|
#include "emac_api.h"
|
||
|
|
#include "emac_stack_mem.h"
|
||
|
|
|
||
|
|
#include "emac_membuf.h"
|
||
|
|
#include "emac_util.h"
|
||
|
|
|
||
|
|
int emac_if_memory_buffer_read(emac_stack_mem_chain_t *mem_chain_p, unsigned char *eth_frame)
|
||
|
|
{
|
||
|
|
int eth_frame_index = 0;
|
||
|
|
int invalid_data_index = 0;
|
||
|
|
int index = ETH_PAD_SIZE;
|
||
|
|
|
||
|
|
for (emac_stack_mem_t *mem_p = emac_stack_mem_chain_dequeue(0, &mem_chain_p); mem_p != NULL; mem_p = emac_stack_mem_chain_dequeue(0, &mem_chain_p)) {
|
||
|
|
unsigned char *buf_payload = (unsigned char *) emac_stack_mem_ptr(0, mem_p);
|
||
|
|
int buf_payload_len = emac_stack_mem_len(0, mem_p);
|
||
|
|
|
||
|
|
for (; index < buf_payload_len; index++) {
|
||
|
|
if (eth_frame_index < ETH_FRAME_HEADER_LEN) {
|
||
|
|
eth_frame[eth_frame_index] = buf_payload[index];
|
||
|
|
} else {
|
||
|
|
if (buf_payload[index] != (uint8_t) eth_frame_index) {
|
||
|
|
invalid_data_index = eth_frame_index;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
eth_frame_index++;
|
||
|
|
}
|
||
|
|
index = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
return invalid_data_index;
|
||
|
|
}
|
||
|
|
|
||
|
|
void emac_if_memory_buffer_write(emac_stack_mem_chain_t *mem_chain_p, unsigned char *eth_frame, bool write_data)
|
||
|
|
{
|
||
|
|
int eth_frame_index = 0;
|
||
|
|
int index = ETH_PAD_SIZE;
|
||
|
|
|
||
|
|
for (emac_stack_mem_t *mem_p = emac_stack_mem_chain_dequeue(0, &mem_chain_p); mem_p != NULL; mem_p = emac_stack_mem_chain_dequeue(0, &mem_chain_p)) {
|
||
|
|
unsigned char *buf_payload = (unsigned char *) emac_stack_mem_ptr(0, mem_p);
|
||
|
|
int buf_payload_len = emac_stack_mem_len(0, mem_p);
|
||
|
|
|
||
|
|
for (; index < buf_payload_len; index++) {
|
||
|
|
if (eth_frame_index < ETH_FRAME_HEADER_LEN) {
|
||
|
|
buf_payload[index] = eth_frame[eth_frame_index];
|
||
|
|
} else if (write_data) {
|
||
|
|
buf_payload[index] = (char) eth_frame_index;
|
||
|
|
} else {
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
eth_frame_index++;
|
||
|
|
}
|
||
|
|
index = 0;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
#endif
|