X-Git-Url: http://www.chiark.greenend.org.uk/ucgi/~ian/git?p=secnet.git;a=blobdiff_plain;f=netlink.c;h=ea1221deaf9e67a10019f474001d99774c961872;hp=e53c339f420f01b5e18790ba2fe02ea746f35278;hb=5c19b79c7c817a28a1582970b2685c98e05b2de5;hpb=dbe11c2091cfdb8f99f032a9ed81321b09c4094e

diff --git a/netlink.c b/netlink.c
index e53c339..ea1221d 100644
--- a/netlink.c
+++ b/netlink.c
@@ -180,7 +180,7 @@ static inline uint16_t ip_fast_csum(const uint8_t *iph, int32_t ihl) {
     return sum;
 }
 #else
-static inline uint16_t ip_fast_csum(uint8_t *iph, int32_t ihl)
+static inline uint16_t ip_fast_csum(const uint8_t *iph, int32_t ihl)
 {
     assert(ihl < INT_MAX/4);
     return ip_csum(iph,ihl*4);
@@ -237,6 +237,15 @@ struct icmphdr {
 
 static const union icmpinfofield icmp_noinfo;
     
+static void netlink_client_deliver(struct netlink *st,
+				   struct netlink_client *client,
+				   uint32_t source, uint32_t dest,
+				   struct buffer_if *buf);
+static void netlink_host_deliver(struct netlink *st,
+				 struct netlink_client *sender,
+				 uint32_t source, uint32_t dest,
+				 struct buffer_if *buf);
+
 static const char *sender_name(struct netlink_client *sender /* or NULL */)
 {
     return sender?sender->name:"(local)";
@@ -254,7 +263,8 @@ static void netlink_packet_deliver(struct netlink *st,
    settable.
    */
 static struct icmphdr *netlink_icmp_tmpl(struct netlink *st,
-					 uint32_t dest,uint16_t len)
+					 uint32_t source, uint32_t dest,
+					 uint16_t len)
 {
     struct icmphdr *h;
 
@@ -270,7 +280,7 @@ static struct icmphdr *netlink_icmp_tmpl(struct netlink *st,
     h->iph.frag=0;
     h->iph.ttl=255; /* XXX should be configurable */
     h->iph.protocol=1;
-    h->iph.saddr=htonl(st->secnet_address);
+    h->iph.saddr=htonl(source);
     h->iph.daddr=htonl(dest);
     h->iph.check=0;
     h->iph.check=ip_fast_csum((uint8_t *)&h->iph,h->iph.ihl);
@@ -381,7 +391,9 @@ static uint16_t netlink_icmp_reply_len(struct buffer_if *buf)
 
 /* client indicates where the packet we're constructing a response to
    comes from. NULL indicates the host. */
-static void netlink_icmp_simple(struct netlink *st, struct buffer_if *buf,
+static void netlink_icmp_simple(struct netlink *st,
+				struct netlink_client *origsender,
+				struct buffer_if *buf,
 				uint8_t type, uint8_t code,
 				union icmpinfofield info)
 {
@@ -390,12 +402,44 @@ static void netlink_icmp_simple(struct netlink *st, struct buffer_if *buf,
 
     if (netlink_icmp_may_reply(buf)) {
 	struct iphdr *iph=(struct iphdr *)buf->start;
+
+	uint32_t icmpdest = ntohl(iph->saddr);
+	uint32_t icmpsource;
+	const char *icmpsourcedebugprefix;
+	if (!st->ptp) {
+	    icmpsource=st->secnet_address;
+	    icmpsourcedebugprefix="";
+	} else if (origsender) {
+	    /* was from peer, send reply as if from host */
+	    icmpsource=st->local_address;
+	    icmpsourcedebugprefix="L!";
+	} else {
+	    /* was from host, send reply as if from peer */
+	    icmpsource=st->secnet_address; /* actually, peer address */
+	    icmpsourcedebugprefix="P!";
+	}
+	MDEBUG("%s: generating ICMP re %s[%s]->[%s]:"
+	       " from %s%s type=%u code=%u\n",
+	       st->name, sender_name(origsender),
+	       ipaddr_to_string(ntohl(iph->saddr)),
+	       ipaddr_to_string(ntohl(iph->daddr)),
+	       icmpsourcedebugprefix,
+	       ipaddr_to_string(icmpsource),
+	       type, code);
+
 	len=netlink_icmp_reply_len(buf);
-	h=netlink_icmp_tmpl(st,ntohl(iph->saddr),len);
+	h=netlink_icmp_tmpl(st,icmpsource,icmpdest,len);
 	h->type=type; h->code=code; h->d=info;
 	memcpy(buf_append(&st->icmp,len),buf->start,len);
 	netlink_icmp_csum(h);
-	netlink_packet_deliver(st,NULL,&st->icmp);
+
+	if (!st->ptp) {
+	    netlink_packet_deliver(st,NULL,&st->icmp);
+	} else if (origsender) {
+	    netlink_client_deliver(st,origsender,icmpsource,icmpdest,&st->icmp);
+	} else {
+	    netlink_host_deliver(st,NULL,icmpsource,icmpdest,&st->icmp);
+	}
 	BUF_ASSERT_FREE(&st->icmp);
     }
 }
@@ -470,6 +514,7 @@ static const char *fragment_filter_header(uint8_t *base, long *hlp)
 
 /* Fragment or send ICMP Fragmentation Needed */
 static void netlink_maybe_fragment(struct netlink *st,
+				   struct netlink_client *sender,
 				   netlink_deliver_fn *deliver,
 				   void *deliver_dst,
 				   const char *delivery_name,
@@ -501,7 +546,7 @@ static void netlink_maybe_fragment(struct netlink *st,
     if (orig_frag&IPHDR_FRAG_DONT) {
 	union icmpinfofield info =
 	    { .fragneeded = { .unused = 0, .mtu = htons(mtu) } };
-	netlink_icmp_simple(st,buf,
+	netlink_icmp_simple(st,sender,buf,
 			    ICMP_TYPE_UNREACHABLE,
 			    ICMP_CODE_FRAGMENTATION_REQUIRED,
 			    info);
@@ -596,7 +641,7 @@ static void netlink_client_deliver(struct netlink *st,
 	BUF_FREE(buf);
 	return;
     }
-    netlink_maybe_fragment(st, client->deliver,client->dst,client->name,
+    netlink_maybe_fragment(st,NULL, client->deliver,client->dst,client->name,
 			   client->mtu, source,dest,buf);
     client->outcount++;
 }
@@ -604,10 +649,11 @@ static void netlink_client_deliver(struct netlink *st,
 /* Deliver a packet to the host; used after we have decided that that
  * is what to do with it. */
 static void netlink_host_deliver(struct netlink *st,
+				 struct netlink_client *sender,
 				 uint32_t source, uint32_t dest,
 				 struct buffer_if *buf)
 {
-    netlink_maybe_fragment(st, st->deliver_to_host,st->dst,"(host)",
+    netlink_maybe_fragment(st,sender, st->deliver_to_host,st->dst,"(host)",
 			   st->mtu, source,dest,buf);
     st->outcount++;
 }
@@ -690,7 +736,7 @@ static void netlink_packet_deliver(struct netlink *st,
 	/* The packet's not going down a tunnel.  It might (ought to)
 	   be for the host.   */
 	if (ipset_contains_addr(st->networks,dest)) {
-	    netlink_host_deliver(st,source,dest,buf);
+	    netlink_host_deliver(st,sender,source,dest,buf);
 	    BUF_ASSERT_FREE(buf);
 	} else {
 	    string_t s,d;
@@ -699,7 +745,7 @@ static void netlink_packet_deliver(struct netlink *st,
 	    Message(M_DEBUG,"%s: don't know where to deliver packet "
 		    "(s=%s, d=%s)\n", st->name, s, d);
 	    free(s); free(d);
-	    netlink_icmp_simple(st,buf,ICMP_TYPE_UNREACHABLE,
+	    netlink_icmp_simple(st,sender,buf,ICMP_TYPE_UNREACHABLE,
 				ICMP_CODE_NET_UNREACHABLE, icmp_noinfo);
 	    BUF_FREE(buf);
 	}
@@ -716,7 +762,7 @@ static void netlink_packet_deliver(struct netlink *st,
 		    st->name,s,d);
 	    free(s); free(d);
 		    
-	    netlink_icmp_simple(st,buf,ICMP_TYPE_UNREACHABLE,
+	    netlink_icmp_simple(st,sender,buf,ICMP_TYPE_UNREACHABLE,
 				ICMP_CODE_NET_PROHIBITED, icmp_noinfo);
 	    BUF_FREE(buf);
 	} else {
@@ -726,7 +772,7 @@ static void netlink_packet_deliver(struct netlink *st,
 		BUF_ASSERT_FREE(buf);
 	    } else {
 		/* Generate ICMP destination unreachable */
-		netlink_icmp_simple(st,buf,
+		netlink_icmp_simple(st,sender,buf,
 				    ICMP_TYPE_UNREACHABLE,
 				    ICMP_CODE_NET_UNREACHABLE,
 				    icmp_noinfo);
@@ -749,7 +795,7 @@ static void netlink_packet_forward(struct netlink *st,
     /* Packet has already been checked */
     if (iph->ttl<=1) {
 	/* Generate ICMP time exceeded */
-	netlink_icmp_simple(st,buf,ICMP_TYPE_TIME_EXCEEDED,
+	netlink_icmp_simple(st,sender,buf,ICMP_TYPE_TIME_EXCEEDED,
 			    ICMP_CODE_TTL_EXCEEDED,icmp_noinfo);
 	BUF_FREE(buf);
 	return;
@@ -807,7 +853,7 @@ static void netlink_packet_local(struct netlink *st,
 	Message(M_WARNING,"%s: unknown incoming ICMP\n",st->name);
     } else {
 	/* Send ICMP protocol unreachable */
-	netlink_icmp_simple(st,buf,ICMP_TYPE_UNREACHABLE,
+	netlink_icmp_simple(st,sender,buf,ICMP_TYPE_UNREACHABLE,
 			    ICMP_CODE_PROTOCOL_UNREACHABLE,icmp_noinfo);
 	BUF_FREE(buf);
 	return;
@@ -880,7 +926,7 @@ static void netlink_incoming(struct netlink *st, struct netlink_client *sender,
        address validity and generate ICMP, etc. */
     if (st->ptp) {
 	if (sender) {
-	    netlink_host_deliver(st,source,dest,buf);
+	    netlink_host_deliver(st,sender,source,dest,buf);
 	} else {
 	    netlink_client_deliver(st,st->clients,source,dest,buf);
 	}
@@ -1194,6 +1240,8 @@ netlink_deliver_fn *netlink_init(struct netlink *st,
 	st->remote_networks=ipset_complement(empty);
 	ipset_free(empty);
     }
+    st->local_address=string_item_to_ipaddr(
+	dict_find_item(dict,"local-address", True, "netlink", loc),"netlink");
 
     sa=dict_find_item(dict,"secnet-address",False,"netlink",loc);
     ptpa=dict_find_item(dict,"ptp-address",False,"netlink",loc);