6lowpan.h revision 17d8ecb8ff791359c9d9a44bc766c3d4b87f37f7
144331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov/* 244331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * Copyright 2011, Siemens AG 344331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * written by Alexander Smirnov <alex.bluesman.smirnov@gmail.com> 444331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov */ 544331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 644331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov/* 744331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * Based on patches from Jon Smirl <jonsmirl@gmail.com> 844331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * Copyright (c) 2011 Jon Smirl <jonsmirl@gmail.com> 944331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * 1044331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * This program is free software; you can redistribute it and/or modify 1144331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * it under the terms of the GNU General Public License version 2 1244331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * as published by the Free Software Foundation. 1344331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * 1444331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * This program is distributed in the hope that it will be useful, 1544331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * but WITHOUT ANY WARRANTY; without even the implied warranty of 1644331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 1744331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * GNU General Public License for more details. 1844331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * 1944331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * You should have received a copy of the GNU General Public License along 2044331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * with this program; if not, write to the Free Software Foundation, Inc., 2144331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. 2244331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov */ 2344331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 2444331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov/* Jon's code is based on 6lowpan implementation for Contiki which is: 2544331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * Copyright (c) 2008, Swedish Institute of Computer Science. 2644331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * All rights reserved. 2744331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * 2844331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * Redistribution and use in source and binary forms, with or without 2944331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * modification, are permitted provided that the following conditions 3044331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * are met: 3144331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * 1. Redistributions of source code must retain the above copyright 3244331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * notice, this list of conditions and the following disclaimer. 3344331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * 2. Redistributions in binary form must reproduce the above copyright 3444331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * notice, this list of conditions and the following disclaimer in the 3544331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * documentation and/or other materials provided with the distribution. 3644331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * 3. Neither the name of the Institute nor the names of its contributors 3744331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * may be used to endorse or promote products derived from this software 3844331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * without specific prior written permission. 3944331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * 4044331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * THIS SOFTWARE IS PROVIDED BY THE INSTITUTE AND CONTRIBUTORS ``AS IS'' AND 4144331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 4244331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 4344331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * ARE DISCLAIMED. IN NO EVENT SHALL THE INSTITUTE OR CONTRIBUTORS BE LIABLE 4444331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 4544331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 4644331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 4744331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 4844331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 4944331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 5044331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * SUCH DAMAGE. 5144331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov */ 5244331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 5344331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#ifndef __6LOWPAN_H__ 5444331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define __6LOWPAN_H__ 5544331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 5691c69227452f6cdf3759a8af624de1f81565d5bdAlexander Aring#include <net/ipv6.h> 5717d8ecb8ff791359c9d9a44bc766c3d4b87f37f7Luis R. Rodriguez#include <net/net_namespace.h> 5891c69227452f6cdf3759a8af624de1f81565d5bdAlexander Aring 5944331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define UIP_802154_SHORTADDR_LEN 2 /* compressed ipv6 address length */ 6044331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define UIP_IPH_LEN 40 /* ipv6 fixed header size */ 6144331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define UIP_PROTO_UDP 17 /* ipv6 next header value for UDP */ 6244331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define UIP_FRAGH_LEN 8 /* ipv6 fragment header size */ 6344331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 6444331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov/* 6544331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * ipv6 address based on mac 6644331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * second bit-flip (Universe/Local) is done according RFC2464 6744331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov */ 6844331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define is_addr_mac_addr_based(a, m) \ 6944331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov ((((a)->s6_addr[8]) == (((m)[0]) ^ 0x02)) && \ 7044331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr[9]) == (m)[1]) && \ 7144331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr[10]) == (m)[2]) && \ 7244331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr[11]) == (m)[3]) && \ 7344331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr[12]) == (m)[4]) && \ 7444331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr[13]) == (m)[5]) && \ 7544331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr[14]) == (m)[6]) && \ 7644331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr[15]) == (m)[7])) 7744331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 7844331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov/* ipv6 address is unspecified */ 7944331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define is_addr_unspecified(a) \ 8044331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov ((((a)->s6_addr32[0]) == 0) && \ 8144331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr32[1]) == 0) && \ 8244331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr32[2]) == 0) && \ 8344331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr32[3]) == 0)) 8444331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 8544331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov/* compare ipv6 addresses prefixes */ 8644331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define ipaddr_prefixcmp(addr1, addr2, length) \ 8744331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (memcmp(addr1, addr2, length >> 3) == 0) 8844331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 8944331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov/* local link, i.e. FE80::/10 */ 909026c4927254f5bea695cc3ef2e255280e6a3011YOSHIFUJI Hideaki / 吉藤英明#define is_addr_link_local(a) (((a)->s6_addr16[0]) == htons(0xFE80)) 9144331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 9244331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov/* 9344331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * check whether we can compress the IID to 16 bits, 9444331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * it's possible for unicast adresses with first 49 bits are zero only. 9544331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov */ 9644331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define lowpan_is_iid_16_bit_compressable(a) \ 9744331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov ((((a)->s6_addr16[4]) == 0) && \ 988d879a3f9856fe6c6e27853a96c0beaed03acb2cTony Cheneau (((a)->s6_addr[10]) == 0) && \ 998d879a3f9856fe6c6e27853a96c0beaed03acb2cTony Cheneau (((a)->s6_addr[11]) == 0xff) && \ 1008d879a3f9856fe6c6e27853a96c0beaed03acb2cTony Cheneau (((a)->s6_addr[12]) == 0xfe) && \ 1018d879a3f9856fe6c6e27853a96c0beaed03acb2cTony Cheneau (((a)->s6_addr[13]) == 0)) 10244331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 10344331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov/* multicast address */ 10444331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define is_addr_mcast(a) (((a)->s6_addr[0]) == 0xFF) 10544331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 10644331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov/* check whether the 112-bit gid of the multicast address is mappable to: */ 10744331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 10844331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov/* 9 bits, for FF02::1 (all nodes) and FF02::2 (all routers) addresses only. */ 10944331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define lowpan_is_mcast_addr_compressable(a) \ 11044331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov ((((a)->s6_addr16[1]) == 0) && \ 11144331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr16[2]) == 0) && \ 11244331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr16[3]) == 0) && \ 11344331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr16[4]) == 0) && \ 11444331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr16[5]) == 0) && \ 11544331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr16[6]) == 0) && \ 11644331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr[14]) == 0) && \ 11744331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov ((((a)->s6_addr[15]) == 1) || (((a)->s6_addr[15]) == 2))) 11844331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 11944331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov/* 48 bits, FFXX::00XX:XXXX:XXXX */ 12044331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define lowpan_is_mcast_addr_compressable48(a) \ 12144331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov ((((a)->s6_addr16[1]) == 0) && \ 12244331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr16[2]) == 0) && \ 12344331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr16[3]) == 0) && \ 12444331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr16[4]) == 0) && \ 12544331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr[10]) == 0)) 12644331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 12744331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov/* 32 bits, FFXX::00XX:XXXX */ 12844331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define lowpan_is_mcast_addr_compressable32(a) \ 12944331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov ((((a)->s6_addr16[1]) == 0) && \ 13044331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr16[2]) == 0) && \ 13144331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr16[3]) == 0) && \ 13244331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr16[4]) == 0) && \ 13344331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr16[5]) == 0) && \ 13444331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr[12]) == 0)) 13544331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 13644331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov/* 8 bits, FF02::00XX */ 13744331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define lowpan_is_mcast_addr_compressable8(a) \ 13844331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov ((((a)->s6_addr[1]) == 2) && \ 13944331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr16[1]) == 0) && \ 14044331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr16[2]) == 0) && \ 14144331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr16[3]) == 0) && \ 14244331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr16[4]) == 0) && \ 14344331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr16[5]) == 0) && \ 14444331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr16[6]) == 0) && \ 14544331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)->s6_addr[14]) == 0)) 14644331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 14744331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define lowpan_is_addr_broadcast(a) \ 14844331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov ((((a)[0]) == 0xFF) && \ 14944331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)[1]) == 0xFF) && \ 15044331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)[2]) == 0xFF) && \ 15144331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)[3]) == 0xFF) && \ 15244331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)[4]) == 0xFF) && \ 15344331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)[5]) == 0xFF) && \ 15444331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)[6]) == 0xFF) && \ 15544331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov (((a)[7]) == 0xFF)) 15644331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 15744331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_DISPATCH_IPV6 0x41 /* 01000001 = 65 */ 15844331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_DISPATCH_HC1 0x42 /* 01000010 = 66 */ 15944331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_DISPATCH_IPHC 0x60 /* 011xxxxx = ... */ 16044331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_DISPATCH_FRAG1 0xc0 /* 11000xxx */ 16144331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_DISPATCH_FRAGN 0xe0 /* 11100xxx */ 16244331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 163719269afbc69ab96339aad6c2d3b32f7d8311146alex.bluesman.smirnov@gmail.com#define LOWPAN_DISPATCH_MASK 0xf8 /* 11111000 */ 164719269afbc69ab96339aad6c2d3b32f7d8311146alex.bluesman.smirnov@gmail.com 165719269afbc69ab96339aad6c2d3b32f7d8311146alex.bluesman.smirnov@gmail.com#define LOWPAN_FRAG_TIMEOUT (HZ * 60) /* time-out 60 sec */ 166719269afbc69ab96339aad6c2d3b32f7d8311146alex.bluesman.smirnov@gmail.com 167719269afbc69ab96339aad6c2d3b32f7d8311146alex.bluesman.smirnov@gmail.com#define LOWPAN_FRAG1_HEAD_SIZE 0x4 168719269afbc69ab96339aad6c2d3b32f7d8311146alex.bluesman.smirnov@gmail.com#define LOWPAN_FRAGN_HEAD_SIZE 0x5 169719269afbc69ab96339aad6c2d3b32f7d8311146alex.bluesman.smirnov@gmail.com 170719269afbc69ab96339aad6c2d3b32f7d8311146alex.bluesman.smirnov@gmail.com/* 171719269afbc69ab96339aad6c2d3b32f7d8311146alex.bluesman.smirnov@gmail.com * According IEEE802.15.4 standard: 172719269afbc69ab96339aad6c2d3b32f7d8311146alex.bluesman.smirnov@gmail.com * - MTU is 127 octets 173719269afbc69ab96339aad6c2d3b32f7d8311146alex.bluesman.smirnov@gmail.com * - maximum MHR size is 37 octets 174719269afbc69ab96339aad6c2d3b32f7d8311146alex.bluesman.smirnov@gmail.com * - MFR size is 2 octets 175719269afbc69ab96339aad6c2d3b32f7d8311146alex.bluesman.smirnov@gmail.com * 176719269afbc69ab96339aad6c2d3b32f7d8311146alex.bluesman.smirnov@gmail.com * so minimal payload size that we may guarantee is: 177719269afbc69ab96339aad6c2d3b32f7d8311146alex.bluesman.smirnov@gmail.com * MTU - MHR - MFR = 88 octets 178719269afbc69ab96339aad6c2d3b32f7d8311146alex.bluesman.smirnov@gmail.com */ 179719269afbc69ab96339aad6c2d3b32f7d8311146alex.bluesman.smirnov@gmail.com#define LOWPAN_FRAG_SIZE 88 180719269afbc69ab96339aad6c2d3b32f7d8311146alex.bluesman.smirnov@gmail.com 18144331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov/* 18244331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * Values of fields within the IPHC encoding first byte 18344331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * (C stands for compressed and I for inline) 18444331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov */ 18544331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_IPHC_TF 0x18 18644331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 18744331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_IPHC_FL_C 0x10 18844331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_IPHC_TC_C 0x08 18944331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_IPHC_NH_C 0x04 19044331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_IPHC_TTL_1 0x01 19144331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_IPHC_TTL_64 0x02 19244331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_IPHC_TTL_255 0x03 19344331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_IPHC_TTL_I 0x00 19444331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 19544331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 19644331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov/* Values of fields within the IPHC encoding second byte */ 19744331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_IPHC_CID 0x80 19844331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 199ce2463b283a0cb63e0e4de5e7d971b4c92be542aAlexander Aring#define LOWPAN_IPHC_ADDR_00 0x00 200ce2463b283a0cb63e0e4de5e7d971b4c92be542aAlexander Aring#define LOWPAN_IPHC_ADDR_01 0x01 201ce2463b283a0cb63e0e4de5e7d971b4c92be542aAlexander Aring#define LOWPAN_IPHC_ADDR_02 0x02 202ce2463b283a0cb63e0e4de5e7d971b4c92be542aAlexander Aring#define LOWPAN_IPHC_ADDR_03 0x03 203ce2463b283a0cb63e0e4de5e7d971b4c92be542aAlexander Aring 20444331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_IPHC_SAC 0x40 20544331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_IPHC_SAM 0x30 20644331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 20744331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_IPHC_SAM_BIT 4 20844331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 20944331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_IPHC_M 0x08 21044331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_IPHC_DAC 0x04 21144331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_IPHC_DAM_00 0x00 21244331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_IPHC_DAM_01 0x01 21344331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_IPHC_DAM_10 0x02 21444331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_IPHC_DAM_11 0x03 21544331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 21644331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_IPHC_DAM_BIT 0 21744331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov/* 21844331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov * LOWPAN_UDP encoding (works together with IPHC) 21944331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov */ 22044331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_NHC_UDP_MASK 0xF8 22144331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_NHC_UDP_ID 0xF0 22244331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_NHC_UDP_CHECKSUMC 0x04 22344331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_NHC_UDP_CHECKSUMI 0x00 22444331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 2253bd5b958c2a2dd1a9b4c8d21e75fb47b062fc941alex.bluesman.smirnov@gmail.com#define LOWPAN_NHC_UDP_4BIT_PORT 0xF0B0 2263bd5b958c2a2dd1a9b4c8d21e75fb47b062fc941alex.bluesman.smirnov@gmail.com#define LOWPAN_NHC_UDP_4BIT_MASK 0xFFF0 2273bd5b958c2a2dd1a9b4c8d21e75fb47b062fc941alex.bluesman.smirnov@gmail.com#define LOWPAN_NHC_UDP_8BIT_PORT 0xF000 2283bd5b958c2a2dd1a9b4c8d21e75fb47b062fc941alex.bluesman.smirnov@gmail.com#define LOWPAN_NHC_UDP_8BIT_MASK 0xFF00 2293bd5b958c2a2dd1a9b4c8d21e75fb47b062fc941alex.bluesman.smirnov@gmail.com 23044331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov/* values for port compression, _with checksum_ ie bit 5 set to 0 */ 23144331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_NHC_UDP_CS_P_00 0xF0 /* all inline */ 23244331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_NHC_UDP_CS_P_01 0xF1 /* source 16bit inline, 23344331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov dest = 0xF0 + 8 bit inline */ 23444331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_NHC_UDP_CS_P_10 0xF2 /* source = 0xF0 + 8bit inline, 23544331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov dest = 16 bit inline */ 23644331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#define LOWPAN_NHC_UDP_CS_P_11 0xF3 /* source & dest = 0xF0B + 4bit inline */ 237573701ce3715434f01a8baea3255da8d04ad5979Alexander Aring#define LOWPAN_NHC_UDP_CS_C 0x04 /* checksum elided */ 23844331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov 239841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring#ifdef DEBUG 240841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring/* print data in line */ 241841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aringstatic inline void raw_dump_inline(const char *caller, char *msg, 242841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring unsigned char *buf, int len) 243841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring{ 244841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring if (msg) 245841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring pr_debug("%s():%s: ", caller, msg); 246841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring 247841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring print_hex_dump_debug("", DUMP_PREFIX_NONE, 16, 1, buf, len, false); 248841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring} 249841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring 250841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring/* print data in a table format: 251841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring * 252841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring * addr: xx xx xx xx xx xx 253841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring * addr: xx xx xx xx xx xx 254841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring * ... 255841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring */ 256841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aringstatic inline void raw_dump_table(const char *caller, char *msg, 257841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring unsigned char *buf, int len) 258841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring{ 259841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring if (msg) 260841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring pr_debug("%s():%s:\n", caller, msg); 261841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring 262841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring print_hex_dump_debug("\t", DUMP_PREFIX_OFFSET, 16, 1, buf, len, false); 263841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring} 264841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring#else 265841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aringstatic inline void raw_dump_table(const char *caller, char *msg, 266841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring unsigned char *buf, int len) { } 267841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aringstatic inline void raw_dump_inline(const char *caller, char *msg, 268841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring unsigned char *buf, int len) { } 269841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring#endif 270841a5ec72c028432f716670c4a7c2e1b70ee1341Alexander Aring 2718df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanenstatic inline int lowpan_fetch_skb_u8(struct sk_buff *skb, u8 *val) 2728df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen{ 2738df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen if (unlikely(!pskb_may_pull(skb, 1))) 2748df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen return -EINVAL; 2758df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen 2768df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen *val = skb->data[0]; 2778df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen skb_pull(skb, 1); 2788df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen 2798df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen return 0; 2808df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen} 2818df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen 2828df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanenstatic inline int lowpan_fetch_skb_u16(struct sk_buff *skb, u16 *val) 2838df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen{ 2848df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen if (unlikely(!pskb_may_pull(skb, 2))) 2858df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen return -EINVAL; 2868df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen 2878df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen *val = (skb->data[0] << 8) | skb->data[1]; 2888df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen skb_pull(skb, 2); 2898df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen 2908df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen return 0; 2918df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen} 2928df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen 2934666669fc3b83f0d01b08c6b17432563f2eedcbaAlexander Aringstatic inline bool lowpan_fetch_skb(struct sk_buff *skb, 2944666669fc3b83f0d01b08c6b17432563f2eedcbaAlexander Aring void *data, const unsigned int len) 2954666669fc3b83f0d01b08c6b17432563f2eedcbaAlexander Aring{ 2964666669fc3b83f0d01b08c6b17432563f2eedcbaAlexander Aring if (unlikely(!pskb_may_pull(skb, len))) 2974666669fc3b83f0d01b08c6b17432563f2eedcbaAlexander Aring return true; 2984666669fc3b83f0d01b08c6b17432563f2eedcbaAlexander Aring 2994666669fc3b83f0d01b08c6b17432563f2eedcbaAlexander Aring skb_copy_from_linear_data(skb, data, len); 3004666669fc3b83f0d01b08c6b17432563f2eedcbaAlexander Aring skb_pull(skb, len); 3014666669fc3b83f0d01b08c6b17432563f2eedcbaAlexander Aring 3024666669fc3b83f0d01b08c6b17432563f2eedcbaAlexander Aring return false; 3034666669fc3b83f0d01b08c6b17432563f2eedcbaAlexander Aring} 3044666669fc3b83f0d01b08c6b17432563f2eedcbaAlexander Aring 3053109f2e28b0a3216e07d4933d28a8480c6520379Alexander Aringstatic inline void lowpan_push_hc_data(u8 **hc_ptr, const void *data, 3063109f2e28b0a3216e07d4933d28a8480c6520379Alexander Aring const size_t len) 3073109f2e28b0a3216e07d4933d28a8480c6520379Alexander Aring{ 3083109f2e28b0a3216e07d4933d28a8480c6520379Alexander Aring memcpy(*hc_ptr, data, len); 3093109f2e28b0a3216e07d4933d28a8480c6520379Alexander Aring *hc_ptr += len; 3103109f2e28b0a3216e07d4933d28a8480c6520379Alexander Aring} 3113109f2e28b0a3216e07d4933d28a8480c6520379Alexander Aring 312349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aringstatic inline u8 lowpan_addr_mode_size(const u8 addr_mode) 313349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring{ 314349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring static const u8 addr_sizes[] = { 315349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring [LOWPAN_IPHC_ADDR_00] = 16, 316349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring [LOWPAN_IPHC_ADDR_01] = 8, 317349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring [LOWPAN_IPHC_ADDR_02] = 2, 318349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring [LOWPAN_IPHC_ADDR_03] = 0, 319349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring }; 320349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring return addr_sizes[addr_mode]; 321349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring} 322349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring 323349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aringstatic inline u8 lowpan_next_hdr_size(const u8 h_enc, u16 *uncomp_header) 324349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring{ 325349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring u8 ret = 1; 326349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring 327349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring if ((h_enc & LOWPAN_NHC_UDP_MASK) == LOWPAN_NHC_UDP_ID) { 328349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring *uncomp_header += sizeof(struct udphdr); 329349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring 330349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring switch (h_enc & LOWPAN_NHC_UDP_CS_P_11) { 331349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring case LOWPAN_NHC_UDP_CS_P_00: 332349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring ret += 4; 333349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring break; 334349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring case LOWPAN_NHC_UDP_CS_P_01: 335349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring case LOWPAN_NHC_UDP_CS_P_10: 336349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring ret += 3; 337349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring break; 338349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring case LOWPAN_NHC_UDP_CS_P_11: 339349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring ret++; 340349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring break; 341349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring default: 342349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring break; 343349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring } 344349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring 345349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring if (!(h_enc & LOWPAN_NHC_UDP_CS_C)) 346349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring ret += 2; 347349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring } 348349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring 349349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring return ret; 350349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring} 351349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring 352349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring/** 353349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring * lowpan_uncompress_size - returns skb->len size with uncompressed header 354349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring * @skb: sk_buff with 6lowpan header inside 355349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring * @datagram_offset: optional to get the datagram_offset value 356349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring * 357349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring * Returns the skb->len with uncompressed header 358349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring */ 359349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aringstatic inline u16 360349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aringlowpan_uncompress_size(const struct sk_buff *skb, u16 *dgram_offset) 361349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring{ 362349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring u16 ret = 2, uncomp_header = sizeof(struct ipv6hdr); 363349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring u8 iphc0, iphc1, h_enc; 364349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring 365349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring iphc0 = skb_network_header(skb)[0]; 366349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring iphc1 = skb_network_header(skb)[1]; 367349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring 368349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring switch ((iphc0 & LOWPAN_IPHC_TF) >> 3) { 369349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring case 0: 370349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring ret += 4; 371349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring break; 372349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring case 1: 373349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring ret += 3; 374349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring break; 375349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring case 2: 376349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring ret++; 377349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring break; 378349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring default: 379349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring break; 380349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring } 381349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring 382349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring if (!(iphc0 & LOWPAN_IPHC_NH_C)) 383349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring ret++; 384349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring 385349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring if (!(iphc0 & 0x03)) 386349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring ret++; 387349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring 388349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring ret += lowpan_addr_mode_size((iphc1 & LOWPAN_IPHC_SAM) >> 389349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring LOWPAN_IPHC_SAM_BIT); 390349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring 391349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring if (iphc1 & LOWPAN_IPHC_M) { 392349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring switch ((iphc1 & LOWPAN_IPHC_DAM_11) >> 393349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring LOWPAN_IPHC_DAM_BIT) { 394349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring case LOWPAN_IPHC_DAM_00: 395349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring ret += 16; 396349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring break; 397349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring case LOWPAN_IPHC_DAM_01: 398349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring ret += 6; 399349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring break; 400349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring case LOWPAN_IPHC_DAM_10: 401349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring ret += 4; 402349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring break; 403349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring case LOWPAN_IPHC_DAM_11: 404349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring ret++; 405349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring break; 406349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring default: 407349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring break; 408349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring } 409349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring } else { 410349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring ret += lowpan_addr_mode_size((iphc1 & LOWPAN_IPHC_DAM_11) >> 411349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring LOWPAN_IPHC_DAM_BIT); 412349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring } 413349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring 414349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring if (iphc0 & LOWPAN_IPHC_NH_C) { 415349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring h_enc = skb_network_header(skb)[ret]; 416349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring ret += lowpan_next_hdr_size(h_enc, &uncomp_header); 417349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring } 418349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring 419349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring if (dgram_offset) 420349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring *dgram_offset = uncomp_header; 421349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring 422349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring return skb->len + uncomp_header - ret; 423349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring} 424349aa7bc29ee2469f94bba97bb1c9c270fffa215Alexander Aring 4258df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanentypedef int (*skb_delivery_cb)(struct sk_buff *skb, struct net_device *dev); 4268df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen 4278df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanenint lowpan_process_data(struct sk_buff *skb, struct net_device *dev, 4288df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen const u8 *saddr, const u8 saddr_type, const u8 saddr_len, 4298df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen const u8 *daddr, const u8 daddr_type, const u8 daddr_len, 4308df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen u8 iphc0, u8 iphc1, skb_delivery_cb skb_deliver); 4318df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanenint lowpan_header_compress(struct sk_buff *skb, struct net_device *dev, 4328df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen unsigned short type, const void *_daddr, 4338df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen const void *_saddr, unsigned int len); 4348df8c56a5abc70af5862aa7cac2875aeeb17a42bJukka Rissanen 43544331fe2aa0d7eed54e68484df58e9e00aee0f6eAlexander Smirnov#endif /* __6LOWPAN_H__ */ 436