/**************************************************************************** * net/sixlowpan/sixlowpan_utils.c * * Copyright (C) 2017 Gregory Nutt. All rights reserved. * Author: Gregory Nutt * * Copyright (C) 2017, Gregory Nutt, all rights reserved * Author: Gregory Nutt * * Derives from logic in Contiki: * * Copyright (c) 2008, Swedish Institute of Computer Science. * All rights reserved. * Authors: Adam Dunkels * Nicolas Tsiftes * Niclas Finne * Mathilde Durvy * Julien Abeille * Joakim Eriksson * Joel Hoglund * * 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 #include #include #include #include #include #include #include "sixlowpan/sixlowpan_internal.h" #ifdef CONFIG_NET_6LOWPAN /**************************************************************************** * Public Functions ****************************************************************************/ /**************************************************************************** * Name: sixlowpan_addrfromip * * Description: * sixlowpan_addrfromip(): Extract the IEEE 802.15.14 address from a MAC * based IPv6 address. sixlowpan_addrfromip() is intended to handle a * tagged address or and size; sixlowpan_saddrfromip() and * sixlowpan_eaddrfromip() specifically handler short and extended * addresses. * * 128 112 96 80 64 48 32 16 * ---- ---- ---- ---- ---- ---- ---- ---- * 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 * ****************************************************************************/ void sixlowpan_saddrfromip(const net_ipv6addr_t ipaddr, FAR struct sixlowpan_saddr_s *saddr) { DEBUGASSERT(ipaddr[0] == HTONS(0xfe80)); memcpy(saddr, &ipaddr[7], NET_6LOWPAN_SADDRSIZE); saddr->u8[0] ^= 0x02; } void sixlowpan_eaddrfromip(const net_ipv6addr_t ipaddr, FAR struct sixlowpan_eaddr_s *eaddr) { DEBUGASSERT(ipaddr[0] == HTONS(0xfe80)); memcpy(eaddr, &ipaddr[4], NET_6LOWPAN_EADDRSIZE); eaddr->u8[0] ^= 0x02; } void sixlowpan_addrfromip(const net_ipv6addr_t ipaddr, FAR struct sixlowpan_tagaddr_s *addr) { DEBUGASSERT(ipaddr[0] == HTONS(0xfe80)); if (SIXLOWPAN_IS_IID_16BIT_COMPRESSABLE(ipaddr)) { memset(addr, 0, sizeof(struct sixlowpan_tagaddr_s)); sixlowpan_saddrfromip(ipaddr, &addr->u.saddr); } else { sixlowpan_eaddrfromip(ipaddr, &addr->u.eaddr); addr->extended = true; } } /**************************************************************************** * Name: sixlowpan_ismacbased * * Description: * sixlowpan_ismacbased() will return true for IP addresses formed from * IEEE802.15.4 MAC addresses. sixlowpan_addrfromip() is intended to * handle a tagged address or any size; sixlowpan_issaddrbased() and * sixlowpan_iseaddrbased() specifically handle short and extended * addresses. Local addresses are of a fixed but configurable size and * sixlowpan_isaddrbased() is for use with such local addresses. * * * 128 112 96 80 64 48 32 16 * ---- ---- ---- ---- ---- ---- ---- ---- * 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 * ****************************************************************************/ bool sixlowpan_issaddrbased(const net_ipv6addr_t ipaddr, FAR const struct sixlowpan_saddr_s *saddr) { FAR const uint8_t *byteptr = saddr->u8; return (ipaddr[5] == HTONS(0x00ff) && ipaddr[6] == HTONS(0xfe00) && ipaddr[7] == (GETNET16(byteptr, 0) ^ HTONS(0x0200))); } bool sixlowpan_iseaddrbased(const net_ipv6addr_t ipaddr, FAR const struct sixlowpan_eaddr_s *eaddr) { FAR const uint8_t *byteptr = eaddr->u8; return (ipaddr[4] == (GETNET16(byteptr, 0) ^ HTONS(0x0200)) && ipaddr[5] == GETNET16(byteptr, 2) && ipaddr[6] == GETNET16(byteptr, 4) && ipaddr[7] == GETNET16(byteptr, 6)); } bool sixlowpan_ismacbased(const net_ipv6addr_t ipaddr, FAR const struct sixlowpan_tagaddr_s *addr) { if (addr->extended) { return sixlowpan_iseaddrbased(ipaddr, &addr->u.eaddr); } else { return sixlowpan_issaddrbased(ipaddr, &addr->u.saddr); } } /**************************************************************************** * Name: sixlowpan_src_panid * * Description: * Get the source PAN ID from the IEEE802.15.4 MAC layer. * * Input parameters: * ieee - A reference IEEE802.15.4 MAC network device structure. * 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. * ****************************************************************************/ int sixlowpan_src_panid(FAR struct ieee802154_driver_s *ieee, FAR uint16_t *panid) { FAR struct net_driver_s *dev = &ieee->i_dev; struct ieee802154_netmac_s arg; int ret; memcpy(arg.ifr_name, ieee->i_dev.d_ifname, IFNAMSIZ); arg.u.getreq.pib_attr = IEEE802154_PIB_MAC_PANID; ret = dev->d_ioctl(dev, MAC802154IOC_MLME_GET_REQUEST, (unsigned long)((uintptr_t)&arg)); if (ret < 0) { wlerr("ERROR: MAC802154IOC_MLME_GET_REQUEST failed: %d\n", ret); return ret; } *panid = arg.u.getreq.attrval.mac.panid; return OK; } #endif /* CONFIG_NET_6LOWPAN */