cff4ac6845
commit 2a3ab1652a2c95bcfc8be8380fc7cbdcb6472938
Author: Gregory Nutt <gnutt@nuttx.org>
Date: Sat Aug 19 08:44:31 2017 -0600
PF_IEEE802154: Finish some missing bind() logic. Add configs/sim configuration for testing.
commit 59be4b846a6e3bfe82087a888e3fdac9c3c414e5
Author: Gregory Nutt <gnutt@nuttx.org>
Date: Fri Aug 18 19:30:04 2017 -0600
PF_IEEE802154: More renaming to decouple 6LoPAN from radios in general.
commit 69fabb1aea76e54381bdc13de28a3f1441fb42f4
Author: Gregory Nutt <gnutt@nuttx.org>
Date: Fri Aug 18 19:21:11 2017 -0600
PF_IEEE802154: Missed a few renamings.
commit ff0af1bb25567720934cc1c2a721ccd92cc35f89
Author: Gregory Nutt <gnutt@nuttx.org>
Date: Fri Aug 18 17:46:58 2017 -0600
PF_IEEE802154: A few bugfixes
commit 01c7c84afd00cf907d280d30cfaf0fb2cf90e02e
Author: Gregory Nutt <gnutt@nuttx.org>
Date: Fri Aug 18 17:01:31 2017 -0600
PF_IEEE802154: A few bugfixes
commit dcef4056d1c1488c93151135f3b7106977faa903
Author: Gregory Nutt <gnutt@nuttx.org>
Date: Fri Aug 18 16:31:05 2017 -0600
PF_IEEE802154: Bring in framework for sendto/recvfrom. Currently just a crude port of functions from net/pkt and do not provide the implemenation needed.
commit 68c5b7b6dd3ab7eb2d0c19890abb38e6561b140e
Author: Gregory Nutt <gnutt@nuttx.org>
Date: Fri Aug 18 15:18:31 2017 -0600
Trivial fix to typo in comment
commit fd0af534c089569ccdbd59f13b85453de0a653ad
Author: Gregory Nutt <gnutt@nuttx.org>
Date: Fri Aug 18 15:07:20 2017 -0600
PF_IEEE802154: Add device lookup logic; Rename some things that used to be used only by 6LoWPAN but now must be shared with PF_IEEE802154 and need more generic naming.
commit 4fc80a1659f1c699b050775cefc7f6b631b46114
Author: Gregory Nutt <gnutt@nuttx.org>
Date: Fri Aug 18 13:49:54 2017 -0600
PF_IEEE802154: Add driver poll logic.
commit d83f71992df8764faa93f9425f1a7602a758f730
Author: Gregory Nutt <gnutt@nuttx.org>
Date: Fri Aug 18 13:28:59 2017 -0600
PF_IEEE802154: Add frame input function.
commit 77561b8c4d5d7be1f8d8eb62cf1a07229afe2048
Author: Gregory Nutt <gnutt@nuttx.org>
Date: Fri Aug 18 12:46:29 2017 -0600
PF_IEEE802154: Socket type should be SOCK_DGRAM. Hook in socket interface.
commit c0f90350282e9905d7f26a1b30f04cc6d6794648
Merge: 8b518abfd0 169c55e546
Author: Gregory Nutt <gnutt@nuttx.org>
Date: Fri Aug 18 09:36:32 2017 -0600
Merge remote-tracking branch 'origin/master' into pf_ieee802154
commit 8b518abfd07d492f5148f2c5fdf65604de9822da
Author: Gregory Nutt <gnutt@nuttx.org>
Date: Fri Aug 18 09:35:39 2017 -0600
PF_IEEE802154: Add initialization and connection management logic.
commit 98b62620b3cb420041d8ad14204f9410a8aace8c
Author: Gregory Nutt <gnutt@nuttx.org>
Date: Fri Aug 18 07:52:51 2017 -0600
PF_IEEE802154: Add basic build support and socket interface framework.
684 lines
22 KiB
C
684 lines
22 KiB
C
/****************************************************************************
|
|
* net/sixlowpan/sixlowpan_utils.c
|
|
*
|
|
* Copyright (C) 2017 Gregory Nutt. All rights reserved.
|
|
* Author: Gregory Nutt <gnutt@nuttx.org>
|
|
*
|
|
* Derives from logic in Contiki:
|
|
*
|
|
* Copyright (c) 2008, Swedish Institute of Computer Science.
|
|
* All rights reserved.
|
|
* Authors: Adam Dunkels <adam@sics.se>
|
|
* Nicolas Tsiftes <nvt@sics.se>
|
|
* Niclas Finne <nfi@sics.se>
|
|
* Mathilde Durvy <mdurvy@cisco.com>
|
|
* Julien Abeille <jabeille@cisco.com>
|
|
* Joakim Eriksson <joakime@sics.se>
|
|
* Joel Hoglund <joel@sics.se>
|
|
*
|
|
* 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 of the Institute 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 INSTITUTE 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 INSTITUTE 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 <assert.h>
|
|
#include <errno.h>
|
|
#include <debug.h>
|
|
|
|
#include <nuttx/net/ip.h>
|
|
#include <nuttx/net/sixlowpan.h>
|
|
#include <nuttx/wireless/pktradio.h>
|
|
#include <nuttx/wireless/ieee802154/ieee802154_mac.h>
|
|
|
|
#include "inet/inet.h"
|
|
#include "sixlowpan/sixlowpan_internal.h"
|
|
|
|
#ifdef CONFIG_NET_6LOWPAN
|
|
|
|
/****************************************************************************
|
|
* Pre-processor Definitions
|
|
****************************************************************************/
|
|
|
|
/* REVISIT: The setting CONFIG_PKTRADIO_ADDRLEN should be the *maximum*
|
|
* address length. If there is only a single packet radio then it should be
|
|
* the exact address length of that radio. If there are multiple packet
|
|
* radios with different address lengths, then it will be inexact; it will
|
|
* be the size of the longest address.
|
|
*/
|
|
|
|
#undef HAVE_BYTEADDR
|
|
#undef HAVE_SADDR
|
|
#undef HAVE_EADDR
|
|
|
|
#ifdef CONFIG_WIRELESS_IEEE802154
|
|
# define HAVE_SADDR 1
|
|
# define HAVE_EADDR 1
|
|
#endif
|
|
|
|
#ifdef CONFIG_WIRELESS_PKTRADIO
|
|
# if CONFIG_PKTRADIO_ADDRLEN == 1
|
|
# define HAVE_BYTEADDR 1
|
|
# elif CONFIG_PKTRADIO_ADDRLEN == 2
|
|
# define HAVE_BYTEADDR 1
|
|
# define HAVE_SADDR 1
|
|
# elif CONFIG_PKTRADIO_ADDRLEN == 8
|
|
# define HAVE_BYTEADDR 1
|
|
# define HAVE_SADDR 1
|
|
# define HAVE_EADDR 1
|
|
# else
|
|
# error Unsupported value for CONFIG_PKTRADIO_ADDRLEN
|
|
# endif
|
|
#endif
|
|
|
|
/****************************************************************************
|
|
* Private Functions
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Name: sixlowpan_[s|e]addrfromip
|
|
*
|
|
* Description:
|
|
* sixlowpan_[s|e]addrfromip(): Extract the IEEE 802.15.14 address from a
|
|
* MAC-based IPv6 address. sixlowpan_saddrfromip() and
|
|
* sixlowpan_eaddrfromip() handle short and extended addresses,
|
|
* respectively.
|
|
*
|
|
* 128 112 96 80 64 48 32 16
|
|
* ---- ---- ---- ---- ---- ---- ---- ----
|
|
* fe80 0000 0000 0000 0000 00ff fe00 xx00 1-byte short address IEEE 48-bit MAC
|
|
* xxxx 0000 0000 0000 0000 00ff fe00 xxxx 2-byte short address IEEE 48-bit MAC
|
|
* xxxx 0000 0000 0000 xxxx xxxx xxxx xxxx 8-byte extended address IEEE EUI-64
|
|
*
|
|
****************************************************************************/
|
|
|
|
#ifndef CONFIG_NET_STARPOINT
|
|
#ifdef HAVE_BYTEADDR
|
|
static void sixlowpan_baddrfromip(const net_ipv6addr_t ipaddr, FAR uint8_t *baddr)
|
|
{
|
|
/* Big-endian uint16_t to byte order */
|
|
|
|
baddr[0] = ipaddr[7] >> 8 ^ 0x02;
|
|
}
|
|
#endif
|
|
|
|
#ifdef HAVE_SADDR
|
|
static void sixlowpan_saddrfromip(const net_ipv6addr_t ipaddr, FAR uint8_t *saddr)
|
|
{
|
|
/* Big-endian uint16_t to byte order */
|
|
|
|
saddr[0] = ipaddr[7] >> 8;
|
|
saddr[1] = ipaddr[7] & 0xff;
|
|
saddr[0] ^= 0x02;
|
|
}
|
|
#endif
|
|
|
|
#ifdef HAVE_EADDR
|
|
static void sixlowpan_eaddrfromip(const net_ipv6addr_t ipaddr, FAR uint8_t *eaddr)
|
|
{
|
|
FAR uint8_t *eptr = eaddr;
|
|
int i;
|
|
|
|
DEBUGASSERT(ipaddr[0] == HTONS(0xfe80));
|
|
|
|
for (i = 4; i < 8; i++)
|
|
{
|
|
/* Big-endian uint16_t to byte order */
|
|
|
|
*eptr++ = ipaddr[i] >> 8;
|
|
*eptr++ = ipaddr[i] & 0xff;
|
|
}
|
|
|
|
eaddr[0] ^= 0x02;
|
|
}
|
|
#endif
|
|
#endif /* !CONFIG_NET_STARPOINT */
|
|
|
|
/****************************************************************************
|
|
* Public Functions
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Name: sixlowpan_destaddrfromip
|
|
*
|
|
* Description:
|
|
* sixlowpan_destaddrfromip(): Extract the IEEE 802.15.14 destination
|
|
* address from a MAC-based destination IPv6 address. This function
|
|
* handles a tagged address union which may either a short or and
|
|
* extended destination address.
|
|
*
|
|
* 128 112 96 80 64 48 32 16
|
|
* ---- ---- ---- ---- ---- ---- ---- ----
|
|
* ff02 xxxx xxxx xxxx xxxx xxxx xxxx xxxx Multicast
|
|
* ff02 0000 0000 0000 0000 0000 0000 0001 All nodes multicast group
|
|
* xxxx 0000 0000 0000 0000 00ff fe00 xx00 1-byte short address IEEE 48-bit MAC
|
|
* xxxx 0000 0000 0000 0000 00ff fe00 xxxx 2-byte short address IEEE 48-bit MAC
|
|
* xxxx 0000 0000 0000 xxxx xxxx xxxx xxxx 8-byte extended address IEEE EUI-64
|
|
*
|
|
* In the case there the IEEE 802.15.4 node functions as an endpoint in a
|
|
* start topology, the destination address will, instead, be the address
|
|
* of the star hub (which is assumed to be the address of the cooordinator).
|
|
*
|
|
****************************************************************************/
|
|
|
|
int sixlowpan_destaddrfromip(FAR struct radio_driver_s *radio,
|
|
const net_ipv6addr_t ipaddr,
|
|
FAR struct netdev_varaddr_s *destaddr)
|
|
{
|
|
struct sixlowpan_properties_s properties;
|
|
int ret;
|
|
|
|
#ifdef CONFIG_NET_STARPOINT
|
|
/* Only the radio driver knows the correct address of the hub. For IEEE
|
|
* 802.15.4 this will be the address of the PAN coordinator. For other
|
|
* radios, this may be some configured, "well-known" address.
|
|
*/
|
|
|
|
DEBUGASSERT(radio->r_properties != NULL);
|
|
ret = radio->r_properties(radio, &properties);
|
|
if (ret < 0)
|
|
{
|
|
return ret;
|
|
}
|
|
|
|
memcpy(destaddr, &properties.sp_hubnode, sizeof(struct netdev_varaddr_s));
|
|
return OK;
|
|
|
|
#else /* CONFIG_NET_STARPOINT */
|
|
|
|
/* Check for a multicast address */
|
|
|
|
if (ipaddr[0] == HTONS(0xff02))
|
|
{
|
|
DEBUGASSERT(radio->r_properties != NULL);
|
|
ret = radio->r_properties(radio, &properties);
|
|
if (ret < 0)
|
|
{
|
|
return ret;
|
|
}
|
|
|
|
/* Check for the broadcast IP address
|
|
*
|
|
* IPv6 does not implement the method of broadcast, and therefore
|
|
* does not define broadcast addresses. Instead, IPv6 uses multicast
|
|
* addressing to the all-nodes multicast group: ff02:0:0:0:0:0:0:1.
|
|
*
|
|
* However, the use of the all-nodes group is not common, and most
|
|
* IPv6 protocols use a dedicated link-local multicast group to avoid
|
|
* disturbing every interface in the network.
|
|
*/
|
|
|
|
if (net_ipv6addr_cmp(ipaddr, g_ipv6_allnodes))
|
|
{
|
|
memcpy(destaddr, &properties.sp_bcast,
|
|
sizeof(struct netdev_varaddr_s));
|
|
}
|
|
else
|
|
{
|
|
memcpy(destaddr, &properties.sp_mcast,
|
|
sizeof(struct netdev_varaddr_s));
|
|
}
|
|
|
|
return OK;
|
|
}
|
|
|
|
/* Otherwise, the destination MAC address is encoded in the IP address */
|
|
|
|
/* Check for compressible link-local address.
|
|
* REVISIT: This should not restrict us to link-local addresses.
|
|
*/
|
|
|
|
if (ipaddr[0] != HTONS(0xfe80) || ipaddr[1] != 0 ||
|
|
ipaddr[2] != 0 || ipaddr[3] != 0)
|
|
{
|
|
return -EADDRNOTAVAIL;
|
|
}
|
|
|
|
#ifdef CONFIG_WIRELESS_PKTRADIO
|
|
/* If this is a packet radio, then we cannot know the correct size of the
|
|
* radio's MAC address without asking. The setting CONFIG_PKTRADIO_ADDRLEN
|
|
* is inexact if there are multiple packet radios with different address
|
|
* lengths; it that case it will be the size of the longest address.
|
|
*
|
|
* NOTE: This logic assumes that the packet radio's address length is a
|
|
* constant.
|
|
*/
|
|
|
|
#ifdef CONFIG_WIRELESS_IEEE802154
|
|
if (radio->r_dev.d_lltype == NET_LL_PKTRADIO)
|
|
#endif
|
|
{
|
|
DEBUGASSERT(radio->r_properties != NULL);
|
|
ret = radio->r_properties(radio, &properties);
|
|
if (ret < 0)
|
|
{
|
|
return ret;
|
|
}
|
|
|
|
#ifdef HAVE_BYTEADDR
|
|
if (properties.sp_addrlen == 1 &&
|
|
SIXLOWPAN_IS_IID_8BIT_COMPRESSABLE(ipaddr))
|
|
{
|
|
memset(destaddr, 0, sizeof(struct netdev_varaddr_s));
|
|
sixlowpan_baddrfromip(ipaddr, destaddr->nv_addr);
|
|
destaddr->nv_addrlen = 1;
|
|
return OK;
|
|
}
|
|
else
|
|
#endif
|
|
#ifdef HAVE_SADDR
|
|
if (properties.sp_addrlen == 2 &&
|
|
SIXLOWPAN_IS_IID_16BIT_COMPRESSABLE(ipaddr))
|
|
{
|
|
memset(destaddr, 0, sizeof(struct netdev_varaddr_s));
|
|
sixlowpan_saddrfromip(ipaddr, destaddr->nv_addr);
|
|
destaddr->nv_addrlen = 2;
|
|
return OK;
|
|
}
|
|
else
|
|
#endif
|
|
#ifdef HAVE_EADDR
|
|
if (properties.sp_addrlen == 8)
|
|
{
|
|
sixlowpan_eaddrfromip(ipaddr, destaddr->nv_addr);
|
|
destaddr->nv_addrlen = 8;
|
|
return OK;
|
|
}
|
|
else
|
|
#endif
|
|
{
|
|
/* Just to satisfy the last dangling 'else' */
|
|
}
|
|
|
|
return -EADDRNOTAVAIL;
|
|
}
|
|
|
|
#endif /* CONFIG_WIRELESS_PKTRADIO */
|
|
|
|
#ifdef CONFIG_WIRELESS_IEEE802154
|
|
#ifdef CONFIG_WIRELESS_PKTRADIO
|
|
else
|
|
#endif
|
|
{
|
|
if (SIXLOWPAN_IS_IID_16BIT_COMPRESSABLE(ipaddr))
|
|
{
|
|
memset(destaddr, 0, sizeof(struct netdev_varaddr_s));
|
|
sixlowpan_saddrfromip(ipaddr, destaddr->nv_addr);
|
|
destaddr->nv_addrlen = NET_6LOWPAN_SADDRSIZE;
|
|
}
|
|
else
|
|
{
|
|
sixlowpan_eaddrfromip(ipaddr, destaddr->nv_addr);
|
|
destaddr->nv_addrlen = NET_6LOWPAN_EADDRSIZE;
|
|
}
|
|
|
|
return OK;
|
|
}
|
|
|
|
#endif /* CONFIG_WIRELESS_IEEE802154 */
|
|
#endif /* CONFIG_NET_STARPOINT */
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: sixlowpan_ipfromaddr (plus helpers)
|
|
*
|
|
* Description:
|
|
* sixlowpan_ipfrom[s|e]addr(): Create a link-local, MAC-based IPv6
|
|
* address from an IEEE802.15.4 short address (saddr), extended address
|
|
* (eaddr), or other variable length radio addresses.
|
|
*
|
|
* 128 112 96 80 64 48 32 16
|
|
* ---- ---- ---- ---- ---- ---- ---- ----
|
|
* fe80 0000 0000 0000 0000 00ff fe00 xx00 1-byte short address IEEE 48-bit MAC
|
|
* fe80 0000 0000 0000 0000 00ff fe00 xxxx 2-byte short address IEEE 48-bit MAC
|
|
* fe80 0000 0000 0000 xxxx xxxx xxxx xxxx 8-byte extended address IEEE EUI-64
|
|
*
|
|
****************************************************************************/
|
|
|
|
#ifdef HAVE_BYTEADDR
|
|
static inline void sixlowpan_ipfrombyte(FAR const uint8_t *byte,
|
|
FAR net_ipv6addr_t ipaddr)
|
|
{
|
|
ipaddr[0] = HTONS(0xfe80);
|
|
ipaddr[1] = 0;
|
|
ipaddr[2] = 0;
|
|
ipaddr[3] = 0;
|
|
ipaddr[4] = 0;
|
|
ipaddr[5] = HTONS(0x00ff);
|
|
ipaddr[6] = HTONS(0xfe00);
|
|
ipaddr[7] = (uint16_t)byte[0] << 8 ^ 0x0200;
|
|
}
|
|
#endif
|
|
|
|
#ifdef HAVE_SADDR
|
|
static inline void sixlowpan_ipfromsaddr(FAR const uint8_t *saddr,
|
|
FAR net_ipv6addr_t ipaddr)
|
|
{
|
|
ipaddr[0] = HTONS(0xfe80);
|
|
ipaddr[1] = 0;
|
|
ipaddr[2] = 0;
|
|
ipaddr[3] = 0;
|
|
ipaddr[4] = 0;
|
|
ipaddr[5] = HTONS(0x00ff);
|
|
ipaddr[6] = HTONS(0xfe00);
|
|
ipaddr[7] = (uint16_t)saddr[0] << 8 | (uint16_t)saddr[1];
|
|
ipaddr[7] ^= 0x0200;
|
|
}
|
|
#endif
|
|
|
|
#ifdef HAVE_EADDR
|
|
static inline void sixlowpan_ipfromeaddr(FAR const uint8_t *eaddr,
|
|
FAR net_ipv6addr_t ipaddr)
|
|
{
|
|
ipaddr[0] = HTONS(0xfe80);
|
|
ipaddr[1] = 0;
|
|
ipaddr[2] = 0;
|
|
ipaddr[3] = 0;
|
|
ipaddr[4] = (uint16_t)eaddr[0] << 8 | (uint16_t)eaddr[1];
|
|
ipaddr[5] = (uint16_t)eaddr[2] << 8 | (uint16_t)eaddr[3];
|
|
ipaddr[6] = (uint16_t)eaddr[4] << 8 | (uint16_t)eaddr[5];
|
|
ipaddr[7] = (uint16_t)eaddr[6] << 8 | (uint16_t)eaddr[7];
|
|
ipaddr[4] ^= 0x0200;
|
|
}
|
|
#endif
|
|
|
|
void sixlowpan_ipfromaddr(FAR const struct netdev_varaddr_s *addr,
|
|
FAR net_ipv6addr_t ipaddr)
|
|
{
|
|
switch (addr->nv_addrlen)
|
|
{
|
|
#ifdef HAVE_BYTEADDR
|
|
case 1:
|
|
sixlowpan_ipfrombyte(addr->nv_addr, ipaddr);
|
|
break;
|
|
#endif
|
|
|
|
#ifdef HAVE_SADDR
|
|
case NET_6LOWPAN_SADDRSIZE:
|
|
sixlowpan_ipfromsaddr(addr->nv_addr, ipaddr);
|
|
break;
|
|
#endif
|
|
|
|
#ifdef HAVE_EADDR
|
|
case NET_6LOWPAN_EADDRSIZE:
|
|
sixlowpan_ipfromeaddr(addr->nv_addr, ipaddr);
|
|
break;
|
|
#endif
|
|
|
|
default:
|
|
nerr("ERROR: Unsupported address length: %u\n", addr->nv_addrlen);
|
|
break;
|
|
}
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: sixlowpan_ismacbased (and helpers)
|
|
*
|
|
* Description:
|
|
* sixlowpan_ismacbased() will return true for IP addresses formed from
|
|
* IEEE802.15.4 MAC addresses. sixlowpan_destaddrfromip() is intended to
|
|
* handle a tagged address or any size.
|
|
*
|
|
* 128 112 96 80 64 48 32 16
|
|
* ---- ---- ---- ---- ---- ---- ---- ----
|
|
* fe80 0000 0000 0000 0000 00ff fe00 xx00 1-byte short address IEEE 48-bit MAC
|
|
* fe80 0000 0000 0000 0000 00ff fe00 xxxx 2-byte short address IEEE 48-bit MAC
|
|
* fe80 0000 0000 0000 xxxx xxxx xxxx xxxx 8-byte extended address IEEE EUI-64
|
|
*
|
|
****************************************************************************/
|
|
|
|
#ifdef HAVE_BYTEADDR
|
|
static inline bool sixlowpan_isbytebased(const net_ipv6addr_t ipaddr,
|
|
uint8_t byte)
|
|
{
|
|
return (ipaddr[5] == HTONS(0x00ff) &&
|
|
ipaddr[6] == HTONS(0xfe00) &&
|
|
ipaddr[7] == (((uint16_t)byte << 8) ^ 0x0200));
|
|
}
|
|
#endif
|
|
|
|
static inline bool sixlowpan_issaddrbased(const net_ipv6addr_t ipaddr,
|
|
FAR const uint8_t *saddr)
|
|
{
|
|
return (ipaddr[5] == HTONS(0x00ff) &&
|
|
ipaddr[6] == HTONS(0xfe00) &&
|
|
ipaddr[7] == (GETUINT16(saddr, 0) ^ 0x0200));
|
|
}
|
|
|
|
static inline bool sixlowpan_iseaddrbased(const net_ipv6addr_t ipaddr,
|
|
FAR const uint8_t *eaddr)
|
|
{
|
|
return (ipaddr[4] == (GETUINT16(eaddr, 0) ^ 0x0200) &&
|
|
ipaddr[5] == GETUINT16(eaddr, 2) &&
|
|
ipaddr[6] == GETUINT16(eaddr, 4) &&
|
|
ipaddr[7] == GETUINT16(eaddr, 6));
|
|
}
|
|
|
|
bool sixlowpan_ismacbased(const net_ipv6addr_t ipaddr,
|
|
FAR const struct netdev_varaddr_s *addr)
|
|
{
|
|
switch (addr->nv_addrlen)
|
|
{
|
|
#ifdef HAVE_BYTEADDR
|
|
case 1:
|
|
return sixlowpan_isbytebased(ipaddr, addr->nv_addr[0]);
|
|
#endif
|
|
|
|
#ifdef HAVE_SADDR
|
|
case NET_6LOWPAN_SADDRSIZE:
|
|
return sixlowpan_issaddrbased(ipaddr, addr->nv_addr);
|
|
#endif
|
|
|
|
#ifdef HAVE_EADDR
|
|
case NET_6LOWPAN_EADDRSIZE:
|
|
return sixlowpan_iseaddrbased(ipaddr, addr->nv_addr);
|
|
#endif
|
|
|
|
default:
|
|
nerr("ERROR: Unsupported address length: %u\n", addr->nv_addrlen);
|
|
return false;
|
|
}
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: sixlowpan_src_panid
|
|
*
|
|
* Description:
|
|
* Get the source PAN ID from the IEEE802.15.4 MAC layer.
|
|
*
|
|
* Input parameters:
|
|
* radio - Reference to a radio network driver state instance.
|
|
* panid - The location in which to return the PAN ID. 0xfff may be
|
|
* returned if the device is not associated.
|
|
*
|
|
* Returned Value:
|
|
* Zero (OK) on success; a negated errno value on failure.
|
|
*
|
|
****************************************************************************/
|
|
|
|
#ifdef CONFIG_WIRELESS_IEEE802154
|
|
int sixlowpan_src_panid(FAR struct radio_driver_s *radio,
|
|
FAR uint8_t *panid)
|
|
{
|
|
FAR struct net_driver_s *dev = &radio->r_dev;
|
|
struct ieee802154_netmac_s arg;
|
|
int ret;
|
|
|
|
memcpy(arg.ifr_name, radio->r_dev.d_ifname, IFNAMSIZ);
|
|
arg.u.getreq.attr = IEEE802154_ATTR_MAC_PANID;
|
|
ret = dev->d_ioctl(dev, MAC802154IOC_MLME_GET_REQUEST,
|
|
(unsigned long)((uintptr_t)&arg));
|
|
if (ret < 0)
|
|
{
|
|
nerr("ERROR: MAC802154IOC_MLME_GET_REQUEST failed: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
IEEE802154_PANIDCOPY(panid, arg.u.getreq.attrval.mac.panid);
|
|
return OK;
|
|
}
|
|
#endif
|
|
|
|
/****************************************************************************
|
|
* Name: sixlowpan_extract_srcaddr
|
|
*
|
|
* Description:
|
|
* Extract the source MAC address from the radio-specific RX metadata, and
|
|
* return the source address in a radio-agnostic form.
|
|
*
|
|
* Input parameters:
|
|
* radio - Reference to a radio network driver state instance.
|
|
* metadata - Opaque reference to the radio-specific RX metadata.
|
|
* srcaddr - The location in which to return the source MAC address.
|
|
*
|
|
* Returned Value:
|
|
* Zero (OK) on success; a negated errno value on failure.
|
|
*
|
|
****************************************************************************/
|
|
|
|
int sixlowpan_extract_srcaddr(FAR struct radio_driver_s *radio,
|
|
FAR const void *metadata,
|
|
FAR struct netdev_varaddr_s *srcaddr)
|
|
{
|
|
DEBUGASSERT(radio != NULL && metadata != NULL && srcaddr != NULL);
|
|
|
|
#ifdef CONFIG_WIRELESS_IEEE802154
|
|
#ifdef CONFIG_WIRELESS_PKTRADIO
|
|
if (radio->r_dev.d_lltype == NET_LL_IEEE802154)
|
|
#endif
|
|
{
|
|
FAR const struct ieee802154_data_ind_s *ind =
|
|
(FAR const struct ieee802154_data_ind_s *)metadata;
|
|
|
|
if (ind->src.mode == IEEE802154_ADDRMODE_SHORT)
|
|
{
|
|
srcaddr->nv_addrlen = NET_6LOWPAN_SADDRSIZE;
|
|
memcpy(srcaddr->nv_addr, ind->src.saddr, NET_6LOWPAN_SADDRSIZE);
|
|
}
|
|
else
|
|
{
|
|
srcaddr->nv_addrlen = NET_6LOWPAN_EADDRSIZE;
|
|
memcpy(srcaddr->nv_addr, ind->src.eaddr, NET_6LOWPAN_EADDRSIZE);
|
|
}
|
|
|
|
return OK;
|
|
}
|
|
#endif
|
|
|
|
#ifdef CONFIG_WIRELESS_PKTRADIO
|
|
#ifdef CONFIG_WIRELESS_IEEE802154
|
|
else
|
|
#endif
|
|
{
|
|
FAR const struct pktradio_metadata_s *pktmeta =
|
|
(FAR const struct pktradio_metadata_s *)metadata;
|
|
|
|
DEBUGASSERT(pktmeta->pm_src.pa_addrlen <= CONFIG_PKTRADIO_ADDRLEN);
|
|
|
|
srcaddr->nv_addrlen = pktmeta->pm_src.pa_addrlen;
|
|
memcpy(srcaddr->nv_addr, pktmeta->pm_src.pa_addr,
|
|
pktmeta->pm_src.pa_addrlen);
|
|
|
|
return OK;
|
|
}
|
|
#endif
|
|
|
|
return -EINVAL; /* Shouldn't get here */
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: sixlowpan_extract_destaddr
|
|
*
|
|
* Description:
|
|
* Extract the destination MAC address from the radio-specific RX metadata,
|
|
* and return the destination address in a radio-agnostic form.
|
|
*
|
|
* Input parameters:
|
|
* radio - Reference to a radio network driver state instance.
|
|
* metadata - Opaque reference to the radio-specific RX metadata.
|
|
* destaddr - The location in which to return the destination MAC address.
|
|
*
|
|
* Returned Value:
|
|
* Zero (OK) on success; a negated errno value on failure.
|
|
*
|
|
****************************************************************************/
|
|
|
|
int sixlowpan_extract_destaddr(FAR struct radio_driver_s *radio,
|
|
FAR const void *metadata,
|
|
FAR struct netdev_varaddr_s *destaddr)
|
|
{
|
|
DEBUGASSERT(radio != NULL && metadata != NULL && destaddr != NULL);
|
|
|
|
#ifdef CONFIG_WIRELESS_IEEE802154
|
|
#ifdef CONFIG_WIRELESS_PKTRADIO
|
|
if (radio->r_dev.d_lltype == NET_LL_IEEE802154)
|
|
#endif
|
|
{
|
|
FAR const struct ieee802154_data_ind_s *ind =
|
|
(FAR const struct ieee802154_data_ind_s *)metadata;
|
|
|
|
if (ind->dest.mode == IEEE802154_ADDRMODE_SHORT)
|
|
{
|
|
destaddr->nv_addrlen = NET_6LOWPAN_SADDRSIZE;
|
|
memcpy(destaddr->nv_addr, ind->dest.saddr, NET_6LOWPAN_SADDRSIZE);
|
|
}
|
|
else
|
|
{
|
|
destaddr->nv_addrlen = NET_6LOWPAN_EADDRSIZE;
|
|
memcpy(destaddr->nv_addr, ind->dest.eaddr, NET_6LOWPAN_EADDRSIZE);
|
|
}
|
|
|
|
return OK;
|
|
}
|
|
#endif
|
|
|
|
#ifdef CONFIG_WIRELESS_PKTRADIO
|
|
#ifdef CONFIG_WIRELESS_IEEE802154
|
|
else
|
|
#endif
|
|
{
|
|
FAR const struct pktradio_metadata_s *pktmeta =
|
|
(FAR const struct pktradio_metadata_s *)metadata;
|
|
|
|
DEBUGASSERT(pktmeta->pm_dest.pa_addrlen <= CONFIG_PKTRADIO_ADDRLEN);
|
|
|
|
destaddr->nv_addrlen = pktmeta->pm_dest.pa_addrlen;
|
|
memcpy(destaddr->nv_addr, pktmeta->pm_dest.pa_addr,
|
|
pktmeta->pm_dest.pa_addrlen);
|
|
|
|
return OK;
|
|
}
|
|
#endif
|
|
|
|
return -EINVAL; /* Shouldn't get here */
|
|
}
|
|
|
|
#endif /* CONFIG_NET_6LOWPAN */
|