WebSVN – HelenOS – Diff – /branches/network/uspace/srv/net/tl/udp/udp.c

 #include "../../include/socket_errno.h"
 #include "../../socket/socket_core.h"
 #include "../../socket/socket_messages.h"
+#include "../tl_common.h"
 #include "../tl_messages.h"
 #include "udp.h"
 #include "udp_header.h"
 #include "udp_module.h"
  *  @param result The result to be returned. Input parameter.
  *  @return The result parameter.
  */
 int udp_release_and_return( packet_t packet, int result );
-/** Sends the port unreachable ICMP notification.
- *  Sends the first packet and releases all the others.
- *  Releases the packet queu on error.
- *  @param packet The packet to be send. Input parameter.
- *  @param error The packet error reporting service. Prefixes the received packet. Input parameter.
- */
-void    udp_send_icmp_port_unreachable( packet_t packet, services_t error );
 /** @name Socket messages processing functions
  */
 /*@{*/
 /** Processes the socket client messages.
  *  @param local_sockets The application local sockets. Input/output parameter.
  *  @param socket_id Socket identifier. Input parameter.
  *  @param addr The destination address. Input parameter.
  *  @param addrlen The address length. Input parameter.
  *  @param fragments The number of data fragments. Input parameter.
+ *  @param data_fragment_size The data fragment size in bytes. Input parameter.
  *  @param flags Various send flags. Input parameter.
  *  @returns EOK on success.
  *  @returns EAFNOTSUPPORT if the address family is not supported.
  *  @returns ENOTSOCK if the socket is not found.
  *  @returns EINVAL if the address is invalid.
  *  @returns ENOMEM if there is not enough memory left.
  *  @returns Other error codes as defined for the socket_read_packet_data() function.
  *  @returns Other error codes as defined for the ip_client_prepare_packet() function.
  *  @returns Other error codes as defined for the ip_send_msg() function.
  */
-int udp_sendto_message( socket_cores_ref local_sockets, int socket_id, const struct sockaddr * addr, socklen_t addrlen, int fragments, int flags );
+int udp_sendto_message( socket_cores_ref local_sockets, int socket_id, const struct sockaddr * addr, socklen_t addrlen, int fragments, size_t data_fragment_size, int flags );
 /** Receives data to the socket.
  *  Handles the NET_SOCKET_RECVFROM message.
  *  Replies the source address as well.
  *  @param local_sockets The application local sockets. Input parameter.
  */
 int udp_recvfrom_message( socket_cores_ref local_sockets, int socket_id, int flags, size_t * addrlen );
 /*@}*/
-/** Receives data from the socket into a packet.
- *  @param packet The new created packet. Output parameter.
- *  @param prefix Reserved packet data prefix length. Input parameter.
- *  @param addr The destination address. Input parameter.
- *  @param addrlen The address length. Input parameter.
- *  @returns Number of bytes received.
- *  @returns EINVAL if the client does not send data.
- *  @returns ENOMEM if there is not enough memory left.
- *  @returns Other error codes as defined for the ipc_data_read_finalize() function.
- */
-int socket_read_packet_data( packet_ref packet, size_t prefix, const struct sockaddr * addr, socklen_t addrlen );
-/** Sets the address port.
- *  Supports AF_INET and AF_INET6 address families.
- *  @param addr The address to be updated. Input/output parameter.
- *  @param addrlen The address length. Input parameter.
- *  @param port The port to be set. Input parameter.
- *  @returns EOK on success.
- *  @returns EINVAL if the address length does not match the address family.
- *  @returns EAFNOSUPPORT if the address family is not supported.
- */
-int udp_set_address_port( struct sockaddr * addr, int addrlen, uint16_t port );
 /** UDP global data.
  */
 udp_globals_t   udp_globals;
 int udp_initialize( async_client_conn_t client_connection ){
+    }
     udp_globals.ip_phone = ip_bind_service( SERVICE_IP, IPPROTO_UDP, SERVICE_UDP, client_connection, udp_received_msg );
     if( udp_globals.ip_phone < 0 ){
         return udp_globals.ip_phone;
+    }
-    ERROR_PROPAGATE( ip_packet_size_req( udp_globals.ip_phone, -1, & udp_globals.addr_len, & udp_globals.prefix, & udp_globals.content, & udp_globals.suffix ));
+    ERROR_PROPAGATE( ip_packet_size_req( udp_globals.ip_phone, -1, & udp_globals.packet_dimension.addr_len, & udp_globals.packet_dimension.prefix, & udp_globals.packet_dimension.content, & udp_globals.packet_dimension.suffix ));
     ERROR_PROPAGATE( socket_ports_initialize( & udp_globals.sockets ));
-    udp_globals.prefix += sizeof( udp_header_t );
+    udp_globals.packet_dimension.prefix += sizeof( udp_header_t );
-    udp_globals.content -= sizeof( udp_header_t );
+    udp_globals.packet_dimension.content -= sizeof( udp_header_t );
     udp_globals.last_used_port = UDP_FREE_PORTS_START - 1;
     // get configuration
     udp_globals.checksum_computing = NET_DEFAULT_UDP_CHECKSUM_COMPUTING;
     configuration = & names[ 0 ];
     ERROR_PROPAGATE( net_get_conf_req( udp_globals.net_phone, & configuration, count, & data ));
     // get udp header
     header = ( udp_header_ref )( data + offset );
     // find the destination socket
     socket = socket_ports_find( & udp_globals.sockets, ntohs( header->dest ));
     if( ! socket ){
-        udp_send_icmp_port_unreachable( packet, error );
+        tl_send_icmp_port_unreachable( udp_globals.net_phone, udp_globals.icmp_phone, packet, error );
         return EADDRNOTAVAIL;
+    }
     // trim after successful processing to be able to send an ICMP error message!
     ERROR_PROPAGATE( packet_trim( packet, offset, 0 ));
     // count the received packet fragments
     if( ERROR_OCCURRED( dyn_fifo_push( &( ** socket ).received, packet_get_id( packet ), SOCKET_MAX_RECEIVED_SIZE ))){
         return udp_release_and_return( packet, ERROR_CODE );
+    }
     // notify the destination socket
-    async_msg_2(( ** socket ).phone, NET_SOCKET_RECEIVED, ( ipcarg_t ) ( ** socket ).socket_id, ( ipcarg_t ) fragments );
+    async_msg_5(( ** socket ).phone, NET_SOCKET_RECEIVED, ( ipcarg_t ) ( ** socket ).socket_id, 0, 0, 0, ( ipcarg_t ) fragments );
     return EOK;
+}
 int udp_message( ipc_callid_t callid, ipc_call_t * call, ipc_call_t * answer, int * answer_count ){
     ERROR_DECLARE;
     bool                    keep_on_going = true;
     socket_cores_t          local_sockets;
     int                     app_phone = IPC_GET_PHONE( & call );
     struct sockaddr *       addr;
     size_t                  addrlen;
-    fibril_rwlock_t         lock;
+//  fibril_rwlock_t         lock;
     ipc_call_t              answer;
     int                     answer_count;
     /*
      * Accept the connection
      *  - Answer the first IPC_M_CONNECT_ME_TO call.
      */
     ipc_answer_0( callid, EOK );
+    // The client connection is only in one fibril and therefore no additional locks are needed.
     socket_cores_initialize( & local_sockets );
-    fibril_rwlock_initialize( & lock );
+//  fibril_rwlock_initialize( & lock );
     while( keep_on_going ){
         // refresh data
         refresh_answer( & answer, & answer_count );
             case IPC_M_PHONE_HUNGUP:
                 keep_on_going = false;
                 res = EOK;
                 break;
             case NET_SOCKET:
-                fibril_rwlock_write_lock( & lock );
+//              fibril_rwlock_write_lock( & lock );
-                res = socket_create( & local_sockets, app_phone, SOCKET_SET_SOCKET_ID( answer ));
+                res = socket_create( & local_sockets, app_phone, NULL, SOCKET_SET_SOCKET_ID( answer ));
-                fibril_rwlock_write_unlock( & lock );
+//              fibril_rwlock_write_unlock( & lock );
-                * SOCKET_SET_HEADER_SIZE( answer ) = sizeof( udp_header_t );
                 * SOCKET_SET_DATA_FRAGMENT_SIZE( answer ) = MAX_UDP_FRAGMENT_SIZE;
+                * SOCKET_SET_HEADER_SIZE( answer ) = sizeof( udp_header_t );
                 answer_count = 3;
                 break;
             case NET_SOCKET_BIND:
                 res = data_receive(( void ** ) & addr, & addrlen );
                 if( res == EOK ){
-                    fibril_rwlock_write_lock( & lock );
+//                  fibril_rwlock_write_lock( & lock );
                     fibril_rwlock_write_lock( & udp_globals.lock );
                     res = socket_bind( & local_sockets, & udp_globals.sockets, SOCKET_GET_SOCKET_ID( call ), addr, addrlen, UDP_FREE_PORTS_START, UDP_FREE_PORTS_END, udp_globals.last_used_port );
                     fibril_rwlock_write_unlock( & udp_globals.lock );
-                    fibril_rwlock_write_unlock( & lock );
+//                  fibril_rwlock_write_unlock( & lock );
                     free( addr );
+                }
                 break;
             case NET_SOCKET_SENDTO:
                 res = data_receive(( void ** ) & addr, & addrlen );
                 if( res == EOK ){
-                    fibril_rwlock_read_lock( & lock );
+//                  fibril_rwlock_read_lock( & lock );
                     fibril_rwlock_read_lock( & udp_globals.lock );
-                    res = udp_sendto_message( & local_sockets, SOCKET_GET_SOCKET_ID( call ), addr, addrlen, SOCKET_GET_DATA_FRAGMENTS( call ), SOCKET_GET_FLAGS( call ));
+                    res = udp_sendto_message( & local_sockets, SOCKET_GET_SOCKET_ID( call ), addr, addrlen, SOCKET_GET_DATA_FRAGMENTS( call ), SOCKET_GET_DATA_FRAGMENT_SIZE( call ), SOCKET_GET_FLAGS( call ));
                     fibril_rwlock_read_unlock( & udp_globals.lock );
-                    fibril_rwlock_read_unlock( & lock );
+//                  fibril_rwlock_read_unlock( & lock );
                     free( addr );
+                }
                 break;
             case NET_SOCKET_RECVFROM:
-                fibril_rwlock_read_lock( & lock );
+//              fibril_rwlock_read_lock( & lock );
                 fibril_rwlock_read_lock( & udp_globals.lock );
                 res = udp_recvfrom_message( & local_sockets, SOCKET_GET_SOCKET_ID( call ), SOCKET_GET_FLAGS( call ), & addrlen );
                 fibril_rwlock_read_unlock( & udp_globals.lock );
-                fibril_rwlock_read_unlock( & lock );
+//              fibril_rwlock_read_unlock( & lock );
                 if( res > 0 ){
                     * SOCKET_SET_READ_DATA_LENGTH( answer ) = res;
                     * SOCKET_SET_ADDRESS_LENGTH( answer ) = addrlen;
                     answer_count = 2;
                     res = EOK;
+                }
                 break;
             case NET_SOCKET_CLOSE:
-                fibril_rwlock_write_lock( & lock );
+//              fibril_rwlock_write_lock( & lock );
                 fibril_rwlock_write_lock( & udp_globals.lock );
                 res = socket_destroy( udp_globals.net_phone, SOCKET_GET_SOCKET_ID( call ), & local_sockets, & udp_globals.sockets );
                 fibril_rwlock_write_unlock( & udp_globals.lock );
-                fibril_rwlock_write_unlock( & lock );
+//              fibril_rwlock_write_unlock( & lock );
                 break;
             case NET_SOCKET_GETSOCKOPT:
             case NET_SOCKET_SETSOCKOPT:
             default:
                 res = ENOTSUP;
 //      printf( "res = %d\n", res );
         answer_call( callid, res, & answer, answer_count );
+    }
+    // TODO call socket_destroy() on all bound!
     socket_cores_destroy( & local_sockets );
     return EOK;
+}
-int udp_sendto_message( socket_cores_ref local_sockets, int socket_id, const struct sockaddr * addr, socklen_t addrlen, int fragments, int flags ){
+int udp_sendto_message( socket_cores_ref local_sockets, int socket_id, const struct sockaddr * addr, socklen_t addrlen, int fragments, size_t data_fragment_size, int flags ){
     ERROR_DECLARE;
     socket_core_ref         socket;
-    struct sockaddr_in *    address_in;
-    struct sockaddr_in6 *   address_in6;
     packet_t                packet;
     packet_t                next_packet;
     udp_header_ref          header;
     int                     index;
     size_t                  total_length;
     uint32_t                checksum;
     ip_pseudo_header_ref    ip_header;
     size_t                  headerlen;
     device_id_t             device_id;
-    if( addrlen < sizeof( struct sockaddr )) return EINVAL;
-    switch( addr->sa_family ){
-        case AF_INET:
-            if( addrlen != sizeof( struct sockaddr_in )) return EINVAL;
-            address_in = ( struct sockaddr_in * ) addr;
-            dest_port = address_in->sin_port;
-            break;
-        case AF_INET6:
-            if( addrlen != sizeof( struct sockaddr_in6 )) return EINVAL;
+    ERROR_PROPAGATE( tl_get_address_port( addr, addrlen, & dest_port ));
-            address_in6 = ( struct sockaddr_in6 * ) addr;
-            dest_port = address_in6->sin6_port;
-            break;
-        default:
-            return EAFNOSUPPORT;
-    }
     socket = socket_cores_find( local_sockets, socket_id );
     if( ! socket ) return ENOTSOCK;
     // bind the socket to a random free port if not bound
         fibril_rwlock_write_unlock( & udp_globals.lock );
         fibril_rwlock_read_lock( & udp_globals.lock );
+    }
     // TODO do not ask all the time
-    ERROR_PROPAGATE( ip_packet_size_req( udp_globals.ip_phone, socket->device_id, & udp_globals.addr_len, & udp_globals.prefix, & udp_globals.content, & udp_globals.suffix ));
+    ERROR_PROPAGATE( ip_packet_size_req( udp_globals.ip_phone, -1, & udp_globals.packet_dimension.addr_len, & udp_globals.packet_dimension.prefix, & udp_globals.packet_dimension.content, & udp_globals.packet_dimension.suffix ));
     // read the first packet fragment
-    result = socket_read_packet_data( & packet, sizeof( udp_header_t ), addr, addrlen );
+    result = tl_socket_read_packet_data( udp_globals.net_phone, & packet, sizeof( udp_header_t ), & udp_globals.packet_dimension, addr, addrlen );
     if( result < 0 ) return result;
     total_length = ( size_t ) result;
     if( udp_globals.checksum_computing ){
         checksum = compute_checksum( 0, packet_get_data( packet ), packet_get_data_length( packet ));
     }else{
         return udp_release_and_return( packet, ENOMEM );
+    }
     bzero( header, sizeof( * header ));
     // read the rest of the packet fragments
     for( index = 1; index < fragments; ++ index ){
-        result = socket_read_packet_data( & next_packet, 0, addr, addrlen );
+        result = tl_socket_read_packet_data( udp_globals.net_phone, & next_packet, 0, & udp_globals.packet_dimension, addr, addrlen );
         if( result < 0 ){
             return udp_release_and_return( packet, result );
+        }
         packet = pq_add( packet, next_packet, index, 0 );
         total_length += ( size_t ) result;
 */      checksum = compute_checksum( checksum, ip_header, headerlen );
         checksum = compute_checksum( checksum, ( uint8_t * ) header, sizeof( * header ));
         header->check = htons( flip_checksum( compact_checksum( checksum )));
         free( ip_header );
     }else{
-        device_id = socket->device_id;
+        device_id = -1;
+    }
     // prepare the first packet fragment
     if( ERROR_OCCURRED( ip_client_prepare_packet( packet, IPPROTO_UDP, 0, 0, 0, 0 ))){
         return udp_release_and_return( packet, ERROR_CODE );
+    }
+    }
     header = ( udp_header_ref ) data;
     // set the source address port
     result = packet_get_addr( packet, ( uint8_t ** ) & addr, NULL );
-    if( ERROR_OCCURRED( udp_set_address_port( addr, result, ntohs( header->source )))){
+    if( ERROR_OCCURRED( tl_set_address_port( addr, result, ntohs( header->source )))){
         pq_release( udp_globals.net_phone, packet_id );
         return ERROR_CODE;
+    }
     * addrlen = ( size_t ) result;
     // send the source address
     pq_release( udp_globals.net_phone, packet_get_id( packet ));
     // return the total length
     return ( int ) length;
+}
-int socket_read_packet_data( packet_ref packet, size_t prefix, const struct sockaddr * addr, socklen_t addrlen ){
-    ERROR_DECLARE;
-    ipc_callid_t    callid;
-    size_t          length;
-    void *          data;
-    // get the data length
-    if( ! ipc_data_write_receive( & callid, & length )) return EINVAL;
-    // get a new packet
-    * packet = packet_get_4( udp_globals.net_phone, length, udp_globals.addr_len, prefix + udp_globals.prefix, udp_globals.suffix );
-    if( ! packet ) return ENOMEM;
-    // allocate space in the packet
-    data = packet_suffix( * packet, length );
-    if( ! data ){
-        return udp_release_and_return( * packet, ENOMEM );
-    }
-    // read the data into the packet
-    if( ERROR_OCCURRED( ipc_data_write_finalize( callid, data, length ))
-    // set the packet destination address
-    || ERROR_OCCURRED( packet_set_addr( * packet, NULL, ( uint8_t * ) addr, addrlen ))){
-        return udp_release_and_return( * packet, ERROR_CODE );
-    }
-    return ( int ) length;
-}
 int udp_release_and_return( packet_t packet, int result ){
     pq_release( udp_globals.net_phone, packet_get_id( packet ));
     return result;
+}
-void udp_send_icmp_port_unreachable( packet_t packet, services_t error ){
-    packet_t    next;
-    uint8_t *   src;
-    int         length;
-    // detach the first packet and release the others
-    next = pq_detach( packet );
-    if( next ){
-        pq_release( udp_globals.net_phone, packet_get_id( next ));
-    }
-    length = packet_get_addr( packet, & src, NULL );
-    if(( length > 0 )
-    && ( ! error )
-    && ( udp_globals.icmp_phone >= 0 )
-    // set both addresses to the source one (avoids the source address deletion before setting the destination one)
-    && ( packet_set_addr( packet, src, src, ( size_t ) length ) == EOK )){
-        icmp_destination_unreachable_msg( udp_globals.icmp_phone, ICMP_PORT_UNREACH, 0, packet );
-    }else{
-        udp_release_and_return( packet, EINVAL );
-    }
-}
-int udp_set_address_port( struct sockaddr * addr, int addrlen, uint16_t port ){
-    struct sockaddr_in *    address_in;
-    struct sockaddr_in6 *   address_in6;
-    size_t                  length;
-    if( addrlen < 0 ) return EINVAL;
-    length = ( size_t ) addrlen;
-    if( length < sizeof( struct sockaddr )) return EINVAL;
-    switch( addr->sa_family ){
-        case AF_INET:
-            if( length != sizeof( struct sockaddr_in )) return EINVAL;
-            address_in = ( struct sockaddr_in * ) addr;
-            address_in->sin_port = port;
-            return EOK;
-        case AF_INET6:
-            if( length != sizeof( struct sockaddr_in6 )) return EINVAL;
-            address_in6 = ( struct sockaddr_in6 * ) addr;
-            address_in6->sin6_port = port;
-            return EOK;
-        default:
-            return EAFNOSUPPORT;
-    }
-}
 /** @}
  */

Subversion Repositories HelenOS

(root)/branches/network/uspace/srv/net/tl/udp/udp.c – Rev 4722 → 4726