PageRenderTime 51ms CodeModel.GetById 18ms RepoModel.GetById 0ms app.codeStats 1ms

/epan/dissectors/packet-ieee802154.c

https://github.com/labx-technologies-llc/wireshark
C | 2806 lines | 1635 code | 326 blank | 845 comment | 300 complexity | d478e8a8a02678e6e8f8e4e714a3f0ec MD5 | raw file
Possible License(s): GPL-2.0, BSD-3-Clause

Large files files are truncated, but you can click here to view the full file

    

  1. /* packet-ieee802154.c
    2. 

  2.  *
    3. 

  3.  * $Id$
    4. 

  4.  *
    5. 

  5.  * Auxiliary Security Header support and
    6. 

  6.  * option to force TI CC24xx FCS format
    7. 

  7.  * By Jean-Francois Wauthy <jfw@info.fundp.ac.be>
    8. 

  8.  * Copyright 2009 The University of Namur, Belgium
    9. 

  9.  *
    10. 

  10.  * IEEE 802.15.4 Dissectors for Wireshark
    11. 

  11.  * By Owen Kirby <osk@exegin.com>
    12. 

  12.  * Copyright 2007 Exegin Technologies Limited
    13. 

  13.  *
    14. 

  14.  * Wireshark - Network traffic analyzer
    15. 

  15.  * By Gerald Combs <gerald@wireshark.org>
    16. 

  16.  * Copyright 1998 Gerald Combs
    17. 

  17.  *
    18. 

  18.  * This program is free software; you can redistribute it and/or
    19. 

  19.  * modify it under the terms of the GNU General Public License
    20. 

  20.  * as published by the Free Software Foundation; either version 2
    21. 

  21.  * of the License, or (at your option) any later version.
    22. 

  22.  *
    23. 

  23.  * This program is distributed in the hope that it will be useful,
    24. 

  24.  * but WITHOUT ANY WARRANTY; without even the implied warranty of
    25. 

  25.  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    26. 

  26.  * GNU General Public License for more details.
    27. 

  27.  *
    28. 

  28.  * You should have received a copy of the GNU General Public License
    29. 

  29.  * along with this program; if not, write to the Free Software
    30. 

  30.  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
    31. 

  31.  *------------------------------------------------------------
    32. 

  32.  *
    33. 

  33.  *  In IEEE 802.15.4 packets, all fields are little endian. And
    34. 

  34.  *  Each byte is transmitted least significant bit first (reflected
    35. 

  35.  *  bit ordering).
    36. 

  36.  *------------------------------------------------------------
    37. 

  37.  *
    38. 

  38.  *  IEEE 802.15.4 Packets have the following format:
    39. 

  39.  *  |  FCF  |Seq No|  Addressing |         Data          |  FCS  |
    40. 

  40.  *  |2 bytes|1 byte|0 to 20 bytes|Length-(Overhead) bytes|2 Bytes|
    41. 

  41.  *------------------------------------------------------------
    42. 

  42.  *
    43. 

  43.  *  CRC16 is calculated using the x^16 + x^12 + x^5 + 1 polynomial
    44. 

  44.  *  as specified by ITU-T, and is calculated over the IEEE 802.15.4
    45. 

  45.  *  packet (excluding the FCS) as transmitted over the air. Note,
    46. 

  46.  *  that because the least significan bits are transmitted first, this
    47. 

  47.  *  will require reversing the bit-order in each byte. Also, unlike
    48. 

  48.  *  most CRC algorithms, IEEE 802.15.4 uses an initial and final value
    49. 

  49.  *  of 0x0000, instead of 0xffff (which is used by the CCITT).
    50. 

  50.  *------------------------------------------------------------
    51. 

  51.  *
    52. 

  52.  *  This dissector supports both link-layer IEEE 802.15.4 captures
    53. 

  53.  *  and IEEE 802.15.4 packets encapsulated within other layers.
    54. 

  54.  *  Additionally, support has been provided for various formats
    55. 

  55.  *  of the frame check sequence:
    56. 

  56.  *      - IEEE 802.15.4 compliant FCS.
    57. 

  57.  *      - ChipCon/Texas Instruments CC24xx style FCS.
    58. 

  58.  *------------------------------------------------------------
    59. 

  59.  */
    60. 

  60. 

  61. /*  Include files */
    62. 

  62. #include "config.h"
    63. 

  63. 

  64. #include <string.h>
    65. 

  65. 

  66. #include <sys/stat.h>
    67. 

  67. 

  68. #include <glib.h>
    69. 

  69. 

  70. #include <epan/wmem/wmem.h>
    71. 

  71. #include <epan/packet.h>
    72. 

  72. #include <epan/crc16-tvb.h>
    73. 

  73. #include <epan/expert.h>
    74. 

  74. #include <epan/addr_resolv.h>
    75. 

  75. #include <epan/prefs.h>
    76. 

  76. #include <epan/uat.h>
    77. 

  77. #include <epan/strutil.h>
    78. 

  78. #include <epan/show_exception.h>
    79. 

  79. 

  80. /* Use libgcrypt for cipher libraries. */
    81. 

  81. #ifdef HAVE_LIBGCRYPT
    82. 

  82. #include <wsutil/wsgcrypt.h>
    83. 

  83. #endif /* HAVE_LIBGCRYPT */
    84. 

  84. 

  85. #include "packet-ieee802154.h"
    86. 

  86. #include "packet-sll.h"
    87. 

  87. 

  88. /* Dissection Options for dissect_ieee802154_common */
    89. 

  89. #define DISSECT_IEEE802154_OPTION_CC24xx    0x00000001  /* FCS field contains a TI CC24xx style FCS. */
    90. 

  90. #define DISSECT_IEEE802154_OPTION_LINUX     0x00000002  /* Addressing fields are padded DLT_IEEE802_15_4_LINUX, not implemented. */
    91. 

  91. 

  92. /* ethertype for 802.15.4 tag - encapsulating an Ethernet packet */
    93. 

  93. static unsigned int ieee802154_ethertype = 0x809A;
    94. 

  94. 

  95. /* boolean value set if the FCS field is using the TI CC24xx format */
    96. 

  96. static gboolean ieee802154_cc24xx = FALSE;
    97. 

  97. 

  98. /* boolean value set if the FCS must be ok before payload is dissected */
    99. 

  99. static gboolean ieee802154_fcs_ok = TRUE;
    100. 

  100. 

  101. /* User string with the decryption key. */
    102. 

  102. static const gchar *ieee802154_key_str = NULL;
    103. 

  103. static gboolean     ieee802154_key_valid;
    104. 

  104. static guint8       ieee802154_key[IEEE802154_CIPHER_SIZE];
    105. 

  105. static const char  *ieee802154_user    = "User";
    106. 

  106. 

  107. /*-------------------------------------
    108. 

  108.  * Address Hash Tables
    109. 

  109.  *-------------------------------------
    110. 

  110.  */
    111. 

  111. static ieee802154_map_tab_t ieee802154_map = { NULL, NULL };
    112. 

  112. 

  113. /*-------------------------------------
    114. 

  114.  * Static Address Mapping UAT
    115. 

  115.  *-------------------------------------
    116. 

  116.  */
    117. 

  117. /* UAT entry structure. */
    118. 

  118. typedef struct {
    119. 

  119.     guchar *eui64;
    120. 

  120.     guint   eui64_len;
    121. 

  121.     guint   addr16;
    122. 

  122.     guint   pan;
    123. 

  123. } static_addr_t;
    124. 

  124. 

  125. /* UAT variables */
    126. 

  126. static uat_t         *static_addr_uat  = NULL;
    127. 

  127. static static_addr_t *static_addrs     = NULL;
    128. 

  128. static guint          num_static_addrs = 0;
    129. 

  129. 

  130. /* Sanity-checks a UAT record. */
    131. 

  131. static void
    132. 

  132. addr_uat_update_cb(void *r, const char **err)
    133. 

  133. {
    134. 

  134.     static_addr_t *map = (static_addr_t *)r;
    135. 

  135.     /* Ensure a valid short address */
    136. 

  136.     if (map->addr16 >= IEEE802154_NO_ADDR16) {
    137. 

  137.         *err = "Invalid short address";
    138. 

  138.     }
    139. 

  139.     /* Ensure a valid PAN identifier. */
    140. 

  140.     if (map->pan >= IEEE802154_BCAST_PAN) {
    141. 

  141.         *err = "Invalid PAN identifier";
    142. 

  142.     }
    143. 

  143.     /* Ensure a valid EUI-64 length */
    144. 

  144.     if (map->eui64_len != sizeof(guint64)) {
    145. 

  145.         *err = "Invalid EUI-64 length";
    146. 

  146.     }
    147. 

  147. } /* ieee802154_addr_uat_update_cb */
    148. 

  148. 

  149. /* Field callbacks. */
    150. 

  150. UAT_HEX_CB_DEF(addr_uat, addr16, static_addr_t)
    151. 

  151. UAT_HEX_CB_DEF(addr_uat, pan, static_addr_t)
    152. 

  152. UAT_BUFFER_CB_DEF(addr_uat, eui64, static_addr_t, eui64, eui64_len)
    153. 

  153. 

  154. /*-------------------------------------
    155. 

  155.  * Dissector Function Prototypes
    156. 

  156.  *-------------------------------------
    157. 

  157.  */
    158. 

  158. /* Register Functions. Loads the dissector into Wireshark. */
    159. 

  159. void proto_reg_handoff_ieee802154   (void);
    160. 

  160. 

  161. /* Dissection Routines. */
    162. 

  162. static void dissect_ieee802154_nonask_phy   (tvbuff_t *, packet_info *, proto_tree *);
    163. 

  163. static void dissect_ieee802154              (tvbuff_t *, packet_info *, proto_tree *);
    164. 

  164. static void dissect_ieee802154_nofcs        (tvbuff_t *, packet_info *, proto_tree *);
    165. 

  165. static void dissect_ieee802154_cc24xx       (tvbuff_t *, packet_info *, proto_tree *);
    166. 

  166. /*static void dissect_ieee802154_linux        (tvbuff_t *, packet_info *, proto_tree *);  TODO: Implement Me. */
    167. 

  167. static void dissect_ieee802154_common       (tvbuff_t *, packet_info *, proto_tree *, guint);
    168. 

  168. 

  169. /* Sub-dissector helpers. */
    170. 

  170. static void dissect_ieee802154_fcf          (tvbuff_t *, packet_info *, proto_tree *, ieee802154_packet *, guint *);
    171. 

  171. static void dissect_ieee802154_superframe   (tvbuff_t *, packet_info *, proto_tree *, guint *);
    172. 

  172. static void dissect_ieee802154_gtsinfo      (tvbuff_t *, packet_info *, proto_tree *, guint *);
    173. 

  173. static void dissect_ieee802154_pendaddr     (tvbuff_t *, packet_info *, proto_tree *, guint *);
    174. 

  174. static void dissect_ieee802154_assoc_req    (tvbuff_t *, packet_info *, proto_tree *, ieee802154_packet *);
    175. 

  175. static void dissect_ieee802154_assoc_rsp    (tvbuff_t *, packet_info *, proto_tree *, ieee802154_packet *);
    176. 

  176. static void dissect_ieee802154_disassoc     (tvbuff_t *, packet_info *, proto_tree *, ieee802154_packet *);
    177. 

  177. static void dissect_ieee802154_realign      (tvbuff_t *, packet_info *, proto_tree *, ieee802154_packet *);
    178. 

  178. static void dissect_ieee802154_gtsreq       (tvbuff_t *, packet_info *, proto_tree *, ieee802154_packet *);
    179. 

  179. 

  180. /* Decryption helpers. */
    181. 

  181. typedef enum {
    182. 

  182.     DECRYPT_PACKET_SUCCEEDED,
    183. 

  183.     DECRYPT_NOT_ENCRYPTED,
    184. 

  184.     DECRYPT_VERSION_UNSUPPORTED,
    185. 

  185.     DECRYPT_PACKET_TOO_SMALL,
    186. 

  186.     DECRYPT_PACKET_NO_EXT_SRC_ADDR,
    187. 

  187.     DECRYPT_PACKET_NO_KEY,
    188. 

  188.     DECRYPT_PACKET_DECRYPT_FAILED,
    189. 

  189.     DECRYPT_PACKET_MIC_CHECK_FAILED
    190. 

  190. } ws_decrypt_status;
    191. 

  191. 

  192. static tvbuff_t * dissect_ieee802154_decrypt(tvbuff_t *, guint, packet_info *, ieee802154_packet *,
    193. 

  193.         ws_decrypt_status *);
    194. 

  194. static void ccm_init_block          (gchar *, gboolean, gint, guint64, ieee802154_packet *, gint);
    195. 

  195. static gboolean ccm_ctr_encrypt     (const gchar *, const gchar *, gchar *, gchar *, gint);
    196. 

  196. static gboolean ccm_cbc_mac         (const gchar *, const gchar *, const gchar *, gint, const gchar *, gint, gchar *);
    197. 

  197. 

  198. /*  Initialize Protocol and Registered fields */
    199. 

  199. static int proto_ieee802154_nonask_phy = -1;
    200. 

  200. static int hf_ieee802154_nonask_phy_preamble = -1;
    201. 

  201. static int hf_ieee802154_nonask_phy_sfd = -1;
    202. 

  202. static int hf_ieee802154_nonask_phy_length = -1;
    203. 

  203. 

  204. static int proto_ieee802154 = -1;
    205. 

  205. static int hf_ieee802154_frame_length = -1;
    206. 

  206. static int hf_ieee802154_frame_type = -1;
    207. 

  207. static int hf_ieee802154_security = -1;
    208. 

  208. static int hf_ieee802154_pending = -1;
    209. 

  209. static int hf_ieee802154_ack_request = -1;
    210. 

  210. static int hf_ieee802154_intra_pan = -1;
    211. 

  211. static int hf_ieee802154_seqno = -1;
    212. 

  212. static int hf_ieee802154_src_addr_mode = -1;
    213. 

  213. static int hf_ieee802154_dst_addr_mode = -1;
    214. 

  214. static int hf_ieee802154_version = -1;
    215. 

  215. static int hf_ieee802154_dst_panID = -1;
    216. 

  216. static int hf_ieee802154_dst16 = -1;
    217. 

  217. static int hf_ieee802154_dst64 = -1;
    218. 

  218. static int hf_ieee802154_src_panID = -1;
    219. 

  219. static int hf_ieee802154_src16 = -1;
    220. 

  220. static int hf_ieee802154_src64 = -1;
    221. 

  221. static int hf_ieee802154_src64_origin = -1;
    222. 

  222. static int hf_ieee802154_fcs = -1;
    223. 

  223. static int hf_ieee802154_rssi = -1;
    224. 

  224. static int hf_ieee802154_fcs_ok = -1;
    225. 

  225. static int hf_ieee802154_correlation = -1;
    226. 

  226. 

  227. /*  Registered fields for Command Packets */
    228. 

  228. static int hf_ieee802154_cmd_id = -1;
    229. 

  229. static int hf_ieee802154_cinfo_alt_coord = -1;
    230. 

  230. static int hf_ieee802154_cinfo_device_type = -1;
    231. 

  231. static int hf_ieee802154_cinfo_power_src = -1;
    232. 

  232. static int hf_ieee802154_cinfo_idle_rx = -1;
    233. 

  233. static int hf_ieee802154_cinfo_sec_capable = -1;
    234. 

  234. static int hf_ieee802154_cinfo_alloc_addr = -1;
    235. 

  235. static int hf_ieee802154_assoc_addr = -1;
    236. 

  236. static int hf_ieee802154_assoc_status = -1;
    237. 

  237. static int hf_ieee802154_disassoc_reason = -1;
    238. 

  238. static int hf_ieee802154_realign_pan = -1;
    239. 

  239. static int hf_ieee802154_realign_caddr = -1;
    240. 

  240. static int hf_ieee802154_realign_channel = -1;
    241. 

  241. static int hf_ieee802154_realign_addr = -1;
    242. 

  242. static int hf_ieee802154_realign_channel_page = -1;
    243. 

  243. static int hf_ieee802154_gtsreq_len = -1;
    244. 

  244. static int hf_ieee802154_gtsreq_dir = -1;
    245. 

  245. static int hf_ieee802154_gtsreq_type = -1;
    246. 

  246. 

  247. /*  Registered fields for Beacon Packets */
    248. 

  248. static int hf_ieee802154_beacon_order = -1;
    249. 

  249. static int hf_ieee802154_superframe_order = -1;
    250. 

  250. static int hf_ieee802154_cap = -1;
    251. 

  251. static int hf_ieee802154_superframe_battery_ext = -1;
    252. 

  252. static int hf_ieee802154_superframe_coord = -1;
    253. 

  253. static int hf_ieee802154_assoc_permit = -1;
    254. 

  254. static int hf_ieee802154_gts_count = -1;
    255. 

  255. static int hf_ieee802154_gts_permit = -1;
    256. 

  256. static int hf_ieee802154_gts_direction = -1;
    257. 

  257. static int hf_ieee802154_pending16 = -1;
    258. 

  258. static int hf_ieee802154_pending64 = -1;
    259. 

  259. 

  260. /*  Registered fields for Auxiliary Security Header */
    261. 

  261. static int hf_ieee802154_security_level = -1;
    262. 

  262. static int hf_ieee802154_key_id_mode = -1;
    263. 

  263. static int hf_ieee802154_aux_sec_reserved = -1;
    264. 

  264. static int hf_ieee802154_aux_sec_frame_counter = -1;
    265. 

  265. static int hf_ieee802154_aux_sec_key_source = -1;
    266. 

  266. static int hf_ieee802154_aux_sec_key_index = -1;
    267. 

  267. 

  268. /* 802.15.4-2003 security */
    269. 

  269. static int hf_ieee802154_sec_frame_counter = -1;
    270. 

  270. static int hf_ieee802154_sec_key_sequence_counter = -1;
    271. 

  271. 

  272. /*  Initialize Subtree Pointers */
    273. 

  273. static gint ett_ieee802154_nonask_phy = -1;
    274. 

  274. static gint ett_ieee802154_nonask_phy_phr = -1;
    275. 

  275. static gint ett_ieee802154 = -1;
    276. 

  276. static gint ett_ieee802154_fcf = -1;
    277. 

  277. static gint ett_ieee802154_auxiliary_security = -1;
    278. 

  278. static gint ett_ieee802154_aux_sec_control = -1;
    279. 

  279. static gint ett_ieee802154_aux_sec_key_id = -1;
    280. 

  280. static gint ett_ieee802154_fcs = -1;
    281. 

  281. static gint ett_ieee802154_cmd = -1;
    282. 

  282. static gint ett_ieee802154_superframe = -1;
    283. 

  283. static gint ett_ieee802154_gts = -1;
    284. 

  284. static gint ett_ieee802154_gts_direction = -1;
    285. 

  285. static gint ett_ieee802154_gts_descriptors = -1;
    286. 

  286. static gint ett_ieee802154_pendaddr = -1;
    287. 

  287. 

  288. /*  Dissector handles */
    289. 

  289. static dissector_handle_t       data_handle;
    290. 

  290. static heur_dissector_list_t    ieee802154_heur_subdissector_list;
    291. 

  291. 

  292. /* Name Strings */
    293. 

  293. static const value_string ieee802154_frame_types[] = {
    294. 

  294.     { IEEE802154_FCF_BEACON,    "Beacon" },
    295. 

  295.     { IEEE802154_FCF_DATA,      "Data" },
    296. 

  296.     { IEEE802154_FCF_ACK,       "Ack" },
    297. 

  297.     { IEEE802154_FCF_CMD,       "Command" },
    298. 

  298.     { 0, NULL }
    299. 

  299. };
    300. 

  300. 

  301. static const value_string ieee802154_addr_modes[] = {
    302. 

  302.     { IEEE802154_FCF_ADDR_NONE, "None" },
    303. 

  303.     { IEEE802154_FCF_ADDR_SHORT,"Short/16-bit" },
    304. 

  304.     { IEEE802154_FCF_ADDR_EXT,  "Long/64-bit" },
    305. 

  305.     { 0, NULL }
    306. 

  306. };
    307. 

  307. 

  308. static const value_string ieee802154_cmd_names[] = {
    309. 

  309.     { IEEE802154_CMD_ASRQ,      "Association Request" },
    310. 

  310.     { IEEE802154_CMD_ASRSP,     "Association Response" },
    311. 

  311.     { IEEE802154_CMD_DISAS,     "Disassociation Notification" },
    312. 

  312.     { IEEE802154_CMD_DATA_RQ,   "Data Request" },
    313. 

  313.     { IEEE802154_CMD_PANID_ERR, "PAN ID Conflict" },
    314. 

  314.     { IEEE802154_CMD_ORPH_NOTIF,"Orphan Notification" },
    315. 

  315.     { IEEE802154_CMD_BCN_RQ,    "Beacon Request" },
    316. 

  316.     { IEEE802154_CMD_COORD_REAL,"Coordinator Realignment" },
    317. 

  317.     { IEEE802154_CMD_GTS_REQ,   "GTS Request" },
    318. 

  318.     { 0, NULL }
    319. 

  319. };
    320. 

  320. 

  321. static const value_string ieee802154_sec_level_names[] = {
    322. 

  322.     { SECURITY_LEVEL_NONE,        "No Security" },
    323. 

  323.     { SECURITY_LEVEL_MIC_32,      "32-bit Message Integrity Code" },
    324. 

  324.     { SECURITY_LEVEL_MIC_64,      "64-bit Message Integrity Code" },
    325. 

  325.     { SECURITY_LEVEL_MIC_128,     "128-bit Message Integrity Code" },
    326. 

  326.     { SECURITY_LEVEL_ENC,         "Encryption" },
    327. 

  327.     { SECURITY_LEVEL_ENC_MIC_32,  "Encryption with 32-bit Message Integrity Code" },
    328. 

  328.     { SECURITY_LEVEL_ENC_MIC_64,  "Encryption with 64-bit Message Integrity Code" },
    329. 

  329.     { SECURITY_LEVEL_ENC_MIC_128, "Encryption with 128-bit Message Integrity Code" },
    330. 

  330.     { 0, NULL }
    331. 

  331. };
    332. 

  332. 

  333. static const value_string ieee802154_key_id_mode_names[] = {
    334. 

  334.     { KEY_ID_MODE_IMPLICIT,       "Implicit Key" },
    335. 

  335.     { KEY_ID_MODE_KEY_INDEX,      "Indexed Key using the Default Key Source" },
    336. 

  336.     { KEY_ID_MODE_KEY_EXPLICIT_4, "Explicit Key with 4-octet Key Source" },
    337. 

  337.     { KEY_ID_MODE_KEY_EXPLICIT_8, "Explicit Key with 8-octet Key Source" },
    338. 

  338.     { 0, NULL }
    339. 

  339. };
    340. 

  340. 

  341. static const true_false_string ieee802154_gts_direction_tfs = {
    342. 

  342.     "Receive Only",
    343. 

  343.     "Transmit Only"
    344. 

  344. };
    345. 

  345. 

  346. /* The 802.15.4-2003 security suites for the security preferences (only AES-CCM suites are supported). */
    347. 

  347. /* NOTE: The equivalent 2006 security level identifer enumerations are used to simplify 2003 & 2006 integration! */
    348. 

  348. static const enum_val_t ieee802154_2003_sec_suite_enums[] = {
    349. 

  349.     { "AES-CCM-128", "AES-128 Encryption, 128-bit Integrity Protection", SECURITY_LEVEL_ENC_MIC_128 },
    350. 

  350.     { "AES-CCM-64",  "AES-128 Encryption, 64-bit Integrity Protection",  SECURITY_LEVEL_ENC_MIC_64 },
    351. 

  351.     { "AES-CCM-32",  "AES-128 Encryption, 32-bit Integrity Protection",  SECURITY_LEVEL_ENC_MIC_32 },
    352. 

  352.     { NULL, NULL, 0 }
    353. 

  353. };
    354. 

  354. 

  355. /* Preferences for 2003 security */
    356. 

  356. static gint ieee802154_sec_suite = SECURITY_LEVEL_ENC_MIC_64;
    357. 

  357. static gboolean ieee802154_extend_auth = TRUE;
    358. 

  358. 

  359. /* Macro to check addressing, and throw a warning flag if incorrect. */
    360. 

  360. #define IEEE802154_CMD_ADDR_CHECK(_pinfo_, _item_, _cmdid_, _x_)    \
    361. 

  361.    if (!(_x_))                                                      \
    362. 

  362.      expert_add_info_format(_pinfo_, _item_, PI_MALFORMED, PI_WARN, \
    363. 

  363.                             "Invalid Addressing for %s",            \
    364. 

  364.                             val_to_str_const(_cmdid_, ieee802154_cmd_names, "Unknown Command"))
    365. 

  365. 

  366. /* CRC definitions. IEEE 802.15.4 CRCs vary from CCITT by using an initial value of
    367. 

  367.  * 0x0000, and no XOR out. IEEE802154_CRC_XOR is defined as 0xFFFF in order to un-XOR
    368. 

  368.  * the output from the CCITT CRC routines in Wireshark.
    369. 

  369.  */
    370. 

  370. #define IEEE802154_CRC_SEED     0x0000
    371. 

  371. #define IEEE802154_CRC_XOROUT   0xFFFF
    372. 

  372. #define ieee802154_crc_tvb(tvb, offset)   (crc16_ccitt_tvb_seed(tvb, offset, IEEE802154_CRC_SEED) ^ IEEE802154_CRC_XOROUT)
    373. 

  373. 

  374. 

  375. /*FUNCTION:------------------------------------------------------
    376. 

  376.  *  NAME
    377. 

  377.  *      dissect_ieee802154_fcf
    378. 

  378.  *  DESCRIPTION
    379. 

  379.  *      Dissector helper, parses and displays the frame control
    380. 

  380.  *      field.
    381. 

  381.  *
    382. 

  382.  *  PARAMETERS
    383. 

  383.  *      ieee802154_packet   *packet - Packet info structure.
    384. 

  384.  *      tvbuff_t    *tvb    - pointer to buffer containing raw packet.
    385. 

  385.  *      packet_info *pinfo  - pointer to packet information fields
    386. 

  386.  *      proto_tree  *tree   - pointer to data tree wireshark uses to display packet.
    387. 

  387.  *      ieee802154_packet *packet   - IEEE 802.15.4 packet information.
    388. 

  388.  *      guint       offset  - offset into the tvb to find the FCF.
    389. 

  389.  *  RETURNS
    390. 

  390.  *      void
    391. 

  391.  *---------------------------------------------------------------
    392. 

  392.  */
    393. 

  393. static void
    394. 

  394. dissect_ieee802154_fcf(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, ieee802154_packet *packet, guint *offset)
    395. 

  395. {
    396. 

  396.     guint16     fcf;
    397. 

  397.     proto_tree *field_tree;
    398. 

  398.     proto_item *ti;
    399. 

  399. 

  400.     /* Get the FCF field. */
    401. 

  401.     fcf = tvb_get_letohs(tvb, *offset);
    402. 

  402. 

  403.      /* Parse FCF Flags. */
    404. 

  404.     packet->frame_type      = fcf & IEEE802154_FCF_TYPE_MASK;
    405. 

  405.     packet->security_enable = fcf & IEEE802154_FCF_SEC_EN;
    406. 

  406.     packet->frame_pending   = fcf & IEEE802154_FCF_FRAME_PND;
    407. 

  407.     packet->ack_request     = fcf & IEEE802154_FCF_ACK_REQ;
    408. 

  408.     packet->intra_pan       = fcf & IEEE802154_FCF_INTRA_PAN;
    409. 

  409.     packet->version         = (fcf & IEEE802154_FCF_VERSION) >> 12;
    410. 

  410.     packet->dst_addr_mode   = (fcf & IEEE802154_FCF_DADDR_MASK) >> 10;
    411. 

  411.     packet->src_addr_mode   = (fcf & IEEE802154_FCF_SADDR_MASK) >> 14;
    412. 

  412. 

  413.     /* Display the frame type. */
    414. 

  414.     proto_item_append_text(tree, " %s", val_to_str_const(packet->frame_type, ieee802154_frame_types, "Reserved"));
    415. 

  415.     col_set_str(pinfo->cinfo, COL_INFO, val_to_str_const(packet->frame_type, ieee802154_frame_types, "Reserved"));
    416. 

  416. 

  417.     /* Add the FCF to the protocol tree. */
    418. 

  418.     if (tree) {
    419. 

  419.         /*  Create the FCF subtree. */
    420. 

  420.         ti = proto_tree_add_text(tree, tvb, *offset, 2, "Frame Control Field: %s (0x%04x)",
    421. 

  421.                 val_to_str_const(packet->frame_type, ieee802154_frame_types, "Unknown"), fcf);
    422. 

  422.         field_tree = proto_item_add_subtree(ti, ett_ieee802154_fcf);
    423. 

  423. 

  424.         /* FCF Fields. */
    425. 

  425.         proto_tree_add_uint(field_tree, hf_ieee802154_frame_type, tvb, *offset, 1, fcf & IEEE802154_FCF_TYPE_MASK);
    426. 

  426.         proto_tree_add_boolean(field_tree, hf_ieee802154_security, tvb, *offset, 1, fcf & IEEE802154_FCF_SEC_EN);
    427. 

  427.         proto_tree_add_boolean(field_tree, hf_ieee802154_pending, tvb, *offset, 1, fcf & IEEE802154_FCF_FRAME_PND);
    428. 

  428.         proto_tree_add_boolean(field_tree, hf_ieee802154_ack_request, tvb, *offset, 1, fcf & IEEE802154_FCF_ACK_REQ);
    429. 

  429.         proto_tree_add_boolean(field_tree, hf_ieee802154_intra_pan, tvb, *offset, 1, fcf & IEEE802154_FCF_INTRA_PAN);
    430. 

  430.         proto_tree_add_uint(field_tree, hf_ieee802154_dst_addr_mode, tvb, (*offset)+1, 1, fcf & IEEE802154_FCF_DADDR_MASK);
    431. 

  431.         proto_tree_add_uint(field_tree, hf_ieee802154_version, tvb, (*offset)+1, 1, fcf & IEEE802154_FCF_VERSION);
    432. 

  432.         proto_tree_add_uint(field_tree, hf_ieee802154_src_addr_mode, tvb, (*offset)+1, 1, fcf & IEEE802154_FCF_SADDR_MASK);
    433. 

  433.     }
    434. 

  434. 

  435.     *offset += 2;
    436. 

  436. } /* dissect_ieee802154_fcf */
    437. 

  437. 

  438. /*FUNCTION:------------------------------------------------------
    439. 

  439.  *  NAME
    440. 

  440.  *      dissect_ieee802154_nonask_phy
    441. 

  441.  *  DESCRIPTION
    442. 

  442.  *      Dissector for IEEE 802.15.4 non-ASK PHY packet with an FCS containing
    443. 

  443.  *      a 16-bit CRC value.
    444. 

  444.  *
    445. 

  445.  *  PARAMETERS
    446. 

  446.  *      tvbuff_t *tvb       - pointer to buffer containing raw packet.
    447. 

  447.  *      packet_info *pinfo  - pointer to packet information fields
    448. 

  448.  *      proto_tree *tree    - pointer to data tree wireshark uses to display packet.
    449. 

  449.  *  RETURNS
    450. 

  450.  *      void
    451. 

  451.  *---------------------------------------------------------------
    452. 

  452.  */
    453. 

  453. static void
    454. 

  454. dissect_ieee802154_nonask_phy(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree)
    455. 

  455. {
    456. 

  456.     proto_tree *ieee802154_tree = NULL;
    457. 

  457.     proto_item *proto_root      = NULL;
    458. 

  458. 

  459.     guint       offset          = 0;
    460. 

  460.     guint32     preamble;
    461. 

  461.     guint8      sfd,phr;
    462. 

  462.     tvbuff_t*   mac;
    463. 

  463. 

  464.     /* Create the protocol tree. */
    465. 

  465.     if (tree) {
    466. 

  466.         proto_root = proto_tree_add_protocol_format(tree, proto_ieee802154_nonask_phy, tvb, 0, tvb_length(tvb), "IEEE 802.15.4 non-ASK PHY");
    467. 

  467.         ieee802154_tree = proto_item_add_subtree(proto_root, ett_ieee802154_nonask_phy);
    468. 

  468.     }
    469. 

  469. 

  470.     /* Add the protocol name. */
    471. 

  471.     col_set_str(pinfo->cinfo, COL_PROTOCOL, "IEEE 802.15.4 non-ASK PHY");
    472. 

  472.     /* Add the packet length. */
    473. 

  473.     col_clear(pinfo->cinfo, COL_PACKET_LENGTH);
    474. 

  474.     col_add_fstr(pinfo->cinfo, COL_PACKET_LENGTH, "%i", tvb_length(tvb));
    475. 

  475. 

  476.     preamble=tvb_get_letohl(tvb,offset);
    477. 

  477.     sfd=tvb_get_guint8(tvb,offset+4);
    478. 

  478.     phr=tvb_get_guint8(tvb,offset+4+1);
    479. 

  479. 

  480.     if(tree) {
    481. 

  481.         proto_tree *phr_tree;
    482. 

  482.         proto_item *pi;
    483. 

  483.         guint loffset=offset;
    484. 

  484. 

  485.         proto_tree_add_uint(ieee802154_tree, hf_ieee802154_nonask_phy_preamble, tvb, loffset, 4, preamble);
    486. 

  486.         loffset+=4;
    487. 

  487.         proto_tree_add_uint(ieee802154_tree, hf_ieee802154_nonask_phy_sfd, tvb, loffset, 1, sfd);
    488. 

  488.         loffset+=1;
    489. 

  489. 

  490.         pi = proto_tree_add_text(ieee802154_tree, tvb, loffset, 1, "PHR: 0x%02x", phr);
    491. 

  491.         phr_tree = proto_item_add_subtree(pi, ett_ieee802154_nonask_phy_phr);
    492. 

  492. 

  493.         proto_tree_add_uint(phr_tree, hf_ieee802154_nonask_phy_length, tvb, loffset, 1, phr);
    494. 

  494.     }
    495. 

  495. 

  496.     offset+=4+2*1;
    497. 

  497.     mac=tvb_new_subset(tvb,offset,-1, phr & IEEE802154_PHY_LENGTH_MASK);
    498. 

  498. 

  499.     /* Call the common dissector. */
    500. 

  500.     dissect_ieee802154(mac, pinfo, ieee802154_tree);
    501. 

  501. } /* dissect_ieee802154_nonask_phy */
    502. 

  502. 

  503. /*FUNCTION:------------------------------------------------------
    504. 

  504.  *  NAME
    505. 

  505.  *      dissect_ieee802154
    506. 

  506.  *  DESCRIPTION
    507. 

  507.  *      Dissector for IEEE 802.15.4 packet with an FCS containing
    508. 

  508.  *      a 16-bit CRC value.
    509. 

  509.  *
    510. 

  510.  *  PARAMETERS
    511. 

  511.  *      tvbuff_t *tvb       - pointer to buffer containing raw packet.
    512. 

  512.  *      packet_info *pinfo  - pointer to packet information fields
    513. 

  513.  *      proto_tree *tree    - pointer to data tree wireshark uses to display packet.
    514. 

  514.  *  RETURNS
    515. 

  515.  *      void
    516. 

  516.  *---------------------------------------------------------------
    517. 

  517.  */
    518. 

  518. static void
    519. 

  519. dissect_ieee802154(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree)
    520. 

  520. {
    521. 

  521.     /* Call the common dissector. */
    522. 

  522.     dissect_ieee802154_common(tvb, pinfo, tree, (ieee802154_cc24xx ? DISSECT_IEEE802154_OPTION_CC24xx : 0));
    523. 

  523. } /* dissect_ieee802154 */
    524. 

  524. 

  525. /*FUNCTION:------------------------------------------------------
    526. 

  526.  *  NAME
    527. 

  527.  *      dissect_ieee802154_nofcs
    528. 

  528.  *  DESCRIPTION
    529. 

  529.  *      Dissector for IEEE 802.15.4 packet with no FCS present.
    530. 

  530.  *
    531. 

  531.  *  PARAMETERS
    532. 

  532.  *      tvbuff_t *tvb       - pointer to buffer containing raw packet.
    533. 

  533.  *      packet_info *pinfo  - pointer to packet information fields
    534. 

  534.  *      proto_tree *tree    - pointer to data tree wireshark uses to display packet.
    535. 

  535.  *  RETURNS
    536. 

  536.  *      void
    537. 

  537.  *---------------------------------------------------------------
    538. 

  538.  */
    539. 

  539. static void
    540. 

  540. dissect_ieee802154_nofcs(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree)
    541. 

  541. {
    542. 

  542.     tvbuff_t    *new_tvb;
    543. 

  543.     /* If there is no FCS present in the reported packet, then the length of
    544. 

  544.      * the true IEEE 802.15.4 packet is actually 2 bytes longer. Re-create
    545. 

  545.      * the buffer with an extended reported length so that the packet will
    546. 

  546.      * be handled as though the FCS were truncated.
    547. 

  547.      *
    548. 

  548.      * Note, we can't just call tvb_set_reported_length(), because it includes
    549. 

  549.      * checks to ensure that the new reported length is not longer than the old
    550. 

  550.      * reported length (why?), and will throw an exception.
    551. 

  551.      */
    552. 

  552.     new_tvb = tvb_new_subset(tvb, 0, -1, tvb_reported_length(tvb)+IEEE802154_FCS_LEN);
    553. 

  553.     /* Call the common dissector. */
    554. 

  554.     dissect_ieee802154_common(new_tvb, pinfo, tree, 0);
    555. 

  555. } /* dissect_ieee802154_nofcs */
    556. 

  556. 

  557. /*FUNCTION:------------------------------------------------------
    558. 

  558.  *  NAME
    559. 

  559.  *      dissect_ieee802154_cc24xx
    560. 

  560.  *  DESCRIPTION
    561. 

  561.  *      Dissector for IEEE 802.15.4 packet with a ChipCon/Texas
    562. 

  562.  *      Instruments compatible FCS. This is typically called by
    563. 

  563.  *      layers encapsulating an IEEE 802.15.4 packet.
    564. 

  564.  *
    565. 

  565.  *  PARAMETERS
    566. 

  566.  *      tvbuff_t *tvb       - pointer to buffer containing raw packet.
    567. 

  567.  *      packet_info *pinfo  - pointer to packet information fields
    568. 

  568.  *      proto_tree *tree    - pointer to data tree wireshark uses to display packet.
    569. 

  569.  *  RETURNS
    570. 

  570.  *      void
    571. 

  571.  *---------------------------------------------------------------
    572. 

  572.  */
    573. 

  573. static void
    574. 

  574. dissect_ieee802154_cc24xx(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree)
    575. 

  575. {
    576. 

  576.     /* Call the common dissector. */
    577. 

  577.     dissect_ieee802154_common(tvb, pinfo, tree, DISSECT_IEEE802154_OPTION_CC24xx);
    578. 

  578. } /* dissect_ieee802154_cc24xx */
    579. 

  579. 

  580. /*FUNCTION:------------------------------------------------------
    581. 

  581.  *  NAME
    582. 

  582.  *      dissect_ieee802154_common
    583. 

  583.  *  DESCRIPTION
    584. 

  584.  *      IEEE 802.15.4 packet dissection routine for Wireshark.
    585. 

  585.  *      This function extracts all the information first before displaying.
    586. 

  586.  *      If payload exists, that portion will be passed into another dissector
    587. 

  587.  *      for further processing.
    588. 

  588.  *
    589. 

  589.  *      This is called after the individual dissect_ieee802154* functions
    590. 

  590.  *      have been called to determine what sort of FCS is present.
    591. 

  591.  *      The dissect_ieee802154* functions will set the parameters
    592. 

  592.  *      in the ieee802154_packet structure, and pass it to this one
    593. 

  593.  *      through the pinfo->private_data pointer.
    594. 

  594.  *
    595. 

  595.  *  PARAMETERS
    596. 

  596.  *      tvbuff_t *tvb       - pointer to buffer containing raw packet.
    597. 

  597.  *      packet_info *pinfo  - pointer to packet information fields
    598. 

  598.  *      proto_tree *tree    - pointer to data tree wireshark uses to display packet.
    599. 

  599.  *      guint options       - bitwise or of dissector options (see DISSECT_IEEE802154_OPTION_xxx).
    600. 

  600.  *  RETURNS
    601. 

  601.  *      void
    602. 

  602.  *---------------------------------------------------------------
    603. 

  603.  */
    604. 

  604. static void
    605. 

  605. dissect_ieee802154_common(tvbuff_t *tvb, packet_info *pinfo, proto_tree *tree, guint options)
    606. 

  606. {
    607. 

  607.     tvbuff_t                *volatile payload_tvb;
    608. 

  608.     proto_tree              *volatile ieee802154_tree = NULL;
    609. 

  609.     proto_item              *volatile proto_root = NULL;
    610. 

  610.     proto_item              *hidden_item;
    611. 

  611.     proto_item              *ti;
    612. 

  612.     void                    *pd_save;
    613. 

  613. 

  614.     guint                   offset = 0;
    615. 

  615.     volatile gboolean       fcs_ok = TRUE;
    616. 

  616.     const char              *saved_proto;
    617. 

  617.     ws_decrypt_status       status;
    618. 

  618. 

  619.     ieee802154_packet      *packet = wmem_new(wmem_packet_scope(), ieee802154_packet);
    620. 

  620.     ieee802154_short_addr   addr16;
    621. 

  621.     ieee802154_hints_t     *ieee_hints;
    622. 

  622. 

  623.     /* Link our packet info structure into the private data field for the
    624. 

  624.      * Network-Layer heuristic subdissectors. */
    625. 

  625.     pd_save = pinfo->private_data;
    626. 

  626.     pinfo->private_data = packet;
    627. 

  627. 

  628.     packet->short_table = ieee802154_map.short_table;
    629. 

  629. 

  630.     /* Allocate frame data with hints for upper layers */
    631. 

  631.     if(!pinfo->fd->flags.visited){
    632. 

  632.         ieee_hints = se_new0(ieee802154_hints_t);
    633. 

  633.         p_add_proto_data(pinfo->fd, proto_ieee802154, 0, ieee_hints);
    634. 

  634.     } else {
    635. 

  635.         ieee_hints = (ieee802154_hints_t *)p_get_proto_data(pinfo->fd, proto_ieee802154, 0);
    636. 

  636.     }
    637. 

  637. 

  638.     /* Create the protocol tree. */
    639. 

  639.     if (tree) {
    640. 

  640.         proto_root = proto_tree_add_protocol_format(tree, proto_ieee802154, tvb, 0, tvb_length(tvb), "IEEE 802.15.4");
    641. 

  641.         ieee802154_tree = proto_item_add_subtree(proto_root, ett_ieee802154);
    642. 

  642.     }
    643. 

  643.     /* Add the protocol name. */
    644. 

  644.     col_set_str(pinfo->cinfo, COL_PROTOCOL, "IEEE 802.15.4");
    645. 

  645.     /* Add the packet length. */
    646. 

  646.     col_clear(pinfo->cinfo, COL_PACKET_LENGTH);
    647. 

  647.     col_add_fstr(pinfo->cinfo, COL_PACKET_LENGTH, "%i", tvb_length(tvb));
    648. 

  648. 

  649.     /* Add the packet length to the filter field */
    650. 

  650.     hidden_item = proto_tree_add_uint(ieee802154_tree, hf_ieee802154_frame_length, NULL, 0, 0, tvb_reported_length(tvb));
    651. 

  651.     PROTO_ITEM_SET_HIDDEN(hidden_item);
    652. 

  652. 

  653.     /*=====================================================
    654. 

  654.      * FRAME CONTROL FIELD
    655. 

  655.      *=====================================================
    656. 

  656.      */
    657. 

  657.     dissect_ieee802154_fcf(tvb, pinfo, ieee802154_tree, packet, &offset);
    658. 

  658. 

  659.     /*=====================================================
    660. 

  660.      * SEQUENCE NUMBER
    661. 

  661.      *=====================================================
    662. 

  662.      */
    663. 

  663.     packet->seqno = tvb_get_guint8(tvb, offset);
    664. 

  664.     if (tree) {
    665. 

  665.         proto_tree_add_uint(ieee802154_tree, hf_ieee802154_seqno, tvb, offset, 1, packet->seqno);
    666. 

  666.         /* For Ack packets display this in the root. */
    667. 

  667.         if (packet->frame_type == IEEE802154_FCF_ACK) {
    668. 

  668.             proto_item_append_text(proto_root, ", Sequence Number: %u", packet->seqno);
    669. 

  669.         }
    670. 

  670.     }
    671. 

  671.     offset += 1;
    672. 

  672. 

  673.     /*=====================================================
    674. 

  674.      * ADDRESSING FIELDS
    675. 

  675.      *=====================================================
    676. 

  676.      */
    677. 

  677.     /* Clear out the addressing strings. */
    678. 

  678.     SET_ADDRESS(&pinfo->dst, AT_NONE, 0, NULL);
    679. 

  679.     SET_ADDRESS(&pinfo->src, AT_NONE, 0, NULL);
    680. 

  680.     SET_ADDRESS(&pinfo->dl_dst, AT_NONE, 0, NULL);
    681. 

  681.     SET_ADDRESS(&pinfo->dl_src, AT_NONE, 0, NULL);
    682. 

  682.     SET_ADDRESS(&pinfo->net_dst, AT_NONE, 0, NULL);
    683. 

  683.     SET_ADDRESS(&pinfo->net_src, AT_NONE, 0, NULL);
    684. 

  684. 

  685.     /* Get and display the destination PAN, if present. */
    686. 

  686.     if ( (packet->dst_addr_mode == IEEE802154_FCF_ADDR_SHORT) ||
    687. 

  687.          (packet->dst_addr_mode == IEEE802154_FCF_ADDR_EXT) ) {
    688. 

  688.         packet->dst_pan = tvb_get_letohs(tvb, offset);
    689. 

  689.         if (tree) {
    690. 

  690.             proto_tree_add_uint(ieee802154_tree, hf_ieee802154_dst_panID, tvb, offset, 2, packet->dst_pan);
    691. 

  691.         }
    692. 

  692.         offset += 2;
    693. 

  693.     }
    694. 

  694. 

  695.     /* Get destination address. */
    696. 

  696.     if (packet->dst_addr_mode == IEEE802154_FCF_ADDR_SHORT) {
    697. 

  697.         char dst_addr[32];
    698. 

  698. 

  699.         /* Get the address. */
    700. 

  700.         packet->dst16 = tvb_get_letohs(tvb, offset);
    701. 

  701. 

  702.         /* Display the destination address. */
    703. 

  703.         if ( packet->dst16 == IEEE802154_BCAST_ADDR ) {
    704. 

  704.             g_snprintf(dst_addr, 32, "Broadcast");
    705. 

  705.         }
    706. 

  706.         else {
    707. 

  707.             g_snprintf(dst_addr, 32, "0x%04x", packet->dst16);
    708. 

  708.         }
    709. 

  709.         /* Provide address hints to higher layers that need it. */
    710. 

  710.         if (ieee_hints) {
    711. 

  711.             ieee_hints->dst16 = packet->dst16;
    712. 

  712.         }
    713. 

  713. 

  714.         TVB_SET_ADDRESS(&pinfo->dl_dst, AT_IEEE_802_15_4_SHORT, tvb, offset, 2);
    715. 

  715.         TVB_SET_ADDRESS(&pinfo->dst, AT_IEEE_802_15_4_SHORT, tvb, offset, 2);
    716. 

  716. 

  717.         if (tree) {
    718. 

  718.             proto_tree_add_uint(ieee802154_tree, hf_ieee802154_dst16, tvb, offset, 2, packet->dst16);
    719. 

  719.             proto_item_append_text(proto_root, ", Dst: %s", dst_addr);
    720. 

  720.         }
    721. 

  721. 

  722.         col_append_fstr(pinfo->cinfo, COL_INFO, ", Dst: %s", dst_addr);
    723. 

  723.         offset += 2;
    724. 

  724.     }
    725. 

  725.     else if (packet->dst_addr_mode == IEEE802154_FCF_ADDR_EXT) {
    726. 

  726.         static guint64 addr; /* has to be static due to SET_ADDRESS */
    727. 

  727. 

  728.         /* Get the address */
    729. 

  729.         packet->dst64 = tvb_get_letoh64(tvb, offset);
    730. 

  730. 

  731.         /* Copy and convert the address to network byte order. */
    732. 

  732.         addr = pntoh64(&(packet->dst64));
    733. 

  733. 

  734.         /* Display the destination address. */
    735. 

  735.         /* XXX - OUI resolution doesn't happen when displaying resolved
    736. 

  736.          * EUI64 addresses; that should probably be fixed in
    737. 

  737.          * epan/addr_resolv.c.
    738. 

  738.          */
    739. 

  739.         SET_ADDRESS(&pinfo->dl_dst, AT_EUI64, 8, &addr);
    740. 

  740.         SET_ADDRESS(&pinfo->dst, AT_EUI64, 8, &addr);
    741. 

  741.         if (tree) {
    742. 

  742.             proto_tree_add_item(ieee802154_tree, hf_ieee802154_dst64, tvb, offset, 8, ENC_LITTLE_ENDIAN);
    743. 

  743.             proto_item_append_text(proto_root, ", Dst: %s", get_eui64_name(packet->dst64));
    744. 

  744.         }
    745. 

  745.         col_append_fstr(pinfo->cinfo, COL_INFO, ", Dst: %s", get_eui64_name(packet->dst64));
    746. 

  746.         offset += 8;
    747. 

  747.     }
    748. 

  748.     else if (packet->dst_addr_mode != IEEE802154_FCF_ADDR_NONE) {
    749. 

  749.         /* Invalid Destination Address Mode. Abort Dissection. */
    750. 

  750.         expert_add_info_format(pinfo, proto_root, PI_MALFORMED, PI_ERROR, "Invalid Destination Address Mode");
    751. 

  751.         pinfo->private_data = pd_save;
    752. 

  752.         return;
    753. 

  753.     }
    754. 

  754. 

  755.     /* Get the source PAN if it exists. The source address will be present if:
    756. 

  756.      *  - The Source addressing exists and
    757. 

  757.      *  - The Destination addressing doesn't exist, or the Intra-PAN bit is unset.
    758. 

  758.      */
    759. 

  759.     if ( ((packet->src_addr_mode == IEEE802154_FCF_ADDR_SHORT) || (packet->src_addr_mode == IEEE802154_FCF_ADDR_EXT)) &&
    760. 

  760.          ((packet->dst_addr_mode == IEEE802154_FCF_ADDR_NONE) || (!packet->intra_pan)) ) {
    761. 

  761.         /* Source PAN is present, extract it and add it to the tree. */
    762. 

  762.         packet->src_pan = tvb_get_letohs(tvb, offset);
    763. 

  763.         if (tree) {
    764. 

  764.             proto_tree_add_uint(ieee802154_tree, hf_ieee802154_src_panID, tvb, offset, 2, packet->src_pan);
    765. 

  765.         }
    766. 

  766.         offset += 2;
    767. 

  767.     }
    768. 

  768.     else {
    769. 

  769.         /* Set the panID field in case the intra-pan condition was met. */
    770. 

  770.         packet->src_pan = packet->dst_pan;
    771. 

  771.     }
    772. 

  772. 

  773.     if (ieee_hints) {
    774. 

  774.         ieee_hints->src_pan = packet->src_pan;
    775. 

  775.     }
    776. 

  776. 

  777.     /* Get short source address if present. */
    778. 

  778.     if (packet->src_addr_mode == IEEE802154_FCF_ADDR_SHORT) {
    779. 

  779.         char src_addr[32];
    780. 

  780. 

  781.         /* Get the address. */
    782. 

  782.         packet->src16 = tvb_get_letohs(tvb, offset);
    783. 

  783. 

  784.         /* Update the Address fields. */
    785. 

  785.         if (packet->src16==IEEE802154_BCAST_ADDR) {
    786. 

  786.             g_snprintf(src_addr, 32, "Broadcast");
    787. 

  787.         }
    788. 

  788.         else {
    789. 

  789.             g_snprintf(src_addr, 32, "0x%04x", packet->src16);
    790. 

  790. 

  791.             if (!pinfo->fd->flags.visited) {
    792. 

  792.                 /* If we know our extended source address from previous packets,
    793. 

  793.                  * provide a pointer to it in a hint for upper layers */
    794. 

  794.                 addr16.addr = packet->src16;
    795. 

  795.                 addr16.pan = packet->src_pan;
    796. 

  796. 

  797.                 if (ieee_hints) {
    798. 

  798.                     ieee_hints->src16 = packet->src16;
    799. 

  799.                     ieee_hints->map_rec = (ieee802154_map_rec *)
    800. 

  800.                         g_hash_table_lookup(ieee802154_map.short_table, &addr16);
    801. 

  801.                 }
    802. 

  802.             }
    803. 

  803.         }
    804. 

  804. 

  805.         TVB_SET_ADDRESS(&pinfo->dl_src, AT_IEEE_802_15_4_SHORT, tvb, offset, 2);
    806. 

  806.         TVB_SET_ADDRESS(&pinfo->src, AT_IEEE_802_15_4_SHORT, tvb, offset, 2);
    807. 

  807. 

  808.         /* Add the addressing info to the tree. */
    809. 

  809.         if (tree) {
    810. 

  810.             proto_tree_add_uint(ieee802154_tree, hf_ieee802154_src16, tvb, offset, 2, packet->src16);
    811. 

  811.             proto_item_append_text(proto_root, ", Src: %s", src_addr);
    812. 

  812. 

  813.             if (ieee_hints && ieee_hints->map_rec) {
    814. 

  814.                 /* Display inferred source address info */
    815. 

  815.                 ti = proto_tree_add_eui64(ieee802154_tree, hf_ieee802154_src64, tvb, offset, 0,
    816. 

  816.                         ieee_hints->map_rec->addr64);
    817. 

  817.                 PROTO_ITEM_SET_GENERATED(ti);
    818. 

  818. 

  819.                 if ( ieee_hints->map_rec->start_fnum ) {
    820. 

  820.                     ti = proto_tree_add_uint(ieee802154_tree, hf_ieee802154_src64_origin, tvb, 0, 0,
    821. 

  821.                         ieee_hints->map_rec->start_fnum);
    822. 

  822.                 }
    823. 

  823.                 else {
    824. 

  824.                     ti = proto_tree_add_text(ieee802154_tree, tvb, 0, 0, "Origin: Pre-configured");
    825. 

  825.                 }
    826. 

  826.                 PROTO_ITEM_SET_GENERATED(ti);
    827. 

  827.             }
    828. 

  828.         }
    829. 

  829. 

  830.         col_append_fstr(pinfo->cinfo, COL_INFO, ", Src: %s", src_addr);
    831. 

  831. 

  832.         offset += 2;
    833. 

  833.     }
    834. 

  834.     else if (packet->src_addr_mode == IEEE802154_FCF_ADDR_EXT) {
    835. 

  835.         static guint64 addr; /* has to be static due to SET_ADDRESS */
    836. 

  836. 

  837.         /* Get the address. */
    838. 

  838.         packet->src64 = tvb_get_letoh64(tvb, offset);
    839. 

  839. 

  840.         /* Copy and convert the address to network byte order. */
    841. 

  841.         addr = pntoh64(&(packet->src64));
    842. 

  842. 

  843.         /* Display the source address. */
    844. 

  844.         /* XXX - OUI resolution doesn't happen when displaying resolved
    845. 

  845.          * EUI64 addresses; that should probably be fixed in
    846. 

  846.          * epan/addr_resolv.c.
    847. 

  847.          */
    848. 

  848.         SET_ADDRESS(&pinfo->dl_src, AT_EUI64, 8, &addr);
    849. 

  849.         SET_ADDRESS(&pinfo->src, AT_EUI64, 8, &addr);
    850. 

  850.         if (tree) {
    851. 

  851.             proto_tree_add_item(ieee802154_tree, hf_ieee802154_src64, tvb, offset, 8, ENC_LITTLE_ENDIAN);
    852. 

  852.             proto_item_append_text(proto_root, ", Src: %s", get_eui64_name(packet->src64));
    853. 

  853.         }
    854. 

  854. 

  855.         col_append_fstr(pinfo->cinfo, COL_INFO, ", Src: %s", get_eui64_name(packet->src64));
    856. 

  856.         offset += 8;
    857. 

  857.     }
    858. 

  858.     else if (packet->src_addr_mode != IEEE802154_FCF_ADDR_NONE) {
    859. 

  859.         /* Invalid Destination Address Mode. Abort Dissection. */
    860. 

  860.         expert_add_info_format(pinfo, proto_root, PI_MALFORMED, PI_ERROR, "Invalid Source Address Mode");
    861. 

  861.         pinfo->private_data = pd_save;
    862. 

  862.         return;
    863. 

  863.     }
    864. 

  864. 

  865.     /*=====================================================
    866. 

  866.      * VERIFY FRAME CHECK SEQUENCE
    867. 

  867.      *=====================================================
    868. 

  868.      */
    869. 

  869.     /* Check, but don't display the FCS yet, otherwise the payload dissection
    870. 

  870.      * may be out of place in the tree. But we want to know if the FCS is OK in
    871. 

  871.      * case the CRC is bad (don't want to continue dissection to the NWK layer).
    872. 

  872.      */
    873. 

  873.     if (tvb_bytes_exist(tvb, tvb_reported_length(tvb)-IEEE802154_FCS_LEN, IEEE802154_FCS_LEN)) {
    874. 

  874.         /* The FCS is in the last two bytes of the packet. */
    875. 

  875.         guint16     fcs = tvb_get_letohs(tvb, tvb_reported_length(tvb)-IEEE802154_FCS_LEN);
    876. 

  876.         /* Check if we are expecting a CC2420-style FCS*/
    877. 

  877.         if (options & DISSECT_IEEE802154_OPTION_CC24xx) {
    878. 

  878.             fcs_ok = (fcs & IEEE802154_CC24xx_CRC_OK);
    879. 

  879.         }
    880. 

  880.         else {
    881. 

  881.             guint16 fcs_calc = ieee802154_crc_tvb(tvb, tvb_reported_length(tvb)-IEEE802154_FCS_LEN);
    882. 

  882.             fcs_ok = (fcs == fcs_calc);
    883. 

  883.         }
    884. 

  884.     }
    885. 

  885. 

  886.     /*=====================================================
    887. 

  887.      * AUXILIARY SECURITY HEADER
    888. 

  888.      *=====================================================
    889. 

  889.      */
    890. 

  890.     /* The Auxiliary Security Header only exists in IEEE 802.15.4-2006 */
    891. 

  891.     if (packet->security_enable && (packet->version == IEEE802154_VERSION_2006)) {
    892. 

  892.       proto_tree *header_tree, *field_tree;
    893. 

  893.       guint8                    security_control;
    894. 

  894.       guint                     aux_length = 5; /* Minimum length of the auxiliary header. */
    895. 

  895. 

  896.       /* Parse the security control field. */
    897. 

  897.       security_control = tvb_get_guint8(tvb, offset);
    898. 

  898.       packet->security_level = (ieee802154_security_level)(security_control & IEEE802154_AUX_SEC_LEVEL_MASK);
    899. 

  899.       packet->key_id_mode = (ieee802154_key_id_mode)((security_control & IEEE802154_AUX_KEY_ID_MODE_MASK) >> IEEE802154_AUX_KEY_ID_MODE_SHIFT);
    900. 

  900. 

  901.       /* Compute the length of the auxiliary header and create a subtree.  */
    902. 

  902.       if (packet->key_id_mode != KEY_ID_MODE_IMPLICIT) aux_length++;
    903. 

  903.       if (packet->key_id_mode == KEY_ID_MODE_KEY_EXPLICIT_4) aux_length += 4;
    904. 

  904.       if (packet->key_id_mode == KEY_ID_MODE_KEY_EXPLICIT_8) aux_length += 8;
    905. 

  905.       ti = proto_tree_add_text(ieee802154_tree, tvb, offset, aux_length, "Auxiliary Security Header");
    906. 

  906.       header_tree = proto_item_add_subtree(ti, ett_ieee802154_auxiliary_security);
    907. 

  907. 

  908.       /* Security Control Field */
    909. 

  909.       ti = proto_tree_add_text(header_tree, tvb, offset, 1, "Security Control Field (0x%02x)", security_control);
    910. 

  910.       field_tree = proto_item_add_subtree(ti, ett_ieee802154_aux_sec_control);
    911. 

  911.       proto_tree_add_uint(field_tree, hf_ieee802154_security_level, tvb, offset, 1, security_control & IEEE802154_AUX_SEC_LEVEL_MASK);
    912. 

  912.       proto_tree_add_uint(field_tree, hf_ieee802154_key_id_mode, tvb, offset, 1, security_control & IEEE802154_AUX_KEY_ID_MODE_MASK);
    913. 

  913.       proto_tree_add_uint(field_tree, hf_ieee802154_aux_sec_reserved, tvb, offset, 1, security_control & IEEE802154_AUX_KEY_RESERVED_MASK);
    914. 

  914.       offset++;
    915. 

  915. 

  916.       /* Frame Counter Field */
    917. 

  917.       packet->frame_counter = tvb_get_letohl (tvb, offset);
    918. 

  918.       proto_tree_add_uint(header_tree, hf_ieee802154_aux_sec_frame_counter, tvb, offset,4, packet->frame_counter);
    919. 

  919.       offset +=4;
    920. 

  920. 

  921.       /* Key identifier field(s). */
    922. 

  922.       if (packet->key_id_mode != KEY_ID_MODE_IMPLICIT) {
    923. 

  923.         /* Create a subtree. */
    924. 

  924.         ti = proto_tree_add_text(header_tree, tvb, offset, 1, "Key Identifier Field"); /* Will fix length later. */
    925. 

  925.         field_tree = proto_item_add_subtree(ti, ett_ieee802154_aux_sec_key_id);
    926. 

  926.         /* Add key source, if it exists. */
    927. 

  927.         if (packet->key_id_mode == KEY_ID_MODE_KEY_EXPLICIT_4) {
    928. 

  928.           packet->key_source.addr32 = tvb_get_ntohl(tvb, offset);
    929. 

  929.           proto_tree_add_uint64(field_tree, hf_ieee802154_aux_sec_key_source, tvb, offset, 4, packet->key_source.addr32);
    930. 

  930.           proto_item_set_len(ti, 1 + 4);
    931. 

  931.           offset += (int)sizeof (guint32);
    932. 

  932.         }
    933. 

  933.         if (packet->key_id_mode == KEY_ID_MODE_KEY_EXPLICIT_8) {
    934. 

  934.           packet->key_source.addr64 = tvb_get_ntoh64(tvb, offset);
    935. 

  935.           proto_tree_add_uint64(field_tree, hf_ieee802154_aux_sec_key_source, tvb, offset, 8, packet->key_source.addr64);
    936. 

  936.           proto_item_set_len(ti, 1 + 8);
    937. 

  937.           offset += 8;
    938. 

  938.         }
    939. 

  939.         /* Add key identifier. */
    940. 

  940.         packet->key_index = tvb_get_guint8(tvb, offset);
    941. 

  941.         proto_tree_add_uint(field_tree, hf_ieee802154_aux_sec_key_index, tvb, offset,1, packet->key_index);
    942. 

  942.         offset++;
    943. 

  943.       }
    944. 

  944.     }
    945. 

  945. 

  946.     /*=====================================================
    947. 

  947.      * NONPAYLOAD FIELDS
    948. 

  948.      *=====================================================
    949. 

  949.      */
    950. 

  950.     /* All of the beacon fields, except the beacon payload are considered nonpayload. */
    951. 

  951.     if (packet->frame_type == IEEE802154_FCF_BEACON) {
    952. 

  952.         /* Parse the superframe spec. */
    953. 

  953.         dissect_ieee802154_superframe(tvb, pinfo, ieee802154_tree, &offset);
    954. 

  954.         /* Parse the GTS information fields. */
    955. 

  955.         dissect_ieee802154_gtsinfo(tvb, pinfo, ieee802154_tree, &offset);
    956. 

  956.         /* Parse the Pending address list. */
    957. 

  957.         dissect_ieee802154_pendaddr(tvb, pinfo, ieee802154_tree, &offset);
    958. 

  958.     }
    959. 

  959.     /* Only the Command ID is considered nonpayload. */
    960. 

  960.     if (packet->frame_type == IEEE802154_FCF_CMD) {
    961. 

  961.         packet->command_id = tvb_get_guint8(tvb, offset);
    962. 

  962.         if (tree) {
    963. 

  963.             proto_tree_add_uint(ieee802154_tree, hf_ieee802154_cmd_id, tvb, offset, 1, packet->command_id);
    964. 

  964.         }
    965. 

  965.         offset++;
    966. 

  966. 

  967.         /* Display the command identifier in the info column. */
    968. 

  968.         col_set_str(pinfo->cinfo, COL_INFO, val_to_str_const(packet->command_id, ieee802154_cmd_names, "Unknown Command"));
    969. 

  969.     }
    970. 

  970.     /* No other frame types have nonpayload fields. */
    971. 

  971. 

  972.     /*=====================================================
    973. 

  973.      * PAYLOAD DISSECTION
    974. 

  974.      *=====================================================
    975. 

  975.      */
    976. 

  976.     /* IEEE 802.15.4-2003 may have security information pre-pended to payload */
    977. 

  977.     if (packet->security_enable && (packet->version == IEEE802154_VERSION_2003)) {
    978. 

  978.         /* Store security suite preference in the 2006 security level identifier to simplify 2003 integration! */
    979. 

  979.         packet->security_level = (ieee802154_security_level)ieee802154_sec_suite;
    980. 

  980. 

  981.         /* Frame Counter and Key Sequence Counter prepended to the payload of an encrypted frame */
    982. 

  982.         if (IEEE802154_IS_ENCRYPTED(packet->security_level)) {
    983. 

  983.             packet->frame_counter = tvb_get_letohl (tvb, offset);
    984. 

  984.             proto_tree_add_uint(ieee802154_tree, hf_ieee802154_sec_frame_counter, tvb, offset, (int)sizeof(guint32), packet->frame_counter);
    985. 

  985.             offset += (int)sizeof(guint32);
    986. 

  986. 

  987.             packet->key_sequence_counter = tvb_get_guint8 (tvb, offset);
    988. 

  988.             proto_tree_add_uint(ieee802154_tree, hf_ieee802154_sec_key_sequence_counter, tvb, offset, (int)sizeof(guint8), packet->key_sequence_counter);
    989. 

  989.             offset += (int)sizeof(guint8);
    990. 

  990.         }
    991. 

  991.     }
    992. 

  992. 

  993.     /* Encrypted Payload. */
    994. 

  994.     if (packet->security_enable) {
    995. 

  995.         payload_tvb = dissect_ieee802154_decrypt(tvb, offset, pinfo, packet, &status);
    996. 

  996. 

  997.         /* Get the unencrypted data if decryption failed.  */
    998. 

  998.         if (!payload_tvb) {
    999. 

  999.             /* Deal with possible truncation and the FCS field at the end. */
    1000. 

  1000.             gint            reported_len = tvb_reported_length(tvb)-offset-IEEE802154_FCS_LEN;
    1001. 

  1001.             gint            captured_len = tvb_length(tvb)-offset;
    1002. 

  1002.             if (reported_len < captured_len) captured_len = reported_len;
    1003. 

  1003.             payload_tvb = tvb_new_subset(tvb, offset, captured_len, reported_len);
    1004. 

  1004.         }
    1005. 

  1005. 

  1006.         /* Display the reason for failure, and abort if the error was fatal. */
    1007. 

  1007.         switch (status) {
    1008. 

  1008.         case DECRYPT_PACKET_SUCCEEDED:
    1009. 

  1009.         case DECRYPT_NOT_ENCRYPTED:
    1010. 

  1010.             /* No problem. */
    1011. 

  1011.             break;
    1012. 

  1012. 

  1013.         case DECRYPT_VERSION_UNSUPPORTED:
    1014. 

  1014.             /* We don't support decryption with that version of the protocol */
    1015. 

  1015.             expert_add_info_format(pinfo, proto_root, PI_UNDECODED, PI_WARN, "We don't support decryption with protocol version %u",
    1016. 

  1016.                                    packet->version);
    1017. 

  1017.             call_dissector(data_handle, payload_tvb, pinfo, tree);
    1018. 

  1018.             goto dissect_ieee802154_fcs;
    1019. 

  1019. 

  1020.         case DECRYPT_PACKET_TOO_SMALL:
    1021. 

  1021.             expert_add_info_format(pinfo, proto_root, PI_UNDECODED, PI_WARN, "Packet was too small to include the CRC and MIC");
    1022. 

  1022.             call_dissector(data_handle, payload_tvb, pinfo, tree);
    1023. 

  1023.             goto dissect_ieee802154_fcs;
    1024. 

  1024. 

  1025.         case DECRYPT_PACKET_NO_EXT_SRC_ADDR:
    1026. 

  1026.             expert_add_info_format(pinfo, proto_root, PI_UNDECODED, PI_WARN, "No extended source address - can't decrypt");
    1027. 

  1027.             call_dissector(data_handle, payload_tvb, pinfo, tree);
    1028. 

  1028.             goto dissect_ieee802154_fcs;
    1029. 

  1029. 

  1030.         case DECRYPT_PACKET_NO_KEY:
    1031. 

  1031.             expert_add_info_format(pinfo, proto_root, PI_UNDECODED, PI_WARN, "No encryption key set - can't decrypt");
    1032. 

  1032.             call_dissector(data_handle, payload_tvb, pinfo, tree);
    1033. 

  1033.             goto dissect_ieee802154_fcs;
    1034. 

  1034. 

  1035.         case DECRYPT_PACKET_DECRYPT_FAILED:
    1036. 

  1036.             expert_add_info_format(pinfo, proto_root, PI_UNDECODED, PI_WARN, "Decrypt failed");
    1037. 

  1037.             call_dissector(data_handle, payload_tvb, pinfo, tree);
    1038. 

  1038.             goto dissect_ieee802154_fcs;
    1039. 

  1039. 

  1040.         case DECRYPT_PACKET_MIC_CHECK_FAILED:
    1041. 

  1041.             expert_add_info_format(pinfo, proto_root, PI_UNDECODED, PI_WARN, "MIC check failed");
    1042. 

  1042.             /*
    1043. 

  1043.              * Abort only if the payload was encrypted, in which case we
    1044. 

  1044.              * probably didn't decrypt the packet right (eg: wrong key).
    1045. 

  1045.              */
    1046. 

  1046.             if (IEEE802154_IS_ENCRYPTED(packet->security_level)) {
    1047. 

  1047.                 call_dissector(data_handle, payload_tvb, pinfo, tree);
    1048. 

  1048.                 goto dissect_ieee802154_fcs;
    1049. 

  1049.             }
    1050. 

  1050.             break;
    1051. 

  1051.         }
    1052. 

  1052.     }
    1053. 

  1053.     /* Plaintext Payload. */
    1054. 

  1054.     else {
    1055. 

  1055.         /* Deal with possible truncation and the FCS field at the end. */
    1056. 

  1056.         gint            reported_len = tvb_reported_length(tvb)-offset-IEEE802154_FCS_LEN;
    1057. 

  1057.         gint            captured_len = tvb_length(tvb)-offset;
    1058. 

  1058.         if (reported_len < captured_len) captured_len = reported_len;
    1059. 

  1059.         payload_tvb = tvb_new_subset(tvb, offset, captured_len, reported_len);
    1060. 

  1060.     }
    1061. 

  1061. 

  1062.     /*
    1063. 

  1063.      * Wrap the sub-dissection in a try/catch block in case the payload is
    1064. 

  1064.      * broken. First we store the current protocol so we can fix it if an
    1065. 

  1065.      * exception is thrown by the subdissectors.
    1066. 

  1066.      */
    1067. 

  1067.     saved_proto = pinfo->current_proto;
    1068. 

  1068.     /* Try to dissect the payload. */
    1069. 

  1069.     TRY {
    1070. 

  1070.         if ((packet->frame_type == IEEE802154_FCF_BEACON) ||
    1071. 

  1071.             (packet->frame_type == IEEE802154_FCF_DATA)) {
    1072. 

  1072.             /* Beacon and Data packets contain a payload. */
    1073. 

  1073.             if ((fcs_ok || !ieee802154_fcs_ok) && (tvb_reported_length(payload_tvb)>0)) {
    1074. 

  1074.                 /* Attempt heuristic subdissection. */
    1075. 

  1075.                 if (!dissector_try_heuristic(ieee802154_heur_subdissector_list, payload_tvb, pinfo, tree, NULL)) {
    1076. 

  1076.                     /* Could not subdissect, call the data dissector instead. */
    1077. 

  1077.                     call_dissector(data_handle, payload_tvb, pinfo, tree);
    1078. 

  1078.                 }
    1079. 

  1079.             }
    1080. 

  1080.             else {
    1081. 

  1081.                 /* If no sub-dissector was called, call the data dissector. */
    1082. 

  1082.                 call_dissector(data_handle, payload_tvb, pinfo, tree);
    1083. 

  1083.             }
    1084. 

  1084.         }
    1085. 

  1085.         /* If the packet is a command, try to dissect the payload. */
    1086. 

  1086.         else if (packet->frame_type == IEEE802154_FCF_CMD) {
    1087. 

  1087.             switch (packet->command_id) {
    1088. 

  1088.               case IEEE802154_CMD_ASRQ:
    1089. 

  1089.                 IEEE802154_CMD_ADDR_CHECK(pinfo, proto_root, packet->command_id,
    1090. 

  1090.                     (packet->src_addr_mode == IEEE802154_FCF_ADDR_EXT) &&
    1091. 

  1091.                     (packet->dst_addr_mode != IEEE802154_FCF_ADDR_NONE));
    1092. 

  1092.                 dissect_ieee802154_assoc_req(payload_tvb, pinfo, ieee802154_tree, packet);
    1093. 

  1093.                 break;
    1094. 

  1094. 

  1095.               case IEEE802154_CMD_ASRSP:
    1096. 

  1096.                 IEEE802154_CMD_ADDR_CHECK(pinfo, proto_root, packet->command_id,
    1097. 

  1097.                     (packet->src_addr_mode == IEEE802154_FCF_ADDR_EXT) &&
    1098. 

  1098.                     (packet->dst_addr_mode == IEEE802154_FCF_ADDR_EXT));
    1099. 

  1099.                 dissect_ieee802154_assoc_rsp(payload_tvb, pinfo, ieee802154_tree, packet);
    1100. 

  1100.                 break;
    1101. 

  1101. 

  1102.               case IEEE802154_CMD_DISAS:
    1103. 

  1103.                 IEEE802154_CMD_ADDR_CHECK(pinfo, proto_root, packet->command_id,
    1104. 

  1104.                     (packet->src_addr_mode == IEEE802154_FCF_ADDR_EXT) &&
    1105. 

  1105.                     (packet->dst_addr_mode == IEEE802154_FCF_ADDR_EXT));
    1106. 

  1106.                 dissect_ieee802154_disassoc(payload_tvb, pinfo, ieee802154_tree, packet);
    1107. 

  1107.                 break;
    1108. 

  1108. 

  1109.               case IEEE802154_CMD_DATA_RQ:
    1110. 

  1110.                 IEEE802154_CMD_ADDR_CHECK(pinfo, proto_root, packet->command_id, packet->src_addr_mode != IEEE802154_FCF_ADDR_NONE);
    1111. 

  1111.                 /* No payload expected. */
    1112. 

  1112.                 break;
    1113. 

  1113. 

  1114.               case IEEE802154_CMD_PANID_ERR:
    1115. 

  1115.                 IEEE802154_CMD_ADDR_CHECK(pinfo, proto_root, packet->command_id,
    1116. 

  1116.                     (packet->src_addr_mode == IEEE802154_FCF_ADDR_EXT) &&
    1117. 

  1117.                     (packet->dst_addr_mode == IEEE802154_FCF_ADDR_EXT));
    1118. 

  1118.                 /* No payload expected. */
    1119. 

  1119.                 break;
    1120. 

  1120. 

  1121.               case IEEE802154_CMD_ORPH_NOTIF:
    1122. 

  1122.                 IEEE802154_CMD_ADDR_CHECK(pinfo, proto_root, packet->command_id,
    1123. 

  1123.                     (packet->src_addr_mode == IEEE802154_FCF_ADDR_EXT) &&
    1124. 

  1124.                     (packet->dst_addr_mode == IEEE802154_FCF_ADDR_SHORT) &&
    1125. 

  1125.                     (packet->dst16 == IEEE802154_BCAST_ADDR) &&
    1126. 

  1126.                     (packet->src_pan == IEEE802154_BCAST_PAN) &&
    1127. 

  1127.                     (packet->dst_pan == IEEE802154_BCAST_PAN));
    1128. 

  1128.                 /* No payload expected. */
    1129. 

  1129.                 break;
    1130. 

  1130. 

  1131.               case IEEE802154_CMD_BCN_RQ:
    1132. 

  1132.                 IEEE802154_CMD_ADDR_CHECK(pinfo, proto_root, packet->command_id,
    1133. 

  1133.                     (packet->dst_addr_mode == IEEE802154_FCF_ADDR_SHORT) &&
    1134. 

  1134.       …
    1135.

Large files files are truncated, but you can click here to view the full file