33ed27ae65
net/mld: Checksum calculation needs to know the full size of the IPv6 header, including the size of the extension headers. The payload size in the IPv64 header must include the extension headers (not considered part of the header in this case). Fixes a few additional errors in size, endian-ness and checksum calculations. Wireshark now reports the the outgoing Report has a good checksum.
net/mld/mld_query.c: Add a cast to assure that the left shift does not overflow.
372 lines
12 KiB
C
372 lines
12 KiB
C
/****************************************************************************
|
|
* net/mld/mld_send.c
|
|
*
|
|
* Copyright (C) 2018 Gregory Nutt. All rights reserved.
|
|
* Author: Gregory Nutt <gnutt@nuttx.org>
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
*
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. 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.
|
|
* 3. Neither the name NuttX nor the names of its contributors may be
|
|
* used to endorse or promote products derived from this software
|
|
* without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
|
* "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
|
|
* COPYRIGHT OWNER OR CONTRIBUTORS 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.
|
|
*
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Included Files
|
|
****************************************************************************/
|
|
|
|
#include <nuttx/config.h>
|
|
|
|
#include <string.h>
|
|
#include <debug.h>
|
|
#include <arpa/inet.h>
|
|
|
|
#include <nuttx/net/netconfig.h>
|
|
#include <nuttx/net/netdev.h>
|
|
#include <nuttx/net/netstats.h>
|
|
#include <nuttx/net/ip.h>
|
|
#include <nuttx/net/ipv6ext.h>
|
|
#include <nuttx/net/tcp.h>
|
|
#include <nuttx/net/mld.h>
|
|
|
|
#include "devif/devif.h"
|
|
#include "inet/inet.h"
|
|
#include "utils/utils.h"
|
|
#include "mld/mld.h"
|
|
|
|
/****************************************************************************
|
|
* Pre-processor Definitions
|
|
****************************************************************************/
|
|
|
|
/* Debug */
|
|
|
|
#undef MLD_DUMPPKT /* Define to enable packet dump */
|
|
|
|
#ifndef CONFIG_DEBUG_NET
|
|
# undef MLD_DUMPPKT
|
|
#endif
|
|
|
|
#ifdef MLD_DUMPPKT
|
|
# define mld_dumppkt(b,n) lib_dumpbuffer("MLD", (FAR const uint8_t*)(b), (n))
|
|
#else
|
|
# define mld_dumppkt(b,n)
|
|
#endif
|
|
|
|
/* IPv6 header size with extensions */
|
|
|
|
#define RASIZE sizeof(struct ipv6_router_alert_s)
|
|
#define MLD_HDRLEN (IPv6_HDRLEN + RASIZE)
|
|
|
|
/* Buffer layout */
|
|
|
|
#define IPv6BUF ((FAR struct ipv6_hdr_s *)&dev->d_buf[NET_LL_HDRLEN(dev)])
|
|
#define RABUF ((FAR struct ipv6_router_alert_s *) \
|
|
(&dev->d_buf[NET_LL_HDRLEN(dev)] + IPv6_HDRLEN))
|
|
#define QUERYBUF ((FAR struct mld_mcast_listen_query_s *) \
|
|
(&dev->d_buf[NET_LL_HDRLEN(dev)] + MLD_HDRLEN))
|
|
#define V1REPORTBUF ((FAR struct mld_mcast_listen_report_v1_s *) \
|
|
(&dev->d_buf[NET_LL_HDRLEN(dev)] + MLD_HDRLEN))
|
|
#define V2REPORTBUF ((FAR struct mld_mcast_listen_report_v2_s *) \
|
|
(&dev->d_buf[NET_LL_HDRLEN(dev)] + MLD_HDRLEN))
|
|
#define DONEBUF ((FAR struct mld_mcast_listen_done_v1_s *) \
|
|
(&dev->d_buf[NET_LL_HDRLEN(dev)] + MLD_HDRLEN))
|
|
|
|
/****************************************************************************
|
|
* Public Functions
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Name: mld_send
|
|
*
|
|
* Description:
|
|
* Sends an MLD IP packet on a network interface. This function constructs
|
|
* the IP header and calculates the IP header checksum.
|
|
*
|
|
* Input Parameters:
|
|
* dev - The device driver structure to use in the send operation.
|
|
* group - Describes the multicast group member and identifies the
|
|
* message to be sent.
|
|
* msgtype - The type of the message to be sent (see enum mld_msgtype_e)
|
|
*
|
|
* Returned Value:
|
|
* None
|
|
*
|
|
* Assumptions:
|
|
* The network is locked.
|
|
*
|
|
****************************************************************************/
|
|
|
|
void mld_send(FAR struct net_driver_s *dev, FAR struct mld_group_s *group,
|
|
uint8_t msgtype)
|
|
{
|
|
FAR struct ipv6_hdr_s *ipv6;
|
|
FAR struct ipv6_router_alert_s *ra;
|
|
FAR const uint16_t *destipaddr;
|
|
unsigned int mldsize;
|
|
|
|
/* Select IPv6 */
|
|
|
|
IFF_SET_IPv6(dev->d_flags);
|
|
|
|
/* What is the size of the ICMPv6 payload? */
|
|
|
|
switch (msgtype)
|
|
{
|
|
case MLD_SEND_GENQUERY: /* Send General Query */
|
|
{
|
|
ninfo("Send General Query, flags=%02x\n", group->flags);
|
|
mldsize = SIZEOF_MLD_MCAST_LISTEN_QUERY_S(0);
|
|
}
|
|
break;
|
|
|
|
case MLD_SEND_V1REPORT: /* Send MLDv1 Report message */
|
|
{
|
|
ninfo("Send MLDv1 Report, flags=%02x\n", group->flags);
|
|
mldsize = sizeof(struct mld_mcast_listen_report_v1_s);
|
|
}
|
|
break;
|
|
|
|
case MLD_SEND_V2REPORT: /* Send MLDv2 Report message */
|
|
{
|
|
unsigned int addreclen;
|
|
|
|
ninfo("Send MLDv2 Report, flags=%02x\n", group->flags);
|
|
addreclen = SIZEOF_MLD_MCAST_ADDREC_V2_S(0, 0);
|
|
mldsize = SIZEOF_MLD_MCAST_LISTEN_REPORT_V2_S(addreclen);
|
|
}
|
|
break;
|
|
|
|
case MLD_SEND_V1DONE: /* Send MLDv1 Done message */
|
|
{
|
|
ninfo("Send Done message, flags=%02x\n", group->flags);
|
|
mldsize = sizeof(struct mld_mcast_listen_done_v1_s);
|
|
}
|
|
break;
|
|
|
|
default:
|
|
{
|
|
nerr("Bad msgtype: %02x \n", msgtype);
|
|
DEBUGPANIC();
|
|
}
|
|
return;
|
|
}
|
|
|
|
/* The total length to send is the size of the IPv6 header, 4 bytes for the
|
|
* ROUTER ALERT, and the MLD ICMPv6 payload (and, eventually, the Ethernet
|
|
* header length)
|
|
*/
|
|
|
|
dev->d_len = MLD_HDRLEN + mldsize;
|
|
|
|
/* The total size of the data is the size of the ICMPv6 payload PLUS the
|
|
* size of the IPv6 extension headers.
|
|
*/
|
|
|
|
dev->d_sndlen = RASIZE + mldsize;
|
|
|
|
/* Set up the IPv6 header */
|
|
|
|
ipv6 = IPv6BUF;
|
|
ipv6->vtc = 0x60; /* Version/traffic class (MS) */
|
|
ipv6->tcf = 0; /* Traffic class(LS)/Flow label(MS) */
|
|
ipv6->flow = 0; /* Flow label (LS) */
|
|
ipv6->len[0] = (dev->d_sndlen >> 8); /* Length excludes the IPv6 header */
|
|
ipv6->len[1] = (dev->d_sndlen & 0xff); /* but includes the extension headers */
|
|
ipv6->proto = NEXT_HOPBYBOT_EH; /* Hop-to-hop extension header */
|
|
ipv6->ttl = MLD_TTL; /* MLD Time-to-live */
|
|
|
|
/* Select the IPv6 source address (the local interface assigned to the
|
|
* network device).
|
|
*/
|
|
|
|
net_ipv6addr_hdrcopy(ipv6->srcipaddr, dev->d_ipv6addr);
|
|
|
|
/* Select the IPv6 destination address. This varies with the type of message
|
|
* being sent:
|
|
*
|
|
* MESSAGE DESTINATION ADDRESS
|
|
* General Query Message: The link-local, all nodes multicast address
|
|
* MAS Query Messages: The group multicast address
|
|
* Report Message: The group multicast address
|
|
* Done Message: The link-local, all routers multicast address.
|
|
*/
|
|
|
|
switch (msgtype)
|
|
{
|
|
case MLD_SEND_GENQUERY: /* Send General Query */
|
|
destipaddr = g_ipv6_allnodes;
|
|
break;
|
|
|
|
case MLD_SEND_V1REPORT: /* Send MLDv1 Report message */
|
|
destipaddr = group->grpaddr;
|
|
break;
|
|
|
|
case MLD_SEND_V2REPORT: /* Send MLDv2 Report message */
|
|
destipaddr = g_ipv6_allmldv2routers;
|
|
break;
|
|
|
|
case MLD_SEND_V1DONE: /* Send MLDv1 Done message */
|
|
destipaddr = g_ipv6_allrouters;
|
|
break;
|
|
|
|
default: /* Can't happen, but eliminates a warning */
|
|
return;
|
|
}
|
|
|
|
ninfo("destipaddr: %04x:%04x:%04x:%04x:%04x:%04x:%04x:%04x\n",
|
|
destipaddr[0], destipaddr[1], destipaddr[2], destipaddr[3],
|
|
destipaddr[4], destipaddr[5], destipaddr[6], destipaddr[7]);
|
|
|
|
net_ipv6addr_hdrcopy(ipv6->destipaddr, destipaddr);
|
|
|
|
/* Add the router alert IP header option.
|
|
*
|
|
* The IPv6 router alert option (type 5) is defined in RFC 2711.
|
|
*/
|
|
|
|
ra = RABUF;
|
|
memset(ra, 0, RASIZE);
|
|
|
|
ra->hbyh.nxthdr = IP_PROTO_ICMP6; /* ICMPv6 payload follows extension header */
|
|
ra->hbyh.len = 1; /* One 8-octet option follows */
|
|
ra->type = HOPBYHOP_ROUTER_ALERT; /* Router alert */
|
|
|
|
/* Format the MLD ICMPv6 payload into place after the IPv6 header (with
|
|
* router alert)
|
|
*/
|
|
|
|
switch (msgtype)
|
|
{
|
|
case MLD_SEND_GENQUERY:
|
|
{
|
|
FAR struct mld_mcast_listen_query_s *query = QUERYBUF;
|
|
|
|
/* Initialize the Query payload. In a General Query, both the
|
|
* Multicast Address field and the Number of Sources (N)
|
|
* field are zero.
|
|
*
|
|
* Careful here. In MLDv1 compatibility mode, the MRC is not
|
|
* encoded and must follow the rules for MLDv1.
|
|
*/
|
|
|
|
memset(query, 0, sizeof(struct mld_mcast_listen_report_v1_s));
|
|
net_ipv6addr_hdrcopy(query->grpaddr, &group->grpaddr);
|
|
query->type = ICMPV6_MCAST_LISTEN_QUERY;
|
|
query->mrc = MLD_QRESP_MSEC;
|
|
|
|
/* Fields unique to the extended MLDv2 query */
|
|
|
|
if (!IS_MLD_V1COMPAT(group->flags))
|
|
{
|
|
query->flags = MLD_ROBUSTNESS;
|
|
query->qqic = MLD_QRESP_SEC;
|
|
}
|
|
|
|
/* Calculate the ICMPv6 checksum. */
|
|
|
|
query->chksum = 0;
|
|
query->chksum = ~icmpv6_chksum(dev, MLD_HDRLEN);
|
|
|
|
MLD_STATINCR(g_netstats.mld.query_sent);
|
|
}
|
|
break;
|
|
|
|
case MLD_SEND_V1REPORT: /* Send MLDv1 Report message */
|
|
{
|
|
FAR struct mld_mcast_listen_report_v1_s *report = V1REPORTBUF;
|
|
|
|
/* Initialize the Report payload */
|
|
|
|
memset(report, 0, sizeof(struct mld_mcast_listen_report_v1_s));
|
|
net_ipv6addr_hdrcopy(report->mcastaddr, &group->grpaddr);
|
|
report->type = ICMPV6_MCAST_LISTEN_REPORT_V1;
|
|
|
|
/* Calculate the ICMPv6 checksum. */
|
|
|
|
report->chksum = 0;
|
|
report->chksum = ~icmpv6_chksum(dev, MLD_HDRLEN);
|
|
|
|
SET_MLD_LASTREPORT(group->flags); /* Remember we were the last to report */
|
|
MLD_STATINCR(g_netstats.mld.report_sent);
|
|
}
|
|
break;
|
|
|
|
case MLD_SEND_V2REPORT: /* Send MLDv2 Report message */
|
|
{
|
|
FAR struct mld_mcast_listen_report_v2_s *report = V2REPORTBUF;
|
|
FAR struct mld_mcast_addrec_v2_s *addrec;
|
|
|
|
/* Initialize the Report payload */
|
|
|
|
memset(report, 0, mldsize);
|
|
report->type = ICMPV6_MCAST_LISTEN_REPORT_V2;
|
|
report->naddrec = HTONS(1);
|
|
|
|
addrec = report->addrec;
|
|
addrec->rectype = MODE_IS_INCLUDE;
|
|
net_ipv6addr_hdrcopy(addrec->mcast, &group->grpaddr);
|
|
|
|
/* Calculate the ICMPv6 checksum. */
|
|
|
|
report->chksum = 0;
|
|
report->chksum = ~icmpv6_chksum(dev, MLD_HDRLEN);
|
|
|
|
SET_MLD_LASTREPORT(group->flags); /* Remember we were the last to report */
|
|
MLD_STATINCR(g_netstats.mld.report_sent);
|
|
}
|
|
break;
|
|
|
|
case MLD_SEND_V1DONE: /* Send MLDv1 Done message */
|
|
{
|
|
FAR struct mld_mcast_listen_done_v1_s *done = DONEBUF;
|
|
|
|
/* Initialize the Done payload */
|
|
|
|
memset(done, 0, sizeof(struct mld_mcast_listen_done_v1_s));
|
|
done->type = ICMPV6_MCAST_LISTEN_DONE_V1;
|
|
net_ipv6addr_hdrcopy(done->mcastaddr, &group->grpaddr);
|
|
|
|
/* Calculate the ICMPv6 checksum. */
|
|
|
|
done->chksum = 0;
|
|
done->chksum = ~icmpv6_chksum(dev, MLD_HDRLEN);
|
|
|
|
MLD_STATINCR(g_netstats.mld.done_sent);
|
|
}
|
|
break;
|
|
|
|
default: /* Can't happen, but eliminates a warning */
|
|
return;
|
|
}
|
|
|
|
MLD_STATINCR(g_netstats.icmpv6.sent);
|
|
MLD_STATINCR(g_netstats.ipv6.sent);
|
|
|
|
ninfo("Outgoing ICMPv6 MLD packet length: %d (%d)\n",
|
|
dev->d_len, (ipv6->len[0] << 8) | ipv6->len[1]);
|
|
|
|
mld_dumppkt(RA, IPMLD_HDRLEN + RASIZE);
|
|
}
|