blob: 91b75abbd1a1d05b3219b9089232d9f67eb73ccd [file] [log] [blame]
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +00001/*
2 * Copyright 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 *
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +000013 * Written by:
14 * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com>
15 * Sergey Lapin <slapin@ossfans.org>
16 * Maxim Gorbachyov <maxim.gorbachev@siemens.com>
17 * Alexander Smirnov <alex.bluesman.smirnov@gmail.com>
18 */
19
20#include <linux/netdevice.h>
21#include <linux/module.h>
22#include <linux/if_arp.h>
Alexander Aring4ca24ac2014-10-25 09:41:04 +020023#include <linux/ieee802154.h>
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +000024
Alexander Aring944742a2014-11-17 08:20:49 +010025#include <net/nl802154.h>
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +000026#include <net/mac802154.h>
27#include <net/ieee802154_netdev.h>
Alexander Aring5ad60d32014-10-25 09:41:02 +020028#include <net/cfg802154.h>
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +000029
Alexander Aring0f1556b2014-10-25 09:41:00 +020030#include "ieee802154_i.h"
Alexander Aring59cb3002014-10-28 18:21:21 +010031#include "driver-ops.h"
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +000032
Phoebe Buckheister9b0bb4a2014-05-16 17:46:43 +020033static int mac802154_wpan_update_llsec(struct net_device *dev)
34{
Alexander Aring59d19cd2014-10-25 17:16:40 +020035 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
Phoebe Buckheister9b0bb4a2014-05-16 17:46:43 +020036 struct ieee802154_mlme_ops *ops = ieee802154_mlme_ops(dev);
Alexander Aring863e88f2014-11-09 08:36:45 +010037 struct wpan_dev *wpan_dev = &sdata->wpan_dev;
Phoebe Buckheister9b0bb4a2014-05-16 17:46:43 +020038 int rc = 0;
39
40 if (ops->llsec) {
41 struct ieee802154_llsec_params params;
42 int changed = 0;
43
Alexander Aring863e88f2014-11-09 08:36:45 +010044 params.pan_id = wpan_dev->pan_id;
Phoebe Buckheister9b0bb4a2014-05-16 17:46:43 +020045 changed |= IEEE802154_LLSEC_PARAM_PAN_ID;
46
Alexander Aring863e88f2014-11-09 08:36:45 +010047 params.hwaddr = wpan_dev->extended_addr;
Phoebe Buckheister9b0bb4a2014-05-16 17:46:43 +020048 changed |= IEEE802154_LLSEC_PARAM_HWADDR;
49
50 rc = ops->llsec->set_params(dev, &params, changed);
51 }
52
53 return rc;
54}
55
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +000056static int
57mac802154_wpan_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
58{
Alexander Aring59d19cd2014-10-25 17:16:40 +020059 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
Alexander Aring863e88f2014-11-09 08:36:45 +010060 struct wpan_dev *wpan_dev = &sdata->wpan_dev;
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +000061 struct sockaddr_ieee802154 *sa =
62 (struct sockaddr_ieee802154 *)&ifr->ifr_addr;
63 int err = -ENOIOCTLCMD;
64
Alexander Aringf7cb96f2014-11-09 08:36:59 +010065 ASSERT_RTNL();
66
Alexander Aring036562f2014-10-25 17:16:36 +020067 spin_lock_bh(&sdata->mib_lock);
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +000068
69 switch (cmd) {
70 case SIOCGIFADDR:
Phoebe Buckheisterb70ab2e2014-03-14 21:23:59 +010071 {
72 u16 pan_id, short_addr;
73
Alexander Aring863e88f2014-11-09 08:36:45 +010074 pan_id = le16_to_cpu(wpan_dev->pan_id);
75 short_addr = le16_to_cpu(wpan_dev->short_addr);
Phoebe Buckheisterb70ab2e2014-03-14 21:23:59 +010076 if (pan_id == IEEE802154_PANID_BROADCAST ||
77 short_addr == IEEE802154_ADDR_BROADCAST) {
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +000078 err = -EADDRNOTAVAIL;
79 break;
80 }
81
82 sa->family = AF_IEEE802154;
83 sa->addr.addr_type = IEEE802154_ADDR_SHORT;
Phoebe Buckheisterb70ab2e2014-03-14 21:23:59 +010084 sa->addr.pan_id = pan_id;
85 sa->addr.short_addr = short_addr;
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +000086
87 err = 0;
88 break;
Phoebe Buckheisterb70ab2e2014-03-14 21:23:59 +010089 }
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +000090 case SIOCSIFADDR:
Alexander Aringf7cb96f2014-11-09 08:36:59 +010091 if (netif_running(dev)) {
92 spin_unlock_bh(&sdata->mib_lock);
93 return -EBUSY;
94 }
95
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +000096 dev_warn(&dev->dev,
Masanari Iida9b134942014-08-06 22:31:28 +090097 "Using DEBUGing ioctl SIOCSIFADDR isn't recommended!\n");
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +000098 if (sa->family != AF_IEEE802154 ||
99 sa->addr.addr_type != IEEE802154_ADDR_SHORT ||
100 sa->addr.pan_id == IEEE802154_PANID_BROADCAST ||
101 sa->addr.short_addr == IEEE802154_ADDR_BROADCAST ||
102 sa->addr.short_addr == IEEE802154_ADDR_UNDEF) {
103 err = -EINVAL;
104 break;
105 }
106
Alexander Aring863e88f2014-11-09 08:36:45 +0100107 wpan_dev->pan_id = cpu_to_le16(sa->addr.pan_id);
108 wpan_dev->short_addr = cpu_to_le16(sa->addr.short_addr);
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000109
Phoebe Buckheister9b0bb4a2014-05-16 17:46:43 +0200110 err = mac802154_wpan_update_llsec(dev);
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000111 break;
112 }
113
Alexander Aring036562f2014-10-25 17:16:36 +0200114 spin_unlock_bh(&sdata->mib_lock);
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000115 return err;
116}
117
118static int mac802154_wpan_mac_addr(struct net_device *dev, void *p)
119{
Alexander Aring776e59d2014-11-02 04:18:41 +0100120 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000121 struct sockaddr *addr = p;
Alexander Aringea7053c2014-11-02 04:18:46 +0100122 __le64 extended_addr;
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000123
124 if (netif_running(dev))
125 return -EBUSY;
126
Alexander Aring705cbbb2014-11-05 20:51:24 +0100127 ieee802154_be64_to_le64(&extended_addr, addr->sa_data);
Alexander Aringea7053c2014-11-02 04:18:46 +0100128 if (!ieee802154_is_valid_extended_addr(extended_addr))
129 return -EINVAL;
130
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000131 memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
Alexander Aring863e88f2014-11-09 08:36:45 +0100132 sdata->wpan_dev.extended_addr = extended_addr;
Alexander Aring776e59d2014-11-02 04:18:41 +0100133
Phoebe Buckheister9b0bb4a2014-05-16 17:46:43 +0200134 return mac802154_wpan_update_llsec(dev);
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000135}
136
Alexander Aring19ec6902014-10-28 18:21:17 +0100137static int mac802154_slave_open(struct net_device *dev)
138{
139 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
Alexander Aring19ec6902014-10-28 18:21:17 +0100140 struct ieee802154_local *local = sdata->local;
141 int res = 0;
142
143 ASSERT_RTNL();
144
Alexander Aring0ea3da62014-10-28 18:21:24 +0100145 set_bit(SDATA_STATE_RUNNING, &sdata->state);
Alexander Aring19ec6902014-10-28 18:21:17 +0100146
Alexander Aring74457642014-10-28 18:21:31 +0100147 if (!local->open_count) {
Alexander Aring59cb3002014-10-28 18:21:21 +0100148 res = drv_start(local);
Alexander Aring19ec6902014-10-28 18:21:17 +0100149 WARN_ON(res);
150 if (res)
151 goto err;
152 }
153
Alexander Aring74457642014-10-28 18:21:31 +0100154 local->open_count++;
Alexander Aring19ec6902014-10-28 18:21:17 +0100155 netif_start_queue(dev);
156 return 0;
157err:
Alexander Aring0ea3da62014-10-28 18:21:24 +0100158 /* might already be clear but that doesn't matter */
159 clear_bit(SDATA_STATE_RUNNING, &sdata->state);
Alexander Aring19ec6902014-10-28 18:21:17 +0100160
161 return res;
162}
163
Alexander Aringbd37a782014-12-19 23:45:58 +0100164static int
165ieee802154_check_mac_settings(struct ieee802154_local *local,
166 struct wpan_dev *wpan_dev,
167 struct wpan_dev *nwpan_dev)
168{
169 ASSERT_RTNL();
170
171 if (local->hw.flags & IEEE802154_HW_PROMISCUOUS) {
172 if (wpan_dev->promiscuous_mode != nwpan_dev->promiscuous_mode)
173 return -EBUSY;
174 }
175
176 if (local->hw.flags & IEEE802154_HW_AFILT) {
Alexander Aring8bf95382015-03-26 12:46:28 +0100177 if (wpan_dev->pan_id != nwpan_dev->pan_id ||
178 wpan_dev->short_addr != nwpan_dev->short_addr ||
179 wpan_dev->extended_addr != nwpan_dev->extended_addr)
Alexander Aringbd37a782014-12-19 23:45:58 +0100180 return -EBUSY;
181 }
182
183 if (local->hw.flags & IEEE802154_HW_CSMA_PARAMS) {
Alexander Aring8bf95382015-03-26 12:46:28 +0100184 if (wpan_dev->min_be != nwpan_dev->min_be ||
185 wpan_dev->max_be != nwpan_dev->max_be ||
186 wpan_dev->csma_retries != nwpan_dev->csma_retries)
Alexander Aringbd37a782014-12-19 23:45:58 +0100187 return -EBUSY;
188 }
189
190 if (local->hw.flags & IEEE802154_HW_FRAME_RETRIES) {
191 if (wpan_dev->frame_retries != nwpan_dev->frame_retries)
192 return -EBUSY;
193 }
194
195 if (local->hw.flags & IEEE802154_HW_LBT) {
196 if (wpan_dev->lbt != nwpan_dev->lbt)
197 return -EBUSY;
198 }
199
200 return 0;
201}
202
203static int
204ieee802154_check_concurrent_iface(struct ieee802154_sub_if_data *sdata,
205 enum nl802154_iftype iftype)
206{
207 struct ieee802154_local *local = sdata->local;
208 struct wpan_dev *wpan_dev = &sdata->wpan_dev;
209 struct ieee802154_sub_if_data *nsdata;
210
211 /* we hold the RTNL here so can safely walk the list */
212 list_for_each_entry(nsdata, &local->interfaces, list) {
213 if (nsdata != sdata && ieee802154_sdata_running(nsdata)) {
214 int ret;
215
Alexander Aringcd1c5662014-12-19 23:45:59 +0100216 /* TODO currently we don't support multiple node types
217 * we need to run skb_clone at rx path. Check if there
218 * exist really an use case if we need to support
219 * multiple node types at the same time.
220 */
221 if (sdata->vif.type == NL802154_IFTYPE_NODE &&
222 nsdata->vif.type == NL802154_IFTYPE_NODE)
223 return -EBUSY;
224
Alexander Aringbd37a782014-12-19 23:45:58 +0100225 /* check all phy mac sublayer settings are the same.
226 * We have only one phy, different values makes trouble.
227 */
228 ret = ieee802154_check_mac_settings(local, wpan_dev,
229 &nsdata->wpan_dev);
230 if (ret < 0)
231 return ret;
232 }
233 }
234
235 return 0;
236}
237
Phoebe Buckheister6ef00232014-05-14 17:43:11 +0200238static int mac802154_wpan_open(struct net_device *dev)
Phoebe Buckheistere462ded2014-03-31 21:37:46 +0200239{
240 int rc;
Alexander Aring59d19cd2014-10-25 17:16:40 +0200241 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
Alexander Aring59cb3002014-10-28 18:21:21 +0100242 struct ieee802154_local *local = sdata->local;
Alexander Aring863e88f2014-11-09 08:36:45 +0100243 struct wpan_dev *wpan_dev = &sdata->wpan_dev;
Alexander Aring04e850f2014-10-25 17:16:37 +0200244 struct wpan_phy *phy = sdata->local->phy;
Phoebe Buckheistere462ded2014-03-31 21:37:46 +0200245
Alexander Aringbd37a782014-12-19 23:45:58 +0100246 rc = ieee802154_check_concurrent_iface(sdata, sdata->vif.type);
247 if (rc < 0)
248 return rc;
249
Phoebe Buckheistere462ded2014-03-31 21:37:46 +0200250 rc = mac802154_slave_open(dev);
251 if (rc < 0)
252 return rc;
253
254 mutex_lock(&phy->pib_lock);
255
Alexander Aring38130c32014-10-29 21:34:44 +0100256 if (local->hw.flags & IEEE802154_HW_PROMISCUOUS) {
Alexander Aring863e88f2014-11-09 08:36:45 +0100257 rc = drv_set_promiscuous_mode(local,
258 wpan_dev->promiscuous_mode);
Alexander Aring38130c32014-10-29 21:34:44 +0100259 if (rc < 0)
260 goto out;
261 }
262
Alexander Aring776e59d2014-11-02 04:18:41 +0100263 if (local->hw.flags & IEEE802154_HW_AFILT) {
Alexander Aring863e88f2014-11-09 08:36:45 +0100264 rc = drv_set_pan_id(local, wpan_dev->pan_id);
Alexander Aring50c79072014-11-02 04:18:43 +0100265 if (rc < 0)
266 goto out;
267
Alexander Aring863e88f2014-11-09 08:36:45 +0100268 rc = drv_set_extended_addr(local, wpan_dev->extended_addr);
Alexander Aring776e59d2014-11-02 04:18:41 +0100269 if (rc < 0)
270 goto out;
Alexander Aring78b4bad162014-11-02 04:18:42 +0100271
Alexander Aring863e88f2014-11-09 08:36:45 +0100272 rc = drv_set_short_addr(local, wpan_dev->short_addr);
Alexander Aring78b4bad162014-11-02 04:18:42 +0100273 if (rc < 0)
274 goto out;
Alexander Aring776e59d2014-11-02 04:18:41 +0100275 }
276
Alexander Aringa543c592014-10-28 18:21:23 +0100277 if (local->hw.flags & IEEE802154_HW_LBT) {
Alexander Aring5fb3f022014-11-09 08:36:46 +0100278 rc = drv_set_lbt_mode(local, wpan_dev->lbt);
Phoebe Buckheistere462ded2014-03-31 21:37:46 +0200279 if (rc < 0)
280 goto out;
281 }
282
Alexander Aringa543c592014-10-28 18:21:23 +0100283 if (local->hw.flags & IEEE802154_HW_CSMA_PARAMS) {
Alexander Aring5fb3f022014-11-09 08:36:46 +0100284 rc = drv_set_csma_params(local, wpan_dev->min_be,
285 wpan_dev->max_be,
286 wpan_dev->csma_retries);
Phoebe Buckheistere462ded2014-03-31 21:37:46 +0200287 if (rc < 0)
288 goto out;
289 }
290
Alexander Aringa543c592014-10-28 18:21:23 +0100291 if (local->hw.flags & IEEE802154_HW_FRAME_RETRIES) {
Alexander Aring5fb3f022014-11-09 08:36:46 +0100292 rc = drv_set_max_frame_retries(local, wpan_dev->frame_retries);
Phoebe Buckheistere462ded2014-03-31 21:37:46 +0200293 if (rc < 0)
294 goto out;
295 }
296
297 mutex_unlock(&phy->pib_lock);
298 return 0;
299
300out:
301 mutex_unlock(&phy->pib_lock);
302 return rc;
303}
304
Alexander Aring19ec6902014-10-28 18:21:17 +0100305static int mac802154_slave_close(struct net_device *dev)
306{
307 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
308 struct ieee802154_local *local = sdata->local;
309
310 ASSERT_RTNL();
311
Alexander Aring61f2dcb2014-11-12 19:51:56 +0100312 hrtimer_cancel(&local->ifs_timer);
313
Alexander Aring19ec6902014-10-28 18:21:17 +0100314 netif_stop_queue(dev);
Alexander Aring74457642014-10-28 18:21:31 +0100315 local->open_count--;
Alexander Aring19ec6902014-10-28 18:21:17 +0100316
Alexander Aring0ea3da62014-10-28 18:21:24 +0100317 clear_bit(SDATA_STATE_RUNNING, &sdata->state);
Alexander Aring19ec6902014-10-28 18:21:17 +0100318
Alexander Aring74457642014-10-28 18:21:31 +0100319 if (!local->open_count)
Alexander Aring59cb3002014-10-28 18:21:21 +0100320 drv_stop(local);
Alexander Aring19ec6902014-10-28 18:21:17 +0100321
322 return 0;
323}
324
Alexander Aring036562f2014-10-25 17:16:36 +0200325static int mac802154_set_header_security(struct ieee802154_sub_if_data *sdata,
Phoebe Buckheisterf30be4d2014-05-16 17:46:40 +0200326 struct ieee802154_hdr *hdr,
327 const struct ieee802154_mac_cb *cb)
328{
329 struct ieee802154_llsec_params params;
330 u8 level;
331
Alexander Aring036562f2014-10-25 17:16:36 +0200332 mac802154_llsec_get_params(&sdata->sec, &params);
Phoebe Buckheisterf30be4d2014-05-16 17:46:40 +0200333
334 if (!params.enabled && cb->secen_override && cb->secen)
335 return -EINVAL;
336 if (!params.enabled ||
337 (cb->secen_override && !cb->secen) ||
338 !params.out_level)
339 return 0;
340 if (cb->seclevel_override && !cb->seclevel)
341 return -EINVAL;
342
343 level = cb->seclevel_override ? cb->seclevel : params.out_level;
344
345 hdr->fc.security_enabled = 1;
346 hdr->sec.level = level;
347 hdr->sec.key_id_mode = params.out_key.mode;
348 if (params.out_key.mode == IEEE802154_SCF_KEY_SHORT_INDEX)
349 hdr->sec.short_src = params.out_key.short_source;
350 else if (params.out_key.mode == IEEE802154_SCF_KEY_HW_INDEX)
351 hdr->sec.extended_src = params.out_key.extended_source;
352 hdr->sec.key_id = params.out_key.id;
353
354 return 0;
355}
356
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000357static int mac802154_header_create(struct sk_buff *skb,
358 struct net_device *dev,
359 unsigned short type,
Phoebe Buckheistere6278d92014-03-14 21:24:01 +0100360 const void *daddr,
361 const void *saddr,
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000362 unsigned len)
363{
Phoebe Buckheistere6278d92014-03-14 21:24:01 +0100364 struct ieee802154_hdr hdr;
Alexander Aring59d19cd2014-10-25 17:16:40 +0200365 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
Alexander Aring863e88f2014-11-09 08:36:45 +0100366 struct wpan_dev *wpan_dev = &sdata->wpan_dev;
Phoebe Buckheister32edc402014-05-14 17:43:08 +0200367 struct ieee802154_mac_cb *cb = mac_cb(skb);
Phoebe Buckheistere6278d92014-03-14 21:24:01 +0100368 int hlen;
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000369
370 if (!daddr)
371 return -EINVAL;
372
Phoebe Buckheistere6278d92014-03-14 21:24:01 +0100373 memset(&hdr.fc, 0, sizeof(hdr.fc));
Phoebe Buckheister32edc402014-05-14 17:43:08 +0200374 hdr.fc.type = cb->type;
375 hdr.fc.security_enabled = cb->secen;
376 hdr.fc.ack_request = cb->ackreq;
377 hdr.seq = ieee802154_mlme_ops(dev)->get_dsn(dev);
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000378
Alexander Aring036562f2014-10-25 17:16:36 +0200379 if (mac802154_set_header_security(sdata, &hdr, cb) < 0)
Phoebe Buckheisterf30be4d2014-05-16 17:46:40 +0200380 return -EINVAL;
381
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000382 if (!saddr) {
Alexander Aring036562f2014-10-25 17:16:36 +0200383 spin_lock_bh(&sdata->mib_lock);
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000384
Alexander Aring863e88f2014-11-09 08:36:45 +0100385 if (wpan_dev->short_addr == cpu_to_le16(IEEE802154_ADDR_BROADCAST) ||
386 wpan_dev->short_addr == cpu_to_le16(IEEE802154_ADDR_UNDEF) ||
387 wpan_dev->pan_id == cpu_to_le16(IEEE802154_PANID_BROADCAST)) {
Phoebe Buckheistere6278d92014-03-14 21:24:01 +0100388 hdr.source.mode = IEEE802154_ADDR_LONG;
Alexander Aring863e88f2014-11-09 08:36:45 +0100389 hdr.source.extended_addr = wpan_dev->extended_addr;
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000390 } else {
Phoebe Buckheistere6278d92014-03-14 21:24:01 +0100391 hdr.source.mode = IEEE802154_ADDR_SHORT;
Alexander Aring863e88f2014-11-09 08:36:45 +0100392 hdr.source.short_addr = wpan_dev->short_addr;
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000393 }
394
Alexander Aring863e88f2014-11-09 08:36:45 +0100395 hdr.source.pan_id = wpan_dev->pan_id;
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000396
Alexander Aring036562f2014-10-25 17:16:36 +0200397 spin_unlock_bh(&sdata->mib_lock);
Phoebe Buckheistere6278d92014-03-14 21:24:01 +0100398 } else {
399 hdr.source = *(const struct ieee802154_addr *)saddr;
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000400 }
401
Phoebe Buckheistere6278d92014-03-14 21:24:01 +0100402 hdr.dest = *(const struct ieee802154_addr *)daddr;
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000403
Phoebe Buckheistere6278d92014-03-14 21:24:01 +0100404 hlen = ieee802154_hdr_push(skb, &hdr);
405 if (hlen < 0)
406 return -EINVAL;
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000407
Alexander Aring3e691622013-10-30 09:18:22 +0100408 skb_reset_mac_header(skb);
Phoebe Buckheistere6278d92014-03-14 21:24:01 +0100409 skb->mac_len = hlen;
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000410
Phoebe Buckheister8c842962014-05-14 17:43:07 +0200411 if (len > ieee802154_max_payload(&hdr))
Phoebe Buckheisterd1d73582014-03-14 21:24:04 +0100412 return -EMSGSIZE;
413
Phoebe Buckheistere6278d92014-03-14 21:24:01 +0100414 return hlen;
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000415}
416
417static int
418mac802154_header_parse(const struct sk_buff *skb, unsigned char *haddr)
419{
Phoebe Buckheistere6278d92014-03-14 21:24:01 +0100420 struct ieee802154_hdr hdr;
421 struct ieee802154_addr *addr = (struct ieee802154_addr *)haddr;
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000422
Phoebe Buckheistere6278d92014-03-14 21:24:01 +0100423 if (ieee802154_hdr_peek_addrs(skb, &hdr) < 0) {
424 pr_debug("malformed packet\n");
425 return 0;
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000426 }
427
Phoebe Buckheistere6278d92014-03-14 21:24:01 +0100428 *addr = hdr.source;
429 return sizeof(*addr);
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000430}
431
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000432static struct header_ops mac802154_header_ops = {
433 .create = mac802154_header_create,
434 .parse = mac802154_header_parse,
435};
436
437static const struct net_device_ops mac802154_wpan_ops = {
Phoebe Buckheistere462ded2014-03-31 21:37:46 +0200438 .ndo_open = mac802154_wpan_open,
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000439 .ndo_stop = mac802154_slave_close,
Alexander Aringe5e584f2014-10-26 09:37:13 +0100440 .ndo_start_xmit = ieee802154_subif_start_xmit,
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000441 .ndo_do_ioctl = mac802154_wpan_ioctl,
442 .ndo_set_mac_address = mac802154_wpan_mac_addr,
443};
444
Alexander Aringb9ff77e2014-10-28 18:21:16 +0100445static const struct net_device_ops mac802154_monitor_ops = {
Alexander Aring38130c32014-10-29 21:34:44 +0100446 .ndo_open = mac802154_wpan_open,
Alexander Aringb9ff77e2014-10-28 18:21:16 +0100447 .ndo_stop = mac802154_slave_close,
448 .ndo_start_xmit = ieee802154_monitor_start_xmit,
449};
450
Phoebe Buckheisterf30be4d2014-05-16 17:46:40 +0200451static void mac802154_wpan_free(struct net_device *dev)
452{
Alexander Aring59d19cd2014-10-25 17:16:40 +0200453 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
Phoebe Buckheisterf30be4d2014-05-16 17:46:40 +0200454
Alexander Aring036562f2014-10-25 17:16:36 +0200455 mac802154_llsec_destroy(&sdata->sec);
Phoebe Buckheisterf30be4d2014-05-16 17:46:40 +0200456
457 free_netdev(dev);
458}
459
Alexander Aringd5ae67b2014-11-05 20:51:17 +0100460static void ieee802154_if_setup(struct net_device *dev)
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000461{
Alexander Aringe57a8942014-11-05 20:51:28 +0100462 dev->addr_len = IEEE802154_EXTENDED_ADDR_LEN;
463 memset(dev->broadcast, 0xff, IEEE802154_EXTENDED_ADDR_LEN);
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000464
465 dev->hard_header_len = MAC802154_FRAME_HARD_HEADER_LEN;
Phoebe Buckheisterf30be4d2014-05-16 17:46:40 +0200466 dev->needed_tailroom = 2 + 16; /* FCS + MIC */
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000467 dev->mtu = IEEE802154_MTU;
Alan Otte937f5832013-04-03 04:00:57 +0000468 dev->tx_queue_len = 300;
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000469 dev->flags = IFF_NOARP | IFF_BROADCAST;
Alexander Aringd5ae67b2014-11-05 20:51:17 +0100470}
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000471
Alexander Aringd5ae67b2014-11-05 20:51:17 +0100472static int
Alexander Aring944742a2014-11-17 08:20:49 +0100473ieee802154_setup_sdata(struct ieee802154_sub_if_data *sdata,
474 enum nl802154_iftype type)
Alexander Aringd5ae67b2014-11-05 20:51:17 +0100475{
Alexander Aring863e88f2014-11-09 08:36:45 +0100476 struct wpan_dev *wpan_dev = &sdata->wpan_dev;
477
Alexander Aringd5ae67b2014-11-05 20:51:17 +0100478 /* set some type-dependent values */
Alexander Aring7c118c12014-11-05 20:51:20 +0100479 sdata->vif.type = type;
Alexander Aring190ac1c2014-11-09 08:36:49 +0100480 sdata->wpan_dev.iftype = type;
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000481
Alexander Aring863e88f2014-11-09 08:36:45 +0100482 get_random_bytes(&wpan_dev->bsn, 1);
483 get_random_bytes(&wpan_dev->dsn, 1);
alex.bluesman.smirnov@gmail.com32bad7e2012-06-25 23:24:48 +0000484
Phoebe Buckheistere462ded2014-03-31 21:37:46 +0200485 /* defaults per 802.15.4-2011 */
Alexander Aring5fb3f022014-11-09 08:36:46 +0100486 wpan_dev->min_be = 3;
487 wpan_dev->max_be = 5;
488 wpan_dev->csma_retries = 4;
Alexander Aring036562f2014-10-25 17:16:36 +0200489 /* for compatibility, actual default is 3 */
Alexander Aring5fb3f022014-11-09 08:36:46 +0100490 wpan_dev->frame_retries = -1;
Phoebe Buckheistere462ded2014-03-31 21:37:46 +0200491
Alexander Aring863e88f2014-11-09 08:36:45 +0100492 wpan_dev->pan_id = cpu_to_le16(IEEE802154_PANID_BROADCAST);
493 wpan_dev->short_addr = cpu_to_le16(IEEE802154_ADDR_BROADCAST);
Phoebe Buckheisterf30be4d2014-05-16 17:46:40 +0200494
Alexander Aringd5ae67b2014-11-05 20:51:17 +0100495 switch (type) {
Alexander Aring944742a2014-11-17 08:20:49 +0100496 case NL802154_IFTYPE_NODE:
Alexander Aringb03c9cc2014-11-09 08:36:56 +0100497 ieee802154_be64_to_le64(&wpan_dev->extended_addr,
498 sdata->dev->dev_addr);
499
Alexander Aringd5ae67b2014-11-05 20:51:17 +0100500 sdata->dev->header_ops = &mac802154_header_ops;
501 sdata->dev->destructor = mac802154_wpan_free;
502 sdata->dev->netdev_ops = &mac802154_wpan_ops;
503 sdata->dev->ml_priv = &mac802154_mlme_wpan;
Alexander Aring863e88f2014-11-09 08:36:45 +0100504 wpan_dev->promiscuous_mode = false;
Alexander Aring38130c32014-10-29 21:34:44 +0100505
Alexander Aringd5ae67b2014-11-05 20:51:17 +0100506 spin_lock_init(&sdata->mib_lock);
507 mutex_init(&sdata->sec_mtx);
Alexander Aringb9ff77e2014-10-28 18:21:16 +0100508
Alexander Aringd5ae67b2014-11-05 20:51:17 +0100509 mac802154_llsec_init(&sdata->sec);
510 break;
Alexander Aring944742a2014-11-17 08:20:49 +0100511 case NL802154_IFTYPE_MONITOR:
Alexander Aringd5ae67b2014-11-05 20:51:17 +0100512 sdata->dev->destructor = free_netdev;
513 sdata->dev->netdev_ops = &mac802154_monitor_ops;
Alexander Aring863e88f2014-11-09 08:36:45 +0100514 wpan_dev->promiscuous_mode = true;
Alexander Aringd5ae67b2014-11-05 20:51:17 +0100515 break;
516 default:
517 BUG();
518 }
Alexander Aring986a8ab2014-11-05 20:51:15 +0100519
520 return 0;
521}
522
523struct net_device *
524ieee802154_if_add(struct ieee802154_local *local, const char *name,
Varka Bhadram5b4a10392015-04-30 17:44:57 +0200525 unsigned char name_assign_type, enum nl802154_iftype type,
526 __le64 extended_addr)
Alexander Aring986a8ab2014-11-05 20:51:15 +0100527{
Alexander Aringd5ae67b2014-11-05 20:51:17 +0100528 struct net_device *ndev = NULL;
529 struct ieee802154_sub_if_data *sdata = NULL;
530 int ret = -ENOMEM;
Alexander Aring986a8ab2014-11-05 20:51:15 +0100531
Alexander Aringd5ae67b2014-11-05 20:51:17 +0100532 ASSERT_RTNL();
533
Alexander Aring7c118c12014-11-05 20:51:20 +0100534 ndev = alloc_netdev(sizeof(*sdata) + local->hw.vif_data_size, name,
Varka Bhadram5b4a10392015-04-30 17:44:57 +0200535 name_assign_type, ieee802154_if_setup);
Alexander Aringd5ae67b2014-11-05 20:51:17 +0100536 if (!ndev)
537 return ERR_PTR(-ENOMEM);
538
539 ndev->needed_headroom = local->hw.extra_tx_headroom;
540
541 ret = dev_alloc_name(ndev, ndev->name);
542 if (ret < 0)
Alexander Aring986a8ab2014-11-05 20:51:15 +0100543 goto err;
544
Alexander Aring0e575472014-11-17 08:20:52 +0100545 ieee802154_le64_to_be64(ndev->perm_addr,
546 &local->hw.phy->perm_extended_addr);
Alexander Aringd5ae67b2014-11-05 20:51:17 +0100547 switch (type) {
Alexander Aring944742a2014-11-17 08:20:49 +0100548 case NL802154_IFTYPE_NODE:
Alexander Aringd5ae67b2014-11-05 20:51:17 +0100549 ndev->type = ARPHRD_IEEE802154;
Alexander Aring0e575472014-11-17 08:20:52 +0100550 if (ieee802154_is_valid_extended_addr(extended_addr))
551 ieee802154_le64_to_be64(ndev->dev_addr, &extended_addr);
552 else
553 memcpy(ndev->dev_addr, ndev->perm_addr,
554 IEEE802154_EXTENDED_ADDR_LEN);
Alexander Aringd5ae67b2014-11-05 20:51:17 +0100555 break;
Alexander Aring944742a2014-11-17 08:20:49 +0100556 case NL802154_IFTYPE_MONITOR:
Alexander Aringd5ae67b2014-11-05 20:51:17 +0100557 ndev->type = ARPHRD_IEEE802154_MONITOR;
558 break;
559 default:
560 ret = -EINVAL;
561 goto err;
562 }
Alexander Aring986a8ab2014-11-05 20:51:15 +0100563
Alexander Aringd5ae67b2014-11-05 20:51:17 +0100564 /* TODO check this */
565 SET_NETDEV_DEV(ndev, &local->phy->dev);
566 sdata = netdev_priv(ndev);
567 ndev->ieee802154_ptr = &sdata->wpan_dev;
568 memcpy(sdata->name, ndev->name, IFNAMSIZ);
569 sdata->dev = ndev;
570 sdata->wpan_dev.wpan_phy = local->hw.phy;
571 sdata->local = local;
Alexander Aring986a8ab2014-11-05 20:51:15 +0100572
Alexander Aringd5ae67b2014-11-05 20:51:17 +0100573 /* setup type-dependent data */
574 ret = ieee802154_setup_sdata(sdata, type);
575 if (ret)
576 goto err;
577
Varka Bhadram473f3762014-11-25 16:34:43 +0530578 ret = register_netdevice(ndev);
579 if (ret < 0)
580 goto err;
Alexander Aringd5ae67b2014-11-05 20:51:17 +0100581
582 mutex_lock(&local->iflist_mtx);
583 list_add_tail_rcu(&sdata->list, &local->interfaces);
584 mutex_unlock(&local->iflist_mtx);
585
Alexander Aringd5ae67b2014-11-05 20:51:17 +0100586 return ndev;
587
Alexander Aring986a8ab2014-11-05 20:51:15 +0100588err:
Alexander Aringd5ae67b2014-11-05 20:51:17 +0100589 free_netdev(ndev);
590 return ERR_PTR(ret);
Alexander Aring986a8ab2014-11-05 20:51:15 +0100591}
592
Alexander Aringb210b182014-11-05 20:51:14 +0100593void ieee802154_if_remove(struct ieee802154_sub_if_data *sdata)
594{
595 ASSERT_RTNL();
596
597 mutex_lock(&sdata->local->iflist_mtx);
598 list_del_rcu(&sdata->list);
599 mutex_unlock(&sdata->local->iflist_mtx);
600
601 synchronize_rcu();
602 unregister_netdevice(sdata->dev);
603}
Alexander Aring592dfbf2014-11-12 03:36:48 +0100604
605void ieee802154_remove_interfaces(struct ieee802154_local *local)
606{
Alexander Aringd14e1c72014-11-12 03:36:49 +0100607 struct ieee802154_sub_if_data *sdata, *tmp;
Alexander Aring592dfbf2014-11-12 03:36:48 +0100608
Alexander Aring2789e622014-11-12 03:36:50 +0100609 mutex_lock(&local->iflist_mtx);
Alexander Aringd14e1c72014-11-12 03:36:49 +0100610 list_for_each_entry_safe(sdata, tmp, &local->interfaces, list) {
Alexander Aring592dfbf2014-11-12 03:36:48 +0100611 list_del(&sdata->list);
Alexander Aring592dfbf2014-11-12 03:36:48 +0100612
613 unregister_netdevice(sdata->dev);
614 }
Alexander Aring2789e622014-11-12 03:36:50 +0100615 mutex_unlock(&local->iflist_mtx);
Alexander Aring592dfbf2014-11-12 03:36:48 +0100616}
Alexander Aringbe4fd8e2014-11-12 03:36:53 +0100617
618static int netdev_notify(struct notifier_block *nb,
619 unsigned long state, void *ptr)
620{
621 struct net_device *dev = netdev_notifier_info_to_dev(ptr);
622 struct ieee802154_sub_if_data *sdata;
623
624 if (state != NETDEV_CHANGENAME)
625 return NOTIFY_DONE;
626
627 if (!dev->ieee802154_ptr || !dev->ieee802154_ptr->wpan_phy)
628 return NOTIFY_DONE;
629
630 if (dev->ieee802154_ptr->wpan_phy->privid != mac802154_wpan_phy_privid)
631 return NOTIFY_DONE;
632
633 sdata = IEEE802154_DEV_TO_SUB_IF(dev);
634 memcpy(sdata->name, dev->name, IFNAMSIZ);
635
636 return NOTIFY_OK;
637}
638
639static struct notifier_block mac802154_netdev_notifier = {
640 .notifier_call = netdev_notify,
641};
642
643int ieee802154_iface_init(void)
644{
645 return register_netdevice_notifier(&mac802154_netdev_notifier);
646}
647
648void ieee802154_iface_exit(void)
649{
650 unregister_netdevice_notifier(&mac802154_netdev_notifier);
651}