2 * Copyright (C) 2007-2012 Siemens AG
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License version 2
6 * as published by the Free Software Foundation.
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
14 * Pavel Smolenskiy <pavel.smolenskiy@gmail.com>
15 * Maxim Gorbachyov <maxim.gorbachev@siemens.com>
16 * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com>
17 * Alexander Smirnov <alex.bluesman.smirnov@gmail.com>
20 #include <linux/kernel.h>
21 #include <linux/module.h>
22 #include <linux/netdevice.h>
23 #include <linux/crc-ccitt.h>
24 #include <asm/unaligned.h>
26 #include <net/mac802154.h>
27 #include <net/ieee802154_netdev.h>
28 #include <net/rtnetlink.h>
29 #include <linux/nl802154.h>
31 #include "ieee802154_i.h"
33 static int ieee802154_deliver_skb(struct sk_buff
*skb
)
35 skb
->ip_summed
= CHECKSUM_UNNECESSARY
;
36 skb
->protocol
= htons(ETH_P_IEEE802154
);
38 return netif_receive_skb(skb
);
42 ieee802154_subif_frame(struct ieee802154_sub_if_data
*sdata
,
43 struct sk_buff
*skb
, const struct ieee802154_hdr
*hdr
)
48 pr_debug("getting packet via slave interface %s\n", sdata
->dev
->name
);
50 spin_lock_bh(&sdata
->mib_lock
);
53 sshort
= sdata
->short_addr
;
55 switch (mac_cb(skb
)->dest
.mode
) {
56 case IEEE802154_ADDR_NONE
:
57 if (mac_cb(skb
)->dest
.mode
!= IEEE802154_ADDR_NONE
)
58 /* FIXME: check if we are PAN coordinator */
59 skb
->pkt_type
= PACKET_OTHERHOST
;
61 /* ACK comes with both addresses empty */
62 skb
->pkt_type
= PACKET_HOST
;
64 case IEEE802154_ADDR_LONG
:
65 if (mac_cb(skb
)->dest
.pan_id
!= span
&&
66 mac_cb(skb
)->dest
.pan_id
!= cpu_to_le16(IEEE802154_PANID_BROADCAST
))
67 skb
->pkt_type
= PACKET_OTHERHOST
;
68 else if (mac_cb(skb
)->dest
.extended_addr
== sdata
->extended_addr
)
69 skb
->pkt_type
= PACKET_HOST
;
71 skb
->pkt_type
= PACKET_OTHERHOST
;
73 case IEEE802154_ADDR_SHORT
:
74 if (mac_cb(skb
)->dest
.pan_id
!= span
&&
75 mac_cb(skb
)->dest
.pan_id
!= cpu_to_le16(IEEE802154_PANID_BROADCAST
))
76 skb
->pkt_type
= PACKET_OTHERHOST
;
77 else if (mac_cb(skb
)->dest
.short_addr
== sshort
)
78 skb
->pkt_type
= PACKET_HOST
;
79 else if (mac_cb(skb
)->dest
.short_addr
==
80 cpu_to_le16(IEEE802154_ADDR_BROADCAST
))
81 skb
->pkt_type
= PACKET_BROADCAST
;
83 skb
->pkt_type
= PACKET_OTHERHOST
;
86 spin_unlock_bh(&sdata
->mib_lock
);
87 pr_debug("invalid dest mode\n");
92 spin_unlock_bh(&sdata
->mib_lock
);
94 skb
->dev
= sdata
->dev
;
96 rc
= mac802154_llsec_decrypt(&sdata
->sec
, skb
);
98 pr_debug("decryption failed: %i\n", rc
);
102 sdata
->dev
->stats
.rx_packets
++;
103 sdata
->dev
->stats
.rx_bytes
+= skb
->len
;
105 switch (mac_cb(skb
)->type
) {
106 case IEEE802154_FC_TYPE_DATA
:
107 return ieee802154_deliver_skb(skb
);
109 pr_warn("ieee802154: bad frame received (type = %d)\n",
120 ieee802154_print_addr(const char *name
, const struct ieee802154_addr
*addr
)
122 if (addr
->mode
== IEEE802154_ADDR_NONE
)
123 pr_debug("%s not present\n", name
);
125 pr_debug("%s PAN ID: %04x\n", name
, le16_to_cpu(addr
->pan_id
));
126 if (addr
->mode
== IEEE802154_ADDR_SHORT
) {
127 pr_debug("%s is short: %04x\n", name
,
128 le16_to_cpu(addr
->short_addr
));
130 u64 hw
= swab64((__force u64
)addr
->extended_addr
);
132 pr_debug("%s is hardware: %8phC\n", name
, &hw
);
137 ieee802154_parse_frame_start(struct sk_buff
*skb
, struct ieee802154_hdr
*hdr
)
140 struct ieee802154_mac_cb
*cb
= mac_cb_init(skb
);
142 skb_reset_mac_header(skb
);
144 hlen
= ieee802154_hdr_pull(skb
, hdr
);
150 pr_debug("fc: %04x dsn: %02x\n", le16_to_cpup((__le16
*)&hdr
->fc
),
153 cb
->type
= hdr
->fc
.type
;
154 cb
->ackreq
= hdr
->fc
.ack_request
;
155 cb
->secen
= hdr
->fc
.security_enabled
;
157 ieee802154_print_addr("destination", &hdr
->dest
);
158 ieee802154_print_addr("source", &hdr
->source
);
160 cb
->source
= hdr
->source
;
161 cb
->dest
= hdr
->dest
;
163 if (hdr
->fc
.security_enabled
) {
166 pr_debug("seclevel %i\n", hdr
->sec
.level
);
168 switch (hdr
->sec
.key_id_mode
) {
169 case IEEE802154_SCF_KEY_IMPLICIT
:
170 pr_debug("implicit key\n");
173 case IEEE802154_SCF_KEY_INDEX
:
174 pr_debug("key %02x\n", hdr
->sec
.key_id
);
177 case IEEE802154_SCF_KEY_SHORT_INDEX
:
178 pr_debug("key %04x:%04x %02x\n",
179 le32_to_cpu(hdr
->sec
.short_src
) >> 16,
180 le32_to_cpu(hdr
->sec
.short_src
) & 0xffff,
184 case IEEE802154_SCF_KEY_HW_INDEX
:
185 key
= swab64((__force u64
)hdr
->sec
.extended_src
);
186 pr_debug("key source %8phC %02x\n", &key
,
196 __ieee802154_rx_handle_packet(struct ieee802154_local
*local
,
200 struct ieee802154_sub_if_data
*sdata
;
201 struct ieee802154_hdr hdr
;
203 ret
= ieee802154_parse_frame_start(skb
, &hdr
);
205 pr_debug("got invalid frame\n");
210 list_for_each_entry_rcu(sdata
, &local
->interfaces
, list
) {
211 if (sdata
->type
!= IEEE802154_DEV_WPAN
||
212 !netif_running(sdata
->dev
))
215 ieee802154_subif_frame(sdata
, skb
, &hdr
);
225 ieee802154_monitors_rx(struct ieee802154_local
*local
, struct sk_buff
*skb
)
227 struct sk_buff
*skb2
;
228 struct ieee802154_sub_if_data
*sdata
;
230 skb_reset_mac_header(skb
);
231 skb
->ip_summed
= CHECKSUM_UNNECESSARY
;
232 skb
->pkt_type
= PACKET_OTHERHOST
;
233 skb
->protocol
= htons(ETH_P_IEEE802154
);
235 list_for_each_entry_rcu(sdata
, &local
->interfaces
, list
) {
236 if (sdata
->type
!= IEEE802154_DEV_MONITOR
)
239 if (!ieee802154_sdata_running(sdata
))
242 skb2
= skb_clone(skb
, GFP_ATOMIC
);
244 skb2
->dev
= sdata
->dev
;
245 ieee802154_deliver_skb(skb2
);
247 sdata
->dev
->stats
.rx_packets
++;
248 sdata
->dev
->stats
.rx_bytes
+= skb
->len
;
253 void ieee802154_rx(struct ieee802154_hw
*hw
, struct sk_buff
*skb
)
255 struct ieee802154_local
*local
= hw_to_local(hw
);
258 WARN_ON_ONCE(softirq_count() == 0);
260 /* TODO: When a transceiver omits the checksum here, we
261 * add an own calculated one. This is currently an ugly
262 * solution because the monitor needs a crc here.
264 if (local
->hw
.flags
& IEEE802154_HW_RX_OMIT_CKSUM
) {
265 crc
= crc_ccitt(0, skb
->data
, skb
->len
);
266 put_unaligned_le16(crc
, skb_put(skb
, 2));
271 ieee802154_monitors_rx(local
, skb
);
273 /* Check if transceiver doesn't validate the checksum.
274 * If not we validate the checksum here.
276 if (local
->hw
.flags
& IEEE802154_HW_RX_DROP_BAD_CKSUM
) {
277 crc
= crc_ccitt(0, skb
->data
, skb
->len
);
285 skb_trim(skb
, skb
->len
- 2);
287 __ieee802154_rx_handle_packet(local
, skb
);
291 EXPORT_SYMBOL(ieee802154_rx
);
294 ieee802154_rx_irqsafe(struct ieee802154_hw
*hw
, struct sk_buff
*skb
, u8 lqi
)
296 struct ieee802154_local
*local
= hw_to_local(hw
);
298 mac_cb(skb
)->lqi
= lqi
;
299 skb
->pkt_type
= IEEE802154_RX_MSG
;
300 skb_queue_tail(&local
->skb_queue
, skb
);
301 tasklet_schedule(&local
->tasklet
);
303 EXPORT_SYMBOL(ieee802154_rx_irqsafe
);