| 1cd829c8 |
1 | /* |
| 2 | * Copyright (C) 2007-2012 Siemens AG |
| 3 | * |
| 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. |
| 7 | * |
| 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. |
| 12 | * |
| 13 | * You should have received a copy of the GNU General Public License along |
| 14 | * with this program; if not, write to the Free Software Foundation, Inc., |
| 15 | * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. |
| 16 | * |
| 17 | * Written by: |
| 18 | * Pavel Smolenskiy <pavel.smolenskiy@gmail.com> |
| 19 | * Maxim Gorbachyov <maxim.gorbachev@siemens.com> |
| 20 | * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com> |
| 21 | * Alexander Smirnov <alex.bluesman.smirnov@gmail.com> |
| 22 | */ |
| 23 | |
| 24 | #include <linux/kernel.h> |
| 25 | #include <linux/module.h> |
| 26 | #include <linux/workqueue.h> |
| 27 | #include <linux/netdevice.h> |
| 28 | #include <linux/crc-ccitt.h> |
| 29 | |
| 30 | #include <net/mac802154.h> |
| 31 | #include <net/ieee802154_netdev.h> |
| 32 | |
| 33 | #include "mac802154.h" |
| 34 | |
| 35 | /* The IEEE 802.15.4 standard defines 4 MAC packet types: |
| 36 | * - beacon frame |
| 37 | * - MAC command frame |
| 38 | * - acknowledgement frame |
| 39 | * - data frame |
| 40 | * |
| 41 | * and only the data frame should be pushed to the upper layers, other types |
| 42 | * are just internal MAC layer management information. So only data packets |
| 43 | * are going to be sent to the networking queue, all other will be processed |
| 44 | * right here by using the device workqueue. |
| 45 | */ |
| 46 | struct rx_work { |
| 47 | struct sk_buff *skb; |
| 48 | struct work_struct work; |
| 49 | struct ieee802154_dev *dev; |
| 50 | u8 lqi; |
| 51 | }; |
| 52 | |
| 53 | static void |
| 54 | mac802154_subif_rx(struct ieee802154_dev *hw, struct sk_buff *skb, u8 lqi) |
| 55 | { |
| 56 | struct mac802154_priv *priv = mac802154_to_priv(hw); |
| 57 | |
| 58 | mac_cb(skb)->lqi = lqi; |
| 59 | skb->protocol = htons(ETH_P_IEEE802154); |
| 60 | skb_reset_mac_header(skb); |
| 61 | |
| 62 | BUILD_BUG_ON(sizeof(struct ieee802154_mac_cb) > sizeof(skb->cb)); |
| 63 | |
| 64 | if (!(priv->hw.flags & IEEE802154_HW_OMIT_CKSUM)) { |
| 65 | u16 crc; |
| 66 | |
| 67 | if (skb->len < 2) { |
| 68 | pr_debug("got invalid frame\n"); |
| 69 | goto out; |
| 70 | } |
| 71 | crc = crc_ccitt(0, skb->data, skb->len); |
| 72 | if (crc) { |
| 73 | pr_debug("CRC mismatch\n"); |
| 74 | goto out; |
| 75 | } |
| 76 | skb_trim(skb, skb->len - 2); /* CRC */ |
| 77 | } |
| 78 | |
| 0606069d |
79 | mac802154_monitors_rx(priv, skb); |
| 32bad7e3 |
80 | mac802154_wpans_rx(priv, skb); |
| 1cd829c8 |
81 | out: |
| 82 | dev_kfree_skb(skb); |
| 83 | return; |
| 84 | } |
| 85 | |
| 86 | static void mac802154_rx_worker(struct work_struct *work) |
| 87 | { |
| 88 | struct rx_work *rw = container_of(work, struct rx_work, work); |
| 89 | struct sk_buff *skb = rw->skb; |
| 90 | |
| 91 | mac802154_subif_rx(rw->dev, skb, rw->lqi); |
| 92 | kfree(rw); |
| 93 | } |
| 94 | |
| 95 | void |
| 96 | ieee802154_rx_irqsafe(struct ieee802154_dev *dev, struct sk_buff *skb, u8 lqi) |
| 97 | { |
| 98 | struct mac802154_priv *priv = mac802154_to_priv(dev); |
| 99 | struct rx_work *work; |
| 100 | |
| 101 | if (!skb) |
| 102 | return; |
| 103 | |
| 104 | work = kzalloc(sizeof(struct rx_work), GFP_ATOMIC); |
| 105 | if (!work) |
| 106 | return; |
| 107 | |
| 108 | INIT_WORK(&work->work, mac802154_rx_worker); |
| 109 | work->skb = skb; |
| 110 | work->dev = dev; |
| 111 | work->lqi = lqi; |
| 112 | |
| 113 | queue_work(priv->dev_workqueue, &work->work); |
| 114 | } |
| 115 | EXPORT_SYMBOL(ieee802154_rx_irqsafe); |
projects / GitHub / mt8127 / android_kernel_alcatel_ttab.git / blame