Subversion Repositories HelenOS

Rev

Rev 4163 | Rev 4197 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 4163 Rev 4192
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 "../netif.h"
50
#include "../netif.h"
-
 
51
#include "../netif_interface.h"
51
 
52
 
52
#define DEFAULT_MTU 1500
53
#define DEFAULT_MTU 1500
53
 
54
 
-
 
55
#define DEFAULT_ADDR        "\0\0\0\0\0\0"
-
 
56
#define DEFAULT_ADDR_LEN    ( sizeof( DEFAULT_ADDR ) / sizeof( char ))
-
 
57
 
54
#define NAME    "lo - loopback interface"
58
#define NAME    "lo - loopback interface"
55
 
59
 
56
netif_globals_t netif_globals;
60
netif_globals_t netif_globals;
57
 
61
 
58
static struct lo_globals{
62
static struct lo_globals{
59
    measured_string_ref addr;
-
 
60
    int mtu;
63
    int mtu;
61
} lo_globals;
64
} lo_globals;
62
 
65
 
63
int change_state_message( device_id_t device_id, device_state_t state );
66
int change_state_message( device_id_t device_id, device_state_t state );
64
int create( device_id_t device_id, device_ref * device );
67
int create( device_id_t device_id, device_ref * device );
65
int initialize( void );
-
 
66
void    netif_print_name( void );
68
void    netif_print_name( void );
67
int probe_auto_message( void );
-
 
68
int probe_message( device_id_t device_id, int irq, int io );
-
 
69
int send_message( device_id_t device_id, packet_t packet );
-
 
70
int start_message( device_id_t device_id );
-
 
71
int stop_message( device_id_t device_id );
-
 
72
measured_string_ref get_addr_message( device_id_t device_id );
-
 
73
 
69
 
-
 
70
int specific_message( ipc_callid_t callid, ipc_call_t * call, ipc_call_t * answer, int * answer_count ){
-
 
71
    return ENOTSUP;
-
 
72
}
-
 
73
 
-
 
74
int get_addr_message( device_id_t device_id, measured_string_ref address ){
-
 
75
    if( ! address ) return EBADMEM;
-
 
76
    address->value = DEFAULT_ADDR;
-
 
77
    address->length = DEFAULT_ADDR_LEN;
-
 
78
}
-
 
79
 
-
 
80
int get_device_stats( device_id_t device_id, device_stats_ref stats ){
-
 
81
    ERROR_DECLARE;
-
 
82
 
-
 
83
    device_ref  device;
-
 
84
 
-
 
85
    if( ! stats ) return EBADMEM;
74
measured_string_ref get_addr_message( device_id_t device_id ){
86
    ERROR_PROPAGATE( find_device( device_id, & device ));
-
 
87
    memcpy( stats, ( device_stats_ref ) device->specific, sizeof( device_stats_t ));
75
    return lo_globals.addr;
88
    return EOK;
76
}
89
}
77
 
90
 
78
int change_state_message( device_id_t device_id, device_state_t state ){
91
int change_state_message( device_id_t device_id, device_state_t state ){
79
    ERROR_DECLARE;
92
    ERROR_DECLARE;
80
 
93
 
81
    device_ref  device;
94
    device_ref  device;
82
 
95
 
83
    ERROR_PROPAGATE( find_device( device_id, & device ));
96
    ERROR_PROPAGATE( find_device( device_id, & device ));
84
    if( device->state != state ){
97
    if( device->state != state ){
85
        device->state = state;
98
        device->state = state;
86
        nil_message( device, NET_NIL_DEVICE_STATE, device->state, NULL );
99
        nil_message( device, NET_NIL_DEVICE_STATE, device->state, NULL );
87
        printf( "\nState changed to %s", ( state == NETIF_ACTIVE ) ? "ACTIVE" : "STOPPED" );
100
        printf( "\nState changed to %s", ( state == NETIF_ACTIVE ) ? "ACTIVE" : "STOPPED" );
88
    }
101
    }
89
    return EOK;
102
    return EOK;
90
}
103
}
91
 
104
 
92
int create( device_id_t device_id, device_ref * device ){
105
int create( device_id_t device_id, device_ref * device ){
93
    ERROR_DECLARE;
106
    int index;
94
 
107
 
95
    if( device_map_count( & netif_globals.device_map ) > 0 ){
108
    if( device_map_count( & netif_globals.device_map ) > 0 ){
96
        return EXDEV;
109
        return EXDEV;
97
    }else{
110
    }else{
98
        * device = ( device_ref ) malloc( sizeof( device_t ));
111
        * device = ( device_ref ) malloc( sizeof( device_t ));
99
        if( !( * device )) return ENOMEM;
112
        if( !( * device )) return ENOMEM;
-
 
113
        ( ** device ).specific = malloc( sizeof( device_stats_t ));
-
 
114
        if( ! ( ** device ).specific ){
-
 
115
            free( * device );
-
 
116
            return ENOMEM;
-
 
117
        }
-
 
118
        null_device_stats(( device_stats_ref )( ** device ).specific );
100
        ( ** device ).device_id = device_id;
119
        ( ** device ).device_id = device_id;
101
        ( ** device ).nil_phone = -1;
120
        ( ** device ).nil_phone = -1;
102
        ( ** device ).specific = NULL;
-
 
103
        null_device_stats( &(( ** device ).stats ));
-
 
104
        ( ** device ).state = NETIF_STOPPED;
121
        ( ** device ).state = NETIF_STOPPED;
105
        if( ERROR_OCCURRED( device_map_add( & netif_globals.device_map, ( ** device ).device_id, * device ))){
122
        index = device_map_add( & netif_globals.device_map, ( ** device ).device_id, * device );
-
 
123
        if( index < 0 ){
106
            free( * device );
124
            free( * device );
-
 
125
            free(( ** device ).specific );
107
            * device = NULL;
126
            * device = NULL;
108
            return ERROR_CODE;
127
            return index;
109
        }
128
        }
110
    }
129
    }
111
    return EOK;
130
    return EOK;
112
}
131
}
113
 
132
 
114
int initialize( void ){
133
int initialize( void ){
115
    ipcarg_t    phonehash;
134
    ipcarg_t    phonehash;
116
 
135
 
117
    lo_globals.addr = measured_string_create_bulk( "\0\0\0\0\0\0", 0 );
-
 
118
    if( ! lo_globals.addr ) return ENOMEM;
-
 
119
    return REGISTER_ME( SERVICE_LO, & phonehash );
136
    return REGISTER_ME( SERVICE_LO, & phonehash );
120
}
137
}
121
 
138
 
122
void netif_print_name( void ){
139
void netif_print_name( void ){
123
    printf( NAME );
140
    printf( NAME );
124
}
141
}
125
 
142
 
126
int probe_auto_message( void ){
143
int probe_auto_message( void ){
127
/*  ERROR_DECLARE;
144
/*  ERROR_DECLARE;
128
 
145
 
129
    device_ref  device;
146
    device_ref  device;
130
 
147
 
131
    ERROR_PROPAGATE( create( arg1, & device ));
148
    ERROR_PROPAGATE( create( arg1, & device ));
132
    ipc_call_sync_3_3( netif_globals.networking_phone, NET_NET_DEVICE, device->device_id, NULL, NULL, NULL, NULL, NULL );
149
    ipc_call_sync_3_3( netif_globals.networking_phone, NET_NET_DEVICE, device->device_id, NULL, NULL, NULL, NULL, NULL );
133
*/  return ENOTSUP;
150
*/  return ENOTSUP;
134
}
151
}
135
 
152
 
136
int probe_message( device_id_t device_id, int irq, int io ){
153
int probe_message( device_id_t device_id, int irq, int io ){
137
    ERROR_DECLARE;
154
    ERROR_DECLARE;
138
 
155
 
139
    device_ref      device;
156
    device_ref      device;
140
    aid_t           message;
157
    aid_t           message;
141
    ipc_call_t      answer;
158
    ipc_call_t      answer;
142
    measured_string_t   configuration[ 1 ] = {{ "MTU", 3 }};
159
    measured_string_t   configuration[ 1 ] = {{ "MTU", 3 }};
143
    int         count = 1;
160
    int         count = 1;
144
    measured_string_ref settings;
161
    measured_string_ref settings;
145
    char *          data;
162
    char *          data;
-
 
163
    ipcarg_t        result;
146
 
164
 
147
    // create a new device
165
    // create a new device
148
    ERROR_PROPAGATE( create( device_id, & device ));
166
    ERROR_PROPAGATE( create( device_id, & device ));
149
    // get configuration
167
    // get configuration
150
    message = async_send_2( netif_globals.networking_phone, NET_NET_GET_DEVICE_CONF, device->device_id, count, & answer );
168
    message = async_send_2( netif_globals.networking_phone, NET_NET_GET_DEVICE_CONF, device->device_id, count, & answer );
151
    // send names and get settings
169
    // send names and get settings
152
    if( ERROR_OCCURRED( measured_strings_send( netif_globals.networking_phone, configuration, count ))
170
    if( ERROR_OCCURRED( measured_strings_send( netif_globals.networking_phone, configuration, count ))
153
    || ERROR_OCCURRED( measured_strings_return( netif_globals.networking_phone, & settings, & data, count ))){
171
    || ERROR_OCCURRED( measured_strings_return( netif_globals.networking_phone, & settings, & data, count ))){
154
        async_wait_for( message, NULL );
172
        async_wait_for( message, NULL );
155
        return ERROR_CODE;
173
        return ERROR_CODE;
156
    }
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
    }
157
    // MTU is the first one
184
    // MTU is the first one
158
    if( settings && ( settings[ 0 ].value )){
185
    if( settings && ( settings[ 0 ].value )){
159
        lo_globals.mtu = strtoul( settings[ 0 ].value, NULL, 0 );
186
        lo_globals.mtu = strtoul( settings[ 0 ].value, NULL, 0 );
-
 
187
        free( settings );
-
 
188
        free( data );
160
    }else{
189
    }else{
161
        lo_globals.mtu = DEFAULT_MTU;
190
        lo_globals.mtu = DEFAULT_MTU;
162
    }
191
    }
163
    free( settings );
-
 
164
    free( data );
-
 
165
    // end request
-
 
166
    async_wait_for( message, NULL );
-
 
167
    // print the settings
192
    // print the settings
168
    printf("\nNew device registered:\n\tid\t= %d\n\tMTU\t= %d", device->device_id, lo_globals.mtu );
193
    printf("\nNew device registered:\n\tid\t= %d\n\tMTU\t= %d", device->device_id, lo_globals.mtu );
169
    return EOK;
194
    return EOK;
170
}
195
}
171
 
196
 
172
int send_message( device_id_t device_id, packet_t packet ){
197
int send_message( device_id_t device_id, packet_t packet ){
173
    ERROR_DECLARE;
198
    ERROR_DECLARE;
174
 
199
 
175
    device_ref  device;
200
    device_ref  device;
176
    size_t      length;
201
    size_t      length;
177
    packet_t    next;
202
    packet_t    next;
178
 
203
 
179
    ERROR_PROPAGATE( find_device( device_id, & device ));
204
    ERROR_PROPAGATE( find_device( device_id, & device ));
180
    if( device->state != NETIF_ACTIVE ) return EPERM;
205
    if( device->state != NETIF_ACTIVE ) return EPERM;
181
    next = packet;
206
    next = packet;
182
    do{
207
    do{
183
        ++ device->stats.tx_packets;
208
        ++ (( device_stats_ref ) device->specific )->tx_packets;
184
        ++ device->stats.rx_packets;
209
        ++ (( device_stats_ref ) device->specific )->rx_packets;
185
        length = packet_get_data_length( next );
210
        length = packet_get_data_length( next );
186
        device->stats.tx_bytes += length;
211
        (( device_stats_ref ) device->specific )->tx_bytes += length;
187
        device->stats.rx_bytes += length;
212
        (( device_stats_ref ) device->specific )->rx_bytes += length;
188
        next = pq_next( next );
213
        next = pq_next( next );
189
    }while( next );
214
    }while( next );
190
    nil_message( device, NET_NIL_RECEIVED, packet_get_id( packet ), PACKET_SELF );
215
    nil_message( device, NET_NIL_RECEIVED, packet_get_id( packet ), PACKET_SELF );
191
    return EOK;
216
    return EOK;
192
}
217
}
193
 
218
 
194
int start_message( device_id_t device_id ){
219
int start_message( device_id_t device_id ){
195
    return change_state_message( device_id, NETIF_ACTIVE );
220
    return change_state_message( device_id, NETIF_ACTIVE );
196
}
221
}
197
 
222
 
198
int stop_message( device_id_t device_id ){
223
int stop_message( device_id_t device_id ){
199
    return change_state_message( device_id, NETIF_STOPPED );
224
    return change_state_message( device_id, NETIF_STOPPED );
200
}
225
}
201
 
226
 
202
/** @}
227
/** @}
203
 */
228
 */
204
 
229