Subversion Repositories HelenOS

#include <sys/types.h>

#include "../../include/byteorder.h"

#include "../../include/crc.h"

#include "../../include/ip_client.h"

#include "../../include/tl_interface.h"

#include "ip_header.h"

#include "ip_messages.h"

#define IP_MIN_CONTENT  576

#define IP_ADDR                         sizeof( in_addr_t )

#define IP_PREFIX                       sizeof( ip_header_t )

#define IP_SUFFIX                       0

#define IP_MAX_CONTENT                  65535

#define IP_HEADER_LENGTH( header )      (( header )->ihl * 4 )

#define IP_TOTAL_LENGTH( header )       ntohs(( header )->total_length )

#define IP_HEADER_DATA_LENGTH( header ) ( IP_TOTAL_LENGTH( header ) - IP_HEADER_LENGTH( header ))

#define IP_HEADER_CHECKSUM( header )    ( htons( ip_checksum(( uint8_t * )( header ), IP_HEADER_LENGTH( header ))))

//zero is returned as 0xFFFF (not flipped)

#define IP_HEADER_CHECKSUM_ZERO         0xFFFF

GENERIC_FIELD_IMPLEMENT( ip_routes, ip_route_t )

int ip_register( int protocol, services_t service, int phone, tl_received_msg_t tl_received_msg );

int ip_netif_initialize( ip_netif_ref ip_netif );

int ip_send_route( packet_t packet, ip_netif_ref netif, ip_route_ref route, in_addr_t * src, in_addr_t dest );

int ip_prepare_packet( in_addr_t * source, packet_t packet, measured_string_ref destination );

packet_t    ip_split_packet( packet_t packet, size_t prefix, size_t content, size_t suffix, size_t addr_len );

int ip_fragment_packet( packet_t packet, size_t length, size_t prefix, size_t suffix, size_t addr_len );

int ip_fragment_packet_data( packet_t packet, packet_t new_packet, ip_header_ref header, ip_header_ref new_header, size_t length, void * src, void * dest, size_t address_length );

ip_header_ref   ip_create_middle_header( packet_t packet, ip_header_ref last );

ip_header_ref   ip_create_last_header( packet_t packet, ip_header_ref first );

in_addr_t * ip_netif_addr( ip_netif_ref netif );

ip_route_ref    ip_find_route( in_addr_t destination );

ip_route_ref    ip_netif_find_route( ip_netif_ref netif, in_addr_t destination );

int ip_process_packet( device_id_t device_id, packet_t packet );

in_addr_t   ip_get_destination( ip_header_ref header );

int ip_deliver_local( device_id_t device_id, packet_t packet, ip_header_ref header );

/** Computes the ip header checksum.

 *  To compute the checksum of a new packet, the checksum header field must be zero.

 *  To check the checksum of a received packet, the checksum may be left set.

 *  The zero (0) value will returned in this case if valid.

 *  @param data The header data. Input parameter.

 *  @param length The header length in bytes. Input parameter.

 *  @returns The internet protocol header checksum.

 *  @returns IP_HEADER_CHECKSUM_ZERO if the computed checksum is zero.

 */

uint16_t ip_checksum( uint8_t * data, int length );

uint16_t ip_checksum( uint8_t * data, int length ){

    uint16_t    checksum;

    checksum = compact_checksum(compute_checksum( 0, data, length ));

    // flip, zero is returned as 0xFFFF (not flipped)

    return ( ~ checksum ) ? ~ checksum : IP_HEADER_CHECKSUM_ZERO;

}

    ip_globals.packet_counter = 0;

    ip_globals.gateway.address.s_addr = 0;

    ip_globals.gateway.netmask.s_addr = 0;

    ip_globals.gateway.gateway.s_addr = 0;

    ip_globals.gateway.netif = NULL;

    ip_route_ref    route;

    int             index;

    char *          data;

    ip_netif = ( ip_netif_ref ) malloc( sizeof( ip_netif_t ));

    if( ! ip_netif ) return ENOMEM;

    if( ERROR_OCCURRED( ip_routes_initialize( & ip_netif->routes ))){

        free( ip_netif );

        return ERROR_CODE;

    }

    ip_netif->device_id = device_id;

    ip_netif->service = netif;

    ip_netif->state = NETIF_STOPPED;

    if( ERROR_OCCURRED( ip_netif_initialize( ip_netif ))){

        ip_routes_destroy( & ip_netif->routes );

        free( ip_netif );

        return ERROR_CODE;

    }

    if( ip_netif->arp ) ++ ip_netif->arp->usage;

    // print the settings

    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 );

    printf( "\tconfiguration\t= %s\n", ip_netif->dhcp ? "dhcp" : "static" );

    // TODO ipv6 addresses

    data = ( char * ) malloc( INET_ADDRSTRLEN );

    if( data ){

        for( index = 0; index < ip_routes_count( & ip_netif->routes ); ++ index ){

            route = ip_routes_get_index( & ip_netif->routes, index );

            if( route ){

                printf( "\tRouting %d:\n", index );

                inet_ntop( AF_INET, ( uint8_t * ) & route->address.s_addr, data, INET_ADDRSTRLEN );

                printf( "\t\taddress\t= %s\n", data );

                inet_ntop( AF_INET, ( uint8_t * ) & route->netmask.s_addr, data, INET_ADDRSTRLEN );

                printf( "\t\tnetmask\t= %s\n", data );

                inet_ntop( AF_INET, ( uint8_t * ) & route->gateway.s_addr, data, INET_ADDRSTRLEN );

                printf( "\t\tgateway\t= %s\n", data );

            }

        }

        inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->broadcast.s_addr, data, INET_ADDRSTRLEN );

        printf( "\tbroadcast\t= %s\n", data );

        inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->dns1, data, INET_ADDRSTRLEN );

        printf( "\tdns1\t= %s\n", data );

        inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->dns2, data, INET_ADDRSTRLEN );

        printf( "\tdns2\t= %s\n", data );

        free( data );

    }

    return EOK;

}

int ip_netif_initialize( ip_netif_ref ip_netif ){

    ERROR_DECLARE;

    ip_route_ref        route;

    in_addr_t           gateway;

            route = ( ip_route_ref ) malloc( sizeof( ip_route_t ));

            if( ! route ){

                net_free_settings( configuration, data );

                return ENOMEM;

            }

            route->address.s_addr = 0;

            route->netmask.s_addr = 0;

            route->gateway.s_addr = 0;

            route->netif = ip_netif;

            index = ip_routes_add( & ip_netif->routes, route );

            if( index < 0 ){

                net_free_settings( configuration, data );

                free( route );

                return index;

            }

    // MUST BE AFTER the bind_service up there!

    // get packet dimensions

    packet_t        packet;

    in_addr_t       destination;

    ip_netif_ref    netif;

    netif->state = state;

/*      address.value = ( char * ) & ip_globals.gateway.gateway.s_addr;

        address.length = CONVERT_SIZE( ip_globals.gateway.gateway.s_addr, char, 1 );

        if( ERROR_OCCURRED( arp_translate_req( netif->arp->phone, netif->device_id, SERVICE_IP, & address, & translation, & data ))){

            ERROR_PROPAGATE( arp_translate_req( netif->arp->phone, netif->device_id, SERVICE_IP, & address, & translation, & data ));

        }

        printf( "\tgateway translated to\t= %X:%X:%X:%X:%X:%X\n", data[ 0 ], data[ 1 ], data[ 2 ], data[ 3 ], data[ 4 ], data[ 5 ] );

        free( translation );

        free( data );

*/      printf( "IP - testing to send packet:\n" );

        ERROR_PROPAGATE( inet_pton( AF_INET, "90.182.101.18", ( uint8_t * ) & destination.s_addr ));

        packet = packet_get_4( ip_globals.net_phone, 30, netif->addr_len, netif->prefix + sizeof( ip_header_t ), netif->suffix );

        if( ! packet ) return ENOMEM;

        pq_release( ip_globals.net_phone, packet_get_id( packet ));

        packet = packet_get_4( ip_globals.net_phone, 30, netif->addr_len, netif->prefix + sizeof( ip_header_t ), netif->suffix );

        if( ! packet ) return ENOMEM;

        pq_release( ip_globals.net_phone, packet_get_id( packet ));

        packet = packet_get_4( ip_globals.net_phone, 30, netif->addr_len, netif->prefix + sizeof( ip_header_t ), netif->suffix );

        if( ! packet ) return ENOMEM;

        pq_release( ip_globals.net_phone, packet_get_id( packet ));

        packet = packet_get_4( ip_globals.net_phone, 1500, netif->addr_len, netif->prefix + sizeof( ip_header_t ), netif->suffix );

        if( ! packet ) return ENOMEM;

        // try this long version

//      if( ERROR_OCCURRED( packet_copy_data( packet, "Hi, this is IP, wery long version 1, wery long version 2, wery long version 3, wery long version 4, wery long version 5, wery long version 6, wery long version 7, wery long version 8, wery long version 9, wery long version 10, wery long version 11, wery long version 12, wery long version 13, wery long version 14, wery long version 15, wery long version 16, wery long version 17, wery long version 18, wery long version 19, wery long version 20, wery long version 21, wery long version 22, wery long version 23, wery long version 24, wery long version 25, wery long version 26, wery long version 27, wery long version 28, wery long version 29, wery long version 30Hi, this is IP, wery long version 1, wery long version 2, wery long version 3, wery long version 4, wery long version 5, wery long version 6, wery long version 7, wery long version 8, wery long version 9, wery long version 10, wery long version 11, wery long version 12, wery long version 13, wery long version 14, wery long version 15, wery long version 16, wery long version 17, wery long version 18, wery long version 19, wery long version 20, wery long version 21, wery long version 22, wery long version 23, wery long version 24, wery long version 25, wery long version 26, wery long version 27, wery long version 28, wery long version 29, wery long version 30", 1330 ))

        if( ERROR_OCCURRED( packet_copy_data( packet, "Hi, this is IP", 14 ))

        || ERROR_OCCURRED( packet_set_addr( packet, NULL, ( uint8_t * ) & destination.s_addr, 4 ))

        || ERROR_OCCURRED( ip_client_prepare_packet( packet, 0, 0, 0, 0, 0 ))){

            pq_release( ip_globals.net_phone, packet_get_id( packet ));

        }

        ERROR_CODE = ip_send_msg( 0, 0, packet, SERVICE_IP );

        printf( "send returned %d\n", ERROR_CODE );

int ip_bind_service( services_t service, int protocol, services_t me, async_client_conn_t receiver, tl_received_msg_t tl_received_msg ){

}

int ip_register( int protocol, services_t service, int phone, tl_received_msg_t tl_received_msg ){

    if( !( protocol && service && (( phone > 0 ) || ( tl_received_msg )))) return EINVAL;

    proto->service = service;

    proto->tl_received_msg = tl_received_msg;

    ERROR_DECLARE;

    int                 length;

    ip_netif_ref        netif;

    ip_route_ref        route;

    in_addr_t           dest;

    in_addr_t *         src;

    // addresses in the host byte order

    // should be the next hop address or the target destination address

    length = packet_get_addr( packet, NULL, ( void * )( & dest.s_addr ));

    if( length < 0 ){

        pq_release( ip_globals.net_phone, packet_get_id( packet ));

        return length;

    }

    // TODO IPv6

    if( length != IP_ADDR ){

        pq_release( ip_globals.net_phone, packet_get_id( packet ));

        return EINVAL;

    }

//  rwlock_read_lock( & ip_globals.devices_lock );

    // device specified?

//  dest.s_addr = ntohl( dest.s_addr );

    if( device_id ){

        netif = ip_netifs_find( & ip_globals.netifs, device_id );

        route = ip_netif_find_route( netif, dest );

    }else{

        // TODO IPv6

        route = ip_find_route( dest );

        netif = route ? route->netif : NULL;

    }

    if( !( netif && route )){

//      rwlock_read_unlock( & ip_globals.devices_lock );

        pq_release( ip_globals.net_phone, packet_get_id( packet ));

        return ENOENT;

    }

    // to me?

    if( route->address.s_addr == dest.s_addr ){

    }

    src = ip_netif_addr( netif );

    if( ! src ){

        return ENOENT;

    }

    if( ERROR_OCCURRED( ip_send_route( packet, netif, route, src, dest ))){

    }

    return ERROR_CODE;

}

in_addr_t * ip_netif_addr( ip_netif_ref netif ){

    ip_route_ref    route;

    route = ip_routes_get_index( & netif->routes, 0 );

    return route ? & route->address : NULL;

}

int ip_send_route( packet_t packet, ip_netif_ref netif, ip_route_ref route, in_addr_t * src, in_addr_t dest ){

    ERROR_DECLARE;

    packet_t            next;

    packet_t            tmp;

    measured_string_t   destination;

    measured_string_ref translation;

    char *              data;

    if( route->gateway.s_addr ){

        dest.s_addr = route->gateway.s_addr;

    }

    // get destination hardware address

    if( netif->arp ){

        destination.value = ( char * ) & dest.s_addr;

        destination.length = CONVERT_SIZE( dest.s_addr, char, 1 );

        if( ERROR_OCCURRED( arp_translate_req( netif->arp->phone, netif->device_id, SERVICE_IP, & destination, & translation, & data ))){

            usleep( 200000 );

            ERROR_PROPAGATE( arp_translate_req( netif->arp->phone, netif->device_id, SERVICE_IP, & destination, & translation, & data ));

        }

        // TODO unreachable

        if( ! translation ) return EINVAL;

        if( ! translation->value ){

            // TODO unreachable

            free( translation );

            free( data );

            return EINVAL;

        }

    }else translation = NULL;

    // process packet queue

    next = packet;

    do{

        if( ERROR_OCCURRED( ip_prepare_packet( src, next, translation ))){

            // release invalid packet

            tmp = pq_detach( next );

            if( next == packet ) packet = tmp;

            pq_release( ip_globals.net_phone, packet_get_id( next ));

            next = tmp;

        }else{

            next = pq_next( next );

        }

    }while( next );

    if( translation ){

        free( translation );

        free( data );

    }

    // send packet queue

    if( packet ){

        packet = ip_split_packet( packet, netif->prefix, netif->content, netif->suffix, netif->addr_len );

        if( packet ){

            nil_send_msg( netif->phone, netif->device_id, packet, SERVICE_IP );

        }

    }

//  rwlock_read_unlock( & ip_globals.netifs_lock );

    return EOK;

}

int ip_prepare_packet( in_addr_t * source, packet_t packet, measured_string_ref destination ){

    ERROR_DECLARE;

    int                 length;

    ip_header_ref       header;

    length = packet_get_data_length( packet );

    if(( length < sizeof( ip_header_t )) || ( length > IP_MAX_CONTENT )) return EINVAL;

    header = ( ip_header_ref ) packet_get_data( packet );

    if( destination ){

        ERROR_PROPAGATE( packet_set_addr( packet, NULL, ( uint8_t * ) destination->value, CONVERT_SIZE( char, uint8_t, destination->length )));

    }

    header->version = 4;

    header->total_length = htons( length );

    header->fragment_offset = 0;

    if( source ) header->source_address = source->s_addr;//htonl( source.s_addr );

    ++ ip_globals.packet_counter;

    header->identification = htons( ip_globals.packet_counter );

    header->header_checksum = 0;

    // unnecessary for all protocols

    header->header_checksum = IP_HEADER_CHECKSUM( header );

        case NET_IP_ADD_ROUTE:

            return ip_add_route_req( 0, IPC_GET_DEVICE( call ), IP_GET_ADDRESS( call ), IP_GET_NETMASK( call ), IP_GET_GATEWAY( call ));

        case NET_IP_SET_GATEWAY:

            return ip_set_gateway_req( 0, IPC_GET_DEVICE( call ), IP_GET_GATEWAY( call ));

        case NET_IL_PACKET_SPACE:

            ERROR_PROPAGATE( ip_packet_size_req( 0, IPC_GET_DEVICE( call ), IPC_SET_ADDR( answer ), IPC_SET_PREFIX( answer ), IPC_SET_CONTENT( answer ), IPC_SET_SUFFIX( answer )));

            * answer_count = 3;

            return EOK;

int ip_packet_size_req( int ip_phone, device_id_t device_id, size_t * addr_len, size_t * prefix, size_t * content, size_t * suffix ){

    ip_netif_ref    netif;

    if( !( addr_len && prefix && content && suffix )) return EBADMEM;

//  rwlock_read_lock( & ip_globals.netifs_lock );

    netif = ip_netifs_find( & ip_globals.netifs, device_id );

    if( ! netif ){

//      rwlock_read_unlock( & ip_globals.netifs_lock );

        return ENOENT;

    }

    * content = IP_MAX_CONTENT - IP_PREFIX;

    * addr_len = ( netif->addr_len > IP_ADDR ) ? netif->addr_len : IP_ADDR;

    * prefix = netif->prefix + IP_PREFIX;

    * suffix = netif->suffix + IP_SUFFIX;

//  rwlock_read_unlock( & ip_globals.netifs_lock );

    return EOK;

}

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 ){

    ip_route_ref    route;

    ip_netif_ref    netif;

    int             index;

    netif = ip_netifs_find( & ip_globals.netifs, device_id );

    if( ! netif ) return ENOENT;

    route = ( ip_route_ref ) malloc( sizeof( ip_route_t ));

    if( ! route ) return ENOMEM;

    route->address.s_addr = address.s_addr;

    route->netmask.s_addr = netmask.s_addr;

    route->gateway.s_addr = gateway.s_addr;

    route->netif = netif;

    index = ip_routes_add( & netif->routes, route );

    if( index < 0 ) free( route );

    return index;

}

ip_route_ref ip_find_route( in_addr_t destination ){

    int             index;

    ip_route_ref    route;

    ip_netif_ref    netif;

    // start with the last netif - the newest one

    index = ip_netifs_count( & ip_globals.netifs ) - 1;

    while( index >= 0 ){

        netif = ip_netifs_get_index( & ip_globals.netifs, index );

        if( netif && ( netif->state == NETIF_ACTIVE )){

            route = ip_netif_find_route( netif, destination );

            if( route ) return route;

        }

        -- index;

    }

    return & ip_globals.gateway;

}

ip_route_ref ip_netif_find_route( ip_netif_ref netif, in_addr_t destination ){

    int             index;

    ip_route_ref    route;