Changes in uspace/srv/net/inetsrv/inetsrv.c [a1a101d:7af0cc5] in mainline

File:

• uspace/srv/net/inetsrv/inetsrv.c (modified) (10 diffs)

uspace/srv/net/inetsrv/inetsrv.c

@@ -46 +46 @@
 #include <stdlib.h>
 #include <sys/types.h>
-
+#include <net/socket_codes.h>
 #include "addrobj.h"
 #include "icmp.h"
 #include "icmp_std.h"
+#include "icmpv6.h"
+#include "icmpv6_std.h"
 #include "inetsrv.h"
 #include "inetcfg.h"
 #include "inetping.h"
+#include "inetping6.h"
 #include "inet_link.h"
 #include "reass.h"
@@ -59 +62 @@
 #define NAME "inetsrv"
 
+static inet_naddr_t solicited_node_mask = {
+        .family = AF_INET6,
+        .addr6 = {0xff, 0x02, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0x01, 0xff, 0, 0, 0},
+        .prefix = 104
+};
+
+static inet_addr_t broadcast4_all_hosts = {
+        .family = AF_INET,
+        .addr = 0xffffffff
+};
+
+static inet_addr_t multicast_all_nodes = {
+        .family = AF_INET6,
+        .addr6 = {0xff, 0x02, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0x01}
+};
+
 static void inet_client_conn(ipc_callid_t iid, ipc_call_t *icall, void *arg);
 
@@ -98 +117 @@
         }
         
-        rc = inet_link_discovery_start();
-        if (rc != EOK)
+        rc = loc_service_register_with_iface(SERVICE_NAME_INETPING6, &sid,
+            INET_PORT_PING6);
+        if (rc != EOK) {
+                log_msg(LOG_DEFAULT, LVL_ERROR, "Failed registering service (%d).", rc);
                 return EEXIST;
+        }
         
         return EOK;
@@ -154 +176 @@
 {
         inet_dir_t dir;
+        inet_link_t *ilink;
         int rc;
+
+        if (dgram->iplink != 0) {
+                log_msg(LOG_DEFAULT, LVL_DEBUG, "dgram directly to iplink %zu",
+                    dgram->iplink);
+                /* Send packet directly to the specified IP link */
+                ilink = inet_link_get_by_id(dgram->iplink);
+                if (ilink == 0)
+                        return ENOENT;
+
+                if (dgram->src.family != AF_INET ||
+                        dgram->dest.family != AF_INET)
+                        return EINVAL;
+
+                return inet_link_send_dgram(ilink, dgram->src.addr,
+                    dgram->dest.addr, dgram, proto, ttl, df);
+        }
+
+        log_msg(LOG_DEFAULT, LVL_DEBUG, "dgram to be routed");
+
+        /* Route packet using source/destination addresses */
 
         rc = inet_find_dir(&dgram->src, &dgram->dest, dgram->tos, &dir);
@@ -182 +225 @@
 
         /* Take source address from the address object */
-        local->ipv4 = dir.aobj->naddr.ipv4;
+        if (remote->family == AF_INET && remote->addr == 0xffffffff) {
+                local->family = AF_INET;
+                local->addr = 0;
+                return EOK;
+        }
+        inet_naddr_addr(&dir.aobj->naddr, local);
         return EOK;
 }
 
-static void inet_get_srcaddr_srv(inet_client_t *client, ipc_callid_t callid,
-    ipc_call_t *call)
-{
+static void inet_get_srcaddr_srv(inet_client_t *client, ipc_callid_t iid,
+    ipc_call_t *icall)
+{
+        log_msg(LOG_DEFAULT, LVL_DEBUG, "inet_get_srcaddr_srv()");
+        
+        uint8_t tos = IPC_GET_ARG1(*icall);
+        
+        ipc_callid_t callid;
+        size_t size;
+        if (!async_data_write_receive(&callid, &size)) {
+                async_answer_0(callid, EREFUSED);
+                async_answer_0(iid, EREFUSED);
+                return;
+        }
+        
+        if (size != sizeof(inet_addr_t)) {
+                async_answer_0(callid, EINVAL);
+                async_answer_0(iid, EINVAL);
+                return;
+        }
+        
         inet_addr_t remote;
-        uint8_t tos;
+        int rc = async_data_write_finalize(callid, &remote, size);
+        if (rc != EOK) {
+                async_answer_0(callid, rc);
+                async_answer_0(iid, rc);
+        }
+        
         inet_addr_t local;
-        int rc;
-
-        log_msg(LOG_DEFAULT, LVL_DEBUG, "inet_get_srcaddr_srv()");
-
-        remote.ipv4 = IPC_GET_ARG1(*call);
-        tos = IPC_GET_ARG2(*call);
-        local.ipv4 = 0;
-
         rc = inet_get_srcaddr(&remote, tos, &local);
-        async_answer_1(callid, rc, local.ipv4);
-}
-
-static void inet_send_srv(inet_client_t *client, ipc_callid_t callid,
-    ipc_call_t *call)
-{
+        if (rc != EOK) {
+                async_answer_0(iid, rc);
+                return;
+        }
+        
+        if (!async_data_read_receive(&callid, &size)) {
+                async_answer_0(callid, EREFUSED);
+                async_answer_0(iid, EREFUSED);
+                return;
+        }
+        
+        if (size != sizeof(inet_addr_t)) {
+                async_answer_0(callid, EINVAL);
+                async_answer_0(iid, EINVAL);
+                return;
+        }
+        
+        rc = async_data_read_finalize(callid, &local, size);
+        if (rc != EOK) {
+                async_answer_0(callid, rc);
+                async_answer_0(iid, rc);
+                return;
+        }
+        
+        async_answer_0(iid, rc);
+}
+
+static void inet_send_srv(inet_client_t *client, ipc_callid_t iid,
+    ipc_call_t *icall)
+{
+        log_msg(LOG_DEFAULT, LVL_DEBUG, "inet_send_srv()");
+        
         inet_dgram_t dgram;
-        uint8_t ttl;
-        int df;
-        int rc;
-
-        log_msg(LOG_DEFAULT, LVL_DEBUG, "inet_send_srv()");
-
-        dgram.src.ipv4 = IPC_GET_ARG1(*call);
-        dgram.dest.ipv4 = IPC_GET_ARG2(*call);
-        dgram.tos = IPC_GET_ARG3(*call);
-        ttl = IPC_GET_ARG4(*call);
-        df = IPC_GET_ARG5(*call);
-
-        rc = async_data_write_accept(&dgram.data, false, 0, 0, 0, &dgram.size);
+        
+        dgram.iplink = IPC_GET_ARG1(*icall);
+        dgram.tos = IPC_GET_ARG2(*icall);
+        
+        uint8_t ttl = IPC_GET_ARG3(*icall);
+        int df = IPC_GET_ARG3(*icall);
+        
+        ipc_callid_t callid;
+        size_t size;
+        if (!async_data_write_receive(&callid, &size)) {
+                async_answer_0(callid, EREFUSED);
+                async_answer_0(iid, EREFUSED);
+                return;
+        }
+        
+        if (size != sizeof(inet_addr_t)) {
+                async_answer_0(callid, EINVAL);
+                async_answer_0(iid, EINVAL);
+                return;
+        }
+        
+        int rc = async_data_write_finalize(callid, &dgram.src, size);
         if (rc != EOK) {
                 async_answer_0(callid, rc);
-                return;
-        }
-
+                async_answer_0(iid, rc);
+        }
+        
+        if (!async_data_write_receive(&callid, &size)) {
+                async_answer_0(callid, EREFUSED);
+                async_answer_0(iid, EREFUSED);
+                return;
+        }
+        
+        if (size != sizeof(inet_addr_t)) {
+                async_answer_0(callid, EINVAL);
+                async_answer_0(iid, EINVAL);
+                return;
+        }
+        
+        rc = async_data_write_finalize(callid, &dgram.dest, size);
+        if (rc != EOK) {
+                async_answer_0(callid, rc);
+                async_answer_0(iid, rc);
+        }
+        
+        rc = async_data_write_accept(&dgram.data, false, 0, 0, 0,
+            &dgram.size);
+        if (rc != EOK) {
+                async_answer_0(iid, rc);
+                return;
+        }
+        
         rc = inet_send(client, &dgram, client->protocol, ttl, df);
-
+        
         free(dgram.data);
-        async_answer_0(callid, rc);
+        async_answer_0(iid, rc);
 }
 
@@ -327 +450 @@
                 inetping_conn(iid, icall, arg);
                 break;
+        case INET_PORT_PING6:
+                inetping6_conn(iid, icall, arg);
+                break;
         default:
                 async_answer_0(iid, ENOTSUP);
@@ -337 +463 @@
         fibril_mutex_lock(&client_list_lock);
 
-        list_foreach(client_list, link) {
-                inet_client_t *client = list_get_instance(link, inet_client_t,
-                    client_list);
-
+        list_foreach(client_list, client_list, inet_client_t, client) {
                 if (client->protocol == proto) {
                         fibril_mutex_unlock(&client_list_lock);
@@ -354 +477 @@
 {
         async_exch_t *exch = async_exchange_begin(client->sess);
-
+        
         ipc_call_t answer;
-        aid_t req = async_send_3(exch, INET_EV_RECV, dgram->src.ipv4,
-            dgram->dest.ipv4, dgram->tos, &answer);
-        int rc = async_data_write_start(exch, dgram->data, dgram->size);
-        async_exchange_end(exch);
-
-        if (rc != EOK) {
+        aid_t req = async_send_1(exch, INET_EV_RECV, dgram->tos, &answer);
+        
+        int rc = async_data_write_start(exch, &dgram->src, sizeof(inet_addr_t));
+        if (rc != EOK) {
+                async_exchange_end(exch);
                 async_forget(req);
                 return rc;
         }
-
+        
+        rc = async_data_write_start(exch, &dgram->dest, sizeof(inet_addr_t));
+        if (rc != EOK) {
+                async_exchange_end(exch);
+                async_forget(req);
+                return rc;
+        }
+        
+        rc = async_data_write_start(exch, dgram->data, dgram->size);
+        
+        async_exchange_end(exch);
+        
+        if (rc != EOK) {
+                async_forget(req);
+                return rc;
+        }
+        
         sysarg_t retval;
         async_wait_for(req, &retval);
-        if (retval != EOK)
-                return retval;
-
-        return EOK;
+        
+        return (int) retval;
 }
 
@@ -380 +516 @@
         log_msg(LOG_DEFAULT, LVL_DEBUG, "inet_recv_dgram_local()");
 
-        /* ICMP messages are handled internally */
+        /* ICMP and ICMPv6 messages are handled internally */
         if (proto == IP_PROTO_ICMP)
                 return icmp_recv(dgram);
+        
+        if (proto == IP_PROTO_ICMPV6)
+                return icmpv6_recv(dgram);
 
         client = inet_client_find(proto);
@@ -400 +539 @@
 
         addr = inet_addrobj_find(&packet->dest, iaf_addr);
-        if (addr != NULL) {
+        if ((addr != NULL) ||
+            (inet_naddr_compare_mask(&solicited_node_mask, &packet->dest)) ||
+            (inet_addr_compare(&multicast_all_nodes, &packet->dest)) || 
+            (inet_addr_compare(&broadcast4_all_hosts, &packet->dest))) {
                 /* Destined for one of the local addresses */