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

 /*
  * Copyright (c) 2009 Lukas Mejdrech
  * All rights reserved.
+ *
  * Redistribution and use in source and binary forms, with or without
  * modification, are permitted provided that the following conditions
  * are met:
+ *
  * - Redistributions of source code must retain the above copyright
  *   notice, this list of conditions and the following disclaimer.
  * - Redistributions in binary form must reproduce the above copyright
  *   notice, this list of conditions and the following disclaimer in the
  *   documentation and/or other materials provided with the distribution.
  * - The name of the author may not be used to endorse or promote products
  *   derived from this software without specific prior written permission.
+ *
  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
 /** @addtogroup netif
  *  @{
  */
 /** @file
  */
 #include <async.h>
 #include <mem.h>
 #include <rwlock.h>
 #include <stdio.h>
 #include <ipc/ipc.h>
 #include <ipc/services.h>
 #include "../err.h"
 #include "../messages.h"
 #include "../modules.h"
 #include "../structures/packet/packet.h"
 #include "../structures/packet/packet_client.h"
 #include "../structures/measured_strings.h"
 #include "../include/device.h"
 #include "../include/netif_messages.h"
+#include "../include/nil_messages.h"
 #include "netif.h"
 #include "netif_interface.h"
 #include "netif_wrappers.h"
+#if NIL_BUNDLE
+    #include "../nil/nil_module.h"
+#endif
 extern netif_globals_t netif_globals;
 DEVICE_MAP_IMPLEMENT( device_map, device_t )
 int module_message( ipc_callid_t callid, ipc_call_t * call, ipc_call_t * answer, int * answer_count );
 int netif_start_module( async_client_conn_t client_connection );
 int register_message( device_id_t device_id, int phone );
 int netif_probe_wrapper( device_id_t device_id, int irq, int io ){
     int result;
     rwlock_write_lock( & netif_globals.lock );
     result = netif_probe_message( device_id, irq, io );
     rwlock_write_unlock( & netif_globals.lock );
     return result;
+}
-int netif_send_wrapper( device_id_t device_id, packet_t packet ){
+int netif_send_wrapper( device_id_t device_id, packet_t packet, services_t sender ){
     int result;
     rwlock_write_lock( & netif_globals.lock );
-    result = netif_send_message( device_id, packet );
+    result = netif_send_message( device_id, packet, sender );
     rwlock_write_unlock( & netif_globals.lock );
     return result;
+}
 int netif_start_wrapper( device_id_t device_id ){
+    ERROR_DECLARE;
+    device_ref  device;
     int result;
+    int phone;
     rwlock_write_lock( & netif_globals.lock );
+    if( ERROR_OCCURRED( find_device( device_id, & device ))){
+        rwlock_write_unlock( & netif_globals.lock );
+        return ERROR_CODE;
+    }
-    result = netif_start_message( device_id );
+    result = netif_start_message( device );
+    if( result > NETIF_NULL ){
+        phone = device->nil_phone;
+        rwlock_write_unlock( & netif_globals.lock );
+        nil_device_state_msg( phone, device_id, result );
+        return EOK;
+    }else{
-    rwlock_write_unlock( & netif_globals.lock );
+        rwlock_write_unlock( & netif_globals.lock );
+    }
     return result;
+}
 int netif_stop_wrapper( device_id_t device_id ){
+    ERROR_DECLARE;
+    device_ref  device;
     int result;
+    int phone;
     rwlock_write_lock( & netif_globals.lock );
+    if( ERROR_OCCURRED( find_device( device_id, & device ))){
+        rwlock_write_unlock( & netif_globals.lock );
+        return ERROR_CODE;
+    }
-    result = netif_stop_message( device_id );
+    result = netif_stop_message( device );
+    if( result > NETIF_NULL ){
+        phone = device->nil_phone;
+        rwlock_write_unlock( & netif_globals.lock );
+        nil_device_state_msg( phone, device_id, result );
+        return EOK;
+    }else{
-    rwlock_write_unlock( & netif_globals.lock );
+        rwlock_write_unlock( & netif_globals.lock );
+    }
     return result;
+}
-int netif_get_addr_wrapper( device_id_t device_id, measured_string_ref * address ){
+int netif_get_addr_wrapper( device_id_t device_id, measured_string_ref * address, char ** data ){
     ERROR_DECLARE;
     measured_string_t   translation;
-    if( ! address ) return EBADMEM;
+    if( !( address && data )) return EBADMEM;
     rwlock_read_lock( & netif_globals.lock );
     if( ! ERROR_OCCURRED( netif_get_addr_message( device_id, & translation ))){
-        * address = measured_string_create_bulk( translation.value, translation.length );
+//      * address = measured_string_create_bulk( translation.value, translation.length );
+        * address = ( measured_string_ref ) malloc( sizeof( measured_string_t ));
+        if( * address ){
+            * data = ( char * ) malloc( translation.length + 1 );
+            if( * data ){
+                memcpy( * data, translation.value, translation.length + 1 );
+                ( ** address ).value = * data;
+                ( ** address ).length = translation.length;
+                rwlock_read_unlock( & netif_globals.lock );
+                return EOK;
+            }
+            free( * address );
+        }
-        ERROR_CODE = ( * address ) ? EOK : ENOMEM;
+        ERROR_CODE = ENOMEM;
+    }
     rwlock_read_unlock( & netif_globals.lock );
     return ERROR_CODE;
+}
 int find_device( device_id_t device_id, device_ref * device ){
     if( ! device ) return EBADMEM;
     * device = device_map_find( & netif_globals.device_map, device_id );
     if( ! * device ) return ENOENT;
     if(( ** device ).state == NETIF_NULL ) return EPERM;
     return EOK;
+}
 void null_device_stats( device_stats_ref stats ){
     bzero( stats, sizeof( device_stats_t ));
+}
 int register_message( device_id_t device_id, int phone ){
     ERROR_DECLARE;
     device_ref  device;
     ERROR_PROPAGATE( find_device( device_id, & device ));
     if( device->nil_phone > 0 ) return ELIMIT;
     device->nil_phone = phone;
     printf( "\nNew receiver of the device %d registered:\n\tphone\t= %d", device->device_id, device->nil_phone );
     return EOK;
+}
 int netif_message( ipc_callid_t callid, ipc_call_t * call, ipc_call_t * answer, int * answer_count ){
     ERROR_DECLARE;
     size_t              length;
     device_stats_t      stats;
     packet_t            packet;
     measured_string_t   address;
+//  printf( "\nmessage %d - %d", IPC_GET_METHOD( * call ), NET_NETIF_FIRST );
+#if NIL_BUNDLE
+    if( IS_NET_NIL_MESSAGE( call )){
+        return nil_message( callid, call, answer, answer_count );
+    }
+#endif
     * answer_count = 0;
     switch( IPC_GET_METHOD( * call )){
         case IPC_M_PHONE_HUNGUP:
             return EOK;
         case NET_NETIF_PROBE_AUTO:
             rwlock_write_lock( & netif_globals.lock );
             ERROR_CODE = netif_probe_auto_message();
             rwlock_write_unlock( & netif_globals.lock );
             return ERROR_CODE;
         case NET_NETIF_PROBE:
-            return netif_probe_wrapper( NETIF_GET_DEVICE( call ), NETIF_GET_IRQ( call ), NETIF_GET_IO( call ));
+            return netif_probe_wrapper( IPC_GET_DEVICE( call ), NETIF_GET_IRQ( call ), NETIF_GET_IO( call ));
         case IPC_M_CONNECT_TO_ME:
+#if NIL_BUNDLE
+            return nil_register_message( NIL_GET_PROTO( call ), IPC_GET_PHONE( call ));
+#else
             rwlock_write_lock( & netif_globals.lock );
-            ERROR_CODE = register_message( NETIF_GET_DEVICE( call ), IPC_GET_PHONE( call ));
+            ERROR_CODE = register_message( IPC_GET_DEVICE( call ), IPC_GET_PHONE( call ));
             rwlock_write_unlock( & netif_globals.lock );
             return ERROR_CODE;
+#endif
         case NET_NETIF_SEND:
+        case NET_NIL_SEND:
-            ERROR_PROPAGATE( packet_translate( netif_globals.networking_phone, & packet, NETIF_GET_PACKET( call )));
+            ERROR_PROPAGATE( packet_translate( netif_globals.networking_phone, & packet, IPC_GET_PACKET( call )));
-            return netif_send_wrapper( NETIF_GET_DEVICE( call ), packet );
+            return netif_send_wrapper( IPC_GET_DEVICE( call ), packet, IPC_GET_SENDER( call ));
         case NET_NETIF_START:
-            return netif_start_wrapper( NETIF_GET_DEVICE( call ));
+            return netif_start_wrapper( IPC_GET_DEVICE( call ));
         case NET_NETIF_STATS:
             rwlock_read_lock( & netif_globals.lock );
             if( ! ERROR_OCCURRED( ipc_data_read_receive( & callid, & length ))){
                 if( length < sizeof( device_stats_t )){
                     ERROR_CODE = EOVERFLOW;
                 }else{
-                    if( ! ERROR_OCCURRED( netif_get_device_stats( NETIF_GET_DEVICE( call ), & stats ))){
+                    if( ! ERROR_OCCURRED( netif_get_device_stats( IPC_GET_DEVICE( call ), & stats ))){
                         ERROR_CODE = ipc_data_read_finalize( callid, & stats, sizeof( device_stats_t ));
+                    }
+                }
+            }
             rwlock_read_unlock( & netif_globals.lock );
             return ERROR_CODE;
         case NET_NETIF_STOP:
-            return netif_stop_wrapper( NETIF_GET_DEVICE( call ));
+            return netif_stop_wrapper( IPC_GET_DEVICE( call ));
         case NET_NETIF_GET_ADDR:
+        case NET_NIL_ADDR:
             rwlock_read_lock( & netif_globals.lock );
-            if( ! ERROR_OCCURRED( netif_get_addr_message( NETIF_GET_DEVICE( call ), & address ))){
+            if( ! ERROR_OCCURRED( netif_get_addr_message( IPC_GET_DEVICE( call ), & address ))){
                 ERROR_CODE = measured_strings_reply( & address, 1 );
+            }
             rwlock_read_unlock( & netif_globals.lock );
             return ERROR_CODE;
+    }
     return netif_specific_message( callid, call, answer, answer_count );
+}
 int netif_start_module( async_client_conn_t client_connection ){
     ERROR_DECLARE;
     async_set_client_connection( client_connection );
     netif_globals.networking_phone = connect_to_service( SERVICE_NETWORKING );
     device_map_initialize( & netif_globals.device_map );
     ERROR_PROPAGATE( pm_init());
     rwlock_initialize( & netif_globals.lock );
     if( ERROR_OCCURRED( netif_initialize())){
         pm_destroy();
         return ERROR_CODE;
+    }
+#if NIL_BUNDLE
+    if( ERROR_OCCURRED( nil_initialize( netif_globals.networking_phone ))){
+        pm_destroy();
+        return ERROR_CODE;
+    }
+#endif
     async_manager();
     pm_destroy();
     return EOK;
+}
 void netif_pq_release( packet_id_t packet_id ){
     pq_release( netif_globals.networking_phone, packet_id );
+}
 packet_t netif_packet_get_1( size_t content ){
     return packet_get_1( netif_globals.networking_phone, content );
+}
 /** @}
  */

Subversion Repositories HelenOS

(root)/branches/network/uspace/srv/net/netif/netif.c @ 4756 – Rev 4243 → 4261