Subversion Repositories HelenOS

Rev

Rev 4192 | Rev 4261 | 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 "../../structures/measured_strings.h"
  51. #include "../../structures/module_map.h"
  52. #include "../../structures/packet/packet_client.h"
  53.  
  54. #include "ip.h"
  55. #include "ip_messages.h"
  56. #include "ip_module.h"
  57.  
  58. #define DEFAULT_IPV     4
  59.  
  60. #define ARP_NAME                "arp"
  61. #define ARP_FILENAME            "/srv/arp"
  62.  
  63. #define IPC_GET_DEVICE( call )      ( device_id_t ) IPC_GET_ARG1( * call )
  64. #define IPC_GET_PACKET( call )      ( packet_id_t ) IPC_GET_ARG1( * call )
  65. #define IPC_GET_PROTO( call )       ( int ) IPC_GET_ARG1( * call )
  66. #define IPC_GET_SERVICE( call )     ( services_t ) IPC_GET_ARG2( * call )
  67. #define IPC_GET_STATE( call )       ( device_state_t ) IPC_GET_ARG2( * call )
  68. #define IPC_GET_PHONE( call )       ( int ) IPC_GET_ARG5( * call )
  69.  
  70. ip_globals_t    ip_globals;
  71.  
  72. DEVICE_MAP_IMPLEMENT( ip_netifs, ip_netif_t )
  73.  
  74. INT_MAP_IMPLEMENT( ip_protos, ip_proto_t )
  75.  
  76. int ip_register_message( int protocol, int phone );
  77. int ip_state_message( device_id_t device_id, device_state_t state );
  78. void    ip_driver_receiver( ipc_callid_t iid, ipc_call_t * icall );
  79.  
  80. /** Initializes the module.
  81.  */
  82. int ip_initialize( void ){
  83.     ERROR_DECLARE;
  84.  
  85.     ERROR_PROPAGATE( ip_netifs_initialize( & ip_globals.netifs ));
  86.     ERROR_PROPAGATE( ip_protos_initialize( & ip_globals.protos ));
  87.     ERROR_PROPAGATE( modules_initialize( & ip_globals.modules ));
  88.     ERROR_PROPAGATE( add_module( NULL, & ip_globals.modules, ARP_NAME, ARP_FILENAME, SERVICE_ARP, 0 ));
  89.     return EOK;
  90. }
  91.  
  92. 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 ){
  93.     if( answer1 ) * answer1 = arg1;
  94.     if( answer2 ) * answer2 = arg2;
  95.     if( answer3 ) * answer3 = arg3;
  96.     if( answer4 ) * answer4 = arg4;
  97.     if( answer5 ) * answer5 = arg5;
  98.     return EOK;
  99. }
  100.  
  101. int ip_device_message( device_id_t device_id, services_t service ){
  102.     ERROR_DECLARE;
  103.  
  104.     ip_netif_ref    ip_netif;
  105.     aid_t           message;
  106.     ipc_call_t      answer;
  107.     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 }};
  108.     int         count = 9;
  109.     measured_string_ref settings;
  110.     char *          data;
  111.     ipcarg_t        result;
  112.     int             index;
  113.  
  114.     ip_netif = ( ip_netif_ref ) malloc( sizeof( ip_netif_t ));
  115.     if( ! ip_netif ) return ENOMEM;
  116.     ip_netif->device_id = device_id;
  117.     // get configuration
  118.     // TODO mapping
  119.     message = async_send_2( ip_globals.networking_phone, NET_NET_GET_DEVICE_CONF, ip_netif->device_id, count, & answer );
  120.     // send names and get settings
  121.     if( ERROR_OCCURRED( measured_strings_send( ip_globals.networking_phone, configuration, count ))
  122.     || ERROR_OCCURRED( measured_strings_return( ip_globals.networking_phone, & settings, & data, count ))){
  123.         async_wait_for( message, NULL );
  124.         free( ip_netif );
  125.         return ERROR_CODE;
  126.     }
  127.     async_wait_for( message, & result );
  128.     if( ERROR_OCCURRED( result )){
  129.         if( settings ){
  130.             free( settings );
  131.             free( data );
  132.         };
  133.         free( ip_netif );
  134.         return ERROR_CODE;
  135.     }
  136.     if( settings ){
  137.         if( settings[ 0 ].value ){
  138.             ip_netif->ipv = strtol( settings[ 0 ].value, NULL, 0 );
  139.         }else{
  140.             ip_netif->ipv = DEFAULT_IPV;
  141.         }
  142.         ip_netif->dhcp = ! strncmp( settings[ 1 ].value, "dhcp", 4 );
  143.         if( ip_netif->dhcp ){
  144.             // TODO dhcp
  145.             free( settings );
  146.             free( data );
  147.             free( ip_netif );
  148.             return ENOTSUP;
  149.         }else if( ip_netif->ipv == 4 ){
  150.             if( ERROR_OCCURRED( inet_pton( AF_INET, settings[ 2 ].value, ( uint8_t * ) & ip_netif->address ))
  151.             || ERROR_OCCURRED( inet_pton( AF_INET, settings[ 3 ].value, ( uint8_t * ) & ip_netif->netmask ))
  152.             || ( inet_pton( AF_INET, settings[ 4 ].value, ( uint8_t * ) & ip_netif->gateway ) == EINVAL )
  153.             || ( inet_pton( AF_INET, settings[ 5 ].value, ( uint8_t * ) & ip_netif->broadcast ) == EINVAL )
  154.             || ( inet_pton( AF_INET, settings[ 6 ].value, ( uint8_t * ) & ip_netif->dns1 ) == EINVAL )
  155.             || ( inet_pton( AF_INET, settings[ 7 ].value, ( uint8_t * ) & ip_netif->dns2 ) == EINVAL )){
  156.                 free( settings );
  157.                 free( data );
  158.                 free( ip_netif );
  159.                 return EINVAL;
  160.             }
  161.         }else{
  162.             // TODO ipv6
  163.             free( settings );
  164.             free( data );
  165.             free( ip_netif );
  166.             return ENOTSUP;
  167.         }
  168.         if( settings[ 8 ].value ){
  169.             ip_netif->arp = get_running_module( & ip_globals.modules, settings[ 8 ].value );
  170.             if( ! ip_netif->arp ){
  171.                 printf( "\nFailed to start the arp %s", settings[ 8 ].value );
  172.                 free( settings );
  173.                 free( data );
  174.                 free( ip_netif );
  175.                 return EINVAL;
  176.             }
  177.         }else{
  178.             ip_netif->arp = NULL;
  179.         }
  180.         free( settings );
  181.         free( data );
  182.     }
  183.     // TODO mapping
  184.     ip_netif->phone = bind_service( service, ip_netif->device_id, SERVICE_IP, 0, ip_driver_receiver );
  185.     if( ip_netif->phone < 0 ){
  186.         printf( "\nFailed to contact the nil service %d", service );
  187.         free( ip_netif );
  188.         return ip_netif->phone;
  189.     }
  190.     if( ip_netif->arp ){
  191.         message = async_send_3( ip_netif->arp->phone, NET_ARP_DEVICE, ip_netif->device_id, SERVICE_IP, service, & answer );
  192.         configuration[ 0 ].value = ( char * ) & ip_netif->address;
  193.         configuration[ 0 ].length = CONVERT_SIZE( in_addr_t, char, 1 );
  194.         if( ERROR_OCCURRED( measured_strings_send( ip_netif->arp->phone, & configuration[ 0 ], 1 ))){
  195.             free( ip_netif );
  196.             return ERROR_CODE;
  197.         }
  198.         async_wait_for( message, & result );
  199.         if( ERROR_OCCURRED( result )){
  200.             free( ip_netif );
  201.             return ERROR_CODE;
  202.         }
  203.     }
  204.     index = ip_netifs_add( & ip_globals.netifs, ip_netif->device_id, ip_netif );
  205.     if( index < 0 ){
  206.         free( ip_netif );
  207.         return index;
  208.     }
  209.     if( ip_netif->arp ) ++ ip_netif->arp->usage;
  210.     // print the settings
  211.     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 );
  212.     printf( "\n\tconfiguration\t= %s", ip_netif->dhcp ? "dhcp" : "static" );
  213.     // TODO ipv6 addresses
  214.     data = malloc( INET_ADDRSTRLEN );
  215.     if( data ){
  216.         inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->address, data, INET_ADDRSTRLEN );
  217.         printf( "\n\taddress\t= %s", data );
  218.         inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->netmask, data, INET_ADDRSTRLEN );
  219.         printf( "\n\tnetmask\t= %s", data );
  220.         inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->gateway, data, INET_ADDRSTRLEN );
  221.         printf( "\n\tgateway\t= %s", data );
  222.         inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->broadcast, data, INET_ADDRSTRLEN );
  223.         printf( "\n\tbroadcast\t= %s", data );
  224.         inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->dns1, data, INET_ADDRSTRLEN );
  225.         printf( "\n\tdns1\t= %s", data );
  226.         inet_ntop( AF_INET, ( uint8_t * ) & ip_netif->dns2, data, INET_ADDRSTRLEN );
  227.         printf( "\n\tdns2\t= %s", data );
  228.         free( data );
  229.     }
  230.     return EOK;
  231. }
  232.  
  233. void ip_driver_receiver( ipc_callid_t iid, ipc_call_t * icall ){
  234.     ERROR_DECLARE;
  235.  
  236.     ipc_callid_t    callid;
  237.     ipc_call_t  call;
  238. //  ipc_call_t  answer;
  239. //  int     count;
  240.     int     result;
  241.     packet_t    packet;
  242.  
  243.     /*
  244.      * Accept the connection
  245.      *  - Answer the first IPC_M_CONNECT_ME_TO call.
  246.      */
  247.     ipc_answer_0( iid, EOK );
  248.  
  249.     while( true ){
  250. /*      // refresh data
  251.         count = 0;
  252.         IPC_SET_RETVAL( answer, 0 );
  253.         // just to be precize
  254.         IPC_SET_RETVAL( answer, 0 );
  255.         IPC_SET_ARG1( answer, 0 );
  256.         IPC_SET_ARG2( answer, 0 );
  257.         IPC_SET_ARG3( answer, 0 );
  258.         IPC_SET_ARG4( answer, 0 );
  259.         IPC_SET_ARG5( answer, 0 );
  260. */
  261.         callid = async_get_call( & call );
  262.         switch( IPC_GET_METHOD( call )){
  263.             case NET_IL_DEVICE_STATE:
  264.             case NET_NIL_DEVICE_STATE:
  265.                 result = ip_state_message( IPC_GET_DEVICE( & call ), IPC_GET_STATE( & call ));
  266.                 ipc_answer_0( callid, result );
  267.             // TODO packer received
  268.             case NET_IL_RECEIVED:
  269.             case NET_NIL_RECEIVED:
  270.                 if( ! ERROR_OCCURRED( result = packet_translate( ip_globals.networking_phone, & packet, IPC_GET_PACKET( & call )))){
  271.                     //result = ip_receive_message( IPC_GET_DEVICE( call ), packet );
  272.                 }
  273.                 ipc_answer_0( callid, result );
  274.         }
  275.     }
  276. }
  277.  
  278. int ip_state_message( device_id_t device_id, device_state_t state ){
  279.     ERROR_DECLARE;
  280.  
  281.     ip_netif_ref    netif;
  282.  
  283.     aid_t           message;
  284.     ipc_call_t      answer;
  285.     measured_string_t address;
  286.     measured_string_ref translation;
  287.     char *          data;
  288.     ipcarg_t        result;
  289.  
  290.     netif = ip_netifs_find( & ip_globals.netifs, device_id );
  291.     if( ! netif ) return ENOENT;
  292.     // TODO state
  293.     printf( "\nip - device %d changed state to %d\n", device_id, state );
  294.     if( netif->arp ){
  295.         message = async_send_2( netif->arp->phone, NET_ARP_TRANSLATE, netif->device_id, SERVICE_IP, & answer );
  296.         address.value = ( char * ) & netif->gateway;
  297.         address.length = CONVERT_SIZE( in_addr_t, char, 1 );
  298.         if( ERROR_OCCURRED( measured_strings_send( netif->arp->phone, & address, 1 ))
  299.         || ERROR_OCCURRED( measured_strings_return( netif->arp->phone, & translation, & data, 1 ))){
  300.             async_wait_for( message, & result );
  301.             return result;
  302.         }
  303.         async_wait_for( message, & result );
  304.         if( ! ERROR_OCCURRED( result )){
  305.             printf( "\n\tgateway translated to\t= %X:%X:%X:%X:%X:%X", data[ 0 ], data[ 1 ], data[ 2 ], data[ 3 ], data[ 4 ], data[ 5 ] );
  306.         }
  307.         free( translation );
  308.         free( data );
  309.         return result;
  310.     }
  311.     return EOK;
  312. }
  313.  
  314. int ip_register_message( int protocol, int phone ){
  315.     ip_proto_ref    proto;
  316.     int             index;
  317.  
  318.     proto = ( ip_proto_ref ) malloc( sizeof( ip_protos_t ));
  319.     if( ! proto ) return ENOMEM;
  320.     proto->protocol = protocol;
  321.     proto->phone = phone;
  322.     index = ip_protos_add( & ip_globals.protos, proto->protocol, proto );
  323.     if( index < 0 ){
  324.         free( proto );
  325.         return index;
  326.     }
  327.     printf( "\nNew protocol registered:\n\tprotocol\t= %d\n\tphone\t= %d", proto->protocol, proto->phone );
  328.     return EOK;
  329. }
  330.  
  331. int ip_send_message( device_id_t device_id, packet_t packet ){
  332.     // TODO send packet
  333.     printf( "Packet to send via %d: %s", device_id, packet_get_data( packet ));
  334.     pq_release( ip_globals.networking_phone, packet_get_id( packet ));
  335.     return EOK;
  336. }
  337.  
  338. int ip_message( ipc_callid_t callid, ipc_call_t * call, ipc_call_t * answer, int * answer_count ){
  339.     ERROR_DECLARE;
  340.  
  341.     packet_t    packet;
  342.  
  343.     * answer_count = 0;
  344.     switch( IPC_GET_METHOD( * call )){
  345.         case IPC_M_PHONE_HUNGUP:
  346.             return EOK;
  347.         case NET_IP_ECHO:
  348.             * answer_count = 5;
  349.             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 ) );
  350.         case NET_IL_DEVICE:
  351.             return ip_device_message( IPC_GET_DEVICE( call ), IPC_GET_SERVICE( call ));
  352.         case IPC_M_CONNECT_TO_ME:
  353.             return ip_register_message( IPC_GET_PROTO( call ), IPC_GET_PHONE( call ));
  354.         case NET_IP_SEND:
  355.             ERROR_PROPAGATE( packet_translate( ip_globals.networking_phone, & packet, IPC_GET_PACKET( call )));
  356.             return ip_send_message( IPC_GET_DEVICE( call ), packet );
  357.     }
  358.     return ENOTSUP;
  359. }
  360.  
  361. /** @}
  362.  */
  363.