Ignore:
File:
1 edited

Legend:

Unmodified
Added
Removed

  • uspace/srv/net/il/ip/ip.c

    raadf01e ra000878c  
    108108/** IP packet address length.
    109109 */
    110 #define IP_ADDR                                                 sizeof(struct sockaddr_in6)
     110#define IP_ADDR                                                 sizeof( struct sockaddr_in6 )
    111111
    112112/** IP packet prefix length.
    113113 */
    114 #define IP_PREFIX                                               sizeof(ip_header_t)
     114#define IP_PREFIX                                               sizeof( ip_header_t )
    115115
    116116/** IP packet suffix length.
    … …  
    124124/** The IP localhost address.
    125125 */
    126 #define IPV4_LOCALHOST_ADDRESS  htonl((127 << 24) + 1)
     126#define IPV4_LOCALHOST_ADDRESS  htonl(( 127 << 24 ) + 1 )
    127127
    128128/** IP global data.
    … …  
    130130ip_globals_t    ip_globals;
    131131
    132 DEVICE_MAP_IMPLEMENT(ip_netifs, ip_netif_t)
    133 
    134 INT_MAP_IMPLEMENT(ip_protos, ip_proto_t)
    135 
    136 GENERIC_FIELD_IMPLEMENT(ip_routes, ip_route_t)
     132DEVICE_MAP_IMPLEMENT( ip_netifs, ip_netif_t )
     133
     134INT_MAP_IMPLEMENT( ip_protos, ip_proto_t )
     135
     136GENERIC_FIELD_IMPLEMENT( ip_routes, ip_route_t )
    137137
    138138/** Updates the device content length according to the new MTU value.
    … …  
    142142 *  @returns ENOENT if device is not found.
    143143 */
    144 int ip_mtu_changed_message(device_id_t device_id, size_t mtu);
     144int     ip_mtu_changed_message( device_id_t device_id, size_t mtu );
    145145
    146146/** Updates the device state.
    … …  
    150150 *  @returns ENOENT if device is not found.
    151151 */
    152 int ip_device_state_message(device_id_t device_id, device_state_t state);
     152int     ip_device_state_message( device_id_t device_id, device_state_t state );
    153153
    154154/** Returns the device packet dimensions for sending.
    … …  
    162162 *  @returns EOK on success.
    163163 */
    164 int ip_packet_size_message(device_id_t device_id, size_t * addr_len, size_t * prefix, size_t * content, size_t * suffix);
     164int     ip_packet_size_message( device_id_t device_id, size_t * addr_len, size_t * prefix, size_t * content, size_t * suffix );
    165165
    166166/** Registers the transport layer protocol.
    … …  
    175175 *  @returns ENOMEM if there is not enough memory left.
    176176 */
    177 int ip_register(int protocol, services_t service, int phone, tl_received_msg_t tl_received_msg);
     177int     ip_register( int protocol, services_t service, int phone, tl_received_msg_t tl_received_msg );
    178178
    179179/** Initializes a new network interface specific data.
    … …  
    192192 *  @returns Other error codes as defined for the nil_packet_size_req() function.
    193193 */
    194 int ip_netif_initialize(ip_netif_ref ip_netif);
     194int     ip_netif_initialize( ip_netif_ref ip_netif );
    195195
    196196/** Sends the packet or the packet queue via the specified route.
    … …  
    206206 *  @returns Other error codes as defined for the ip_prepare_packet() function.
    207207 */
    208 int ip_send_route(packet_t packet, ip_netif_ref netif, ip_route_ref route, in_addr_t * src, in_addr_t dest, services_t error);
     208int     ip_send_route( packet_t packet, ip_netif_ref netif, ip_route_ref route, in_addr_t * src, in_addr_t dest, services_t error );
    209209
    210210/** Prepares the outgoing packet or the packet queue.
    … …  
    222222 *  @returns Other error codes as defined for the packet_set_addr() function.
    223223 */
    224 int ip_prepare_packet(in_addr_t * source, in_addr_t dest, packet_t packet, measured_string_ref destination);
     224int     ip_prepare_packet( in_addr_t * source, in_addr_t dest, packet_t packet, measured_string_ref destination );
    225225
    226226/** Checks the packet queue lengths and fragments the packets if needed.
    … …  
    235235 *  @returns NULL if there are no packets left.
    236236 */
    237 packet_t ip_split_packet(packet_t packet, size_t prefix, size_t content, size_t suffix, socklen_t addr_len, services_t error);
     237packet_t        ip_split_packet( packet_t packet, size_t prefix, size_t content, size_t suffix, socklen_t addr_len, services_t error );
    238238
    239239/** Checks the packet length and fragments it if needed.
    … …  
    255255 *  @returns Other error codes as defined for the ip_fragment_packet_data() function.
    256256 */
    257 int ip_fragment_packet(packet_t packet, size_t length, size_t prefix, size_t suffix, socklen_t addr_len);
     257int     ip_fragment_packet( packet_t packet, size_t length, size_t prefix, size_t suffix, socklen_t addr_len );
    258258
    259259/** Fragments the packet from the end.
    … …  
    271271 *  @returns Other error codes as defined for the pq_insert_after() function.
    272272 */
    273 int ip_fragment_packet_data(packet_t packet, packet_t new_packet, ip_header_ref header, ip_header_ref new_header, size_t length, const struct sockaddr * src, const struct sockaddr * dest, socklen_t addrlen);
     273int     ip_fragment_packet_data( packet_t packet, packet_t new_packet, ip_header_ref header, ip_header_ref new_header, size_t length, const struct sockaddr * src, const struct sockaddr * dest, socklen_t addrlen );
    274274
    275275/** Prefixes a middle fragment header based on the last fragment header to the packet.
    … …  
    279279 *  @returns NULL on error.
    280280 */
    281 ip_header_ref ip_create_middle_header(packet_t packet, ip_header_ref last);
     281ip_header_ref   ip_create_middle_header( packet_t packet, ip_header_ref last );
    282282
    283283/** Copies the fragment header.
    … …  
    286286 *  @param[in] first The original header to be copied.
    287287 */
    288 void ip_create_last_header(ip_header_ref last, ip_header_ref first);
     288void ip_create_last_header( ip_header_ref last, ip_header_ref first );
    289289
    290290/** Returns the network interface's IP address.
    … …  
    293293 *  @returns NULL if no IP address was found.
    294294 */
    295 in_addr_t * ip_netif_address(ip_netif_ref netif);
     295in_addr_t *     ip_netif_address( ip_netif_ref netif );
    296296
    297297/** Searches all network interfaces if there is a suitable route.
    … …  
    300300 *  @returns NULL if no route was found.
    301301 */
    302 ip_route_ref ip_find_route(in_addr_t destination);
     302ip_route_ref    ip_find_route( in_addr_t destination );
    303303
    304304/** Searches the network interfaces if there is a suitable route.
    … …  
    308308 *  @returns NULL if no route was found.
    309309 */
    310 ip_route_ref ip_netif_find_route(ip_netif_ref netif, in_addr_t destination);
     310ip_route_ref    ip_netif_find_route( ip_netif_ref netif, in_addr_t destination );
    311311
    312312/** Processes the received IP packet or the packet queue one by one.
    … …  
    321321 *  @returns ENOMEM if there is not enough memory left.
    322322 */
    323 int ip_receive_message(device_id_t device_id, packet_t packet);
     323int     ip_receive_message( device_id_t device_id, packet_t packet );
    324324
    325325/** Processes the received packet.
    … …  
    338338 *  @returns ENOENT if the packet is for another host and the routing is disabled.
    339339 */
    340 int ip_process_packet(device_id_t device_id, packet_t packet);
     340int     ip_process_packet( device_id_t device_id, packet_t packet );
    341341
    342342/** Returns the packet destination address from the IP header.
    … …  
    344344 *  @returns The packet destination address.
    345345 */
    346 in_addr_t ip_get_destination(ip_header_ref header);
     346in_addr_t       ip_get_destination( ip_header_ref header );
    347347
    348348/** Delivers the packet to the local host.
    … …  
    361361 *  @returns Other error codes as defined for the protocol specific tl_received_msg function.
    362362 */
    363 int ip_deliver_local(device_id_t device_id, packet_t packet, ip_header_ref header, services_t error);
     363int     ip_deliver_local( device_id_t device_id, packet_t packet, ip_header_ref header, services_t error );
    364364
    365365/** Prepares the ICMP notification packet.
    … …  
    374374 *  @returns EINVAL if the ip_prepare_icmp() fails.
    375375 */
    376 int ip_prepare_icmp_and_get_phone(services_t error, packet_t packet, ip_header_ref header);
     376int     ip_prepare_icmp_and_get_phone( services_t error, packet_t packet, ip_header_ref header );
    377377
    378378/** Returns the ICMP phone.
    … …  
    381381 *  @returns ENOENT if the ICMP is not registered.
    382382 */
    383 int ip_get_icmp_phone(void);
     383int     ip_get_icmp_phone( void );
    384384
    385385/** Prepares the ICMP notification packet.
    … …  
    395395 *  @returns Other error codes as defined for the packet_set_addr().
    396396 */
    397 int ip_prepare_icmp(packet_t packet, ip_header_ref header);
     397int     ip_prepare_icmp( packet_t packet, ip_header_ref header );
    398398
    399399/** Releases the packet and returns the result.
    … …  
    402402 *  @return The result parameter.
    403403 */
    404 int ip_release_and_return(packet_t packet, int result);
    405 
    406 int ip_initialize(async_client_conn_t client_connection){
     404int     ip_release_and_return( packet_t packet, int result );
     405
     406int ip_initialize( async_client_conn_t client_connection ){
    407407        ERROR_DECLARE;
    408408
    409         fibril_rwlock_initialize(&ip_globals.lock);
    410         fibril_rwlock_write_lock(&ip_globals.lock);
    411         fibril_rwlock_initialize(&ip_globals.protos_lock);
    412         fibril_rwlock_initialize(&ip_globals.netifs_lock);
     409        fibril_rwlock_initialize( & ip_globals.lock );
     410        fibril_rwlock_write_lock( & ip_globals.lock );
     411        fibril_rwlock_initialize( & ip_globals.protos_lock );
     412        fibril_rwlock_initialize( & ip_globals.netifs_lock );
    413413        ip_globals.packet_counter = 0;
    414414        ip_globals.gateway.address.s_addr = 0;
    … …  
    416416        ip_globals.gateway.gateway.s_addr = 0;
    417417        ip_globals.gateway.netif = NULL;
    418         ERROR_PROPAGATE(ip_netifs_initialize(&ip_globals.netifs));
    419         ERROR_PROPAGATE(ip_protos_initialize(&ip_globals.protos));
     418        ERROR_PROPAGATE( ip_netifs_initialize( & ip_globals.netifs ));
     419        ERROR_PROPAGATE( ip_protos_initialize( & ip_globals.protos ));
    420420        ip_globals.client_connection = client_connection;
    421         ERROR_PROPAGATE(modules_initialize(&ip_globals.modules));
    422         ERROR_PROPAGATE(add_module(NULL, &ip_globals.modules, ARP_NAME, ARP_FILENAME, SERVICE_ARP, arp_task_get_id(), arp_connect_module));
    423         fibril_rwlock_write_unlock(&ip_globals.lock);
     421        ERROR_PROPAGATE( modules_initialize( & ip_globals.modules ));
     422        ERROR_PROPAGATE( add_module( NULL, & ip_globals.modules, ARP_NAME, ARP_FILENAME, SERVICE_ARP, arp_task_get_id(), arp_connect_module ));
     423        fibril_rwlock_write_unlock( & ip_globals.lock );
    424424        return EOK;
    425425}
    426426
    427 int ip_device_req(int il_phone, device_id_t device_id, services_t netif){
     427int ip_device_req( int il_phone, device_id_t device_id, services_t netif ){
    428428        ERROR_DECLARE;
    429429
    430         ip_netif_ref ip_netif;
    431         ip_route_ref route;
    432         int index;
    433         char * data;
    434 
    435         ip_netif = (ip_netif_ref) malloc(sizeof(ip_netif_t));
    436         if(! ip_netif){
    437                 return ENOMEM;
    438         }
    439         if(ERROR_OCCURRED(ip_routes_initialize(&ip_netif->routes))){
    440                 free(ip_netif);
     430        ip_netif_ref    ip_netif;
     431        ip_route_ref    route;
     432        int                             index;
     433        char *                  data;
     434
     435        ip_netif = ( ip_netif_ref ) malloc( sizeof( ip_netif_t ));
     436        if( ! ip_netif ) return ENOMEM;
     437        if( ERROR_OCCURRED( ip_routes_initialize( & ip_netif->routes ))){
     438                free( ip_netif );
    441439                return ERROR_CODE;
    442440        }
    … …  
    444442        ip_netif->service = netif;
    445443        ip_netif->state = NETIF_STOPPED;
    446         fibril_rwlock_write_lock(&ip_globals.netifs_lock);
    447         if(ERROR_OCCURRED(ip_netif_initialize(ip_netif))){
    448                 fibril_rwlock_write_unlock(&ip_globals.netifs_lock);
    449                 ip_routes_destroy(&ip_netif->routes);
    450                 free(ip_netif);
     444        fibril_rwlock_write_lock( & ip_globals.netifs_lock );
     445        if( ERROR_OCCURRED( ip_netif_initialize( ip_netif ))){
     446                fibril_rwlock_write_unlock( & ip_globals.netifs_lock );
     447                ip_routes_destroy( & ip_netif->routes );
     448                free( ip_netif );
    451449                return ERROR_CODE;
    452450        }
    453         if(ip_netif->arp){
    454                 ++ ip_netif->arp->usage;
    455         }
     451        if( ip_netif->arp ) ++ ip_netif->arp->usage;
    456452        // print the settings
    457         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);
    458         printf("\tconfiguration\t= %s\n", ip_netif->dhcp ? "dhcp" : "static");
     453        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 );
     454        printf( "\tconfiguration\t= %s\n", ip_netif->dhcp ? "dhcp" : "static" );
    459455        // TODO ipv6 addresses
    460         data = (char *) malloc(INET_ADDRSTRLEN);
    461         if(data){
    462                 for(index = 0; index < ip_routes_count(&ip_netif->routes); ++ index){
    463                         route = ip_routes_get_index(&ip_netif->routes, index);
    464                         if(route){
    465                                 printf("\tRouting %d:\n", index);
    466                                 inet_ntop(AF_INET, (uint8_t *) &route->address.s_addr, data, INET_ADDRSTRLEN);
    467                                 printf("\t\taddress\t= %s\n", data);
    468                                 inet_ntop(AF_INET, (uint8_t *) &route->netmask.s_addr, data, INET_ADDRSTRLEN);
    469                                 printf("\t\tnetmask\t= %s\n", data);
    470                                 inet_ntop(AF_INET, (uint8_t *) &route->gateway.s_addr, data, INET_ADDRSTRLEN);
    471                                 printf("\t\tgateway\t= %s\n", data);
    472                         }
    473                 }
    474                 inet_ntop(AF_INET, (uint8_t *) &ip_netif->broadcast.s_addr, data, INET_ADDRSTRLEN);
    475                 printf("\t\tbroadcast\t= %s\n", data);
    476                 free(data);
    477         }
    478         fibril_rwlock_write_unlock(&ip_globals.netifs_lock);
     456        data = ( char * ) malloc( INET_ADDRSTRLEN );
     457        if( data ){
     458                for( index = 0; index < ip_routes_count( & ip_netif->routes ); ++ index ){
     459                        route = ip_routes_get_index( & ip_netif->routes, index );
     460                        if( route ){
     461                                printf( "\tRouting %d:\n", index );
     462                                inet_ntop( AF_INET, ( uint8_t * ) & route->address.s_addr, data, INET_ADDRSTRLEN );
     463                                printf( "\t\taddress\t= %s\n", data );
     464                                inet_ntop( AF_INET, ( uint8_t * ) & route->netmask.s_addr, data, INET_ADDRSTRLEN );
     465                                printf( "\t\tnetmask\t= %s\n", data );
     466                                inet_ntop( AF_INET, ( uint8_t * ) & route->gateway.s_addr, data, INET_ADDRSTRLEN );
     467                                printf( "\t\tgateway\t= %s\n", data );
     468                        }
     469                }
     470                inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->broadcast.s_addr, data, INET_ADDRSTRLEN );
     471                printf( "\t\tbroadcast\t= %s\n", data );
     472                free( data );
     473        }
     474        fibril_rwlock_write_unlock( & ip_globals.netifs_lock );
    479475        return EOK;
    480476}
    481477
    482 int ip_netif_initialize(ip_netif_ref ip_netif){
     478int ip_netif_initialize( ip_netif_ref ip_netif ){
    483479        ERROR_DECLARE;
    484480
    485         measured_string_t names[] = {{str_dup("IPV"), 3}, {str_dup("IP_CONFIG"), 9}, {str_dup("IP_ADDR"), 7}, {str_dup("IP_NETMASK"), 10}, {str_dup("IP_GATEWAY"), 10}, {str_dup("IP_BROADCAST"), 12}, {str_dup("ARP"), 3}, {str_dup("IP_ROUTING"), 10}};
    486         measured_string_ref configuration;
    487         size_t count = sizeof(names) / sizeof(measured_string_t);
    488         char * data;
    489         measured_string_t address;
    490         int index;
    491         ip_route_ref route;
    492         in_addr_t gateway;
     481        measured_string_t       names[] = {{ str_dup("IPV"), 3 }, { str_dup("IP_CONFIG"), 9 }, { str_dup("IP_ADDR"), 7 }, { str_dup("IP_NETMASK"), 10 }, { str_dup("IP_GATEWAY"), 10 }, { str_dup("IP_BROADCAST"), 12 }, { str_dup("ARP"), 3 }, { str_dup("IP_ROUTING"), 10 }};
     482        measured_string_ref     configuration;
     483        size_t                          count = sizeof( names ) / sizeof( measured_string_t );
     484        char *                          data;
     485        measured_string_t       address;
     486        int                                     index;
     487        ip_route_ref            route;
     488        in_addr_t                       gateway;
    493489
    494490        ip_netif->arp = NULL;
    … …  
    497493        ip_netif->dhcp = false;
    498494        ip_netif->routing = NET_DEFAULT_IP_ROUTING;
    499         configuration = &names[0];
     495        configuration = & names[ 0 ];
    500496        // get configuration
    501         ERROR_PROPAGATE(net_get_device_conf_req(ip_globals.net_phone, ip_netif->device_id, &configuration, count, &data));
    502         if(configuration){
    503                 if(configuration[0].value){
    504                         ip_netif->ipv = strtol(configuration[0].value, NULL, 0);
    505                 }
    506                 ip_netif->dhcp = ! str_lcmp(configuration[1].value, "dhcp", configuration[1].length);
    507                 if(ip_netif->dhcp){
     497        ERROR_PROPAGATE( net_get_device_conf_req( ip_globals.net_phone, ip_netif->device_id, & configuration, count, & data ));
     498        if( configuration ){
     499                if( configuration[ 0 ].value ){
     500                        ip_netif->ipv = strtol( configuration[ 0 ].value, NULL, 0 );
     501                }
     502                ip_netif->dhcp = ! str_lcmp( configuration[ 1 ].value, "dhcp", configuration[ 1 ].length );
     503                if( ip_netif->dhcp ){
    508504                        // TODO dhcp
    509                         net_free_settings(configuration, data);
     505                        net_free_settings( configuration, data );
    510506                        return ENOTSUP;
    511                 }else if(ip_netif->ipv == IPV4){
    512                         route = (ip_route_ref) malloc(sizeof(ip_route_t));
    513                         if(! route){
    514                                 net_free_settings(configuration, data);
     507                }else if( ip_netif->ipv == IPV4 ){
     508                        route = ( ip_route_ref ) malloc( sizeof( ip_route_t ));
     509                        if( ! route ){
     510                                net_free_settings( configuration, data );
    515511                                return ENOMEM;
    516512                        }
    … …  
    519515                        route->gateway.s_addr = 0;
    520516                        route->netif = ip_netif;
    521                         index = ip_routes_add(&ip_netif->routes, route);
    522                         if(index < 0){
    523                                 net_free_settings(configuration, data);
    524                                 free(route);
     517                        index = ip_routes_add( & ip_netif->routes, route );
     518                        if( index < 0 ){
     519                                net_free_settings( configuration, data );
     520                                free( route );
    525521                                return index;
    526522                        }
    527                         if(ERROR_OCCURRED(inet_pton(AF_INET, configuration[2].value, (uint8_t *) &route->address.s_addr))
    528                                 || ERROR_OCCURRED(inet_pton(AF_INET, configuration[3].value, (uint8_t *) &route->netmask.s_addr))
    529                                 || (inet_pton(AF_INET, configuration[4].value, (uint8_t *) &gateway.s_addr) == EINVAL)
    530                                 || (inet_pton(AF_INET, configuration[5].value, (uint8_t *) &ip_netif->broadcast.s_addr) == EINVAL)){
    531                                 net_free_settings(configuration, data);
     523                        if( ERROR_OCCURRED( inet_pton( AF_INET, configuration[ 2 ].value, ( uint8_t * ) & route->address.s_addr ))
     524                        || ERROR_OCCURRED( inet_pton( AF_INET, configuration[ 3 ].value, ( uint8_t * ) & route->netmask.s_addr ))
     525                        || ( inet_pton( AF_INET, configuration[ 4 ].value, ( uint8_t * ) & gateway.s_addr ) == EINVAL )
     526                        || ( inet_pton( AF_INET, configuration[ 5 ].value, ( uint8_t * ) & ip_netif->broadcast.s_addr ) == EINVAL )){
     527                                net_free_settings( configuration, data );
    532528                                return EINVAL;
    533529                        }
    534530                }else{
    535531                        // TODO ipv6 in separate module
    536                         net_free_settings(configuration, data);
     532                        net_free_settings( configuration, data );
    537533                        return ENOTSUP;
    538534                }
    539                 if(configuration[6].value){
    540                         ip_netif->arp = get_running_module(&ip_globals.modules, configuration[6].value);
    541                         if(! ip_netif->arp){
    542                                 printf("Failed to start the arp %s\n", configuration[6].value);
    543                                 net_free_settings(configuration, data);
     535                if( configuration[ 6 ].value ){
     536                        ip_netif->arp = get_running_module( & ip_globals.modules, configuration[ 6 ].value );
     537                        if( ! ip_netif->arp ){
     538                                printf( "Failed to start the arp %s\n", configuration[ 6 ].value );
     539                                net_free_settings( configuration, data );
    544540                                return EINVAL;
    545541                        }
    546542                }
    547                 if(configuration[7].value){
    548                         ip_netif->routing = (configuration[7].value[0] == 'y');
    549                 }
    550                 net_free_settings(configuration, data);
     543                if( configuration[ 7 ].value ){
     544                        ip_netif->routing = ( configuration[ 7 ].value[ 0 ] == 'y' );
     545                }
     546                net_free_settings( configuration, data );
    551547        }
    552548        // binds the netif service which also initializes the device
    553         ip_netif->phone = nil_bind_service(ip_netif->service, (ipcarg_t) ip_netif->device_id, SERVICE_IP, ip_globals.client_connection);
    554         if(ip_netif->phone < 0){
    555                 printf("Failed to contact the nil service %d\n", ip_netif->service);
     549        ip_netif->phone = nil_bind_service( ip_netif->service, ( ipcarg_t ) ip_netif->device_id, SERVICE_IP, ip_globals.client_connection );
     550        if( ip_netif->phone < 0 ){
     551                printf( "Failed to contact the nil service %d\n", ip_netif->service );
    556552                return ip_netif->phone;
    557553        }
    558554        // has to be after the device netif module initialization
    559         if(ip_netif->arp){
    560                 if(route){
    561                         address.value = (char *) &route->address.s_addr;
    562                         address.length = CONVERT_SIZE(in_addr_t, char, 1);
    563                         ERROR_PROPAGATE(arp_device_req(ip_netif->arp->phone, ip_netif->device_id, SERVICE_IP, ip_netif->service, &address));
     555        if( ip_netif->arp ){
     556                if( route ){
     557                        address.value = ( char * ) & route->address.s_addr;
     558                        address.length = CONVERT_SIZE( in_addr_t, char, 1 );
     559                        ERROR_PROPAGATE( arp_device_req( ip_netif->arp->phone, ip_netif->device_id, SERVICE_IP, ip_netif->service, & address ));
    564560                }else{
    565561                        ip_netif->arp = 0;
    … …  
    567563        }
    568564        // get packet dimensions
    569         ERROR_PROPAGATE(nil_packet_size_req(ip_netif->phone, ip_netif->device_id, &ip_netif->packet_dimension));
    570         if(ip_netif->packet_dimension.content < IP_MIN_CONTENT){
    571                 printf("Maximum transmission unit %d bytes is too small, at least %d bytes are needed\n", ip_netif->packet_dimension.content, IP_MIN_CONTENT);
     565        ERROR_PROPAGATE( nil_packet_size_req( ip_netif->phone, ip_netif->device_id, & ip_netif->packet_dimension ));
     566        if( ip_netif->packet_dimension.content < IP_MIN_CONTENT ){
     567                printf( "Maximum transmission unit %d bytes is too small, at least %d bytes are needed\n", ip_netif->packet_dimension.content, IP_MIN_CONTENT );
    572568                ip_netif->packet_dimension.content = IP_MIN_CONTENT;
    573569        }
    574         index = ip_netifs_add(&ip_globals.netifs, ip_netif->device_id, ip_netif);
    575         if(index < 0){
    576                 return index;
    577         }
    578         if(gateway.s_addr){
     570        index = ip_netifs_add( & ip_globals.netifs, ip_netif->device_id, ip_netif );
     571        if( index < 0 ) return index;
     572        if( gateway.s_addr ){
    579573                // the default gateway
    580574                ip_globals.gateway.address.s_addr = 0;
    … …  
    586580}
    587581
    588 int ip_mtu_changed_message(device_id_t device_id, size_t mtu){
    589         ip_netif_ref netif;
    590 
    591         fibril_rwlock_write_lock(&ip_globals.netifs_lock);
    592         netif = ip_netifs_find(&ip_globals.netifs, device_id);
    593         if(! netif){
    594                 fibril_rwlock_write_unlock(&ip_globals.netifs_lock);
     582int ip_mtu_changed_message( device_id_t device_id, size_t mtu ){
     583        ip_netif_ref    netif;
     584
     585        fibril_rwlock_write_lock( & ip_globals.netifs_lock );
     586        netif = ip_netifs_find( & ip_globals.netifs, device_id );
     587        if( ! netif ){
     588                fibril_rwlock_write_unlock( & ip_globals.netifs_lock );
    595589                return ENOENT;
    596590        }
    597591        netif->packet_dimension.content = mtu;
    598         printf("ip - device %d changed mtu to %d\n\n", device_id, mtu);
    599         fibril_rwlock_write_unlock(&ip_globals.netifs_lock);
     592        printf( "ip - device %d changed mtu to %d\n\n", device_id, mtu );
     593        fibril_rwlock_write_unlock( & ip_globals.netifs_lock );
    600594        return EOK;
    601595}
    602596
    603 int ip_device_state_message(device_id_t device_id, device_state_t state){
    604         ip_netif_ref netif;
    605 
    606         fibril_rwlock_write_lock(&ip_globals.netifs_lock);
     597int ip_device_state_message( device_id_t device_id, device_state_t state ){
     598        ip_netif_ref    netif;
     599
     600        fibril_rwlock_write_lock( & ip_globals.netifs_lock );
    607601        // find the device
    608         netif = ip_netifs_find(&ip_globals.netifs, device_id);
    609         if(! netif){
    610                 fibril_rwlock_write_unlock(&ip_globals.netifs_lock);
     602        netif = ip_netifs_find( & ip_globals.netifs, device_id );
     603        if( ! netif ){
     604                fibril_rwlock_write_unlock( & ip_globals.netifs_lock );
    611605                return ENOENT;
    612606        }
    613607        netif->state = state;
    614         printf("ip - device %d changed state to %d\n\n", device_id, state);
    615         fibril_rwlock_write_unlock(&ip_globals.netifs_lock);
     608        printf( "ip - device %d changed state to %d\n\n", device_id, state );
     609        fibril_rwlock_write_unlock( & ip_globals.netifs_lock );
    616610        return EOK;
    617611}
    618612
    619 int ip_connect_module(services_t service){
     613int ip_connect_module( services_t service ){
    620614        return EOK;
    621615}
    622616
    623 int ip_bind_service(services_t service, int protocol, services_t me, async_client_conn_t receiver, tl_received_msg_t received_msg){
    624         return ip_register(protocol, me, 0, received_msg);
    625 }
    626 
    627 int ip_register(int protocol, services_t service, int phone, tl_received_msg_t received_msg){
    628         ip_proto_ref proto;
    629         int index;
    630 
    631         if(!(protocol && service && ((phone > 0) || (received_msg)))){
    632                 return EINVAL;
    633         }
    634         proto = (ip_proto_ref) malloc(sizeof(ip_protos_t));
    635         if(! proto){
    636                 return ENOMEM;
    637         }
     617int ip_bind_service( services_t service, int protocol, services_t me, async_client_conn_t receiver, tl_received_msg_t received_msg ){
     618        return ip_register( protocol, me, 0, received_msg );
     619}
     620
     621int ip_register( int protocol, services_t service, int phone, tl_received_msg_t received_msg ){
     622        ip_proto_ref    proto;
     623        int                             index;
     624
     625        if( !( protocol && service && (( phone > 0 ) || ( received_msg )))) return EINVAL;
     626        proto = ( ip_proto_ref ) malloc( sizeof( ip_protos_t ));
     627        if( ! proto ) return ENOMEM;
    638628        proto->protocol = protocol;
    639629        proto->service = service;
    640630        proto->phone = phone;
    641631        proto->received_msg = received_msg;
    642         fibril_rwlock_write_lock(&ip_globals.protos_lock);
    643         index = ip_protos_add(&ip_globals.protos, proto->protocol, proto);
    644         if(index < 0){
    645                 fibril_rwlock_write_unlock(&ip_globals.protos_lock);
    646                 free(proto);
     632        fibril_rwlock_write_lock( & ip_globals.protos_lock );
     633        index = ip_protos_add( & ip_globals.protos, proto->protocol, proto );
     634        if( index < 0 ){
     635                fibril_rwlock_write_unlock( & ip_globals.protos_lock );
     636                free( proto );
    647637                return index;
    648638        }
    649         printf("New protocol registered:\n\tprotocol\t= %d\n\tphone\t= %d\n", proto->protocol, proto->phone);
    650         fibril_rwlock_write_unlock(&ip_globals.protos_lock);
     639        printf( "New protocol registered:\n\tprotocol\t= %d\n\tphone\t= %d\n", proto->protocol, proto->phone );
     640        fibril_rwlock_write_unlock( & ip_globals.protos_lock );
    651641        return EOK;
    652642}
    653643
    654 int ip_send_msg(int il_phone, device_id_t device_id, packet_t packet, services_t sender, services_t error){
     644int ip_send_msg( int il_phone, device_id_t device_id, packet_t packet, services_t sender, services_t error ){
    655645        ERROR_DECLARE;
    656646
    657         int addrlen;
    658         ip_netif_ref netif;
    659         ip_route_ref route;
    660         struct sockaddr * addr;
    661         struct sockaddr_in * address_in;
     647        int                                     addrlen;
     648        ip_netif_ref            netif;
     649        ip_route_ref            route;
     650        struct sockaddr *               addr;
     651        struct sockaddr_in *    address_in;
    662652//      struct sockaddr_in6 *   address_in6;
    663         in_addr_t * dest;
    664         in_addr_t * src;
    665         int phone;
     653        in_addr_t *                     dest;
     654        in_addr_t *                     src;
     655        int                                     phone;
    666656
    667657        // addresses in the host byte order
    668658        // should be the next hop address or the target destination address
    669         addrlen = packet_get_addr(packet, NULL, (uint8_t **) &addr);
    670         if(addrlen < 0){
    671                 return ip_release_and_return(packet, addrlen);
    672         }
    673         if((size_t) addrlen < sizeof(struct sockaddr)){
    674                 return ip_release_and_return(packet, EINVAL);
    675         }
    676         switch(addr->sa_family){
     659        addrlen = packet_get_addr( packet, NULL, ( uint8_t ** ) & addr );
     660        if( addrlen < 0 ){
     661                return ip_release_and_return( packet, addrlen );
     662        }
     663        if(( size_t ) addrlen < sizeof( struct sockaddr )){
     664                return ip_release_and_return( packet, EINVAL );
     665        }
     666        switch( addr->sa_family ){
    677667                case AF_INET:
    678                         if(addrlen != sizeof(struct sockaddr_in)){
    679                                 return ip_release_and_return(packet, EINVAL);
    680                         }
    681                         address_in = (struct sockaddr_in *) addr;
    682                         dest = &address_in->sin_addr;
    683                         if(! dest->s_addr){
     668                        if( addrlen != sizeof( struct sockaddr_in )){
     669                                return ip_release_and_return( packet, EINVAL );
     670                        }
     671                        address_in = ( struct sockaddr_in * ) addr;
     672                        dest = & address_in->sin_addr;
     673                        if( ! dest->s_addr ){
    684674                                dest->s_addr = IPV4_LOCALHOST_ADDRESS;
    685675                        }
    … …  
    687677                // TODO IPv6
    688678/*              case AF_INET6:
    689                         if(addrlen != sizeof(struct sockaddr_in6)){
    690                                 return EINVAL;
    691                         }
    692                         address_in6 = (struct sockaddr_in6 *) dest;
     679                        if( addrlen != sizeof( struct sockaddr_in6 )) return EINVAL;
     680                        address_in6 = ( struct sockaddr_in6 * ) dest;
    693681                        address_in6.sin6_addr.s6_addr;
    694682                        IPV6_LOCALHOST_ADDRESS;
    695683*/              default:
    696                         return ip_release_and_return(packet, EAFNOSUPPORT);
    697         }
    698         fibril_rwlock_read_lock(&ip_globals.netifs_lock);
     684                        return ip_release_and_return( packet, EAFNOSUPPORT );
     685        }
     686        fibril_rwlock_read_lock( & ip_globals.netifs_lock );
    699687        // device specified?
    700         if(device_id > 0){
    701                 netif = ip_netifs_find(&ip_globals.netifs, device_id);
    702                 route = ip_netif_find_route(netif, * dest);
    703                 if(netif && (! route) && (ip_globals.gateway.netif == netif)){
    704                         route = &ip_globals.gateway;
     688        if( device_id > 0 ){
     689                netif = ip_netifs_find( & ip_globals.netifs, device_id );
     690                route = ip_netif_find_route( netif, * dest );
     691                if( netif && ( ! route ) && ( ip_globals.gateway.netif == netif )){
     692                        route = & ip_globals.gateway;
    705693                }
    706694        }else{
    707                 route = ip_find_route(*dest);
     695                route = ip_find_route( * dest );
    708696                netif = route ? route->netif : NULL;
    709697        }
    710         if(!(netif && route)){
    711                 fibril_rwlock_read_unlock(&ip_globals.netifs_lock);
    712                 phone = ip_prepare_icmp_and_get_phone(error, packet, NULL);
    713                 if(phone >= 0){
     698        if( !( netif && route )){
     699                fibril_rwlock_read_unlock( & ip_globals.netifs_lock );
     700                phone = ip_prepare_icmp_and_get_phone( error, packet, NULL );
     701                if( phone >= 0 ){
    714702                        // unreachable ICMP if no routing
    715                         icmp_destination_unreachable_msg(phone, ICMP_NET_UNREACH, 0, packet);
     703                        icmp_destination_unreachable_msg( phone, ICMP_NET_UNREACH, 0, packet );
    716704                }
    717705                return ENOENT;
    718706        }
    719         if(error){
     707        if( error ){
    720708                // do not send for broadcast, anycast packets or network broadcast
    721                 if((! dest->s_addr)
    722                         || (!(~ dest->s_addr))
    723                         || (!(~((dest->s_addr &(~ route->netmask.s_addr)) | route->netmask.s_addr)))
    724                         || (!(dest->s_addr &(~ route->netmask.s_addr)))){
    725                         return ip_release_and_return(packet, EINVAL);
    726                 }
    727         }
    728         if(route->address.s_addr == dest->s_addr){
     709                if(( ! dest->s_addr )
     710                || ( !( ~ dest->s_addr ))
     711                || ( !( ~(( dest->s_addr & ( ~ route->netmask.s_addr )) | route->netmask.s_addr )))
     712                || ( !( dest->s_addr & ( ~ route->netmask.s_addr )))){
     713                        return ip_release_and_return( packet, EINVAL );
     714                }
     715        }
     716        if( route->address.s_addr == dest->s_addr ){
    729717                // find the loopback device to deliver
    730718                dest->s_addr = IPV4_LOCALHOST_ADDRESS;
    731                 route = ip_find_route(*dest);
     719                route = ip_find_route( * dest );
    732720                netif = route ? route->netif : NULL;
    733                 if(!(netif && route)){
    734                         fibril_rwlock_read_unlock(&ip_globals.netifs_lock);
    735                         phone = ip_prepare_icmp_and_get_phone(error, packet, NULL);
    736                         if(phone >= 0){
     721                if( !( netif && route )){
     722                        fibril_rwlock_read_unlock( & ip_globals.netifs_lock );
     723                        phone = ip_prepare_icmp_and_get_phone( error, packet, NULL );
     724                        if( phone >= 0 ){
    737725                                // unreachable ICMP if no routing
    738                                 icmp_destination_unreachable_msg(phone, ICMP_HOST_UNREACH, 0, packet);
     726                                icmp_destination_unreachable_msg( phone, ICMP_HOST_UNREACH, 0, packet );
    739727                        }
    740728                        return ENOENT;
    741729                }
    742730        }
    743         src = ip_netif_address(netif);
    744         if(! src){
    745                 fibril_rwlock_read_unlock(&ip_globals.netifs_lock);
    746                 return ip_release_and_return(packet, ENOENT);
    747         }
    748         ERROR_CODE = ip_send_route(packet, netif, route, src, * dest, error);
    749         fibril_rwlock_read_unlock(&ip_globals.netifs_lock);
     731        src = ip_netif_address( netif );
     732        if( ! src ){
     733                fibril_rwlock_read_unlock( & ip_globals.netifs_lock );
     734                return ip_release_and_return( packet, ENOENT );
     735        }
     736        ERROR_CODE = ip_send_route( packet, netif, route, src, * dest, error );
     737        fibril_rwlock_read_unlock( & ip_globals.netifs_lock );
    750738        return ERROR_CODE;
    751739}
    752740
    753 in_addr_t * ip_netif_address(ip_netif_ref netif){
    754         ip_route_ref route;
    755 
    756         route = ip_routes_get_index(&netif->routes, 0);
    757         return route ? &route->address : NULL;
    758 }
    759 
    760 int ip_send_route(packet_t packet, ip_netif_ref netif, ip_route_ref route, in_addr_t * src, in_addr_t dest, services_t error){
     741in_addr_t * ip_netif_address( ip_netif_ref netif ){
     742        ip_route_ref    route;
     743
     744        route = ip_routes_get_index( & netif->routes, 0 );
     745        return route ? & route->address : NULL;
     746}
     747
     748int ip_send_route( packet_t packet, ip_netif_ref netif, ip_route_ref route, in_addr_t * src, in_addr_t dest, services_t error ){
    761749        ERROR_DECLARE;
    762750
    763         measured_string_t destination;
    764         measured_string_ref translation;
    765         char * data;
    766         int phone;
     751        measured_string_t       destination;
     752        measured_string_ref     translation;
     753        char *                          data;
     754        int                                     phone;
    767755
    768756        // get destination hardware address
    769         if(netif->arp && (route->address.s_addr != dest.s_addr)){
    770                 destination.value = route->gateway.s_addr ? (char *) &route->gateway.s_addr : (char *) &dest.s_addr;
    771                 destination.length = CONVERT_SIZE(dest.s_addr, char, 1);
    772                 if(ERROR_OCCURRED(arp_translate_req(netif->arp->phone, netif->device_id, SERVICE_IP, &destination, &translation, &data))){
    773 //                      sleep(1);
    774 //                      ERROR_PROPAGATE(arp_translate_req(netif->arp->phone, netif->device_id, SERVICE_IP, &destination, &translation, &data));
    775                         pq_release(ip_globals.net_phone, packet_get_id(packet));
     757        if( netif->arp && ( route->address.s_addr != dest.s_addr )){
     758                destination.value = route->gateway.s_addr ? ( char * ) & route->gateway.s_addr : ( char * ) & dest.s_addr;
     759                destination.length = CONVERT_SIZE( dest.s_addr, char, 1 );
     760                if( ERROR_OCCURRED( arp_translate_req( netif->arp->phone, netif->device_id, SERVICE_IP, & destination, & translation, & data ))){
     761//                      sleep( 1 );
     762//                      ERROR_PROPAGATE( arp_translate_req( netif->arp->phone, netif->device_id, SERVICE_IP, & destination, & translation, & data ));
     763                        pq_release( ip_globals.net_phone, packet_get_id( packet ));
    776764                        return ERROR_CODE;
    777765                }
    778                 if(!(translation && translation->value)){
    779                         if(translation){
    780                                 free(translation);
    781                                 free(data);
    782                         }
    783                         phone = ip_prepare_icmp_and_get_phone(error, packet, NULL);
    784                         if(phone >= 0){
     766                if( !( translation && translation->value )){
     767                        if( translation ){
     768                                free( translation );
     769                                free( data );
     770                        }
     771                        phone = ip_prepare_icmp_and_get_phone( error, packet, NULL );
     772                        if( phone >= 0 ){
    785773                                // unreachable ICMP if no routing
    786                                 icmp_destination_unreachable_msg(phone, ICMP_HOST_UNREACH, 0, packet);
     774                                icmp_destination_unreachable_msg( phone, ICMP_HOST_UNREACH, 0, packet );
    787775                        }
    788776                        return EINVAL;
    789777                }
    790778        }else translation = NULL;
    791         if(ERROR_OCCURRED(ip_prepare_packet(src, dest, packet, translation))){
    792                 pq_release(ip_globals.net_phone, packet_get_id(packet));
     779        if( ERROR_OCCURRED( ip_prepare_packet( src, dest, packet, translation ))){
     780                pq_release( ip_globals.net_phone, packet_get_id( packet ));
    793781        }else{
    794                 packet = ip_split_packet(packet, netif->packet_dimension.prefix, netif->packet_dimension.content, netif->packet_dimension.suffix, netif->packet_dimension.addr_len, error);
    795                 if(packet){
    796                         nil_send_msg(netif->phone, netif->device_id, packet, SERVICE_IP);
    797                 }
    798         }
    799         if(translation){
    800                 free(translation);
    801                 free(data);
     782                packet = ip_split_packet( packet, netif->packet_dimension.prefix, netif->packet_dimension.content, netif->packet_dimension.suffix, netif->packet_dimension.addr_len, error );
     783                if( packet ){
     784                        nil_send_msg( netif->phone, netif->device_id, packet, SERVICE_IP );
     785                }
     786        }
     787        if( translation ){
     788                free( translation );
     789                free( data );
    802790        }
    803791        return ERROR_CODE;
    804792}
    805793
    806 int ip_prepare_packet(in_addr_t * source, in_addr_t dest, packet_t packet, measured_string_ref destination){
     794int ip_prepare_packet( in_addr_t * source, in_addr_t dest, packet_t packet, measured_string_ref destination ){
    807795        ERROR_DECLARE;
    808796
    809         size_t length;
    810         ip_header_ref header;
    811         ip_header_ref last_header;
    812         ip_header_ref middle_header;
    813         packet_t next;
    814 
    815         length = packet_get_data_length(packet);
    816         if((length < sizeof(ip_header_t)) || (length > IP_MAX_CONTENT)){
    817                 return EINVAL;
    818         }
    819         header = (ip_header_ref) packet_get_data(packet);
    820         if(destination){
    821                 ERROR_PROPAGATE(packet_set_addr(packet, NULL, (uint8_t *) destination->value, CONVERT_SIZE(char, uint8_t, destination->length)));
     797        size_t                          length;
     798        ip_header_ref           header;
     799        ip_header_ref           last_header;
     800        ip_header_ref           middle_header;
     801        packet_t                        next;
     802
     803        length = packet_get_data_length( packet );
     804        if(( length < sizeof( ip_header_t )) || ( length > IP_MAX_CONTENT )) return EINVAL;
     805        header = ( ip_header_ref ) packet_get_data( packet );
     806        if( destination ){
     807                ERROR_PROPAGATE( packet_set_addr( packet, NULL, ( uint8_t * ) destination->value, CONVERT_SIZE( char, uint8_t, destination->length )));
    822808        }else{
    823                 ERROR_PROPAGATE(packet_set_addr(packet, NULL, NULL, 0));
     809                ERROR_PROPAGATE( packet_set_addr( packet, NULL, NULL, 0 ));
    824810        }
    825811        header->version = IPV4;
    … …  
    827813        header->fragment_offset_low = 0;
    828814        header->header_checksum = 0;
    829         if(source){
    830                 header->source_address = source->s_addr;
    831         }
     815        if( source ) header->source_address = source->s_addr;
    832816        header->destination_address = dest.s_addr;
    833         fibril_rwlock_write_lock(&ip_globals.lock);
     817        fibril_rwlock_write_lock( & ip_globals.lock );
    834818        ++ ip_globals.packet_counter;
    835         header->identification = htons(ip_globals.packet_counter);
    836         fibril_rwlock_write_unlock(&ip_globals.lock);
    837 //      length = packet_get_data_length(packet);
    838         if(pq_next(packet)){
    839                 last_header = (ip_header_ref) malloc(IP_HEADER_LENGTH(header));
    840                 if(! last_header){
    841                         return ENOMEM;
    842                 }
    843                 ip_create_last_header(last_header, header);
    844                 next = pq_next(packet);
    845                 while(pq_next(next)){
    846                         middle_header = (ip_header_ref) packet_prefix(next, IP_HEADER_LENGTH(last_header));
    847                         if(! middle_header){
    848                                 return ENOMEM;
    849                         }
    850                         memcpy(middle_header, last_header, IP_HEADER_LENGTH(last_header));
     819        header->identification = htons( ip_globals.packet_counter );
     820        fibril_rwlock_write_unlock( & ip_globals.lock );
     821//      length = packet_get_data_length( packet );
     822        if( pq_next( packet )){
     823                last_header = ( ip_header_ref ) malloc( IP_HEADER_LENGTH( header ));
     824                if( ! last_header ) return ENOMEM;
     825                ip_create_last_header( last_header, header );
     826                next = pq_next( packet );
     827                while( pq_next( next )){
     828                        middle_header = ( ip_header_ref ) packet_prefix( next, IP_HEADER_LENGTH( last_header ));
     829                        if( ! middle_header ) return ENOMEM;
     830                        memcpy( middle_header, last_header, IP_HEADER_LENGTH( last_header ));
    851831                        header->flags |= IPFLAG_MORE_FRAGMENTS;
    852                         middle_header->total_length = htons(packet_get_data_length(next));
    853                         middle_header->fragment_offset_high = IP_COMPUTE_FRAGMENT_OFFSET_HIGH(length);
    854                         middle_header->fragment_offset_low = IP_COMPUTE_FRAGMENT_OFFSET_LOW(length);
    855                         middle_header->header_checksum = IP_HEADER_CHECKSUM(middle_header);
    856                         if(destination){
    857                                 ERROR_PROPAGATE(packet_set_addr(next, NULL, (uint8_t *) destination->value, CONVERT_SIZE(char, uint8_t, destination->length)));
    858                         }
    859                         length += packet_get_data_length(next);
    860                         next = pq_next(next);
    861                 }
    862                 middle_header = (ip_header_ref) packet_prefix(next, IP_HEADER_LENGTH(last_header));
    863                 if(! middle_header){
    864                         return ENOMEM;
    865                 }
    866                 memcpy(middle_header, last_header, IP_HEADER_LENGTH(last_header));
    867                 middle_header->total_length = htons(packet_get_data_length(next));
    868                 middle_header->fragment_offset_high = IP_COMPUTE_FRAGMENT_OFFSET_HIGH(length);
    869                 middle_header->fragment_offset_low = IP_COMPUTE_FRAGMENT_OFFSET_LOW(length);
    870                 middle_header->header_checksum = IP_HEADER_CHECKSUM(middle_header);
    871                 if(destination){
    872                         ERROR_PROPAGATE(packet_set_addr(next, NULL, (uint8_t *) destination->value, CONVERT_SIZE(char, uint8_t, destination->length)));
    873                 }
    874                 length += packet_get_data_length(next);
    875                 free(last_header);
     832                        middle_header->total_length = htons( packet_get_data_length( next ));
     833                        middle_header->fragment_offset_high = IP_COMPUTE_FRAGMENT_OFFSET_HIGH( length );
     834                        middle_header->fragment_offset_low = IP_COMPUTE_FRAGMENT_OFFSET_LOW( length );
     835                        middle_header->header_checksum = IP_HEADER_CHECKSUM( middle_header );
     836                        if( destination ){
     837                                ERROR_PROPAGATE( packet_set_addr( next, NULL, ( uint8_t * ) destination->value, CONVERT_SIZE( char, uint8_t, destination->length )));
     838                        }
     839                        length += packet_get_data_length( next );
     840                        next = pq_next( next );
     841                }
     842                middle_header = ( ip_header_ref ) packet_prefix( next, IP_HEADER_LENGTH( last_header ));
     843                if( ! middle_header ) return ENOMEM;
     844                memcpy( middle_header, last_header, IP_HEADER_LENGTH( last_header ));
     845                middle_header->total_length = htons( packet_get_data_length( next ));
     846                middle_header->fragment_offset_high = IP_COMPUTE_FRAGMENT_OFFSET_HIGH( length );
     847                middle_header->fragment_offset_low = IP_COMPUTE_FRAGMENT_OFFSET_LOW( length );
     848                middle_header->header_checksum = IP_HEADER_CHECKSUM( middle_header );
     849                if( destination ){
     850                        ERROR_PROPAGATE( packet_set_addr( next, NULL, ( uint8_t * ) destination->value, CONVERT_SIZE( char, uint8_t, destination->length )));
     851                }
     852                length += packet_get_data_length( next );
     853                free( last_header );
    876854                header->flags |= IPFLAG_MORE_FRAGMENTS;
    877855        }
    878         header->total_length = htons(length);
     856        header->total_length = htons( length );
    879857        // unnecessary for all protocols
    880         header->header_checksum = IP_HEADER_CHECKSUM(header);
     858        header->header_checksum = IP_HEADER_CHECKSUM( header );
    881859        return EOK;
    882860}
    883861
    884 int ip_message(ipc_callid_t callid, ipc_call_t * call, ipc_call_t * answer, int * answer_count){
     862int ip_message( ipc_callid_t callid, ipc_call_t * call, ipc_call_t * answer, int * answer_count ){
    885863        ERROR_DECLARE;
    886864
    887         packet_t packet;
    888         struct sockaddr * addr;
    889         size_t addrlen;
    890         ip_pseudo_header_ref header;
    891         size_t headerlen;
    892 
    893         *answer_count = 0;
    894         switch(IPC_GET_METHOD(*call)){
     865        packet_t                                packet;
     866        struct sockaddr *               addr;
     867        size_t                                  addrlen;
     868        ip_pseudo_header_ref    header;
     869        size_t                                  headerlen;
     870
     871        * answer_count = 0;
     872        switch( IPC_GET_METHOD( * call )){
    895873                case IPC_M_PHONE_HUNGUP:
    896874                        return EOK;
    897875                case NET_IL_DEVICE:
    898                         return ip_device_req(0, IPC_GET_DEVICE(call), IPC_GET_SERVICE(call));
     876                        return ip_device_req( 0, IPC_GET_DEVICE( call ), IPC_GET_SERVICE( call ));
    899877                case IPC_M_CONNECT_TO_ME:
    900                         return ip_register(IL_GET_PROTO(call), IL_GET_SERVICE(call), IPC_GET_PHONE(call), NULL);
     878                        return ip_register( IL_GET_PROTO( call ), IL_GET_SERVICE( call ), IPC_GET_PHONE( call ), NULL );
    901879                case NET_IL_SEND:
    902                         ERROR_PROPAGATE(packet_translate(ip_globals.net_phone, &packet, IPC_GET_PACKET(call)));
    903                         return ip_send_msg(0, IPC_GET_DEVICE(call), packet, 0, IPC_GET_ERROR(call));
     880                        ERROR_PROPAGATE( packet_translate( ip_globals.net_phone, & packet, IPC_GET_PACKET( call )));
     881                        return ip_send_msg( 0, IPC_GET_DEVICE( call ), packet, 0, IPC_GET_ERROR( call ));
    904882                case NET_IL_DEVICE_STATE:
    905                         return ip_device_state_message(IPC_GET_DEVICE(call), IPC_GET_STATE(call));
     883                        return ip_device_state_message( IPC_GET_DEVICE( call ), IPC_GET_STATE( call ));
    906884                case NET_IL_RECEIVED:
    907                         ERROR_PROPAGATE(packet_translate(ip_globals.net_phone, &packet, IPC_GET_PACKET(call)));
    908                         return ip_receive_message(IPC_GET_DEVICE(call), packet);
     885                        ERROR_PROPAGATE( packet_translate( ip_globals.net_phone, & packet, IPC_GET_PACKET( call )));
     886                        return ip_receive_message( IPC_GET_DEVICE( call ), packet );
    909887                case NET_IP_RECEIVED_ERROR:
    910                         ERROR_PROPAGATE(packet_translate(ip_globals.net_phone, &packet, IPC_GET_PACKET(call)));
    911                         return ip_received_error_msg(0, IPC_GET_DEVICE(call), packet, IPC_GET_TARGET(call), IPC_GET_ERROR(call));
     888                        ERROR_PROPAGATE( packet_translate( ip_globals.net_phone, & packet, IPC_GET_PACKET( call )));
     889                        return ip_received_error_msg( 0, IPC_GET_DEVICE( call ), packet, IPC_GET_TARGET( call ), IPC_GET_ERROR( call ));
    912890                case NET_IP_ADD_ROUTE:
    913                         return ip_add_route_req(0, IPC_GET_DEVICE(call), IP_GET_ADDRESS(call), IP_GET_NETMASK(call), IP_GET_GATEWAY(call));
     891                        return ip_add_route_req( 0, IPC_GET_DEVICE( call ), IP_GET_ADDRESS( call ), IP_GET_NETMASK( call ), IP_GET_GATEWAY( call ));
    914892                case NET_IP_SET_GATEWAY:
    915                         return ip_set_gateway_req(0, IPC_GET_DEVICE(call), IP_GET_GATEWAY(call));
     893                        return ip_set_gateway_req( 0, IPC_GET_DEVICE( call ), IP_GET_GATEWAY( call ));
    916894                case NET_IP_GET_ROUTE:
    917                         ERROR_PROPAGATE(data_receive((void **) &addr, &addrlen));
    918                         ERROR_PROPAGATE(ip_get_route_req(0, IP_GET_PROTOCOL(call), addr, (socklen_t) addrlen, IPC_SET_DEVICE(answer), &header, &headerlen));
    919                         *IP_SET_HEADERLEN(answer) = headerlen;
    920                         *answer_count = 2;
    921                         if(! ERROR_OCCURRED(data_reply(&headerlen, sizeof(headerlen)))){
    922                                 ERROR_CODE = data_reply(header, headerlen);
    923                         }
    924                         free(header);
     895                        ERROR_PROPAGATE( data_receive(( void ** ) & addr, & addrlen ));
     896                        ERROR_PROPAGATE( ip_get_route_req( 0, IP_GET_PROTOCOL( call ), addr, ( socklen_t ) addrlen, IPC_SET_DEVICE( answer ), & header, & headerlen ));
     897                        * IP_SET_HEADERLEN( answer ) = headerlen;
     898                        * answer_count = 2;
     899                        if( ! ERROR_OCCURRED( data_reply( & headerlen, sizeof( headerlen )))){
     900                                ERROR_CODE = data_reply( header, headerlen );
     901                        }
     902                        free( header );
    925903                        return ERROR_CODE;
    926904                case NET_IL_PACKET_SPACE:
    927                         ERROR_PROPAGATE(ip_packet_size_message(IPC_GET_DEVICE(call), IPC_SET_ADDR(answer), IPC_SET_PREFIX(answer), IPC_SET_CONTENT(answer), IPC_SET_SUFFIX(answer)));
    928                         *answer_count = 3;
     905                        ERROR_PROPAGATE( ip_packet_size_message( IPC_GET_DEVICE( call ), IPC_SET_ADDR( answer ), IPC_SET_PREFIX( answer ), IPC_SET_CONTENT( answer ), IPC_SET_SUFFIX( answer )));
     906                        * answer_count = 3;
    929907                        return EOK;
    930908                case NET_IL_MTU_CHANGED:
    931                         return ip_mtu_changed_message(IPC_GET_DEVICE(call), IPC_GET_MTU(call));
     909                        return ip_mtu_changed_message( IPC_GET_DEVICE( call ), IPC_GET_MTU( call ));
    932910        }
    933911        return ENOTSUP;
    934912}
    935913
    936 int ip_packet_size_req(int ip_phone, device_id_t device_id, packet_dimension_ref packet_dimension){
    937         if(! packet_dimension){
    938                 return EBADMEM;
    939         }
    940         return ip_packet_size_message(device_id, &packet_dimension->addr_len, &packet_dimension->prefix, &packet_dimension->content, &packet_dimension->suffix);
    941 }
    942 
    943 int ip_packet_size_message(device_id_t device_id, size_t * addr_len, size_t * prefix, size_t * content, size_t * suffix){
    944         ip_netif_ref netif;
    945         int index;
    946 
    947         if(!(addr_len && prefix && content && suffix)){
    948                 return EBADMEM;
    949         }
    950         *content = IP_MAX_CONTENT - IP_PREFIX;
    951         fibril_rwlock_read_lock(&ip_globals.netifs_lock);
    952         if(device_id < 0){
    953                 *addr_len = IP_ADDR;
    954                 *prefix = 0;
    955                 *suffix = 0;
    956                 for(index = ip_netifs_count(&ip_globals.netifs) - 1; index >= 0; -- index){
    957                         netif = ip_netifs_get_index(&ip_globals.netifs, index);
    958                         if(netif){
    959                                 if(netif->packet_dimension.addr_len > * addr_len){
    960                                         *addr_len = netif->packet_dimension.addr_len;
    961                                 }
    962                                 if(netif->packet_dimension.prefix > * prefix){
    963                                         *prefix = netif->packet_dimension.prefix;
    964                                 }
    965                                 if(netif->packet_dimension.suffix > * suffix){
    966                                         *suffix = netif->packet_dimension.suffix;
    967                                 }
    968                         }
    969                 }
    970                 *prefix = * prefix + IP_PREFIX;
    971                 *suffix = * suffix + IP_SUFFIX;
     914int ip_packet_size_req( int ip_phone, device_id_t device_id, packet_dimension_ref packet_dimension ){
     915        if( ! packet_dimension ) return EBADMEM;
     916        return ip_packet_size_message( device_id, & packet_dimension->addr_len, & packet_dimension->prefix, & packet_dimension->content, & packet_dimension->suffix );
     917}
     918
     919int ip_packet_size_message( device_id_t device_id, size_t * addr_len, size_t * prefix, size_t * content, size_t * suffix ){
     920        ip_netif_ref    netif;
     921        int                             index;
     922
     923        if( !( addr_len && prefix && content && suffix )) return EBADMEM;
     924        * content = IP_MAX_CONTENT - IP_PREFIX;
     925        fibril_rwlock_read_lock( & ip_globals.netifs_lock );
     926        if( device_id < 0 ){
     927                * addr_len = IP_ADDR;
     928                * prefix = 0;
     929                * suffix = 0;
     930                for( index = ip_netifs_count( & ip_globals.netifs ) - 1; index >= 0; -- index ){
     931                        netif = ip_netifs_get_index( & ip_globals.netifs, index );
     932                        if( netif ){
     933                                if( netif->packet_dimension.addr_len > * addr_len ) * addr_len = netif->packet_dimension.addr_len;
     934                                if( netif->packet_dimension.prefix > * prefix ) * prefix = netif->packet_dimension.prefix;
     935                                if( netif->packet_dimension.suffix > * suffix ) * suffix = netif->packet_dimension.suffix;
     936                        }
     937                }
     938                * prefix = * prefix + IP_PREFIX;
     939                * suffix = * suffix + IP_SUFFIX;
    972940        }else{
    973                 netif = ip_netifs_find(&ip_globals.netifs, device_id);
    974                 if(! netif){
    975                         fibril_rwlock_read_unlock(&ip_globals.netifs_lock);
     941                netif = ip_netifs_find( & ip_globals.netifs, device_id );
     942                if( ! netif ){
     943                        fibril_rwlock_read_unlock( & ip_globals.netifs_lock );
    976944                        return ENOENT;
    977945                }
    978                 *addr_len = (netif->packet_dimension.addr_len > IP_ADDR) ? netif->packet_dimension.addr_len : IP_ADDR;
    979                 *prefix = netif->packet_dimension.prefix + IP_PREFIX;
    980                 *suffix = netif->packet_dimension.suffix + IP_SUFFIX;
    981         }
    982         fibril_rwlock_read_unlock(&ip_globals.netifs_lock);
     946                * addr_len = ( netif->packet_dimension.addr_len > IP_ADDR ) ? netif->packet_dimension.addr_len : IP_ADDR;
     947                * prefix = netif->packet_dimension.prefix + IP_PREFIX;
     948                * suffix = netif->packet_dimension.suffix + IP_SUFFIX;
     949        }
     950        fibril_rwlock_read_unlock( & ip_globals.netifs_lock );
    983951        return EOK;
    984952}
    985953
    986 int ip_add_route_req(int ip_phone, device_id_t device_id, in_addr_t address, in_addr_t netmask, in_addr_t gateway){
    987         ip_route_ref route;
    988         ip_netif_ref netif;
    989         int index;
    990 
    991         fibril_rwlock_write_lock(&ip_globals.netifs_lock);
    992         netif = ip_netifs_find(&ip_globals.netifs, device_id);
    993         if(! netif){
    994                 fibril_rwlock_write_unlock(&ip_globals.netifs_lock);
     954int ip_add_route_req( int ip_phone, device_id_t device_id, in_addr_t address, in_addr_t netmask, in_addr_t gateway ){
     955        ip_route_ref    route;
     956        ip_netif_ref    netif;
     957        int                             index;
     958
     959        fibril_rwlock_write_lock( & ip_globals.netifs_lock );
     960        netif = ip_netifs_find( & ip_globals.netifs, device_id );
     961        if( ! netif ){
     962                fibril_rwlock_write_unlock( & ip_globals.netifs_lock );
    995963                return ENOENT;
    996964        }
    997         route = (ip_route_ref) malloc(sizeof(ip_route_t));
    998         if(! route){
    999                 fibril_rwlock_write_unlock(&ip_globals.netifs_lock);
     965        route = ( ip_route_ref ) malloc( sizeof( ip_route_t ));
     966        if( ! route ){
     967                fibril_rwlock_write_unlock( & ip_globals.netifs_lock );
    1000968                return ENOMEM;
    1001969        }
    … …  
    1004972        route->gateway.s_addr = gateway.s_addr;
    1005973        route->netif = netif;
    1006         index = ip_routes_add(&netif->routes, route);
    1007         if(index < 0){
    1008                 free(route);
    1009         }
    1010         fibril_rwlock_write_unlock(&ip_globals.netifs_lock);
     974        index = ip_routes_add( & netif->routes, route );
     975        if( index < 0 ) free( route );
     976        fibril_rwlock_write_unlock( & ip_globals.netifs_lock );
    1011977        return index;
    1012978}
    1013979
    1014 ip_route_ref ip_find_route(in_addr_t destination){
    1015         int index;
    1016         ip_route_ref route;
    1017         ip_netif_ref netif;
     980ip_route_ref ip_find_route( in_addr_t destination ){
     981        int                             index;
     982        ip_route_ref    route;
     983        ip_netif_ref    netif;
    1018984
    1019985        // start with the last netif - the newest one
    1020         index = ip_netifs_count(&ip_globals.netifs) - 1;
    1021         while(index >= 0){
    1022                 netif = ip_netifs_get_index(&ip_globals.netifs, index);
    1023                 if(netif && (netif->state == NETIF_ACTIVE)){
    1024                         route = ip_netif_find_route(netif, destination);
    1025                         if(route){
     986        index = ip_netifs_count( & ip_globals.netifs ) - 1;
     987        while( index >= 0 ){
     988                netif = ip_netifs_get_index( & ip_globals.netifs, index );
     989                if( netif && ( netif->state == NETIF_ACTIVE )){
     990                        route = ip_netif_find_route( netif, destination );
     991                        if( route ) return route;
     992                }
     993                -- index;
     994        }
     995        return & ip_globals.gateway;
     996}
     997
     998ip_route_ref ip_netif_find_route( ip_netif_ref netif, in_addr_t destination ){
     999        int                             index;
     1000        ip_route_ref    route;
     1001
     1002        if( netif ){
     1003                // start with the first one - the direct route
     1004                for( index = 0; index < ip_routes_count( & netif->routes ); ++ index ){
     1005                        route = ip_routes_get_index( & netif->routes, index );
     1006                        if( route && (( route->address.s_addr & route->netmask.s_addr ) == ( destination.s_addr & route->netmask.s_addr ))){
    10261007                                return route;
    10271008                        }
    10281009                }
    1029                 -- index;
    1030         }
    1031         return &ip_globals.gateway;
    1032 }
    1033 
    1034 ip_route_ref ip_netif_find_route(ip_netif_ref netif, in_addr_t destination){
    1035         int index;
    1036         ip_route_ref route;
    1037 
    1038         if(netif){
    1039                 // start with the first one - the direct route
    1040                 for(index = 0; index < ip_routes_count(&netif->routes); ++ index){
    1041                         route = ip_routes_get_index(&netif->routes, index);
    1042                         if(route && ((route->address.s_addr &route->netmask.s_addr) == (destination.s_addr &route->netmask.s_addr))){
    1043                                 return route;
    1044                         }
    1045                 }
    10461010        }
    10471011        return NULL;
    10481012}
    10491013
    1050 int ip_set_gateway_req(int ip_phone, device_id_t device_id, in_addr_t gateway){
    1051         ip_netif_ref netif;
    1052 
    1053         fibril_rwlock_write_lock(&ip_globals.netifs_lock);
    1054         netif = ip_netifs_find(&ip_globals.netifs, device_id);
    1055         if(! netif){
    1056                 fibril_rwlock_write_unlock(&ip_globals.netifs_lock);
     1014int ip_set_gateway_req( int ip_phone, device_id_t device_id, in_addr_t gateway ){
     1015        ip_netif_ref    netif;
     1016
     1017        fibril_rwlock_write_lock( & ip_globals.netifs_lock );
     1018        netif = ip_netifs_find( & ip_globals.netifs, device_id );
     1019        if( ! netif ){
     1020                fibril_rwlock_write_unlock( & ip_globals.netifs_lock );
    10571021                return ENOENT;
    10581022        }
    … …  
    10611025        ip_globals.gateway.gateway.s_addr = gateway.s_addr;
    10621026        ip_globals.gateway.netif = netif;
    1063         fibril_rwlock_write_unlock(&ip_globals.netifs_lock);
     1027        fibril_rwlock_write_unlock( & ip_globals.netifs_lock );
    10641028        return EOK;
    10651029}
    10661030
    1067 packet_t ip_split_packet(packet_t packet, size_t prefix, size_t content, size_t suffix, socklen_t addr_len, services_t error){
    1068         size_t length;
    1069         packet_t next;
    1070         packet_t new_packet;
    1071         int result;
    1072         int phone;
     1031packet_t ip_split_packet( packet_t packet, size_t prefix, size_t content, size_t suffix, socklen_t addr_len, services_t error ){
     1032        size_t                  length;
     1033        packet_t                next;
     1034        packet_t                new_packet;
     1035        int                             result;
     1036        int                             phone;
    10731037
    10741038        next = packet;
    10751039        // check all packets
    1076         while(next){
    1077                 length = packet_get_data_length(next);
     1040        while( next ){
     1041                length = packet_get_data_length( next );
    10781042                // too long?
    1079                 if(length > content){
    1080                         result = ip_fragment_packet(next, content, prefix, suffix, addr_len);
    1081                         if(result != EOK){
    1082                                 new_packet = pq_detach(next);
    1083                                 if(next == packet){
     1043                if( length > content ){
     1044                        result = ip_fragment_packet( next, content, prefix, suffix, addr_len );
     1045                        if( result != EOK ){
     1046                                new_packet = pq_detach( next );
     1047                                if( next == packet ){
    10841048                                        // the new first packet of the queue
    10851049                                        packet = new_packet;
    10861050                                }
    10871051                                // fragmentation needed?
    1088                                 if(result == EPERM){
    1089                                         phone = ip_prepare_icmp_and_get_phone(error, next, NULL);
    1090                                         if(phone >= 0){
     1052                                if( result == EPERM ){
     1053                                        phone = ip_prepare_icmp_and_get_phone( error, next, NULL );
     1054                                        if( phone >= 0 ){
    10911055                                                // fragmentation necessary ICMP
    1092                                                 icmp_destination_unreachable_msg(phone, ICMP_FRAG_NEEDED, content, next);
     1056                                                icmp_destination_unreachable_msg( phone, ICMP_FRAG_NEEDED, content, next );
    10931057                                        }
    10941058                                }else{
    1095                                         pq_release(ip_globals.net_phone, packet_get_id(next));
     1059                                        pq_release( ip_globals.net_phone, packet_get_id( next ));
    10961060                                }
    10971061                                next = new_packet;
    … …  
    10991063                        }
    11001064                }
    1101                 next = pq_next(next);
     1065                next = pq_next( next );
    11021066        }
    11031067        return packet;
    11041068}
    11051069
    1106 int ip_fragment_packet(packet_t packet, size_t length, size_t prefix, size_t suffix, socklen_t addr_len){
     1070int ip_fragment_packet( packet_t packet, size_t length, size_t prefix, size_t suffix, socklen_t addr_len ){
    11071071        ERROR_DECLARE;
    11081072
    1109         packet_t new_packet;
    1110         ip_header_ref header;
    1111         ip_header_ref middle_header;
    1112         ip_header_ref last_header;
    1113         struct sockaddr * src;
    1114         struct sockaddr * dest;
    1115         socklen_t addrlen;
    1116         int result;
    1117 
    1118         result = packet_get_addr(packet, (uint8_t **) &src, (uint8_t **) &dest);
    1119         if(result <= 0){
    1120                 return EINVAL;
    1121         }
    1122         addrlen = (socklen_t) result;
    1123         if(packet_get_data_length(packet) <= sizeof(ip_header_t)){
    1124                 return ENOMEM;
    1125         }
     1073        packet_t                new_packet;
     1074        ip_header_ref   header;
     1075        ip_header_ref   middle_header;
     1076        ip_header_ref   last_header;
     1077        struct sockaddr *               src;
     1078        struct sockaddr *               dest;
     1079        socklen_t               addrlen;
     1080        int                             result;
     1081
     1082        result = packet_get_addr( packet, ( uint8_t ** ) & src, ( uint8_t ** ) & dest );
     1083        if( result <= 0 ) return EINVAL;
     1084        addrlen = ( socklen_t ) result;
     1085        if( packet_get_data_length( packet ) <= sizeof( ip_header_t )) return ENOMEM;
    11261086        // get header
    1127         header = (ip_header_ref) packet_get_data(packet);
    1128         if(! header){
    1129                 return EINVAL;
    1130         }
     1087        header = ( ip_header_ref ) packet_get_data( packet );
     1088        if( ! header ) return EINVAL;
    11311089        // fragmentation forbidden?
    1132         if(header->flags &IPFLAG_DONT_FRAGMENT){
     1090        if( header->flags & IPFLAG_DONT_FRAGMENT ){
    11331091                return EPERM;
    11341092        }
    11351093        // create the last fragment
    1136         new_packet = packet_get_4(ip_globals.net_phone, prefix, length, suffix, ((addrlen > addr_len) ? addrlen : addr_len));
    1137         if(! new_packet){
    1138                 return ENOMEM;
    1139         }
     1094        new_packet = packet_get_4( ip_globals.net_phone, prefix, length, suffix, (( addrlen > addr_len ) ? addrlen : addr_len ));
     1095        if( ! new_packet ) return ENOMEM;
    11401096        // allocate as much as originally
    1141         last_header = (ip_header_ref) packet_suffix(new_packet, IP_HEADER_LENGTH(header));
    1142         if(! last_header){
    1143                 return ip_release_and_return(packet, ENOMEM);
    1144         }
    1145         ip_create_last_header(last_header, header);
     1097        last_header = ( ip_header_ref ) packet_suffix( new_packet, IP_HEADER_LENGTH( header ));
     1098        if( ! last_header ){
     1099                return ip_release_and_return( packet, ENOMEM );
     1100        }
     1101        ip_create_last_header( last_header, header );
    11461102        // trim the unused space
    1147         if(ERROR_OCCURRED(packet_trim(new_packet, 0, IP_HEADER_LENGTH(header) - IP_HEADER_LENGTH(last_header)))){
    1148                 return ip_release_and_return(packet, ERROR_CODE);
     1103        if( ERROR_OCCURRED( packet_trim( new_packet, 0, IP_HEADER_LENGTH( header ) - IP_HEADER_LENGTH( last_header )))){
     1104                return ip_release_and_return( packet, ERROR_CODE );
    11491105        }
    11501106        // biggest multiple of 8 lower than content
    11511107        // TODO even fragmentation?
    1152         length = length &(~ 0x7);// (content / 8) * 8
    1153         if(ERROR_OCCURRED(ip_fragment_packet_data(packet, new_packet, header, last_header, ((IP_HEADER_DATA_LENGTH(header) - ((length - IP_HEADER_LENGTH(header)) &(~ 0x7))) % ((length - IP_HEADER_LENGTH(last_header)) &(~ 0x7))), src, dest, addrlen))){
    1154                 return ip_release_and_return(packet, ERROR_CODE);
     1108        length = length & ( ~ 0x7 );// ( content / 8 ) * 8
     1109        if( ERROR_OCCURRED( ip_fragment_packet_data( packet, new_packet, header, last_header, (( IP_HEADER_DATA_LENGTH( header ) - (( length - IP_HEADER_LENGTH( header )) & ( ~ 0x7 ))) % (( length - IP_HEADER_LENGTH( last_header )) & ( ~ 0x7 ))), src, dest, addrlen ))){
     1110                return ip_release_and_return( packet, ERROR_CODE );
    11551111        }
    11561112        // mark the first as fragmented
    11571113        header->flags |= IPFLAG_MORE_FRAGMENTS;
    11581114        // create middle framgents
    1159         while(IP_TOTAL_LENGTH(header) > length){
    1160                 new_packet = packet_get_4(ip_globals.net_phone, prefix, length, suffix, ((addrlen >= addr_len) ? addrlen : addr_len));
    1161                 if(! new_packet){
    1162                         return ENOMEM;
    1163                 }
    1164                 middle_header = ip_create_middle_header(new_packet, last_header);
    1165                 if(! middle_header){
    1166                         return ip_release_and_return(packet, ENOMEM);
    1167                 }
    1168                 if(ERROR_OCCURRED(ip_fragment_packet_data(packet, new_packet, header, middle_header, (length - IP_HEADER_LENGTH(middle_header)) &(~ 0x7), src, dest, addrlen))){
    1169                         return ip_release_and_return(packet, ERROR_CODE);
     1115        while( IP_TOTAL_LENGTH( header ) > length ){
     1116                new_packet = packet_get_4( ip_globals.net_phone, prefix, length, suffix, (( addrlen >= addr_len ) ? addrlen : addr_len ));
     1117                if( ! new_packet ) return ENOMEM;
     1118                middle_header = ip_create_middle_header( new_packet, last_header );
     1119                if( ! middle_header ){
     1120                        return ip_release_and_return( packet, ENOMEM );
     1121                }
     1122                if( ERROR_OCCURRED( ip_fragment_packet_data( packet, new_packet, header, middle_header, ( length - IP_HEADER_LENGTH( middle_header )) & ( ~ 0x7 ), src, dest, addrlen ))){
     1123                        return ip_release_and_return( packet, ERROR_CODE );
    11701124                }
    11711125        }
    11721126        // finish the first fragment
    1173         header->header_checksum = IP_HEADER_CHECKSUM(header);
     1127        header->header_checksum = IP_HEADER_CHECKSUM( header );
    11741128        return EOK;
    11751129}
    11761130
    1177 int ip_fragment_packet_data(packet_t packet, packet_t new_packet, ip_header_ref header, ip_header_ref new_header, size_t length, const struct sockaddr * src, const struct sockaddr * dest, socklen_t addrlen){
     1131int ip_fragment_packet_data( packet_t packet, packet_t new_packet, ip_header_ref header, ip_header_ref new_header, size_t length, const struct sockaddr * src, const struct sockaddr * dest, socklen_t addrlen ){
    11781132        ERROR_DECLARE;
    11791133
    1180         void * data;
    1181         size_t offset;
    1182 
    1183         data = packet_suffix(new_packet, length);
    1184         if(! data){
    1185                 return ENOMEM;
    1186         }
    1187         memcpy(data, ((void *) header) + IP_TOTAL_LENGTH(header) - length, length);
    1188         ERROR_PROPAGATE(packet_trim(packet, 0, length));
    1189         header->total_length = htons(IP_TOTAL_LENGTH(header) - length);
    1190         new_header->total_length = htons(IP_HEADER_LENGTH(new_header) + length);
    1191         offset = IP_FRAGMENT_OFFSET(header) + IP_HEADER_DATA_LENGTH(header);
    1192         new_header->fragment_offset_high = IP_COMPUTE_FRAGMENT_OFFSET_HIGH(offset);
    1193         new_header->fragment_offset_low = IP_COMPUTE_FRAGMENT_OFFSET_LOW(offset);
    1194         new_header->header_checksum = IP_HEADER_CHECKSUM(new_header);
    1195         ERROR_PROPAGATE(packet_set_addr(new_packet, (const uint8_t *) src, (const uint8_t *) dest, addrlen));
    1196         return pq_insert_after(packet, new_packet);
    1197 }
    1198 
    1199 ip_header_ref ip_create_middle_header(packet_t packet, ip_header_ref last){
    1200         ip_header_ref middle;
    1201 
    1202         middle = (ip_header_ref) packet_suffix(packet, IP_HEADER_LENGTH(last));
    1203         if(! middle){
    1204                 return NULL;
    1205         }
    1206         memcpy(middle, last, IP_HEADER_LENGTH(last));
     1134        void *                  data;
     1135        size_t                  offset;
     1136
     1137        data = packet_suffix( new_packet, length );
     1138        if( ! data ) return ENOMEM;
     1139        memcpy( data, (( void * ) header ) + IP_TOTAL_LENGTH( header ) - length, length );
     1140        ERROR_PROPAGATE( packet_trim( packet, 0, length ));
     1141        header->total_length = htons( IP_TOTAL_LENGTH( header ) - length );
     1142        new_header->total_length = htons( IP_HEADER_LENGTH( new_header ) + length );
     1143        offset = IP_FRAGMENT_OFFSET( header ) + IP_HEADER_DATA_LENGTH( header );
     1144        new_header->fragment_offset_high = IP_COMPUTE_FRAGMENT_OFFSET_HIGH( offset );
     1145        new_header->fragment_offset_low = IP_COMPUTE_FRAGMENT_OFFSET_LOW( offset );
     1146        new_header->header_checksum = IP_HEADER_CHECKSUM( new_header );
     1147        ERROR_PROPAGATE( packet_set_addr( new_packet, ( const uint8_t * ) src, ( const uint8_t * ) dest, addrlen ));
     1148        return pq_insert_after( packet, new_packet );
     1149}
     1150
     1151ip_header_ref ip_create_middle_header( packet_t packet, ip_header_ref last ){
     1152        ip_header_ref   middle;
     1153
     1154        middle = ( ip_header_ref ) packet_suffix( packet, IP_HEADER_LENGTH( last ));
     1155        if( ! middle ) return NULL;
     1156        memcpy( middle, last, IP_HEADER_LENGTH( last ));
    12071157        middle->flags |= IPFLAG_MORE_FRAGMENTS;
    12081158        return middle;
    12091159}
    12101160
    1211 void ip_create_last_header(ip_header_ref last, ip_header_ref first){
    1212         ip_option_ref option;
    1213         size_t next;
    1214         size_t length;
     1161void ip_create_last_header( ip_header_ref last, ip_header_ref first ){
     1162        ip_option_ref   option;
     1163        size_t                  next;
     1164        size_t                  length;
    12151165
    12161166        // copy first itself
    1217         memcpy(last, first, sizeof(ip_header_t));
    1218         length = sizeof(ip_header_t);
    1219         next = sizeof(ip_header_t);
     1167        memcpy( last, first, sizeof( ip_header_t ));
     1168        length = sizeof( ip_header_t );
     1169        next = sizeof( ip_header_t );
    12201170        // process all ip options
    1221         while(next < first->header_length){
    1222                 option = (ip_option_ref) (((uint8_t *) first) + next);
     1171        while( next < first->header_length ){
     1172                option = ( ip_option_ref ) ((( uint8_t * ) first ) + next );
    12231173                // skip end or noop
    1224                 if((option->type == IPOPT_END) || (option->type == IPOPT_NOOP)){
     1174                if(( option->type == IPOPT_END ) || ( option->type == IPOPT_NOOP )){
    12251175                        ++ next;
    12261176                }else{
    12271177                        // copy if said so or skip
    1228                         if(IPOPT_COPIED(option->type)){
    1229                                 memcpy(((uint8_t *) last) + length, ((uint8_t *) first) + next, option->length);
     1178                        if( IPOPT_COPIED( option->type )){
     1179                                memcpy((( uint8_t * ) last ) + length, (( uint8_t * ) first ) + next, option->length );
    12301180                                length += option->length;
    12311181                        }
    … …  
    12351185        }
    12361186        // align 4 byte boundary
    1237         if(length % 4){
    1238                 bzero(((uint8_t *) last) + length, 4 - (length % 4));
     1187        if( length % 4 ){
     1188                bzero((( uint8_t * ) last ) + length, 4 - ( length % 4 ));
    12391189                last->header_length = length / 4 + 1;
    12401190        }else{
    … …  
    12441194}
    12451195
    1246 int ip_receive_message(device_id_t device_id, packet_t packet){
    1247         packet_t next;
     1196int ip_receive_message( device_id_t device_id, packet_t packet ){
     1197        packet_t                next;
    12481198
    12491199        do{
    1250                 next = pq_detach(packet);
    1251                 ip_process_packet(device_id, packet);
     1200                next = pq_detach( packet );
     1201                ip_process_packet( device_id, packet );
    12521202                packet = next;
    1253         }while(packet);
     1203        }while( packet );
    12541204        return EOK;
    12551205}
    12561206
    1257 int ip_process_packet(device_id_t device_id, packet_t packet){
     1207int ip_process_packet( device_id_t device_id, packet_t packet ){
    12581208        ERROR_DECLARE;
    12591209
    1260         ip_header_ref header;
    1261         in_addr_t dest;
    1262         ip_route_ref route;
    1263         int phone;
    1264         struct sockaddr * addr;
    1265         struct sockaddr_in addr_in;
     1210        ip_header_ref   header;
     1211        in_addr_t               dest;
     1212        ip_route_ref    route;
     1213        int                             phone;
     1214        struct sockaddr *       addr;
     1215        struct sockaddr_in      addr_in;
    12661216//      struct sockaddr_in      addr_in6;
    1267         socklen_t addrlen;
    1268 
    1269         header = (ip_header_ref) packet_get_data(packet);
    1270         if(! header){
    1271                 return ip_release_and_return(packet, ENOMEM);
     1217        socklen_t               addrlen;
     1218
     1219        header = ( ip_header_ref ) packet_get_data( packet );
     1220        if( ! header ){
     1221                return ip_release_and_return( packet, ENOMEM );
    12721222        }
    12731223        // checksum
    1274         if((header->header_checksum) && (IP_HEADER_CHECKSUM(header) != IP_CHECKSUM_ZERO)){
    1275                 phone = ip_prepare_icmp_and_get_phone(0, packet, header);
    1276                 if(phone >= 0){
     1224        if(( header->header_checksum ) && ( IP_HEADER_CHECKSUM( header ) != IP_CHECKSUM_ZERO )){
     1225                phone = ip_prepare_icmp_and_get_phone( 0, packet, header );
     1226                if( phone >= 0 ){
    12771227                        // checksum error ICMP
    1278                         icmp_parameter_problem_msg(phone, ICMP_PARAM_POINTER, ((size_t) ((void *) &header->header_checksum)) - ((size_t) ((void *) header)), packet);
     1228                        icmp_parameter_problem_msg( phone, ICMP_PARAM_POINTER, (( size_t ) (( void * ) & header->header_checksum )) - (( size_t ) (( void * ) header )), packet );
    12791229                }
    12801230                return EINVAL;
    12811231        }
    1282         if(header->ttl <= 1){
    1283                 phone = ip_prepare_icmp_and_get_phone(0, packet, header);
    1284                 if(phone >= 0){
     1232        if( header->ttl <= 1 ){
     1233                phone = ip_prepare_icmp_and_get_phone( 0, packet, header );
     1234                if( phone >= 0 ){
    12851235                        // ttl oxceeded ICMP
    1286                         icmp_time_exceeded_msg(phone, ICMP_EXC_TTL, packet);
     1236                        icmp_time_exceeded_msg( phone, ICMP_EXC_TTL, packet );
    12871237                }
    12881238                return EINVAL;
    12891239        }
    12901240        // process ipopt and get destination
    1291         dest = ip_get_destination(header);
     1241        dest = ip_get_destination( header );
    12921242        // set the addrination address
    1293         switch(header->version){
     1243        switch( header->version ){
    12941244                case IPVERSION:
    1295                         addrlen = sizeof(addr_in);
    1296                         bzero(&addr_in, addrlen);
     1245                        addrlen = sizeof( addr_in );
     1246                        bzero( & addr_in, addrlen );
    12971247                        addr_in.sin_family = AF_INET;
    1298                         memcpy(&addr_in.sin_addr.s_addr, &dest, sizeof(dest));
    1299                         addr = (struct sockaddr *) &addr_in;
     1248                        memcpy( & addr_in.sin_addr.s_addr, & dest, sizeof( dest ));
     1249                        addr = ( struct sockaddr * ) & addr_in;
    13001250                        break;
    13011251/*              case IPv6VERSION:
    1302                         addrlen = sizeof(dest_in6);
    1303                         bzero(&dest_in6, addrlen);
     1252                        addrlen = sizeof( dest_in6 );
     1253                        bzero( & dest_in6, addrlen );
    13041254                        dest_in6.sin6_family = AF_INET6;
    1305                         memcpy(&dest_in6.sin6_addr.s6_addr,);
    1306                         dest = (struct sockaddr *) &dest_in;
     1255                        memcpy( & dest_in6.sin6_addr.s6_addr, );
     1256                        dest = ( struct sockaddr * ) & dest_in;
    13071257                        break;
    13081258*/              default:
    1309                         return ip_release_and_return(packet, EAFNOSUPPORT);
    1310         }
    1311         ERROR_PROPAGATE(packet_set_addr(packet, NULL, (uint8_t *) &addr, addrlen));
    1312         route = ip_find_route(dest);
    1313         if(! route){
    1314                 phone = ip_prepare_icmp_and_get_phone(0, packet, header);
    1315                 if(phone >= 0){
     1259                        return ip_release_and_return( packet, EAFNOSUPPORT );
     1260        }
     1261        ERROR_PROPAGATE( packet_set_addr( packet, NULL, ( uint8_t * ) & addr, addrlen ));
     1262        route = ip_find_route( dest );
     1263        if( ! route ){
     1264                phone = ip_prepare_icmp_and_get_phone( 0, packet, header );
     1265                if( phone >= 0 ){
    13161266                        // unreachable ICMP
    1317                         icmp_destination_unreachable_msg(phone, ICMP_HOST_UNREACH, 0, packet);
     1267                        icmp_destination_unreachable_msg( phone, ICMP_HOST_UNREACH, 0, packet );
    13181268                }
    13191269                return ENOENT;
    13201270        }
    1321         if(route->address.s_addr == dest.s_addr){
     1271        if( route->address.s_addr == dest.s_addr ){
    13221272                // local delivery
    1323                 return ip_deliver_local(device_id, packet, header, 0);
     1273                return ip_deliver_local( device_id, packet, header, 0 );
    13241274        }else{
    13251275                // only if routing enabled
    1326                 if(route->netif->routing){
     1276                if( route->netif->routing ){
    13271277                        -- header->ttl;
    1328                         return ip_send_route(packet, route->netif, route, NULL, dest, 0);
     1278                        return ip_send_route( packet, route->netif, route, NULL, dest, 0 );
    13291279                }else{
    1330                         phone = ip_prepare_icmp_and_get_phone(0, packet, header);
    1331                         if(phone >= 0){
     1280                        phone = ip_prepare_icmp_and_get_phone( 0, packet, header );
     1281                        if( phone >= 0 ){
    13321282                                // unreachable ICMP if no routing
    1333                                 icmp_destination_unreachable_msg(phone, ICMP_HOST_UNREACH, 0, packet);
     1283                                icmp_destination_unreachable_msg( phone, ICMP_HOST_UNREACH, 0, packet );
    13341284                        }
    13351285                        return ENOENT;
    … …  
    13381288}
    13391289
    1340 int ip_received_error_msg(int ip_phone, device_id_t device_id, packet_t packet, services_t target, services_t error){
    1341         uint8_t * data;
    1342         int offset;
    1343         icmp_type_t type;
    1344         icmp_code_t code;
    1345         ip_netif_ref netif;
    1346         measured_string_t address;
    1347         ip_route_ref route;
    1348         ip_header_ref header;
    1349 
    1350         switch(error){
     1290int ip_received_error_msg( int ip_phone, device_id_t device_id, packet_t packet, services_t target, services_t error ){
     1291        uint8_t *                       data;
     1292        int                                     offset;
     1293        icmp_type_t                     type;
     1294        icmp_code_t                     code;
     1295        ip_netif_ref            netif;
     1296        measured_string_t       address;
     1297        ip_route_ref            route;
     1298        ip_header_ref           header;
     1299
     1300        switch( error ){
    13511301                case SERVICE_ICMP:
    1352                         offset = icmp_client_process_packet(packet, &type, &code, NULL, NULL);
    1353                         if(offset < 0){
    1354                                 return ip_release_and_return(packet, ENOMEM);
    1355                         }
    1356                         data = packet_get_data(packet);
    1357                         header = (ip_header_ref)(data + offset);
     1302                        offset = icmp_client_process_packet( packet, & type, & code, NULL, NULL );
     1303                        if( offset < 0 ){
     1304                                return ip_release_and_return( packet, ENOMEM );
     1305                        }
     1306                        data = packet_get_data( packet );
     1307                        header = ( ip_header_ref )( data + offset );
    13581308                        // destination host unreachable?
    1359                         if((type == ICMP_DEST_UNREACH) && (code == ICMP_HOST_UNREACH)){
    1360                                 fibril_rwlock_read_lock(&ip_globals.netifs_lock);
    1361                                 netif = ip_netifs_find(&ip_globals.netifs, device_id);
    1362                                 if(netif && netif->arp){
    1363                                         route = ip_routes_get_index(&netif->routes, 0);
     1309                        if(( type == ICMP_DEST_UNREACH ) && ( code == ICMP_HOST_UNREACH )){
     1310                                fibril_rwlock_read_lock( & ip_globals.netifs_lock );
     1311                                netif = ip_netifs_find( & ip_globals.netifs, device_id );
     1312                                if( netif && netif->arp ){
     1313                                        route = ip_routes_get_index( & netif->routes, 0 );
    13641314                                        // from the same network?
    1365                                         if(route && ((route->address.s_addr &route->netmask.s_addr) == (header->destination_address &route->netmask.s_addr))){
     1315                                        if( route && (( route->address.s_addr & route->netmask.s_addr ) == ( header->destination_address & route->netmask.s_addr ))){
    13661316                                                // clear the ARP mapping if any
    1367                                                 address.value = (char *) &header->destination_address;
    1368                                                 address.length = CONVERT_SIZE(uint8_t, char, sizeof(header->destination_address));
    1369                                                 arp_clear_address_req(netif->arp->phone, netif->device_id, SERVICE_IP, &address);
     1317                                                address.value = ( char * ) & header->destination_address;
     1318                                                address.length = CONVERT_SIZE( uint8_t, char, sizeof( header->destination_address ));
     1319                                                arp_clear_address_req( netif->arp->phone, netif->device_id, SERVICE_IP, & address );
    13701320                                        }
    13711321                                }
    1372                                 fibril_rwlock_read_unlock(&ip_globals.netifs_lock);
     1322                                fibril_rwlock_read_unlock( & ip_globals.netifs_lock );
    13731323                        }
    13741324                        break;
    13751325                default:
    1376                         return ip_release_and_return(packet, ENOTSUP);
    1377         }
    1378         return ip_deliver_local(device_id, packet, header, error);
    1379 }
    1380 
    1381 int ip_deliver_local(device_id_t device_id, packet_t packet, ip_header_ref header, services_t error){
     1326                        return ip_release_and_return( packet, ENOTSUP );
     1327        }
     1328        return ip_deliver_local( device_id, packet, header, error );
     1329}
     1330
     1331int ip_deliver_local( device_id_t device_id, packet_t packet, ip_header_ref header, services_t error ){
    13821332        ERROR_DECLARE;
    13831333
    1384         ip_proto_ref proto;
    1385         int phone;
    1386         services_t service;
    1387         tl_received_msg_t received_msg;
    1388         struct sockaddr * src;
    1389         struct sockaddr * dest;
    1390         struct sockaddr_in src_in;
    1391         struct sockaddr_in dest_in;
     1334        ip_proto_ref    proto;
     1335        int                             phone;
     1336        services_t              service;
     1337        tl_received_msg_t       received_msg;
     1338        struct sockaddr *       src;
     1339        struct sockaddr *       dest;
     1340        struct sockaddr_in      src_in;
     1341        struct sockaddr_in      dest_in;
    13921342//      struct sockaddr_in      src_in6;
    13931343//      struct sockaddr_in      dest_in6;
    1394         socklen_t addrlen;
    1395 
    1396         if((header->flags &IPFLAG_MORE_FRAGMENTS) || IP_FRAGMENT_OFFSET(header)){
     1344        socklen_t               addrlen;
     1345
     1346        if(( header->flags & IPFLAG_MORE_FRAGMENTS ) || IP_FRAGMENT_OFFSET( header )){
    13971347                // TODO fragmented
    13981348                return ENOTSUP;
    13991349        }else{
    1400                 switch(header->version){
     1350                switch( header->version ){
    14011351                        case IPVERSION:
    1402                                 addrlen = sizeof(src_in);
    1403                                 bzero(&src_in, addrlen);
     1352                                addrlen = sizeof( src_in );
     1353                                bzero( & src_in, addrlen );
    14041354                                src_in.sin_family = AF_INET;
    1405                                 memcpy(&dest_in, &src_in, addrlen);
    1406                                 memcpy(&src_in.sin_addr.s_addr, &header->source_address, sizeof(header->source_address));
    1407                                 memcpy(&dest_in.sin_addr.s_addr, &header->destination_address, sizeof(header->destination_address));
    1408                                 src = (struct sockaddr *) &src_in;
    1409                                 dest = (struct sockaddr *) &dest_in;
     1355                                memcpy( & dest_in, & src_in, addrlen );
     1356                                memcpy( & src_in.sin_addr.s_addr, & header->source_address, sizeof( header->source_address ));
     1357                                memcpy( & dest_in.sin_addr.s_addr, & header->destination_address, sizeof( header->destination_address ));
     1358                                src = ( struct sockaddr * ) & src_in;
     1359                                dest = ( struct sockaddr * ) & dest_in;
    14101360                                break;
    14111361/*                      case IPv6VERSION:
    1412                                 addrlen = sizeof(src_in6);
    1413                                 bzero(&src_in6, addrlen);
     1362                                addrlen = sizeof( src_in6 );
     1363                                bzero( & src_in6, addrlen );
    14141364                                src_in6.sin6_family = AF_INET6;
    1415                                 memcpy(&dest_in6, &src_in6, addrlen);
    1416                                 memcpy(&src_in6.sin6_addr.s6_addr,);
    1417                                 memcpy(&dest_in6.sin6_addr.s6_addr,);
    1418                                 src = (struct sockaddr *) &src_in;
    1419                                 dest = (struct sockaddr *) &dest_in;
     1365                                memcpy( & dest_in6, & src_in6, addrlen );
     1366                                memcpy( & src_in6.sin6_addr.s6_addr, );
     1367                                memcpy( & dest_in6.sin6_addr.s6_addr, );
     1368                                src = ( struct sockaddr * ) & src_in;
     1369                                dest = ( struct sockaddr * ) & dest_in;
    14201370                                break;
    14211371*/                      default:
    1422                                 return ip_release_and_return(packet, EAFNOSUPPORT);
    1423                 }
    1424                 if(ERROR_OCCURRED(packet_set_addr(packet, (uint8_t *) src, (uint8_t *) dest, addrlen))){
    1425                         return ip_release_and_return(packet, ERROR_CODE);
     1372                                return ip_release_and_return( packet, EAFNOSUPPORT );
     1373                }
     1374                if( ERROR_OCCURRED( packet_set_addr( packet, ( uint8_t * ) src, ( uint8_t * ) dest, addrlen ))){
     1375                        return ip_release_and_return( packet, ERROR_CODE );
    14261376                }
    14271377                // trim padding if present
    1428                 if((! error) && (IP_TOTAL_LENGTH(header) < packet_get_data_length(packet))){
    1429                         if(ERROR_OCCURRED(packet_trim(packet, 0, packet_get_data_length(packet) - IP_TOTAL_LENGTH(header)))){
    1430                                 return ip_release_and_return(packet, ERROR_CODE);
    1431                         }
    1432                 }
    1433                 fibril_rwlock_read_lock(&ip_globals.protos_lock);
    1434                 proto = ip_protos_find(&ip_globals.protos, header->protocol);
    1435                 if(! proto){
    1436                         fibril_rwlock_read_unlock(&ip_globals.protos_lock);
    1437                         phone = ip_prepare_icmp_and_get_phone(error, packet, header);
    1438                         if(phone >= 0){
     1378                if(( ! error ) && ( IP_TOTAL_LENGTH( header ) < packet_get_data_length( packet ))){
     1379                        if( ERROR_OCCURRED( packet_trim( packet, 0, packet_get_data_length( packet ) - IP_TOTAL_LENGTH( header )))){
     1380                                return ip_release_and_return( packet, ERROR_CODE );
     1381                        }
     1382                }
     1383                fibril_rwlock_read_lock( & ip_globals.protos_lock );
     1384                proto = ip_protos_find( & ip_globals.protos, header->protocol );
     1385                if( ! proto ){
     1386                        fibril_rwlock_read_unlock( & ip_globals.protos_lock );
     1387                        phone = ip_prepare_icmp_and_get_phone( error, packet, header );
     1388                        if( phone >= 0 ){
    14391389                                // unreachable ICMP
    1440                                 icmp_destination_unreachable_msg(phone, ICMP_PROT_UNREACH, 0, packet);
     1390                                icmp_destination_unreachable_msg( phone, ICMP_PROT_UNREACH, 0, packet );
    14411391                        }
    14421392                        return ENOENT;
    14431393                }
    1444                 if(proto->received_msg){
     1394                if( proto->received_msg ){
    14451395                        service = proto->service;
    14461396                        received_msg = proto->received_msg;
    1447                         fibril_rwlock_read_unlock(&ip_globals.protos_lock);
    1448                         ERROR_CODE = received_msg(device_id, packet, service, error);
     1397                        fibril_rwlock_read_unlock( & ip_globals.protos_lock );
     1398                        ERROR_CODE = received_msg( device_id, packet, service, error );
    14491399                }else{
    1450                         ERROR_CODE = tl_received_msg(proto->phone, device_id, packet, proto->service, error);
    1451                         fibril_rwlock_read_unlock(&ip_globals.protos_lock);
     1400                        ERROR_CODE = tl_received_msg( proto->phone, device_id, packet, proto->service, error );
     1401                        fibril_rwlock_read_unlock( & ip_globals.protos_lock );
    14521402                }
    14531403                return ERROR_CODE;
    … …  
    14551405}
    14561406
    1457 in_addr_t ip_get_destination(ip_header_ref header){
    1458         in_addr_t destination;
     1407in_addr_t ip_get_destination( ip_header_ref header ){
     1408        in_addr_t       destination;
    14591409
    14601410        // TODO search set ipopt route?
    … …  
    14631413}
    14641414
    1465 int ip_prepare_icmp(packet_t packet, ip_header_ref header){
    1466         packet_t next;
    1467         struct sockaddr * dest;
    1468         struct sockaddr_in dest_in;
     1415int ip_prepare_icmp( packet_t packet, ip_header_ref header ){
     1416        packet_t        next;
     1417        struct sockaddr *       dest;
     1418        struct sockaddr_in      dest_in;
    14691419//      struct sockaddr_in      dest_in6;
    1470         socklen_t addrlen;
     1420        socklen_t               addrlen;
    14711421
    14721422        // detach the first packet and release the others
    1473         next = pq_detach(packet);
    1474         if(next){
    1475                 pq_release(ip_globals.net_phone, packet_get_id(next));
    1476         }
    1477         if(! header){
    1478                 if(packet_get_data_length(packet) <= sizeof(ip_header_t)){
    1479                         return ENOMEM;
    1480                 }
     1423        next = pq_detach( packet );
     1424        if( next ){
     1425                pq_release( ip_globals.net_phone, packet_get_id( next ));
     1426        }
     1427        if( ! header ){
     1428                if( packet_get_data_length( packet ) <= sizeof( ip_header_t )) return ENOMEM;
    14811429                // get header
    1482                 header = (ip_header_ref) packet_get_data(packet);
    1483                 if(! header){
    1484                         return EINVAL;
    1485                 }
     1430                header = ( ip_header_ref ) packet_get_data( packet );
     1431                if( ! header ) return EINVAL;
    14861432        }
    14871433        // only for the first fragment
    1488         if(IP_FRAGMENT_OFFSET(header)){
    1489                 return EINVAL;
    1490         }
     1434        if( IP_FRAGMENT_OFFSET( header )) return EINVAL;
    14911435        // not for the ICMP protocol
    1492         if(header->protocol == IPPROTO_ICMP){
     1436        if( header->protocol == IPPROTO_ICMP ){
    14931437                return EPERM;
    14941438        }
    14951439        // set the destination address
    1496         switch(header->version){
     1440        switch( header->version ){
    14971441                case IPVERSION:
    1498                         addrlen = sizeof(dest_in);
    1499                         bzero(&dest_in, addrlen);
     1442                        addrlen = sizeof( dest_in );
     1443                        bzero( & dest_in, addrlen );
    15001444                        dest_in.sin_family = AF_INET;
    1501                         memcpy(&dest_in.sin_addr.s_addr, &header->source_address, sizeof(header->source_address));
    1502                         dest = (struct sockaddr *) &dest_in;
     1445                        memcpy( & dest_in.sin_addr.s_addr, & header->source_address, sizeof( header->source_address ));
     1446                        dest = ( struct sockaddr * ) & dest_in;
    15031447                        break;
    15041448/*              case IPv6VERSION:
    1505                         addrlen = sizeof(dest_in6);
    1506                         bzero(&dest_in6, addrlen);
     1449                        addrlen = sizeof( dest_in6 );
     1450                        bzero( & dest_in6, addrlen );
    15071451                        dest_in6.sin6_family = AF_INET6;
    1508                         memcpy(&dest_in6.sin6_addr.s6_addr,);
    1509                         dest = (struct sockaddr *) &dest_in;
     1452                        memcpy( & dest_in6.sin6_addr.s6_addr, );
     1453                        dest = ( struct sockaddr * ) & dest_in;
    15101454                        break;
    15111455*/              default:
    15121456                        return EAFNOSUPPORT;
    15131457        }
    1514         return packet_set_addr(packet, NULL, (uint8_t *) dest, addrlen);
    1515 }
    1516 
    1517 int ip_get_icmp_phone(void){
    1518         ip_proto_ref proto;
    1519         int phone;
    1520 
    1521         fibril_rwlock_read_lock(&ip_globals.protos_lock);
    1522         proto = ip_protos_find(&ip_globals.protos, IPPROTO_ICMP);
     1458        return packet_set_addr( packet, NULL, ( uint8_t * ) dest, addrlen );
     1459}
     1460
     1461int ip_get_icmp_phone( void ){
     1462        ip_proto_ref    proto;
     1463        int                             phone;
     1464
     1465        fibril_rwlock_read_lock( & ip_globals.protos_lock );
     1466        proto = ip_protos_find( & ip_globals.protos, IPPROTO_ICMP );
    15231467        phone = proto ? proto->phone : ENOENT;
    1524         fibril_rwlock_read_unlock(&ip_globals.protos_lock);
     1468        fibril_rwlock_read_unlock( & ip_globals.protos_lock );
    15251469        return phone;
    15261470}
    15271471
    1528 int ip_prepare_icmp_and_get_phone(services_t error, packet_t packet, ip_header_ref header){
    1529         int phone;
     1472int ip_prepare_icmp_and_get_phone( services_t error, packet_t packet, ip_header_ref header ){
     1473        int     phone;
    15301474
    15311475        phone = ip_get_icmp_phone();
    1532         if(error || (phone < 0) || ip_prepare_icmp(packet, header)){
    1533                 return ip_release_and_return(packet, EINVAL);
     1476        if( error || ( phone < 0 ) || ip_prepare_icmp( packet, header )){
     1477                return ip_release_and_return( packet, EINVAL );
    15341478        }
    15351479        return phone;
    15361480}
    15371481
    1538 int ip_release_and_return(packet_t packet, int result){
    1539         pq_release(ip_globals.net_phone, packet_get_id(packet));
     1482int     ip_release_and_return( packet_t packet, int result ){
     1483        pq_release( ip_globals.net_phone, packet_get_id( packet ));
    15401484        return result;
    15411485}
    15421486
    1543 int ip_get_route_req(int ip_phone, ip_protocol_t protocol, const struct sockaddr * destination, socklen_t addrlen, device_id_t * device_id, ip_pseudo_header_ref * header, size_t * headerlen){
    1544         struct sockaddr_in * address_in;
     1487int ip_get_route_req( int ip_phone, ip_protocol_t protocol, const struct sockaddr * destination, socklen_t addrlen, device_id_t * device_id, ip_pseudo_header_ref * header, size_t * headerlen ){
     1488        struct sockaddr_in *    address_in;
    15451489//      struct sockaddr_in6 *   address_in6;
    1546         in_addr_t * dest;
    1547         in_addr_t * src;
    1548         ip_route_ref route;
    1549         ipv4_pseudo_header_ref header_in;
    1550 
    1551         if(!(destination && (addrlen > 0))){
     1490        in_addr_t *                             dest;
     1491        in_addr_t *                             src;
     1492        ip_route_ref                    route;
     1493        ipv4_pseudo_header_ref  header_in;
     1494
     1495        if( !( destination && ( addrlen > 0 ))) return EINVAL;
     1496        if( !( device_id && header && headerlen )) return EBADMEM;
     1497        if(( size_t ) addrlen < sizeof( struct sockaddr )){
    15521498                return EINVAL;
    15531499        }
    1554         if(!(device_id && header && headerlen)){
    1555                 return EBADMEM;
    1556         }
    1557         if((size_t) addrlen < sizeof(struct sockaddr)){
    1558                 return EINVAL;
    1559         }
    1560         switch(destination->sa_family){
     1500        switch( destination->sa_family ){
    15611501                case AF_INET:
    1562                         if(addrlen != sizeof(struct sockaddr_in)){
     1502                        if( addrlen != sizeof( struct sockaddr_in )){
    15631503                                return EINVAL;
    15641504                        }
    1565                         address_in = (struct sockaddr_in *) destination;
    1566                         dest = &address_in->sin_addr;
    1567                         if(! dest->s_addr){
     1505                        address_in = ( struct sockaddr_in * ) destination;
     1506                        dest = & address_in->sin_addr;
     1507                        if( ! dest->s_addr ){
    15681508                                dest->s_addr = IPV4_LOCALHOST_ADDRESS;
    15691509                        }
    … …  
    15711511                // TODO IPv6
    15721512/*              case AF_INET6:
    1573                         if(addrlen != sizeof(struct sockaddr_in6)){
    1574                                 return EINVAL;
    1575                         }
    1576                         address_in6 = (struct sockaddr_in6 *) dest;
     1513                        if( addrlen != sizeof( struct sockaddr_in6 )) return EINVAL;
     1514                        address_in6 = ( struct sockaddr_in6 * ) dest;
    15771515                        address_in6.sin6_addr.s6_addr;
    15781516*/              default:
    15791517                        return EAFNOSUPPORT;
    15801518        }
    1581         fibril_rwlock_read_lock(&ip_globals.lock);
    1582         route = ip_find_route(*dest);
    1583         if(!(route && route->netif)){
    1584                 fibril_rwlock_read_unlock(&ip_globals.lock);
     1519        fibril_rwlock_read_lock( & ip_globals.lock );
     1520        route = ip_find_route( * dest );
     1521        if( !( route && route->netif )){
     1522                fibril_rwlock_read_unlock( & ip_globals.lock );
    15851523                return ENOENT;
    15861524        }
    1587         *device_id = route->netif->device_id;
    1588         src = ip_netif_address(route->netif);
    1589         fibril_rwlock_read_unlock(&ip_globals.lock);
    1590         *headerlen = sizeof(*header_in);
    1591         header_in = (ipv4_pseudo_header_ref) malloc(*headerlen);
    1592         if(! header_in){
    1593                 return ENOMEM;
    1594         }
    1595         bzero(header_in, * headerlen);
     1525        * device_id = route->netif->device_id;
     1526        src = ip_netif_address( route->netif );
     1527        fibril_rwlock_read_unlock( & ip_globals.lock );
     1528        * headerlen = sizeof( * header_in );
     1529        header_in = ( ipv4_pseudo_header_ref ) malloc( * headerlen );
     1530        if( ! header_in ) return ENOMEM;
     1531        bzero( header_in, * headerlen );
    15961532        header_in->destination_address = dest->s_addr;
    15971533        header_in->source_address = src->s_addr;
    15981534        header_in->protocol = protocol;
    15991535        header_in->data_length = 0;
    1600         *header = (ip_pseudo_header_ref) header_in;
     1536        * header = ( ip_pseudo_header_ref ) header_in;
    16011537        return EOK;
    16021538}
Note: See TracChangeset for help on using the changeset viewer.