Subversion Repositories HelenOS

Rev

Rev 4261 | Rev 4327 | Go to most recent revision | Blame | Compare with Previous | Last modification | View Log | Download | RSS feed

  1. /*
  2.  * Copyright (c) 2009 Lukas Mejdrech
  3.  * All rights reserved.
  4.  *
  5.  * Redistribution and use in source and binary forms, with or without
  6.  * modification, are permitted provided that the following conditions
  7.  * are met:
  8.  *
  9.  * - Redistributions of source code must retain the above copyright
  10.  *   notice, this list of conditions and the following disclaimer.
  11.  * - Redistributions in binary form must reproduce the above copyright
  12.  *   notice, this list of conditions and the following disclaimer in the
  13.  *   documentation and/or other materials provided with the distribution.
  14.  * - The name of the author may not be used to endorse or promote products
  15.  *   derived from this software without specific prior written permission.
  16.  *
  17.  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  18.  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  19.  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  20.  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  21.  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  22.  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  23.  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  24.  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  25.  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  26.  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  27.  */
  28.  
  29. /** @addtogroup ip
  30.  *  @{
  31.  */
  32.  
  33. /** @file
  34.  */
  35.  
  36. #include <async.h>
  37. #include <errno.h>
  38. #include <stdio.h>
  39.  
  40. #include <ipc/ipc.h>
  41. #include <ipc/services.h>
  42.  
  43. #include "../../err.h"
  44. #include "../../messages.h"
  45. #include "../../modules.h"
  46.  
  47. #include "../../include/sockaddr.h"
  48. #include "../../include/socket.h"
  49. #include "../../include/device.h"
  50. #include "../../include/arp_messages.h"
  51. #include "../../include/nil_messages.h"
  52. #include "../../structures/measured_strings.h"
  53. #include "../../structures/module_map.h"
  54. #include "../../structures/packet/packet_client.h"
  55.  
  56. #include "ip.h"
  57. #include "ip_messages.h"
  58. #include "ip_module.h"
  59.  
  60. #define DEFAULT_IPV     4
  61.  
  62. #define ARP_NAME                "arp"
  63. #define ARP_FILENAME            "/srv/arp"
  64.  
  65. #define IPC_GET_PROTO( call )       ( int ) IPC_GET_ARG1( * call )
  66. #define IPC_GET_STATE( call )       ( device_state_t ) IPC_GET_ARG2( * call )
  67. #define IPC_GET_PHONE( call )       ( int ) IPC_GET_ARG5( * call )
  68.  
  69. ip_globals_t    ip_globals;
  70.  
  71. DEVICE_MAP_IMPLEMENT( ip_netifs, ip_netif_t )
  72.  
  73. INT_MAP_IMPLEMENT( ip_protos, ip_proto_t )
  74.  
  75. int ip_register_message( int protocol, int phone );
  76. int ip_state_message( device_id_t device_id, device_state_t state );
  77. void    ip_driver_receiver( ipc_callid_t iid, ipc_call_t * icall );
  78.  
  79. /** Initializes the module.
  80.  */
  81. int ip_initialize( void ){
  82.     ERROR_DECLARE;
  83.  
  84.     ERROR_PROPAGATE( ip_netifs_initialize( & ip_globals.netifs ));
  85.     ERROR_PROPAGATE( ip_protos_initialize( & ip_globals.protos ));
  86.     ERROR_PROPAGATE( modules_initialize( & ip_globals.modules ));
  87.     ERROR_PROPAGATE( add_module( NULL, & ip_globals.modules, ARP_NAME, ARP_FILENAME, SERVICE_ARP, 0 ));
  88.     return EOK;
  89. }
  90.  
  91. int ip_echo_message( ipcarg_t arg1, ipcarg_t arg2, ipcarg_t arg3, ipcarg_t arg4, ipcarg_t arg5, ipcarg_t * answer1, ipcarg_t * answer2, ipcarg_t * answer3, ipcarg_t * answer4, ipcarg_t * answer5 ){
  92.     if( answer1 ) * answer1 = arg1;
  93.     if( answer2 ) * answer2 = arg2;
  94.     if( answer3 ) * answer3 = arg3;
  95.     if( answer4 ) * answer4 = arg4;
  96.     if( answer5 ) * answer5 = arg5;
  97.     return EOK;
  98. }
  99.  
  100. int ip_device_message( device_id_t device_id, services_t service ){
  101.     ERROR_DECLARE;
  102.  
  103.     ip_netif_ref    ip_netif;
  104.     aid_t           message;
  105.     ipc_call_t      answer;
  106.     measured_string_t   configuration[ 9 ] = {{ "IPV", 3 }, { "IP_CONFIG", 9 }, { "IP_ADDR", 7 }, { "NETMASK", 7 }, { "GATEWAY", 7 }, { "BROADCAST", 9 }, { "DNS1", 4 }, { "DNS2", 4 }, { "ARP", 3 }};
  107.     int         count = 9;
  108.     measured_string_ref settings;
  109.     char *          data;
  110.     ipcarg_t        result;
  111.     int             index;
  112.  
  113.     ip_netif = ( ip_netif_ref ) malloc( sizeof( ip_netif_t ));
  114.     if( ! ip_netif ) return ENOMEM;
  115.     ip_netif->device_id = device_id;
  116.     // get configuration
  117.     // TODO mapping
  118.     message = async_send_2( ip_globals.networking_phone, NET_NET_GET_DEVICE_CONF, ip_netif->device_id, count, & answer );
  119.     // send names and get settings
  120.     if( ERROR_OCCURRED( measured_strings_send( ip_globals.networking_phone, configuration, count ))
  121.     || ERROR_OCCURRED( measured_strings_return( ip_globals.networking_phone, & settings, & data, count ))){
  122.         async_wait_for( message, NULL );
  123.         free( ip_netif );
  124.         return ERROR_CODE;
  125.     }
  126.     async_wait_for( message, & result );
  127.     if( ERROR_OCCURRED( result )){
  128.         if( settings ){
  129.             free( settings );
  130.             free( data );
  131.         };
  132.         free( ip_netif );
  133.         return ERROR_CODE;
  134.     }
  135.     if( settings ){
  136.         if( settings[ 0 ].value ){
  137.             ip_netif->ipv = strtol( settings[ 0 ].value, NULL, 0 );
  138.         }else{
  139.             ip_netif->ipv = DEFAULT_IPV;
  140.         }
  141.         ip_netif->dhcp = ! strncmp( settings[ 1 ].value, "dhcp", 4 );
  142.         if( ip_netif->dhcp ){
  143.             // TODO dhcp
  144.             free( settings );
  145.             free( data );
  146.             free( ip_netif );
  147.             return ENOTSUP;
  148.         }else if( ip_netif->ipv == 4 ){
  149.             if( ERROR_OCCURRED( inet_pton( AF_INET, settings[ 2 ].value, ( uint8_t * ) & ip_netif->address ))
  150.             || ERROR_OCCURRED( inet_pton( AF_INET, settings[ 3 ].value, ( uint8_t * ) & ip_netif->netmask ))
  151.             || ( inet_pton( AF_INET, settings[ 4 ].value, ( uint8_t * ) & ip_netif->gateway ) == EINVAL )
  152.             || ( inet_pton( AF_INET, settings[ 5 ].value, ( uint8_t * ) & ip_netif->broadcast ) == EINVAL )
  153.             || ( inet_pton( AF_INET, settings[ 6 ].value, ( uint8_t * ) & ip_netif->dns1 ) == EINVAL )
  154.             || ( inet_pton( AF_INET, settings[ 7 ].value, ( uint8_t * ) & ip_netif->dns2 ) == EINVAL )){
  155.                 free( settings );
  156.                 free( data );
  157.                 free( ip_netif );
  158.                 return EINVAL;
  159.             }
  160.         }else{
  161.             // TODO ipv6
  162.             free( settings );
  163.             free( data );
  164.             free( ip_netif );
  165.             return ENOTSUP;
  166.         }
  167.         if( settings[ 8 ].value ){
  168.             ip_netif->arp = get_running_module( & ip_globals.modules, settings[ 8 ].value );
  169.             if( ! ip_netif->arp ){
  170.                 printf( "\nFailed to start the arp %s", settings[ 8 ].value );
  171.                 free( settings );
  172.                 free( data );
  173.                 free( ip_netif );
  174.                 return EINVAL;
  175.             }
  176.         }else{
  177.             ip_netif->arp = NULL;
  178.         }
  179.         free( settings );
  180.         free( data );
  181.     }
  182.     ip_netif->phone = bind_service( service, ip_netif->device_id, SERVICE_IP, 0, ip_driver_receiver );
  183.     if( ip_netif->phone < 0 ){
  184.         printf( "\nFailed to contact the nil service %d", service );
  185.         free( ip_netif );
  186.         return ip_netif->phone;
  187.     }
  188.     if( ip_netif->arp ){
  189.         configuration[ 0 ].value = ( char * ) & ip_netif->address;
  190.         configuration[ 0 ].length = CONVERT_SIZE( in_addr_t, char, 1 );
  191.         if( ERROR_OCCURRED( arp_device_req( ip_netif->arp->phone, ip_netif->device_id, SERVICE_IP, service, & configuration[ 0 ] ))){
  192.             free( ip_netif );
  193.             return ERROR_CODE;
  194.         }
  195.     }
  196.     index = ip_netifs_add( & ip_globals.netifs, ip_netif->device_id, ip_netif );
  197.     if( index < 0 ){
  198.         free( ip_netif );
  199.         return index;
  200.     }
  201.     if( ip_netif->arp ) ++ ip_netif->arp->usage;
  202.     // print the settings
  203.     printf( "\nNew device registered:\n\tid\t= %d\n\tphone\t= %d\n\tIPV\t= %d", ip_netif->device_id, ip_netif->phone, ip_netif->ipv );
  204.     printf( "\n\tconfiguration\t= %s", ip_netif->dhcp ? "dhcp" : "static" );
  205.     // TODO ipv6 addresses
  206.     data = malloc( INET_ADDRSTRLEN );
  207.     if( data ){
  208.         inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->address, data, INET_ADDRSTRLEN );
  209.         printf( "\n\taddress\t= %s", data );
  210.         inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->netmask, data, INET_ADDRSTRLEN );
  211.         printf( "\n\tnetmask\t= %s", data );
  212.         inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->gateway, data, INET_ADDRSTRLEN );
  213.         printf( "\n\tgateway\t= %s", data );
  214.         inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->broadcast, data, INET_ADDRSTRLEN );
  215.         printf( "\n\tbroadcast\t= %s", data );
  216.         inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->dns1, data, INET_ADDRSTRLEN );
  217.         printf( "\n\tdns1\t= %s", data );
  218.         inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->dns2, data, INET_ADDRSTRLEN );
  219.         printf( "\n\tdns2\t= %s", data );
  220.         free( data );
  221.     }
  222.     return EOK;
  223. }
  224.  
  225. void ip_driver_receiver( ipc_callid_t iid, ipc_call_t * icall ){
  226.     ERROR_DECLARE;
  227.  
  228.     ipc_callid_t    callid;
  229.     ipc_call_t  call;
  230. //  ipc_call_t  answer;
  231. //  int     count;
  232.     int     result;
  233.     packet_t    packet;
  234.  
  235.     /*
  236.      * Accept the connection
  237.      *  - Answer the first IPC_M_CONNECT_ME_TO call.
  238.      */
  239.     ipc_answer_0( iid, EOK );
  240.  
  241.     while( true ){
  242. /*      // refresh data
  243.         count = 0;
  244.         IPC_SET_RETVAL( answer, 0 );
  245.         // just to be precize
  246.         IPC_SET_RETVAL( answer, 0 );
  247.         IPC_SET_ARG1( answer, 0 );
  248.         IPC_SET_ARG2( answer, 0 );
  249.         IPC_SET_ARG3( answer, 0 );
  250.         IPC_SET_ARG4( answer, 0 );
  251.         IPC_SET_ARG5( answer, 0 );
  252. */
  253.         callid = async_get_call( & call );
  254.         switch( IPC_GET_METHOD( call )){
  255.             case NET_IL_DEVICE_STATE:
  256.             case NET_NIL_DEVICE_STATE:
  257.                 result = ip_state_message( IPC_GET_DEVICE( & call ), IPC_GET_STATE( & call ));
  258.                 ipc_answer_0( callid, result );
  259.             // TODO packer received
  260.             case NET_IL_RECEIVED:
  261.             case NET_NIL_RECEIVED:
  262.                 if( ! ERROR_OCCURRED( result = packet_translate( ip_globals.networking_phone, & packet, IPC_GET_PACKET( & call )))){
  263.                     //result = ip_receive_message( IPC_GET_DEVICE( call ), packet );
  264.                 }
  265.                 ipc_answer_0( callid, result );
  266.         }
  267.     }
  268. }
  269.  
  270. int ip_state_message( device_id_t device_id, device_state_t state ){
  271.     ERROR_DECLARE;
  272.  
  273.     ip_netif_ref    netif;
  274.  
  275.     measured_string_t address;
  276.     measured_string_ref translation;
  277.     char *          data;
  278.  
  279.     netif = ip_netifs_find( & ip_globals.netifs, device_id );
  280.     if( ! netif ) return ENOENT;
  281.     // TODO state
  282.     printf( "\nip - device %d changed state to %d\n", device_id, state );
  283.     if( netif->arp ){
  284.         address.value = ( char * ) & netif->gateway;
  285.         address.length = CONVERT_SIZE( in_addr_t, char, 1 );
  286.         ERROR_PROPAGATE( arp_translate_req( netif->arp->phone, netif->device_id, SERVICE_IP, & address, & translation, & data ));
  287.         printf( "\n\tgateway translated to\t= %X:%X:%X:%X:%X:%X", data[ 0 ], data[ 1 ], data[ 2 ], data[ 3 ], data[ 4 ], data[ 5 ] );
  288.         free( translation );
  289.         free( data );
  290.     }
  291.     return EOK;
  292. }
  293.  
  294. int ip_register_message( int protocol, int phone ){
  295.     ip_proto_ref    proto;
  296.     int             index;
  297.  
  298.     proto = ( ip_proto_ref ) malloc( sizeof( ip_protos_t ));
  299.     if( ! proto ) return ENOMEM;
  300.     proto->protocol = protocol;
  301.     proto->phone = phone;
  302.     index = ip_protos_add( & ip_globals.protos, proto->protocol, proto );
  303.     if( index < 0 ){
  304.         free( proto );
  305.         return index;
  306.     }
  307.     printf( "\nNew protocol registered:\n\tprotocol\t= %d\n\tphone\t= %d", proto->protocol, proto->phone );
  308.     return EOK;
  309. }
  310.  
  311. int ip_send_message( device_id_t device_id, packet_t packet ){
  312.     // TODO send packet
  313.     printf( "Packet to send via %d: %s", device_id, packet_get_data( packet ));
  314.     pq_release( ip_globals.networking_phone, packet_get_id( packet ));
  315.     return EOK;
  316. }
  317.  
  318. int ip_message( ipc_callid_t callid, ipc_call_t * call, ipc_call_t * answer, int * answer_count ){
  319.     ERROR_DECLARE;
  320.  
  321.     packet_t    packet;
  322.  
  323.     * answer_count = 0;
  324.     switch( IPC_GET_METHOD( * call )){
  325.         case IPC_M_PHONE_HUNGUP:
  326.             return EOK;
  327.         case NET_IP_ECHO:
  328.             * answer_count = 5;
  329.             return ip_echo_message( IPC_GET_ARG1( * call ), IPC_GET_ARG2( * call ), IPC_GET_ARG3( * call ), IPC_GET_ARG4( * call ), IPC_GET_ARG5( * call ), & IPC_GET_ARG1( * answer ), & IPC_GET_ARG2( * answer ), & IPC_GET_ARG3( * answer ), & IPC_GET_ARG4( * answer ), & IPC_GET_ARG5( * answer ) );
  330.         case NET_IL_DEVICE:
  331.             return ip_device_message( IPC_GET_DEVICE( call ), IPC_GET_SERVICE( call ));
  332.         case IPC_M_CONNECT_TO_ME:
  333.             return ip_register_message( IPC_GET_PROTO( call ), IPC_GET_PHONE( call ));
  334.         case NET_IP_SEND:
  335.             ERROR_PROPAGATE( packet_translate( ip_globals.networking_phone, & packet, IPC_GET_PACKET( call )));
  336.             return ip_send_message( IPC_GET_DEVICE( call ), packet );
  337.     }
  338.     return ENOTSUP;
  339. }
  340.  
  341. /** @}
  342.  */
  343.