sergiotarxz/nuttx
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity
405f6a5d37
nuttx/net/icmpv6/icmpv6_radvertise.c
Zhe Weng 7b0d80c94a net/icmpv6: align structs to 2 bytes. 
Fix following misaligned errors:

icmpv6/icmpv6_radvertise.c:145:21: runtime error: member access within misaligned address 0x573da9e6 for type 'struct icmpv6_router_advertise_s', which requires 4 byte alignment
0x573da9e6: note: pointer points here
 00 00 00 01 85 00  d6 14 00 00 00 00 01 01  12 8c 25 08 9c f8 04 00  00 00 ff 02 00 00 00 00  00 00
             ^
icmpv6/icmpv6_radvertise.c:167:21: runtime error: member access within misaligned address 0x573da9fe for type 'struct icmpv6_mtu_s', which requires 4 byte alignment
0x573da9fe: note: pointer points here
 af 78 ab 72 00 00  00 00 00 00 00 01 ff 00  00 01 04 00 00 00 ff 02  00 00 00 00 00 00 00 00  00 01
             ^
icmpv6/icmpv6_radvertise.c:176:23: runtime error: member access within misaligned address 0x573daa06 for type 'struct icmpv6_prefixinfo_s', which requires 4 byte alignment
0x573daa06: note: pointer points here
 00 00 05 dc ff 00  00 01 04 00 00 00 ff 02  00 00 00 00 00 00 00 00  00 01 ff 08 9c f8 04 00  00 00
             ^

Signed-off-by: Zhe Weng <wengzhe@xiaomi.com>
2023-03-10 09:41:02 +01:00

223 lines
7.2 KiB
C
Raw Blame History

/****************************************************************************
* net/icmpv6/icmpv6_radvertise.c
* Send an ICMPv6 Router Advertisement
*
* Licensed to the Apache Software Foundation (ASF) under one or more
* contributor license agreements. See the NOTICE file distributed with
* this work for additional information regarding copyright ownership. The
* ASF licenses this file to you under the Apache License, Version 2.0 (the
* "License"); you may not use this file except in compliance with the
* License. You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
* License for the specific language governing permissions and limitations
* under the License.
*
****************************************************************************/
/****************************************************************************
* Included Files
****************************************************************************/
#include <nuttx/config.h>
#include <stdint.h>
#include <string.h>
#include <debug.h>
#include <nuttx/net/netconfig.h>
#include <nuttx/net/netstats.h>
#include <nuttx/net/netdev.h>
#include <nuttx/net/icmpv6.h>
#include "netdev/netdev.h"
#include "inet/inet.h"
#include "utils/utils.h"
#include "icmpv6/icmpv6.h"
#ifdef CONFIG_NET_ICMPv6_ROUTER
/****************************************************************************
* Private Data
****************************************************************************/
#ifdef CONFIG_NET_ICMPv6_ROUTER_MANUAL
static const net_ipv6addr_t g_ipv6_prefix =
{
HTONS(CONFIG_NET_ICMPv6_PREFIX_1),
HTONS(CONFIG_NET_ICMPv6_PREFIX_2),
HTONS(CONFIG_NET_ICMPv6_PREFIX_3),
HTONS(CONFIG_NET_ICMPv6_PREFIX_4),
HTONS(CONFIG_NET_ICMPv6_PREFIX_5),
HTONS(CONFIG_NET_ICMPv6_PREFIX_6),
HTONS(CONFIG_NET_ICMPv6_PREFIX_7),
HTONS(CONFIG_NET_ICMPv6_PREFIX_8)
};
#endif /* CONFIG_NET_ICMPv6_ROUTER_MANUAL */
/****************************************************************************
* Private Functions
****************************************************************************/
/****************************************************************************
* Name: ipv6addr_mask
*
* Description:
* Copy an IPv6 address under a mask
*
* Input Parameters:
* dest - Location to return the masked address
* src - The IPv6 address to mask
* maksk - The address mask
*
* Returned Value:
* None
*
****************************************************************************/
#ifndef CONFIG_NET_ICMPv6_ROUTER_MANUAL
static inline void ipv6addr_mask(FAR uint16_t *dest, FAR const uint16_t *src,
FAR const uint16_t *mask)
{
int i;
for (i = 0; i < 8; ++i)
{
dest[i] = src[i] & mask[i];
}
}
#endif /* !CONFIG_NET_ICMPv6_ROUTER_MANUAL */
/****************************************************************************
* Public Functions
****************************************************************************/
/****************************************************************************
* Name: icmpv6_radvertise
*
* Description:
* Send an ICMPv6 Router Advertisement
*
* Input Parameters:
* dev - The device driver structure containing the outgoing ICMPv6 packet
* buffer
*
* Returned Value:
* None
*
* Assumptions:
* The network is locked
*
****************************************************************************/
void icmpv6_radvertise(FAR struct net_driver_s *dev)
{
FAR struct icmpv6_router_advertise_s *adv;
FAR struct icmpv6_srclladdr_s *srcaddr;
FAR struct icmpv6_mtu_s *mtu;
FAR struct icmpv6_prefixinfo_s *prefix;
net_ipv6addr_t srcv6addr;
uint16_t lladdrsize;
uint16_t l3size;
/* Length excludes the IPv6 header */
lladdrsize = netdev_lladdrsize(dev);
l3size = sizeof(struct icmpv6_router_advertise_s) +
SIZEOF_ICMPV6_SRCLLADDR_S(lladdrsize) +
sizeof(struct icmpv6_mtu_s) +
sizeof(struct icmpv6_prefixinfo_s);
/* Source IP address must be set to link-local IP */
icmpv6_linkipaddr(dev, srcv6addr);
ipv6_build_header(IPv6BUF, l3size, IP_PROTO_ICMP6,
srcv6addr, g_ipv6_allnodes, 255, 0);
/* Set up the ICMPv6 Router Advertise response */
adv = IPBUF(IPv6_HDRLEN);
adv->type = ICMPV6_ROUTER_ADVERTISE; /* Message type */
adv->code = 0; /* Message qualifier */
adv->hoplimit = 64; /* Current hop limit */
adv->flags = ICMPv6_RADV_FLAG_M; /* Managed address flag. */
adv->lifetime = HTONS(1800); /* Router lifetime */
adv->reachable[0] = 0; /* Reachable time */
adv->reachable[1] = 0;
adv->retrans[0] = 0; /* Retransmission timer */
adv->retrans[1] = 0;
/* Set up the source address option */
srcaddr = (FAR struct icmpv6_srclladdr_s *)
((FAR uint8_t *)adv +
sizeof(struct icmpv6_router_advertise_s));
srcaddr->opttype = ICMPv6_OPT_SRCLLADDR;
srcaddr->optlen = ICMPv6_OPT_OCTECTS(lladdrsize);
memcpy(srcaddr->srclladdr, &dev->d_mac, lladdrsize);
/* Set up the MTU option */
mtu = (FAR struct icmpv6_mtu_s *)
((FAR uint8_t *)srcaddr +
SIZEOF_ICMPV6_SRCLLADDR_S(lladdrsize));
mtu->opttype = ICMPv6_OPT_MTU;
mtu->optlen = 1;
mtu->reserved = 0;
mtu->mtu[0] = 0;
mtu->mtu[1] = HTONS(dev->d_pktsize - dev->d_llhdrlen);
/* Set up the prefix option */
prefix = (FAR struct icmpv6_prefixinfo_s *)
((FAR uint8_t *)mtu + sizeof(struct icmpv6_mtu_s));
prefix->opttype = ICMPv6_OPT_PREFIX;
prefix->optlen = 4;
prefix->flags = ICMPv6_PRFX_FLAG_L | ICMPv6_PRFX_FLAG_A;
prefix->vlifetime[0] = HTONS(2592000 >> 16);
prefix->vlifetime[1] = HTONS(2592000 & 0xffff);
prefix->plifetime[0] = HTONS(604800 >> 16);
prefix->plifetime[1] = HTONS(604800 & 0xffff);
prefix->reserved[0] = 0;
prefix->reserved[1] = 0;
#ifdef CONFIG_NET_ICMPv6_ROUTER_MANUAL
/* Copy the configured prefex */
prefix->preflen = CONFIG_NET_ICMPv6_PREFLEN;
net_ipv6addr_copy(prefix->prefix, g_ipv6_prefix);
#else
/* Set the prefix and prefix length based on net driver IP and netmask */
prefix->preflen = net_ipv6_mask2pref(dev->d_ipv6netmask);
ipv6addr_mask(prefix->prefix, dev->d_ipv6addr, dev->d_ipv6netmask);
#endif /* CONFIG_NET_ICMPv6_ROUTER_MANUAL */
/* Update device buffer length */
iob_update_pktlen(dev->d_iob, IPv6_HDRLEN + l3size);
/* Calculate the checksum over both the ICMP header and payload */
adv->chksum = 0;
adv->chksum = ~icmpv6_chksum(dev, IPv6_HDRLEN);
/* Set the size to the size of the IPv6 header and the payload size */
dev->d_len = IPv6_HDRLEN + l3size;
ninfo("Outgoing ICMPv6 Router Advertise length: %d\n", dev->d_len);
#ifdef CONFIG_NET_STATISTICS
g_netstats.icmpv6.sent++;
g_netstats.ipv6.sent++;
#endif
}
#endif /* CONFIG_NET_ICMPv6_ROUTER */
Reference in New Issue View Git Blame Copy Permalink