Rev 4271 | Rev 4327 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed
Rev | Author | Line No. | Line |
---|---|---|---|
3466 | mejdrech | 1 | /* |
3912 | mejdrech | 2 | * Copyright (c) 2009 Lukas Mejdrech |
3466 | mejdrech | 3 | * All rights reserved. |
4 | * |
||
5 | * Redistribution and use in source and binary forms, with or without |
||
6 | * modification, are permitted provided that the following conditions |
||
7 | * are met: |
||
8 | * |
||
9 | * - Redistributions of source code must retain the above copyright |
||
10 | * notice, this list of conditions and the following disclaimer. |
||
11 | * - Redistributions in binary form must reproduce the above copyright |
||
12 | * notice, this list of conditions and the following disclaimer in the |
||
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 |
||
15 | * derived from this software without specific prior written permission. |
||
16 | * |
||
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 |
||
19 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
||
20 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
||
21 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
||
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 |
||
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 |
||
26 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
||
27 | */ |
||
28 | |||
3912 | mejdrech | 29 | /** @addtogroup ip |
30 | * @{ |
||
3466 | mejdrech | 31 | */ |
32 | |||
33 | /** @file |
||
34 | */ |
||
3666 | mejdrech | 35 | |
3466 | mejdrech | 36 | #include <async.h> |
37 | #include <errno.h> |
||
38 | #include <stdio.h> |
||
3846 | mejdrech | 39 | |
3466 | mejdrech | 40 | #include <ipc/ipc.h> |
41 | #include <ipc/services.h> |
||
42 | |||
3886 | mejdrech | 43 | #include "../../err.h" |
44 | #include "../../messages.h" |
||
45 | #include "../../modules.h" |
||
3466 | mejdrech | 46 | |
4307 | mejdrech | 47 | #include "../../include/net_interface.h" |
3886 | mejdrech | 48 | #include "../../include/sockaddr.h" |
49 | #include "../../include/socket.h" |
||
4243 | mejdrech | 50 | #include "../../include/device.h" |
4307 | mejdrech | 51 | #include "../../include/arp_interface.h" |
52 | #include "../../include/nil_interface.h" |
||
53 | #include "../../include/il_interface.h" |
||
54 | #include "../../include/ip_interface.h" |
||
3886 | mejdrech | 55 | #include "../../structures/measured_strings.h" |
4192 | mejdrech | 56 | #include "../../structures/module_map.h" |
3901 | mejdrech | 57 | #include "../../structures/packet/packet_client.h" |
3846 | mejdrech | 58 | |
4307 | mejdrech | 59 | #include "../../nil/nil_messages.h" |
60 | |||
61 | #include "../il_messages.h" |
||
62 | |||
3466 | mejdrech | 63 | #include "ip.h" |
3846 | mejdrech | 64 | #include "ip_module.h" |
3466 | mejdrech | 65 | |
3846 | mejdrech | 66 | #define DEFAULT_IPV 4 |
3685 | mejdrech | 67 | |
4192 | mejdrech | 68 | #define ARP_NAME "arp" |
69 | #define ARP_FILENAME "/srv/arp" |
||
70 | |||
3666 | mejdrech | 71 | ip_globals_t ip_globals; |
3466 | mejdrech | 72 | |
3666 | mejdrech | 73 | DEVICE_MAP_IMPLEMENT( ip_netifs, ip_netif_t ) |
74 | |||
3846 | mejdrech | 75 | INT_MAP_IMPLEMENT( ip_protos, ip_proto_t ) |
3685 | mejdrech | 76 | |
3846 | mejdrech | 77 | void ip_driver_receiver( ipc_callid_t iid, ipc_call_t * icall ); |
4307 | mejdrech | 78 | int ip_device_state_msg( int il_phone, device_id_t device_id, device_state_t state ); |
79 | int ip_register( int il_phone, int protocol, int phone ); |
||
3846 | mejdrech | 80 | |
3466 | mejdrech | 81 | /** Initializes the module. |
82 | */ |
||
83 | int ip_initialize( void ){ |
||
4192 | mejdrech | 84 | ERROR_DECLARE; |
85 | |||
86 | ERROR_PROPAGATE( ip_netifs_initialize( & ip_globals.netifs )); |
||
87 | ERROR_PROPAGATE( ip_protos_initialize( & ip_globals.protos )); |
||
88 | ERROR_PROPAGATE( modules_initialize( & ip_globals.modules )); |
||
4307 | mejdrech | 89 | ERROR_PROPAGATE( add_module( NULL, & ip_globals.modules, ARP_NAME, ARP_FILENAME, SERVICE_ARP, arp_task_get_id(), arp_connect_module )); |
3466 | mejdrech | 90 | return EOK; |
91 | } |
||
92 | |||
4307 | mejdrech | 93 | int ip_device_req( int il_phone, device_id_t device_id, services_t service ){ |
3666 | mejdrech | 94 | ERROR_DECLARE; |
95 | |||
4307 | mejdrech | 96 | ip_netif_ref ip_netif; |
97 | measured_string_t names[ 9 ] = {{ "IPV", 3 }, { "IP_CONFIG", 9 }, { "IP_ADDR", 7 }, { "NETMASK", 7 }, { "GATEWAY", 7 }, { "BROADCAST", 9 }, { "DNS1", 4 }, { "DNS2", 4 }, { "ARP", 3 }}; |
||
98 | measured_string_ref configuration; |
||
99 | int count = 9; |
||
100 | char * data; |
||
101 | int index; |
||
3666 | mejdrech | 102 | |
4307 | mejdrech | 103 | configuration = & names[ 0 ]; |
3846 | mejdrech | 104 | ip_netif = ( ip_netif_ref ) malloc( sizeof( ip_netif_t )); |
105 | if( ! ip_netif ) return ENOMEM; |
||
106 | ip_netif->device_id = device_id; |
||
107 | // get configuration |
||
4307 | mejdrech | 108 | ERROR_PROPAGATE( net_get_device_conf_req( ip_globals.net_phone, ip_netif->device_id, & configuration, count, & data )); |
109 | if( configuration ){ |
||
110 | if( configuration[ 0 ].value ){ |
||
111 | ip_netif->ipv = strtol( configuration[ 0 ].value, NULL, 0 ); |
||
3846 | mejdrech | 112 | }else{ |
113 | ip_netif->ipv = DEFAULT_IPV; |
||
114 | } |
||
4307 | mejdrech | 115 | ip_netif->dhcp = ! strncmp( configuration[ 1 ].value, "dhcp", 4 ); |
3846 | mejdrech | 116 | if( ip_netif->dhcp ){ |
117 | // TODO dhcp |
||
4307 | mejdrech | 118 | net_free_settings( configuration, data ); |
3846 | mejdrech | 119 | free( ip_netif ); |
120 | return ENOTSUP; |
||
121 | }else if( ip_netif->ipv == 4 ){ |
||
4307 | mejdrech | 122 | if( ERROR_OCCURRED( inet_pton( AF_INET, configuration[ 2 ].value, ( uint8_t * ) & ip_netif->address )) |
123 | || ERROR_OCCURRED( inet_pton( AF_INET, configuration[ 3 ].value, ( uint8_t * ) & ip_netif->netmask )) |
||
124 | || ( inet_pton( AF_INET, configuration[ 4 ].value, ( uint8_t * ) & ip_netif->gateway ) == EINVAL ) |
||
125 | || ( inet_pton( AF_INET, configuration[ 5 ].value, ( uint8_t * ) & ip_netif->broadcast ) == EINVAL ) |
||
126 | || ( inet_pton( AF_INET, configuration[ 6 ].value, ( uint8_t * ) & ip_netif->dns1 ) == EINVAL ) |
||
127 | || ( inet_pton( AF_INET, configuration[ 7 ].value, ( uint8_t * ) & ip_netif->dns2 ) == EINVAL )){ |
||
128 | net_free_settings( configuration, data ); |
||
3846 | mejdrech | 129 | free( ip_netif ); |
130 | return EINVAL; |
||
131 | } |
||
132 | }else{ |
||
133 | // TODO ipv6 |
||
4307 | mejdrech | 134 | net_free_settings( configuration, data ); |
3846 | mejdrech | 135 | free( ip_netif ); |
136 | return ENOTSUP; |
||
137 | } |
||
4307 | mejdrech | 138 | if( configuration[ 8 ].value ){ |
139 | ip_netif->arp = get_running_module( & ip_globals.modules, configuration[ 8 ].value ); |
||
4192 | mejdrech | 140 | if( ! ip_netif->arp ){ |
4307 | mejdrech | 141 | printf( "Failed to start the arp %s\n", configuration[ 8 ].value ); |
142 | net_free_settings( configuration, data ); |
||
4192 | mejdrech | 143 | free( ip_netif ); |
144 | return EINVAL; |
||
145 | } |
||
146 | }else{ |
||
147 | ip_netif->arp = NULL; |
||
148 | } |
||
4307 | mejdrech | 149 | net_free_settings( configuration, data ); |
3846 | mejdrech | 150 | } |
4192 | mejdrech | 151 | ip_netif->phone = bind_service( service, ip_netif->device_id, SERVICE_IP, 0, ip_driver_receiver ); |
152 | if( ip_netif->phone < 0 ){ |
||
4307 | mejdrech | 153 | printf( "Failed to contact the nil service %d\n", service ); |
4192 | mejdrech | 154 | free( ip_netif ); |
155 | return ip_netif->phone; |
||
156 | } |
||
157 | if( ip_netif->arp ){ |
||
158 | configuration[ 0 ].value = ( char * ) & ip_netif->address; |
||
159 | configuration[ 0 ].length = CONVERT_SIZE( in_addr_t, char, 1 ); |
||
4271 | mejdrech | 160 | if( ERROR_OCCURRED( arp_device_req( ip_netif->arp->phone, ip_netif->device_id, SERVICE_IP, service, & configuration[ 0 ] ))){ |
4192 | mejdrech | 161 | free( ip_netif ); |
162 | return ERROR_CODE; |
||
163 | } |
||
164 | } |
||
165 | index = ip_netifs_add( & ip_globals.netifs, ip_netif->device_id, ip_netif ); |
||
166 | if( index < 0 ){ |
||
167 | free( ip_netif ); |
||
168 | return index; |
||
169 | } |
||
170 | if( ip_netif->arp ) ++ ip_netif->arp->usage; |
||
3846 | mejdrech | 171 | // print the settings |
4307 | mejdrech | 172 | printf( "New device registered:\n\tid\t= %d\n\tphone\t= %d\n\tIPV\t= %d\n", ip_netif->device_id, ip_netif->phone, ip_netif->ipv ); |
173 | printf( "\tconfiguration\t= %s\n", ip_netif->dhcp ? "dhcp" : "static" ); |
||
4192 | mejdrech | 174 | // TODO ipv6 addresses |
3846 | mejdrech | 175 | data = malloc( INET_ADDRSTRLEN ); |
176 | if( data ){ |
||
177 | inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->address, data, INET_ADDRSTRLEN ); |
||
4307 | mejdrech | 178 | printf( "\taddress\t= %s\n", data ); |
3846 | mejdrech | 179 | inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->netmask, data, INET_ADDRSTRLEN ); |
4307 | mejdrech | 180 | printf( "\tnetmask\t= %s\n", data ); |
3846 | mejdrech | 181 | inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->gateway, data, INET_ADDRSTRLEN ); |
4307 | mejdrech | 182 | printf( "\tgateway\t= %s\n", data ); |
3846 | mejdrech | 183 | inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->broadcast, data, INET_ADDRSTRLEN ); |
4307 | mejdrech | 184 | printf( "\tbroadcast\t= %s\n", data ); |
3846 | mejdrech | 185 | inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->dns1, data, INET_ADDRSTRLEN ); |
4307 | mejdrech | 186 | printf( "\tdns1\t= %s\n", data ); |
3846 | mejdrech | 187 | inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->dns2, data, INET_ADDRSTRLEN ); |
4307 | mejdrech | 188 | printf( "\tdns2\t= %s\n", data ); |
3846 | mejdrech | 189 | free( data ); |
190 | } |
||
191 | return EOK; |
||
192 | } |
||
193 | |||
194 | void ip_driver_receiver( ipc_callid_t iid, ipc_call_t * icall ){ |
||
195 | ERROR_DECLARE; |
||
196 | |||
197 | ipc_callid_t callid; |
||
198 | ipc_call_t call; |
||
199 | // ipc_call_t answer; |
||
200 | // int count; |
||
201 | int result; |
||
202 | packet_t packet; |
||
203 | |||
204 | /* |
||
205 | * Accept the connection |
||
206 | * - Answer the first IPC_M_CONNECT_ME_TO call. |
||
207 | */ |
||
208 | ipc_answer_0( iid, EOK ); |
||
209 | |||
210 | while( true ){ |
||
211 | /* // refresh data |
||
212 | count = 0; |
||
213 | IPC_SET_RETVAL( answer, 0 ); |
||
214 | // just to be precize |
||
215 | IPC_SET_RETVAL( answer, 0 ); |
||
216 | IPC_SET_ARG1( answer, 0 ); |
||
217 | IPC_SET_ARG2( answer, 0 ); |
||
218 | IPC_SET_ARG3( answer, 0 ); |
||
219 | IPC_SET_ARG4( answer, 0 ); |
||
220 | IPC_SET_ARG5( answer, 0 ); |
||
221 | */ |
||
222 | callid = async_get_call( & call ); |
||
223 | switch( IPC_GET_METHOD( call )){ |
||
224 | case NET_IL_DEVICE_STATE: |
||
225 | case NET_NIL_DEVICE_STATE: |
||
4307 | mejdrech | 226 | result = ip_device_state_msg( 0, IPC_GET_DEVICE( & call ), IPC_GET_STATE( & call )); |
3846 | mejdrech | 227 | ipc_answer_0( callid, result ); |
4307 | mejdrech | 228 | break; |
3846 | mejdrech | 229 | // TODO packer received |
230 | case NET_IL_RECEIVED: |
||
231 | case NET_NIL_RECEIVED: |
||
4307 | mejdrech | 232 | if( ! ERROR_OCCURRED( result = packet_translate( ip_globals.net_phone, & packet, IPC_GET_PACKET( & call )))){ |
233 | //result = il_receive_msg( 0, IPC_GET_DEVICE( call ), packet ); |
||
3846 | mejdrech | 234 | } |
235 | ipc_answer_0( callid, result ); |
||
4307 | mejdrech | 236 | break; |
3846 | mejdrech | 237 | } |
238 | } |
||
239 | } |
||
240 | |||
4307 | mejdrech | 241 | int ip_device_state_msg( int il_phone, device_id_t device_id, device_state_t state ){ |
4243 | mejdrech | 242 | ERROR_DECLARE; |
243 | |||
244 | ip_netif_ref netif; |
||
245 | |||
246 | measured_string_t address; |
||
247 | measured_string_ref translation; |
||
248 | char * data; |
||
249 | |||
250 | netif = ip_netifs_find( & ip_globals.netifs, device_id ); |
||
251 | if( ! netif ) return ENOENT; |
||
3846 | mejdrech | 252 | // TODO state |
4307 | mejdrech | 253 | printf( "ip - device %d changed state to %d\n\n", device_id, state ); |
4243 | mejdrech | 254 | if( netif->arp ){ |
255 | address.value = ( char * ) & netif->gateway; |
||
256 | address.length = CONVERT_SIZE( in_addr_t, char, 1 ); |
||
4271 | mejdrech | 257 | ERROR_PROPAGATE( arp_translate_req( netif->arp->phone, netif->device_id, SERVICE_IP, & address, & translation, & data )); |
4307 | mejdrech | 258 | printf( "\tgateway translated to\t= %X:%X:%X:%X:%X:%X\n", data[ 0 ], data[ 1 ], data[ 2 ], data[ 3 ], data[ 4 ], data[ 5 ] ); |
4243 | mejdrech | 259 | free( translation ); |
260 | free( data ); |
||
261 | } |
||
3846 | mejdrech | 262 | return EOK; |
263 | } |
||
264 | |||
4307 | mejdrech | 265 | int ip_bind_service( services_t service, services_t me, async_client_conn_t receiver ){ |
266 | //TODO receive function |
||
267 | return EOK; |
||
268 | } |
||
269 | |||
270 | int ip_connect_module( services_t service ){ |
||
271 | return EOK; |
||
272 | } |
||
273 | |||
274 | int ip_register( int il_phone, int protocol, int phone ){ |
||
3846 | mejdrech | 275 | ip_proto_ref proto; |
4192 | mejdrech | 276 | int index; |
3846 | mejdrech | 277 | |
278 | proto = ( ip_proto_ref ) malloc( sizeof( ip_protos_t )); |
||
279 | if( ! proto ) return ENOMEM; |
||
280 | proto->protocol = protocol; |
||
281 | proto->phone = phone; |
||
4192 | mejdrech | 282 | index = ip_protos_add( & ip_globals.protos, proto->protocol, proto ); |
283 | if( index < 0 ){ |
||
3846 | mejdrech | 284 | free( proto ); |
4192 | mejdrech | 285 | return index; |
3846 | mejdrech | 286 | } |
4307 | mejdrech | 287 | printf( "New protocol registered:\n\tprotocol\t= %d\n\tphone\t= %d\n", proto->protocol, proto->phone ); |
3846 | mejdrech | 288 | return EOK; |
289 | } |
||
290 | |||
4307 | mejdrech | 291 | int ip_send_msg( int il_phone, device_id_t device_id, packet_t packet, services_t target ){ |
3846 | mejdrech | 292 | // TODO send packet |
4307 | mejdrech | 293 | printf( "Packet to send via %d: %s\n", device_id, packet_get_data( packet )); |
294 | pq_release( ip_globals.net_phone, packet_get_id( packet )); |
||
3846 | mejdrech | 295 | return EOK; |
296 | } |
||
297 | |||
298 | int ip_message( ipc_callid_t callid, ipc_call_t * call, ipc_call_t * answer, int * answer_count ){ |
||
299 | ERROR_DECLARE; |
||
300 | |||
301 | packet_t packet; |
||
302 | |||
303 | * answer_count = 0; |
||
304 | switch( IPC_GET_METHOD( * call )){ |
||
3466 | mejdrech | 305 | case IPC_M_PHONE_HUNGUP: |
306 | return EOK; |
||
3666 | mejdrech | 307 | case NET_IL_DEVICE: |
4307 | mejdrech | 308 | return ip_device_req( 0, IPC_GET_DEVICE( call ), IPC_GET_SERVICE( call )); |
3846 | mejdrech | 309 | case IPC_M_CONNECT_TO_ME: |
4307 | mejdrech | 310 | return ip_register( 0, IL_GET_PROTO( call ), IPC_GET_PHONE( call )); |
311 | case NET_IL_SEND: |
||
312 | ERROR_PROPAGATE( packet_translate( ip_globals.net_phone, & packet, IPC_GET_PACKET( call ))); |
||
313 | return ip_send_msg( 0, IPC_GET_DEVICE( call ), packet, 0 ); |
||
3466 | mejdrech | 314 | } |
315 | return ENOTSUP; |
||
316 | } |
||
317 | |||
318 | /** @} |
||
319 | */ |