0,0 → 1,351 |
/* |
* Copyright (c) 2009 Lukas Mejdrech |
* All rights reserved. |
* |
* Redistribution and use in source and binary forms, with or without |
* modification, are permitted provided that the following conditions |
* are met: |
* |
* - Redistributions of source code must retain the above copyright |
* notice, this list of conditions and the following disclaimer. |
* - Redistributions in binary form must reproduce the above copyright |
* notice, this list of conditions and the following disclaimer in the |
* documentation and/or other materials provided with the distribution. |
* - The name of the author may not be used to endorse or promote products |
* derived from this software without specific prior written permission. |
* |
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
*/ |
|
/** @addtogroup nildummy |
* @{ |
*/ |
|
/** @file |
* Dummy network interface layer module implementation. |
* @see nildummy.h |
*/ |
|
#include <async.h> |
#include <malloc.h> |
#include <mem.h> |
#include <stdio.h> |
#include <string.h> |
|
#include <ipc/ipc.h> |
#include <ipc/services.h> |
|
#include "../../err.h" |
#include "../../messages.h" |
#include "../../modules.h" |
|
#include "../../include/device.h" |
#include "../../include/netif_interface.h" |
#include "../../include/nil_interface.h" |
#include "../../include/il_interface.h" |
|
#include "../../structures/measured_strings.h" |
#include "../../structures/packet/packet.h" |
|
#include "../nil_module.h" |
|
#include "nildummy.h" |
|
/** Default maximum transmission unit. |
*/ |
#define DEFAULT_MTU 1500 |
|
/** Network interface layer module global data. |
*/ |
nildummy_globals_t nildummy_globals; |
|
/** Processes IPC messages from the registered device driver modules in an infinite loop. |
* @param iid The message identifier. Input parameter. |
* @param icall The message parameters. Input/output parameter. |
*/ |
void nildummy_receiver( ipc_callid_t iid, ipc_call_t * icall ); |
|
/** Registers new device or updates the MTU of an existing one. |
* Determines the device local hardware address. |
* @param device_id The new device identifier. Input parameter. |
* @param service The device driver service. Input parameter. |
* @param mtu The device maximum transmission unit. Input parameter. |
* @returns EOK on success. |
* @returns EEXIST if the device with the different service exists. |
* @returns ENOMEM if there is not enough memory left. |
* @returns Other error codes as defined for the netif_bind_service() function. |
* @returns Other error codes as defined for the netif_get_addr() function. |
*/ |
int nildummy_device_message( device_id_t device_id, services_t service, size_t mtu ); |
|
/** Returns the device packet dimensions for sending. |
* @param device_id The device identifier. Input parameter. |
* @param addr_len The minimum reserved address length. Output parameter. |
* @param prefix The minimum reserved prefix size. Output parameter. |
* @param content The maximum content size. Output parameter. |
* @param suffix The minimum reserved suffix size. Output parameter. |
* @returns EOK on success. |
* @returns EBADMEM if either one of the parameters is NULL. |
* @returns ENOENT if there is no such device. |
*/ |
int nildummy_packet_space_message( device_id_t device_id, size_t * addr_len, size_t * prefix, size_t * content, size_t * suffix ); |
|
/** Registers receiving module service. |
* Passes received packets for this service. |
* @param service The module service. Input parameter. |
* @param phone The service phone. Input parameter. |
* @returns EOK on success. |
* @returns ENOENT if the service is not known. |
* @returns ENOMEM if there is not enough memory left. |
*/ |
int nildummy_register_message( services_t service, int phone ); |
|
/** Sends the packet queue. |
* @param device_id The device identifier. Input parameter. |
* @param packet The packet queue. Input parameter. |
* @param sender The sending module service. Input parameter. |
* @returns EOK on success. |
* @returns ENOENT if there no such device. |
* @returns EINVAL if the service parameter is not known. |
*/ |
int nildummy_send_message( device_id_t device_id, packet_t packet, services_t sender ); |
|
/** Returns the device hardware address. |
* @param device_id The device identifier. Input parameter. |
* @param type Type of the desired address. Input parameter |
* @param address The device hardware address. Output parameter. |
* @returns EOK on success. |
* @returns EBADMEM if the address parameter is NULL. |
* @returns ENOENT if there no such device. |
*/ |
int nildummy_addr_message( device_id_t device_id, measured_string_ref * address ); |
|
DEVICE_MAP_IMPLEMENT( nildummy_devices, nildummy_device_t ) |
|
int nil_device_state_msg( int nil_phone, device_id_t device_id, int state ){ |
fibril_rwlock_read_lock( & nildummy_globals.protos_lock ); |
if( nildummy_globals.proto.phone ) il_device_state_msg( nildummy_globals.proto.phone, device_id, state, nildummy_globals.proto.service ); |
fibril_rwlock_read_unlock( & nildummy_globals.protos_lock ); |
return EOK; |
} |
|
int nil_initialize( int net_phone ){ |
ERROR_DECLARE; |
|
fibril_rwlock_initialize( & nildummy_globals.devices_lock ); |
fibril_rwlock_initialize( & nildummy_globals.protos_lock ); |
fibril_rwlock_write_lock( & nildummy_globals.devices_lock ); |
fibril_rwlock_write_lock( & nildummy_globals.protos_lock ); |
nildummy_globals.net_phone = net_phone; |
nildummy_globals.proto.phone = 0; |
ERROR_PROPAGATE( nildummy_devices_initialize( & nildummy_globals.devices )); |
fibril_rwlock_write_unlock( & nildummy_globals.protos_lock ); |
fibril_rwlock_write_unlock( & nildummy_globals.devices_lock ); |
return EOK; |
} |
|
int nildummy_device_message( device_id_t device_id, services_t service, size_t mtu ){ |
ERROR_DECLARE; |
|
nildummy_device_ref device; |
int index; |
|
fibril_rwlock_write_lock( & nildummy_globals.devices_lock ); |
// an existing device? |
device = nildummy_devices_find( & nildummy_globals.devices, device_id ); |
if( device ){ |
if( device->service != service ){ |
printf( "Device %d already exists\n", device->device_id ); |
fibril_rwlock_write_unlock( & nildummy_globals.devices_lock ); |
return EEXIST; |
}else{ |
// update mtu |
device->mtu = mtu; |
printf( "Device %d already exists:\tMTU\t= %d\n", device->device_id, device->mtu ); |
fibril_rwlock_write_unlock( & nildummy_globals.devices_lock ); |
// notify the upper layer module |
fibril_rwlock_read_lock( & nildummy_globals.protos_lock ); |
if( nildummy_globals.proto.phone ){ |
il_mtu_changed_msg( nildummy_globals.proto.phone, device->device_id, device->mtu, nildummy_globals.proto.service ); |
} |
fibril_rwlock_read_unlock( & nildummy_globals.protos_lock ); |
return EOK; |
} |
}else{ |
// create a new device |
device = ( nildummy_device_ref ) malloc( sizeof( nildummy_device_t )); |
if( ! device ) return ENOMEM; |
device->device_id = device_id; |
device->service = service; |
if( mtu > 0 ){ |
device->mtu = mtu; |
}else{ |
device->mtu = DEFAULT_MTU; |
} |
// bind the device driver |
device->phone = netif_bind_service( device->service, device->device_id, SERVICE_ETHERNET, nildummy_receiver ); |
if( device->phone < 0 ){ |
fibril_rwlock_write_unlock( & nildummy_globals.devices_lock ); |
free( device ); |
return device->phone; |
} |
// get hardware address |
if( ERROR_OCCURRED( netif_get_addr( device->phone, device->device_id, & device->addr, & device->addr_data ))){ |
fibril_rwlock_write_unlock( & nildummy_globals.devices_lock ); |
free( device ); |
return ERROR_CODE; |
} |
// add to the cache |
index = nildummy_devices_add( & nildummy_globals.devices, device->device_id, device ); |
if( index < 0 ){ |
fibril_rwlock_write_unlock( & nildummy_globals.devices_lock ); |
free( device->addr ); |
free( device->addr_data ); |
free( device ); |
return index; |
} |
printf( "New device registered:\n\tid\t= %d\n\tservice\t= %d\n\tMTU\t= %d\n", device->device_id, device->service, device->mtu ); |
} |
fibril_rwlock_write_unlock( & nildummy_globals.devices_lock ); |
return EOK; |
} |
|
int nildummy_addr_message( device_id_t device_id, measured_string_ref * address ){ |
nildummy_device_ref device; |
|
if( ! address ) return EBADMEM; |
fibril_rwlock_read_lock( & nildummy_globals.devices_lock ); |
device = nildummy_devices_find( & nildummy_globals.devices, device_id ); |
if( ! device ){ |
fibril_rwlock_read_unlock( & nildummy_globals.devices_lock ); |
return ENOENT; |
} |
* address = device->addr; |
fibril_rwlock_read_unlock( & nildummy_globals.devices_lock ); |
return ( * address ) ? EOK : ENOENT; |
} |
|
int nildummy_packet_space_message( device_id_t device_id, size_t * addr_len, size_t * prefix, size_t * content, size_t * suffix ){ |
nildummy_device_ref device; |
|
if( !( addr_len && prefix && content && suffix )) return EBADMEM; |
fibril_rwlock_read_lock( & nildummy_globals.devices_lock ); |
device = nildummy_devices_find( & nildummy_globals.devices, device_id ); |
if( ! device ){ |
fibril_rwlock_read_unlock( & nildummy_globals.devices_lock ); |
return ENOENT; |
} |
* content = device->mtu; |
fibril_rwlock_read_unlock( & nildummy_globals.devices_lock ); |
* addr_len = 0; |
* prefix = 0; |
* suffix = 0; |
return EOK; |
} |
|
int nil_received_msg( int nil_phone, device_id_t device_id, packet_t packet, services_t target ){ |
packet_t next; |
|
fibril_rwlock_read_lock( & nildummy_globals.protos_lock ); |
if( nildummy_globals.proto.phone ){ |
do{ |
next = pq_detach( packet ); |
il_received_msg( nildummy_globals.proto.phone, device_id, packet, nildummy_globals.proto.service ); |
packet = next; |
}while( packet ); |
} |
fibril_rwlock_read_unlock( & nildummy_globals.protos_lock ); |
return EOK; |
} |
|
int nildummy_register_message( services_t service, int phone ){ |
fibril_rwlock_write_lock( & nildummy_globals.protos_lock ); |
nildummy_globals.proto.service = service; |
nildummy_globals.proto.phone = phone; |
printf( "New protocol registered:\n\tservice\t= %d\n\tphone\t= %d\n", nildummy_globals.proto.service, nildummy_globals.proto.phone ); |
fibril_rwlock_write_unlock( & nildummy_globals.protos_lock ); |
return EOK; |
} |
|
int nildummy_send_message( device_id_t device_id, packet_t packet, services_t sender ){ |
nildummy_device_ref device; |
|
fibril_rwlock_read_lock( & nildummy_globals.devices_lock ); |
device = nildummy_devices_find( & nildummy_globals.devices, device_id ); |
if( ! device ){ |
fibril_rwlock_read_unlock( & nildummy_globals.devices_lock ); |
return ENOENT; |
} |
// send packet queue |
if( packet ){ |
netif_send_msg( device->phone, device_id, packet, SERVICE_NILDUMMY ); |
} |
fibril_rwlock_read_unlock( & nildummy_globals.devices_lock ); |
return EOK; |
} |
|
int nil_message( ipc_callid_t callid, ipc_call_t * call, ipc_call_t * answer, int * answer_count ){ |
ERROR_DECLARE; |
|
measured_string_ref address; |
packet_t packet; |
|
// printf( "message %d - %d\n", IPC_GET_METHOD( * call ), NET_NIL_FIRST ); |
* answer_count = 0; |
switch( IPC_GET_METHOD( * call )){ |
case IPC_M_PHONE_HUNGUP: |
return EOK; |
case NET_NIL_DEVICE: |
return nildummy_device_message( IPC_GET_DEVICE( call ), IPC_GET_SERVICE( call ), IPC_GET_MTU( call )); |
case NET_NIL_SEND: |
ERROR_PROPAGATE( packet_translate( nildummy_globals.net_phone, & packet, IPC_GET_PACKET( call ))); |
return nildummy_send_message( IPC_GET_DEVICE( call ), packet, IPC_GET_SERVICE( call )); |
case NET_NIL_PACKET_SPACE: |
ERROR_PROPAGATE( nildummy_packet_space_message( IPC_GET_DEVICE( call ), IPC_SET_ADDR( answer ), IPC_SET_PREFIX( answer ), IPC_SET_CONTENT( answer ), IPC_SET_SUFFIX( answer ))); |
* answer_count = 4; |
return EOK; |
case NET_NIL_ADDR: |
ERROR_PROPAGATE( nildummy_addr_message( IPC_GET_DEVICE( call ), & address )); |
return measured_strings_reply( address, 1 ); |
case IPC_M_CONNECT_TO_ME: |
return nildummy_register_message( NIL_GET_PROTO( call ), IPC_GET_PHONE( call )); |
} |
return ENOTSUP; |
} |
|
void nildummy_receiver( ipc_callid_t iid, ipc_call_t * icall ){ |
ERROR_DECLARE; |
|
packet_t packet; |
|
while( true ){ |
// printf( "message %d - %d\n", IPC_GET_METHOD( * icall ), NET_NIL_FIRST ); |
switch( IPC_GET_METHOD( * icall )){ |
case NET_NIL_DEVICE_STATE: |
ERROR_CODE = nil_device_state_msg( 0, IPC_GET_DEVICE( icall ), IPC_GET_STATE( icall )); |
ipc_answer_0( iid, ERROR_CODE ); |
break; |
case NET_NIL_RECEIVED: |
if( ! ERROR_OCCURRED( packet_translate( nildummy_globals.net_phone, & packet, IPC_GET_PACKET( icall )))){ |
ERROR_CODE = nil_received_msg( 0, IPC_GET_DEVICE( icall ), packet, 0 ); |
} |
ipc_answer_0( iid, ( ipcarg_t ) ERROR_CODE ); |
break; |
default: |
ipc_answer_0( iid, ( ipcarg_t ) ENOTSUP ); |
} |
iid = async_get_call( icall ); |
} |
} |
|
/** @} |
*/ |
Property changes: |
Added: svn:eol-style |
+native |
\ No newline at end of property |