WebSVN – HelenOS – Diff – /branches/network/uspace/srv/net/netif/lo/lo.c


/*
 * 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 lo
 *  @{
 */
 
/** @file
 */
 
#include <async.h>
#include <errno.h>
#include <stdio.h>
 
#include <ipc/ipc.h>
#include <ipc/services.h>
 
#include "../../err.h"
#include "../../messages.h"
#include "../../modules.h"
 
#include "../../structures/measured_strings.h"
#include "../../structures/packet/packet_client.h"
 
#include "../../include/device.h"
#include "../../include/nil_interface.h"
#include "../../include/net_interface.h"
 
#include "../netif.h"
#include "../netif_module.h"
 
#define DEFAULT_MTU 1500
 
#define DEFAULT_ADDR        "\0\0\0\0\0\0"
#define DEFAULT_ADDR_LEN    ( sizeof( DEFAULT_ADDR ) / sizeof( char ))
 
#define NAME    "lo - loopback interface"
 
netif_globals_t netif_globals;
 
static struct lo_globals{
    unsigned int mtu;
} lo_globals;
 
static int  change_state_message( device_ref device, device_state_t state );
static int  create( device_id_t device_id, device_ref * device );
void    module_print_name( void );
 
int netif_specific_message( ipc_callid_t callid, ipc_call_t * call, ipc_call_t * answer, int * answer_count ){
    //TODO nil send message
    return ENOTSUP;
}
 
int netif_get_addr_message( device_id_t device_id, measured_string_ref address ){
    if( ! address ) return EBADMEM;
    address->value = DEFAULT_ADDR;
    address->length = DEFAULT_ADDR_LEN;
    return EOK;
}
 
int netif_get_device_stats( device_id_t device_id, device_stats_ref stats ){
    ERROR_DECLARE;
 
    device_ref  device;
 
    if( ! stats ) return EBADMEM;
    ERROR_PROPAGATE( find_device( device_id, & device ));
    memcpy( stats, ( device_stats_ref ) device->specific, sizeof( device_stats_t ));
    return EOK;
}
 
static int change_state_message( device_ref device, device_state_t state ){
    if( device->state != state ){
        device->state = state;
        printf( "State changed to %s\n", ( state == NETIF_ACTIVE ) ? "ACTIVE" : "STOPPED" );
        return state;
    }
    return EOK;
}
 
static int create( device_id_t device_id, device_ref * device ){
    int index;
 
    if( device_map_count( & netif_globals.device_map ) > 0 ){
        return EXDEV;
    }else{
        * device = ( device_ref ) malloc( sizeof( device_t ));
        if( !( * device )) return ENOMEM;
        ( ** device ).specific = malloc( sizeof( device_stats_t ));
        if( ! ( ** device ).specific ){
            free( * device );
            return ENOMEM;
        }
        null_device_stats(( device_stats_ref )( ** device ).specific );
        ( ** device ).device_id = device_id;
        ( ** device ).nil_phone = -1;
        ( ** device ).state = NETIF_STOPPED;
        index = device_map_add( & netif_globals.device_map, ( ** device ).device_id, * device );
        if( index < 0 ){
            free( * device );
            free(( ** device ).specific );
            * device = NULL;
            return index;
        }
    }
    return EOK;
}
 
int netif_initialize( void ){
    ipcarg_t    phonehash;
 
    return REGISTER_ME( SERVICE_LO, & phonehash );
}
 
void module_print_name( void ){
    printf( "%s", NAME );
}
 
int netif_probe_auto_message( void ){
/*  ERROR_DECLARE;
 
    device_ref  device;
 
    ERROR_PROPAGATE( create( arg1, & device ));
    ipc_call_sync_3_3( netif_globals.net_phone, NET_NET_DEVICE, device->device_id, NULL, NULL, NULL, NULL, NULL );
*/  return ENOTSUP;
}
 
int netif_probe_message( device_id_t device_id, int irq, int io ){
    ERROR_DECLARE;
 
    device_ref          device;
    measured_string_t   names[ 1 ] = {{ "MTU", 3 }};
 
    measured_string_ref configuration;
    int                 count = 1;
 
    char *              data;
 
 
    configuration = & names[ 0 ];
    // create a new device
    ERROR_PROPAGATE( create( device_id, & device ));
    // get configuration
 
 
    ERROR_PROPAGATE( net_get_device_conf_req( netif_globals.net_phone, device->device_id, & configuration, count, & data ));
 
 
 
 
 
 
 
 
 
 
 
 
 
    // MTU is the first one
    if( configuration && configuration[ 0 ].value ){
        lo_globals.mtu = strtoul( configuration[ 0 ].value, NULL, 0 );
        net_free_settings( configuration, data );
 
    }else{
        lo_globals.mtu = DEFAULT_MTU;
    }
    // print the settings
    printf("New device registered:\n\tid\t= %d\n\tMTU\t= %d\n", device->device_id, lo_globals.mtu );
    return EOK;
}
 
int netif_send_message( device_id_t device_id, packet_t packet, services_t sender ){
    ERROR_DECLARE;
 
    device_ref  device;
    size_t      length;
    packet_t    next;
    int         phone;
 
    ERROR_PROPAGATE( find_device( device_id, & device ));
    if( device->state != NETIF_ACTIVE ) return EPERM;
    next = packet;
    do{
        ++ (( device_stats_ref ) device->specific )->tx_packets;
        ++ (( device_stats_ref ) device->specific )->rx_packets;
        length = packet_get_data_length( next );
        (( device_stats_ref ) device->specific )->tx_bytes += length;
        (( device_stats_ref ) device->specific )->rx_bytes += length;
        next = pq_next( next );
    }while( next );
    phone = device->nil_phone;
    rwlock_write_unlock( & netif_globals.lock );
    nil_received_msg( phone, device_id, packet, sender );
    rwlock_write_lock( & netif_globals.lock );
    return EOK;
}
 
int netif_start_message( device_ref device ){
    return change_state_message( device, NETIF_ACTIVE );
}
 
int netif_stop_message( device_ref device ){
    return change_state_message( device, NETIF_STOPPED );
}
 
/** @}
 */
 

Rev 4261	Rev 4307
1	/*	1	/*
2	* Copyright (c) 2009 Lukas Mejdrech	2	* Copyright (c) 2009 Lukas Mejdrech
3	* All rights reserved.	3	* All rights reserved.
4	*	4	*
5	* Redistribution and use in source and binary forms, with or without	5	* Redistribution and use in source and binary forms, with or without
6	* modification, are permitted provided that the following conditions	6	* modification, are permitted provided that the following conditions
7	* are met:	7	* are met:
8	*	8	*
9	* - Redistributions of source code must retain the above copyright	9	* - Redistributions of source code must retain the above copyright
10	* notice, this list of conditions and the following disclaimer.	10	* notice, this list of conditions and the following disclaimer.
11	* - Redistributions in binary form must reproduce the above copyright	11	* - Redistributions in binary form must reproduce the above copyright
12	* notice, this list of conditions and the following disclaimer in the	12	* notice, this list of conditions and the following disclaimer in the
13	* documentation and/or other materials provided with the distribution.	13	* documentation and/or other materials provided with the distribution.
14	* - The name of the author may not be used to endorse or promote products	14	* - The name of the author may not be used to endorse or promote products
15	* derived from this software without specific prior written permission.	15	* derived from this software without specific prior written permission.
16	*	16	*
17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27	*/	27	*/
28		28
29	/** @addtogroup lo	29	/** @addtogroup lo
30	* @{	30	* @{
31	*/	31	*/
32		32
33	/** @file	33	/** @file
34	*/	34	*/
35		35
36	#include <async.h>	36	#include <async.h>
37	#include <errno.h>	37	#include <errno.h>
38	#include <stdio.h>	38	#include <stdio.h>
39		39
40	#include <ipc/ipc.h>	40	#include <ipc/ipc.h>
41	#include <ipc/services.h>	41	#include <ipc/services.h>
42		42
43	#include "../../err.h"	43	#include "../../err.h"
44	#include "../../messages.h"	44	#include "../../messages.h"
45	#include "../../modules.h"	45	#include "../../modules.h"
46		46
47	#include "../../structures/measured_strings.h"	47	#include "../../structures/measured_strings.h"
48	#include "../../structures/packet/packet_client.h"	48	#include "../../structures/packet/packet_client.h"
49		49
50	#include "../../include/device.h"	50	#include "../../include/device.h"
51	#include "../../include/nil_messages.h"	51	#include "../../include/nil_interface.h"
-		52	#include "../../include/net_interface.h"
52		53
53	#include "../netif.h"	54	#include "../netif.h"
54	#include "../netif_interface.h"	55	#include "../netif_module.h"
55		56
56	#define DEFAULT_MTU 1500	57	#define DEFAULT_MTU 1500
57		58
58	#define DEFAULT_ADDR "\0\0\0\0\0\0"	59	#define DEFAULT_ADDR "\0\0\0\0\0\0"
59	#define DEFAULT_ADDR_LEN ( sizeof( DEFAULT_ADDR ) / sizeof( char ))	60	#define DEFAULT_ADDR_LEN ( sizeof( DEFAULT_ADDR ) / sizeof( char ))
60		61
61	#define NAME "lo - loopback interface"	62	#define NAME "lo - loopback interface"
62		63
63	netif_globals_t netif_globals;	64	netif_globals_t netif_globals;
64		65
65	static struct lo_globals{	66	static struct lo_globals{
66	int mtu;	67	unsigned int mtu;
67	} lo_globals;	68	} lo_globals;
68		69
69	static int change_state_message( device_ref device, device_state_t state );	70	static int change_state_message( device_ref device, device_state_t state );
70	static int create( device_id_t device_id, device_ref * device );	71	static int create( device_id_t device_id, device_ref * device );
71	void netif_print_name( void );	72	void module_print_name( void );
72		73
73	int netif_specific_message( ipc_callid_t callid, ipc_call_t * call, ipc_call_t * answer, int * answer_count ){	74	int netif_specific_message( ipc_callid_t callid, ipc_call_t * call, ipc_call_t * answer, int * answer_count ){
74	//TODO nil send message	75	//TODO nil send message
75	return ENOTSUP;	76	return ENOTSUP;
76	}	77	}
77		78
78	int netif_get_addr_message( device_id_t device_id, measured_string_ref address ){	79	int netif_get_addr_message( device_id_t device_id, measured_string_ref address ){
79	if( ! address ) return EBADMEM;	80	if( ! address ) return EBADMEM;
80	address->value = DEFAULT_ADDR;	81	address->value = DEFAULT_ADDR;
81	address->length = DEFAULT_ADDR_LEN;	82	address->length = DEFAULT_ADDR_LEN;
82	return EOK;	83	return EOK;
83	}	84	}
84		85
85	int netif_get_device_stats( device_id_t device_id, device_stats_ref stats ){	86	int netif_get_device_stats( device_id_t device_id, device_stats_ref stats ){
86	ERROR_DECLARE;	87	ERROR_DECLARE;
87		88
88	device_ref device;	89	device_ref device;
89		90
90	if( ! stats ) return EBADMEM;	91	if( ! stats ) return EBADMEM;
91	ERROR_PROPAGATE( find_device( device_id, & device ));	92	ERROR_PROPAGATE( find_device( device_id, & device ));
92	memcpy( stats, ( device_stats_ref ) device->specific, sizeof( device_stats_t ));	93	memcpy( stats, ( device_stats_ref ) device->specific, sizeof( device_stats_t ));
93	return EOK;	94	return EOK;
94	}	95	}
95		96
96	static int change_state_message( device_ref device, device_state_t state ){	97	static int change_state_message( device_ref device, device_state_t state ){
97	if( device->state != state ){	98	if( device->state != state ){
98	device->state = state;	99	device->state = state;
99	printf( "\nState changed to %s", ( state == NETIF_ACTIVE ) ? "ACTIVE" : "STOPPED" );	100	printf( "State changed to %s\n", ( state == NETIF_ACTIVE ) ? "ACTIVE" : "STOPPED" );
100	return state;	101	return state;
101	}	102	}
102	return EOK;	103	return EOK;
103	}	104	}
104		105
105	static int create( device_id_t device_id, device_ref * device ){	106	static int create( device_id_t device_id, device_ref * device ){
106	int index;	107	int index;
107		108
108	if( device_map_count( & netif_globals.device_map ) > 0 ){	109	if( device_map_count( & netif_globals.device_map ) > 0 ){
109	return EXDEV;	110	return EXDEV;
110	}else{	111	}else{
111	* device = ( device_ref ) malloc( sizeof( device_t ));	112	* device = ( device_ref ) malloc( sizeof( device_t ));
112	if( !( * device )) return ENOMEM;	113	if( !( * device )) return ENOMEM;
113	( ** device ).specific = malloc( sizeof( device_stats_t ));	114	( ** device ).specific = malloc( sizeof( device_stats_t ));
114	if( ! ( ** device ).specific ){	115	if( ! ( ** device ).specific ){
115	free( * device );	116	free( * device );
116	return ENOMEM;	117	return ENOMEM;
117	}	118	}
118	null_device_stats(( device_stats_ref )( ** device ).specific );	119	null_device_stats(( device_stats_ref )( ** device ).specific );
119	( ** device ).device_id = device_id;	120	( ** device ).device_id = device_id;
120	( ** device ).nil_phone = -1;	121	( ** device ).nil_phone = -1;
121	( ** device ).state = NETIF_STOPPED;	122	( ** device ).state = NETIF_STOPPED;
122	index = device_map_add( & netif_globals.device_map, ( ** device ).device_id, * device );	123	index = device_map_add( & netif_globals.device_map, ( ** device ).device_id, * device );
123	if( index < 0 ){	124	if( index < 0 ){
124	free( * device );	125	free( * device );
125	free(( ** device ).specific );	126	free(( ** device ).specific );
126	* device = NULL;	127	* device = NULL;
127	return index;	128	return index;
128	}	129	}
129	}	130	}
130	return EOK;	131	return EOK;
131	}	132	}
132		133
133	int netif_initialize( void ){	134	int netif_initialize( void ){
134	ipcarg_t phonehash;	135	ipcarg_t phonehash;
135		136
136	return REGISTER_ME( SERVICE_LO, & phonehash );	137	return REGISTER_ME( SERVICE_LO, & phonehash );
137	}	138	}
138		139
139	void netif_print_name( void ){	140	void module_print_name( void ){
140	printf( "%s", NAME );	141	printf( "%s", NAME );
141	}	142	}
142		143
143	int netif_probe_auto_message( void ){	144	int netif_probe_auto_message( void ){
144	/* ERROR_DECLARE;	145	/* ERROR_DECLARE;
145		146
146	device_ref device;	147	device_ref device;
147		148
148	ERROR_PROPAGATE( create( arg1, & device ));	149	ERROR_PROPAGATE( create( arg1, & device ));
149	ipc_call_sync_3_3( netif_globals.networking_phone, NET_NET_DEVICE, device->device_id, NULL, NULL, NULL, NULL, NULL );	150	ipc_call_sync_3_3( netif_globals.net_phone, NET_NET_DEVICE, device->device_id, NULL, NULL, NULL, NULL, NULL );
150	*/ return ENOTSUP;	151	*/ return ENOTSUP;
151	}	152	}
152		153
153	int netif_probe_message( device_id_t device_id, int irq, int io ){	154	int netif_probe_message( device_id_t device_id, int irq, int io ){
154	ERROR_DECLARE;	155	ERROR_DECLARE;
155		156
156	device_ref device;	157	device_ref device;
157	aid_t message;	158	measured_string_t names[ 1 ] = {{ "MTU", 3 }};
158	ipc_call_t answer;	-
159	measured_string_t configuration[ 1 ] = {{ "MTU", 3 }};	159	measured_string_ref configuration;
160	int count = 1;	160	int count = 1;
161	measured_string_ref settings;	-
162	char * data;	161	char * data;
163	ipcarg_t result;	-
164		162
-		163	configuration = & names[ 0 ];
165	// create a new device	164	// create a new device
166	ERROR_PROPAGATE( create( device_id, & device ));	165	ERROR_PROPAGATE( create( device_id, & device ));
167	// get configuration	166	// get configuration
168	message = async_send_2( netif_globals.networking_phone, NET_NET_GET_DEVICE_CONF, device->device_id, count, & answer );	-
169	// send names and get settings	-
170	if( ERROR_OCCURRED( measured_strings_send( netif_globals.networking_phone, configuration, count ))	167	ERROR_PROPAGATE( net_get_device_conf_req( netif_globals.net_phone, device->device_id, & configuration, count, & data ));
171	\|\| ERROR_OCCURRED( measured_strings_return( netif_globals.networking_phone, & settings, & data, count ))){	-
172	async_wait_for( message, NULL );	-
173	return ERROR_CODE;	-
174	}	-
175	// end request	-
176	async_wait_for( message, & result );	-
177	if( ERROR_OCCURRED( result )){	-
178	if( settings ){	-
179	free( settings );	-
180	free( data );	-
181	}	-
182	return ERROR_CODE;	-
183	}	-
184	// MTU is the first one	168	// MTU is the first one
185	if( settings && ( settings[ 0 ].value )){	169	if( configuration && configuration[ 0 ].value ){
186	lo_globals.mtu = strtoul( settings[ 0 ].value, NULL, 0 );	170	lo_globals.mtu = strtoul( configuration[ 0 ].value, NULL, 0 );
187	free( settings );	171	net_free_settings( configuration, data );
188	free( data );	-
189	}else{	172	}else{
190	lo_globals.mtu = DEFAULT_MTU;	173	lo_globals.mtu = DEFAULT_MTU;
191	}	174	}
192	// print the settings	175	// print the settings
193	printf("\nNew device registered:\n\tid\t= %d\n\tMTU\t= %d", device->device_id, lo_globals.mtu );	176	printf("New device registered:\n\tid\t= %d\n\tMTU\t= %d\n", device->device_id, lo_globals.mtu );
194	return EOK;	177	return EOK;
195	}	178	}
196		179
197	int netif_send_message( device_id_t device_id, packet_t packet, services_t sender ){	180	int netif_send_message( device_id_t device_id, packet_t packet, services_t sender ){
198	ERROR_DECLARE;	181	ERROR_DECLARE;
199		182
200	device_ref device;	183	device_ref device;
201	size_t length;	184	size_t length;
202	packet_t next;	185	packet_t next;
203	int phone;	186	int phone;
204		187
205	ERROR_PROPAGATE( find_device( device_id, & device ));	188	ERROR_PROPAGATE( find_device( device_id, & device ));
206	if( device->state != NETIF_ACTIVE ) return EPERM;	189	if( device->state != NETIF_ACTIVE ) return EPERM;
207	next = packet;	190	next = packet;
208	do{	191	do{
209	++ (( device_stats_ref ) device->specific )->tx_packets;	192	++ (( device_stats_ref ) device->specific )->tx_packets;
210	++ (( device_stats_ref ) device->specific )->rx_packets;	193	++ (( device_stats_ref ) device->specific )->rx_packets;
211	length = packet_get_data_length( next );	194	length = packet_get_data_length( next );
212	(( device_stats_ref ) device->specific )->tx_bytes += length;	195	(( device_stats_ref ) device->specific )->tx_bytes += length;
213	(( device_stats_ref ) device->specific )->rx_bytes += length;	196	(( device_stats_ref ) device->specific )->rx_bytes += length;
214	next = pq_next( next );	197	next = pq_next( next );
215	}while( next );	198	}while( next );
216	phone = device->nil_phone;	199	phone = device->nil_phone;
217	rwlock_write_unlock( & netif_globals.lock );	200	rwlock_write_unlock( & netif_globals.lock );
218	nil_received_msg( phone, device_id, packet, sender );	201	nil_received_msg( phone, device_id, packet, sender );
219	rwlock_write_lock( & netif_globals.lock );	202	rwlock_write_lock( & netif_globals.lock );
220	return EOK;	203	return EOK;
221	}	204	}
222		205
223	int netif_start_message( device_ref device ){	206	int netif_start_message( device_ref device ){
224	return change_state_message( device, NETIF_ACTIVE );	207	return change_state_message( device, NETIF_ACTIVE );
225	}	208	}
226		209
227	int netif_stop_message( device_ref device ){	210	int netif_stop_message( device_ref device ){
228	return change_state_message( device, NETIF_STOPPED );	211	return change_state_message( device, NETIF_STOPPED );
229	}	212	}
230		213
231	/** @}	214	/** @}
232	*/	215	*/
233		216

Subversion Repositories HelenOS

(root)/branches/network/uspace/srv/net/netif/lo/lo.c – Rev 4261 → 4307