diff -r 000000000000 -r c40eb8fe8501 wlan_bearer/wlanengine/wlan_common/wlanengine_common_3.1/src/core_frame_ethernet.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/wlan_bearer/wlanengine/wlan_common/wlanengine_common_3.1/src/core_frame_ethernet.cpp Tue Feb 02 02:03:13 2010 +0200 @@ -0,0 +1,265 @@ +/* +* Copyright (c) 2006-2007 Nokia Corporation and/or its subsidiary(-ies). +* All rights reserved. +* This component and the accompanying materials are made available +* under the terms of the License "Eclipse Public License v1.0" +* which accompanies this distribution, and is available +* at the URL "http://www.eclipse.org/legal/epl-v10.html". +* +* Initial Contributors: +* Nokia Corporation - initial contribution. +* +* Contributors: +* +* Description: Class for parsing Ethernet frames +* +*/ + + +#include "core_frame_ethernet.h" +#include "core_tools.h" +#include "am_debug.h" + +const u16_t CORE_ETHERNET_MIN_LENGTH = 14; +const u16_t CORE_ETHERNET_DESTINATION_INDEX = 0; +const u16_t CORE_ETHERNET_SOURCE_INDEX = 6; +const u16_t CORE_ETHERNET_TYPE_INDEX = 12; + +// --------------------------------------------------------------------------- +// --------------------------------------------------------------------------- +// +core_frame_ethernet_c* core_frame_ethernet_c::instance( + u16_t data_length, + const u8_t* data, + bool_t is_copied ) + { + DEBUG( "core_frame_ethernet_c::instance()" ); + DEBUG1( "core_frame_ethernet_c::instance() - is_copied %u", + is_copied ); + + if ( data_length < CORE_ETHERNET_MIN_LENGTH ) + { + DEBUG( "core_frame_ethernet_c::instance() - not a valid Ethernet frame, frame is too short" ); + + return NULL; + } + + u8_t* buffer = const_cast( data ); + u16_t buffer_length( 0 ); + + if ( is_copied ) + { + buffer_length = data_length; + buffer = new u8_t[buffer_length]; + + if ( !buffer ) + { + DEBUG( "core_frame_ethernet_c::instance() - not able to allocate buffer for copying" ); + + return NULL; + } + + core_tools_c::copy( + buffer, + data, + buffer_length ); + } + + core_frame_ethernet_c* instance = new core_frame_ethernet_c( + data_length, + buffer, + buffer_length ); + if ( !instance ) + { + DEBUG( "core_frame_ethernet_c::instance() - unable to create an instance" ); + if ( is_copied ) + { + delete[] buffer; + } + + return NULL; + } + + return instance; + } + +// --------------------------------------------------------------------------- +// --------------------------------------------------------------------------- +// +core_frame_ethernet_c* core_frame_ethernet_c::instance( + u16_t max_data_length, + const core_mac_address_s& destination, + const core_mac_address_s& source, + u16_t type ) + { + DEBUG( "core_frame_ethernet_c::instance()" ); + + u8_t* buffer = new u8_t[max_data_length]; + if ( !buffer ) + { + DEBUG( "core_frame_ethernet_c::instance() - unable create the internal buffer" ); + } + + core_frame_ethernet_c* instance = + new core_frame_ethernet_c( 0, buffer, max_data_length ); + if ( !instance ) + { + DEBUG( "core_frame_ethernet_c::instance() - unable to create an instance" ); + delete[] buffer; + + return NULL; + } + + instance->generate( + destination, + source, + type ); + + return instance; + } + +// --------------------------------------------------------------------------- +// --------------------------------------------------------------------------- +// +core_frame_ethernet_c::~core_frame_ethernet_c() + { + DEBUG( "core_frame_ethernet_c::~core_frame_ethernet_c" ); + + /** + * If maximum frame length has been defined, we have allocated + * the frame buffer ourselves. + */ + if ( max_data_length_m ) + { + delete[] data_m; + } + + data_m = NULL; + } + +// --------------------------------------------------------------------------- +// --------------------------------------------------------------------------- +// +core_mac_address_s core_frame_ethernet_c::destination() const + { + return mac_address( CORE_ETHERNET_DESTINATION_INDEX ); + } + +// --------------------------------------------------------------------------- +// --------------------------------------------------------------------------- +// +core_mac_address_s core_frame_ethernet_c::source() const + { + return mac_address( CORE_ETHERNET_SOURCE_INDEX ); + } + +// --------------------------------------------------------------------------- +// --------------------------------------------------------------------------- +// +u16_t core_frame_ethernet_c::type() const + { + return core_tools_c::get_u16_big_endian( data_m, CORE_ETHERNET_TYPE_INDEX ); + } + +// --------------------------------------------------------------------------- +// --------------------------------------------------------------------------- +// +core_mac_address_s core_frame_ethernet_c::mac_address( + u16_t index ) const + { + core_mac_address_s mac( ZERO_MAC_ADDR ); + + core_tools_c::copy( + &mac.addr[0], + &data_m[index], + MAC_ADDR_LEN ); + + return mac; + } + +// --------------------------------------------------------------------------- +// --------------------------------------------------------------------------- +// +u16_t core_frame_ethernet_c::data_length() const + { + return data_length_m; + } + +// --------------------------------------------------------------------------- +// --------------------------------------------------------------------------- +// +const u8_t* core_frame_ethernet_c::data() const + { + return data_m; + } + +// --------------------------------------------------------------------------- +// --------------------------------------------------------------------------- +// +u16_t core_frame_ethernet_c::payload_data_length() const + { + return data_length_m - CORE_ETHERNET_MIN_LENGTH; + } + +// --------------------------------------------------------------------------- +// --------------------------------------------------------------------------- +// +const u8_t* core_frame_ethernet_c::payload_data() const + { + return data_m + CORE_ETHERNET_MIN_LENGTH; + } + +// --------------------------------------------------------------------------- +// --------------------------------------------------------------------------- +// +void core_frame_ethernet_c::core_frame_ethernet_c::generate( + const core_mac_address_s& destination, + const core_mac_address_s& source, + u16_t type ) + { + ASSERT( !data_length_m ); + ASSERT( max_data_length_m ); + + // Destination MAC + core_tools_c::copy( + &data_m[data_length_m], + &destination.addr[0], + MAC_ADDR_LEN ); + data_length_m += MAC_ADDR_LEN; + + // Source MAC + core_tools_c::copy( + &data_m[data_length_m], + &source.addr[0], + MAC_ADDR_LEN ); + data_length_m += MAC_ADDR_LEN; + + // Ethernet Type + u16_t temp16 = core_tools_c::convert_host_to_big_endian( + type ); + core_tools_c::copy( + &data_m[data_length_m], + reinterpret_cast( &temp16 ), + sizeof( temp16 ) ); + data_length_m += sizeof( temp16 ); + } + +// --------------------------------------------------------------------------- +// --------------------------------------------------------------------------- +// +core_frame_ethernet_c::core_frame_ethernet_c( + u16_t data_length, + const u8_t* data, + u16_t max_data_length ) : + data_length_m( data_length ), + data_m( NULL ), + max_data_length_m( max_data_length ) + { + DEBUG( "core_frame_ethernet_c::core_frame_ethernet_c" ); + + /** + * The reason the const is discarded is that the same pointer + * is used when we have allocated the frame buffer ourselves. + */ + data_m = const_cast( data ); + }