aboutsummaryrefslogtreecommitdiffstats
path: root/drivers/net
diff options
context:
space:
mode:
authoralex.bluesman.smirnov@gmail.com <alex.bluesman.smirnov@gmail.com>2012-08-26 01:10:11 -0400
committerDavid S. Miller <davem@davemloft.net>2012-08-30 13:23:56 -0400
commit0739d643b8dda866d1011bcfd01008d29593be03 (patch)
tree4748f4a416a6711bb5d6b889f9d3fa342921376f /drivers/net
parent395a57385508f7b8b445b6911bfa35bc0ccaa0ff (diff)
drivers/ieee802154: move ieee802154 drivers to net folder
The IEEE 802.15.4 standard represents a networking protocol. I don't exactly know why drivers for this protocol are stored into the root 'driver' folder, but better will be to store them with other networking stuff. Currently there are only 3 drivers available for IEEE 802.15.4 stack, so lets do it now with the smallest overhead. Signed-off-by: Alexander Smirnov <alex.bluesman.smirnov@gmail.com> Signed-off-by: David S. Miller <davem@davemloft.net>
Diffstat (limited to 'drivers/net')
-rw-r--r--drivers/net/Kconfig4
-rw-r--r--drivers/net/Makefile1
-rw-r--r--drivers/net/ieee802154/Kconfig36
-rw-r--r--drivers/net/ieee802154/Makefile3
-rw-r--r--drivers/net/ieee802154/at86rf230.c958
-rw-r--r--drivers/net/ieee802154/fakehard.c448
-rw-r--r--drivers/net/ieee802154/fakelb.c294
7 files changed, 1742 insertions, 2 deletions
diff --git a/drivers/net/Kconfig b/drivers/net/Kconfig
index 0c2bd806950e..707ab7bd4ea5 100644
--- a/drivers/net/Kconfig
+++ b/drivers/net/Kconfig
@@ -107,8 +107,6 @@ config MII
107 or internal device. It is safe to say Y or M here even if your 107 or internal device. It is safe to say Y or M here even if your
108 ethernet card lacks MII. 108 ethernet card lacks MII.
109 109
110source "drivers/ieee802154/Kconfig"
111
112config IFB 110config IFB
113 tristate "Intermediate Functional Block support" 111 tristate "Intermediate Functional Block support"
114 depends on NET_CLS_ACT 112 depends on NET_CLS_ACT
@@ -290,6 +288,8 @@ source "drivers/net/wimax/Kconfig"
290 288
291source "drivers/net/wan/Kconfig" 289source "drivers/net/wan/Kconfig"
292 290
291source "drivers/net/ieee802154/Kconfig"
292
293config XEN_NETDEV_FRONTEND 293config XEN_NETDEV_FRONTEND
294 tristate "Xen network device frontend driver" 294 tristate "Xen network device frontend driver"
295 depends on XEN 295 depends on XEN
diff --git a/drivers/net/Makefile b/drivers/net/Makefile
index 3d375ca128a6..b682a1de7be8 100644
--- a/drivers/net/Makefile
+++ b/drivers/net/Makefile
@@ -53,6 +53,7 @@ obj-$(CONFIG_SUNGEM_PHY) += sungem_phy.o
53obj-$(CONFIG_WAN) += wan/ 53obj-$(CONFIG_WAN) += wan/
54obj-$(CONFIG_WLAN) += wireless/ 54obj-$(CONFIG_WLAN) += wireless/
55obj-$(CONFIG_WIMAX) += wimax/ 55obj-$(CONFIG_WIMAX) += wimax/
56obj-$(CONFIG_IEEE802154) += ieee802154/
56 57
57obj-$(CONFIG_VMXNET3) += vmxnet3/ 58obj-$(CONFIG_VMXNET3) += vmxnet3/
58obj-$(CONFIG_XEN_NETDEV_FRONTEND) += xen-netfront.o 59obj-$(CONFIG_XEN_NETDEV_FRONTEND) += xen-netfront.o
diff --git a/drivers/net/ieee802154/Kconfig b/drivers/net/ieee802154/Kconfig
new file mode 100644
index 000000000000..1fc4eefc20ed
--- /dev/null
+++ b/drivers/net/ieee802154/Kconfig
@@ -0,0 +1,36 @@
1menuconfig IEEE802154_DRIVERS
2 tristate "IEEE 802.15.4 drivers"
3 depends on NETDEVICES && IEEE802154
4 default y
5 ---help---
6 Say Y here to get to see options for IEEE 802.15.4 Low-Rate
7 Wireless Personal Area Network device drivers. This option alone
8 does not add any kernel code.
9
10 If you say N, all options in this submenu will be skipped and
11 disabled.
12
13config IEEE802154_FAKEHARD
14 tristate "Fake LR-WPAN driver with several interconnected devices"
15 depends on IEEE802154_DRIVERS
16 ---help---
17 Say Y here to enable the fake driver that serves as an example
18 of HardMAC device driver.
19
20 This driver can also be built as a module. To do so say M here.
21 The module will be called 'fakehard'.
22
23config IEEE802154_FAKELB
24 depends on IEEE802154_DRIVERS && MAC802154
25 tristate "IEEE 802.15.4 loopback driver"
26 ---help---
27 Say Y here to enable the fake driver that can emulate a net
28 of several interconnected radio devices.
29
30 This driver can also be built as a module. To do so say M here.
31 The module will be called 'fakelb'.
32
33config IEEE802154_AT86RF230
34 depends on IEEE802154_DRIVERS && MAC802154
35 tristate "AT86RF230/231 transceiver driver"
36 depends on SPI
diff --git a/drivers/net/ieee802154/Makefile b/drivers/net/ieee802154/Makefile
new file mode 100644
index 000000000000..4f4371d3aa7d
--- /dev/null
+++ b/drivers/net/ieee802154/Makefile
@@ -0,0 +1,3 @@
1obj-$(CONFIG_IEEE802154_FAKEHARD) += fakehard.o
2obj-$(CONFIG_IEEE802154_FAKELB) += fakelb.o
3obj-$(CONFIG_IEEE802154_AT86RF230) += at86rf230.o
diff --git a/drivers/net/ieee802154/at86rf230.c b/drivers/net/ieee802154/at86rf230.c
new file mode 100644
index 000000000000..ba753d87a32f
--- /dev/null
+++ b/drivers/net/ieee802154/at86rf230.c
@@ -0,0 +1,958 @@
1/*
2 * AT86RF230/RF231 driver
3 *
4 * Copyright (C) 2009-2012 Siemens AG
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2
8 * as published by the Free Software Foundation.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License along
16 * with this program; if not, write to the Free Software Foundation, Inc.,
17 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
18 *
19 * Written by:
20 * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com>
21 * Alexander Smirnov <alex.bluesman.smirnov@gmail.com>
22 */
23#include <linux/kernel.h>
24#include <linux/module.h>
25#include <linux/interrupt.h>
26#include <linux/gpio.h>
27#include <linux/delay.h>
28#include <linux/mutex.h>
29#include <linux/workqueue.h>
30#include <linux/spinlock.h>
31#include <linux/spi/spi.h>
32#include <linux/spi/at86rf230.h>
33#include <linux/skbuff.h>
34
35#include <net/mac802154.h>
36#include <net/wpan-phy.h>
37
38struct at86rf230_local {
39 struct spi_device *spi;
40 int rstn, slp_tr, dig2;
41
42 u8 part;
43 u8 vers;
44
45 u8 buf[2];
46 struct mutex bmux;
47
48 struct work_struct irqwork;
49 struct completion tx_complete;
50
51 struct ieee802154_dev *dev;
52
53 spinlock_t lock;
54 bool irq_disabled;
55 bool is_tx;
56};
57
58#define RG_TRX_STATUS (0x01)
59#define SR_TRX_STATUS 0x01, 0x1f, 0
60#define SR_RESERVED_01_3 0x01, 0x20, 5
61#define SR_CCA_STATUS 0x01, 0x40, 6
62#define SR_CCA_DONE 0x01, 0x80, 7
63#define RG_TRX_STATE (0x02)
64#define SR_TRX_CMD 0x02, 0x1f, 0
65#define SR_TRAC_STATUS 0x02, 0xe0, 5
66#define RG_TRX_CTRL_0 (0x03)
67#define SR_CLKM_CTRL 0x03, 0x07, 0
68#define SR_CLKM_SHA_SEL 0x03, 0x08, 3
69#define SR_PAD_IO_CLKM 0x03, 0x30, 4
70#define SR_PAD_IO 0x03, 0xc0, 6
71#define RG_TRX_CTRL_1 (0x04)
72#define SR_IRQ_POLARITY 0x04, 0x01, 0
73#define SR_IRQ_MASK_MODE 0x04, 0x02, 1
74#define SR_SPI_CMD_MODE 0x04, 0x0c, 2
75#define SR_RX_BL_CTRL 0x04, 0x10, 4
76#define SR_TX_AUTO_CRC_ON 0x04, 0x20, 5
77#define SR_IRQ_2_EXT_EN 0x04, 0x40, 6
78#define SR_PA_EXT_EN 0x04, 0x80, 7
79#define RG_PHY_TX_PWR (0x05)
80#define SR_TX_PWR 0x05, 0x0f, 0
81#define SR_PA_LT 0x05, 0x30, 4
82#define SR_PA_BUF_LT 0x05, 0xc0, 6
83#define RG_PHY_RSSI (0x06)
84#define SR_RSSI 0x06, 0x1f, 0
85#define SR_RND_VALUE 0x06, 0x60, 5
86#define SR_RX_CRC_VALID 0x06, 0x80, 7
87#define RG_PHY_ED_LEVEL (0x07)
88#define SR_ED_LEVEL 0x07, 0xff, 0
89#define RG_PHY_CC_CCA (0x08)
90#define SR_CHANNEL 0x08, 0x1f, 0
91#define SR_CCA_MODE 0x08, 0x60, 5
92#define SR_CCA_REQUEST 0x08, 0x80, 7
93#define RG_CCA_THRES (0x09)
94#define SR_CCA_ED_THRES 0x09, 0x0f, 0
95#define SR_RESERVED_09_1 0x09, 0xf0, 4
96#define RG_RX_CTRL (0x0a)
97#define SR_PDT_THRES 0x0a, 0x0f, 0
98#define SR_RESERVED_0a_1 0x0a, 0xf0, 4
99#define RG_SFD_VALUE (0x0b)
100#define SR_SFD_VALUE 0x0b, 0xff, 0
101#define RG_TRX_CTRL_2 (0x0c)
102#define SR_OQPSK_DATA_RATE 0x0c, 0x03, 0
103#define SR_RESERVED_0c_2 0x0c, 0x7c, 2
104#define SR_RX_SAFE_MODE 0x0c, 0x80, 7
105#define RG_ANT_DIV (0x0d)
106#define SR_ANT_CTRL 0x0d, 0x03, 0
107#define SR_ANT_EXT_SW_EN 0x0d, 0x04, 2
108#define SR_ANT_DIV_EN 0x0d, 0x08, 3
109#define SR_RESERVED_0d_2 0x0d, 0x70, 4
110#define SR_ANT_SEL 0x0d, 0x80, 7
111#define RG_IRQ_MASK (0x0e)
112#define SR_IRQ_MASK 0x0e, 0xff, 0
113#define RG_IRQ_STATUS (0x0f)
114#define SR_IRQ_0_PLL_LOCK 0x0f, 0x01, 0
115#define SR_IRQ_1_PLL_UNLOCK 0x0f, 0x02, 1
116#define SR_IRQ_2_RX_START 0x0f, 0x04, 2
117#define SR_IRQ_3_TRX_END 0x0f, 0x08, 3
118#define SR_IRQ_4_CCA_ED_DONE 0x0f, 0x10, 4
119#define SR_IRQ_5_AMI 0x0f, 0x20, 5
120#define SR_IRQ_6_TRX_UR 0x0f, 0x40, 6
121#define SR_IRQ_7_BAT_LOW 0x0f, 0x80, 7
122#define RG_VREG_CTRL (0x10)
123#define SR_RESERVED_10_6 0x10, 0x03, 0
124#define SR_DVDD_OK 0x10, 0x04, 2
125#define SR_DVREG_EXT 0x10, 0x08, 3
126#define SR_RESERVED_10_3 0x10, 0x30, 4
127#define SR_AVDD_OK 0x10, 0x40, 6
128#define SR_AVREG_EXT 0x10, 0x80, 7
129#define RG_BATMON (0x11)
130#define SR_BATMON_VTH 0x11, 0x0f, 0
131#define SR_BATMON_HR 0x11, 0x10, 4
132#define SR_BATMON_OK 0x11, 0x20, 5
133#define SR_RESERVED_11_1 0x11, 0xc0, 6
134#define RG_XOSC_CTRL (0x12)
135#define SR_XTAL_TRIM 0x12, 0x0f, 0
136#define SR_XTAL_MODE 0x12, 0xf0, 4
137#define RG_RX_SYN (0x15)
138#define SR_RX_PDT_LEVEL 0x15, 0x0f, 0
139#define SR_RESERVED_15_2 0x15, 0x70, 4
140#define SR_RX_PDT_DIS 0x15, 0x80, 7
141#define RG_XAH_CTRL_1 (0x17)
142#define SR_RESERVED_17_8 0x17, 0x01, 0
143#define SR_AACK_PROM_MODE 0x17, 0x02, 1
144#define SR_AACK_ACK_TIME 0x17, 0x04, 2
145#define SR_RESERVED_17_5 0x17, 0x08, 3
146#define SR_AACK_UPLD_RES_FT 0x17, 0x10, 4
147#define SR_AACK_FLTR_RES_FT 0x17, 0x20, 5
148#define SR_RESERVED_17_2 0x17, 0x40, 6
149#define SR_RESERVED_17_1 0x17, 0x80, 7
150#define RG_FTN_CTRL (0x18)
151#define SR_RESERVED_18_2 0x18, 0x7f, 0
152#define SR_FTN_START 0x18, 0x80, 7
153#define RG_PLL_CF (0x1a)
154#define SR_RESERVED_1a_2 0x1a, 0x7f, 0
155#define SR_PLL_CF_START 0x1a, 0x80, 7
156#define RG_PLL_DCU (0x1b)
157#define SR_RESERVED_1b_3 0x1b, 0x3f, 0
158#define SR_RESERVED_1b_2 0x1b, 0x40, 6
159#define SR_PLL_DCU_START 0x1b, 0x80, 7
160#define RG_PART_NUM (0x1c)
161#define SR_PART_NUM 0x1c, 0xff, 0
162#define RG_VERSION_NUM (0x1d)
163#define SR_VERSION_NUM 0x1d, 0xff, 0
164#define RG_MAN_ID_0 (0x1e)
165#define SR_MAN_ID_0 0x1e, 0xff, 0
166#define RG_MAN_ID_1 (0x1f)
167#define SR_MAN_ID_1 0x1f, 0xff, 0
168#define RG_SHORT_ADDR_0 (0x20)
169#define SR_SHORT_ADDR_0 0x20, 0xff, 0
170#define RG_SHORT_ADDR_1 (0x21)
171#define SR_SHORT_ADDR_1 0x21, 0xff, 0
172#define RG_PAN_ID_0 (0x22)
173#define SR_PAN_ID_0 0x22, 0xff, 0
174#define RG_PAN_ID_1 (0x23)
175#define SR_PAN_ID_1 0x23, 0xff, 0
176#define RG_IEEE_ADDR_0 (0x24)
177#define SR_IEEE_ADDR_0 0x24, 0xff, 0
178#define RG_IEEE_ADDR_1 (0x25)
179#define SR_IEEE_ADDR_1 0x25, 0xff, 0
180#define RG_IEEE_ADDR_2 (0x26)
181#define SR_IEEE_ADDR_2 0x26, 0xff, 0
182#define RG_IEEE_ADDR_3 (0x27)
183#define SR_IEEE_ADDR_3 0x27, 0xff, 0
184#define RG_IEEE_ADDR_4 (0x28)
185#define SR_IEEE_ADDR_4 0x28, 0xff, 0
186#define RG_IEEE_ADDR_5 (0x29)
187#define SR_IEEE_ADDR_5 0x29, 0xff, 0
188#define RG_IEEE_ADDR_6 (0x2a)
189#define SR_IEEE_ADDR_6 0x2a, 0xff, 0
190#define RG_IEEE_ADDR_7 (0x2b)
191#define SR_IEEE_ADDR_7 0x2b, 0xff, 0
192#define RG_XAH_CTRL_0 (0x2c)
193#define SR_SLOTTED_OPERATION 0x2c, 0x01, 0
194#define SR_MAX_CSMA_RETRIES 0x2c, 0x0e, 1
195#define SR_MAX_FRAME_RETRIES 0x2c, 0xf0, 4
196#define RG_CSMA_SEED_0 (0x2d)
197#define SR_CSMA_SEED_0 0x2d, 0xff, 0
198#define RG_CSMA_SEED_1 (0x2e)
199#define SR_CSMA_SEED_1 0x2e, 0x07, 0
200#define SR_AACK_I_AM_COORD 0x2e, 0x08, 3
201#define SR_AACK_DIS_ACK 0x2e, 0x10, 4
202#define SR_AACK_SET_PD 0x2e, 0x20, 5
203#define SR_AACK_FVN_MODE 0x2e, 0xc0, 6
204#define RG_CSMA_BE (0x2f)
205#define SR_MIN_BE 0x2f, 0x0f, 0
206#define SR_MAX_BE 0x2f, 0xf0, 4
207
208#define CMD_REG 0x80
209#define CMD_REG_MASK 0x3f
210#define CMD_WRITE 0x40
211#define CMD_FB 0x20
212
213#define IRQ_BAT_LOW (1 << 7)
214#define IRQ_TRX_UR (1 << 6)
215#define IRQ_AMI (1 << 5)
216#define IRQ_CCA_ED (1 << 4)
217#define IRQ_TRX_END (1 << 3)
218#define IRQ_RX_START (1 << 2)
219#define IRQ_PLL_UNL (1 << 1)
220#define IRQ_PLL_LOCK (1 << 0)
221
222#define STATE_P_ON 0x00 /* BUSY */
223#define STATE_BUSY_RX 0x01
224#define STATE_BUSY_TX 0x02
225#define STATE_FORCE_TRX_OFF 0x03
226#define STATE_FORCE_TX_ON 0x04 /* IDLE */
227/* 0x05 */ /* INVALID_PARAMETER */
228#define STATE_RX_ON 0x06
229/* 0x07 */ /* SUCCESS */
230#define STATE_TRX_OFF 0x08
231#define STATE_TX_ON 0x09
232/* 0x0a - 0x0e */ /* 0x0a - UNSUPPORTED_ATTRIBUTE */
233#define STATE_SLEEP 0x0F
234#define STATE_BUSY_RX_AACK 0x11
235#define STATE_BUSY_TX_ARET 0x12
236#define STATE_BUSY_RX_AACK_ON 0x16
237#define STATE_BUSY_TX_ARET_ON 0x19
238#define STATE_RX_ON_NOCLK 0x1C
239#define STATE_RX_AACK_ON_NOCLK 0x1D
240#define STATE_BUSY_RX_AACK_NOCLK 0x1E
241#define STATE_TRANSITION_IN_PROGRESS 0x1F
242
243static int
244__at86rf230_write(struct at86rf230_local *lp, u8 addr, u8 data)
245{
246 u8 *buf = lp->buf;
247 int status;
248 struct spi_message msg;
249 struct spi_transfer xfer = {
250 .len = 2,
251 .tx_buf = buf,
252 };
253
254 buf[0] = (addr & CMD_REG_MASK) | CMD_REG | CMD_WRITE;
255 buf[1] = data;
256 dev_vdbg(&lp->spi->dev, "buf[0] = %02x\n", buf[0]);
257 dev_vdbg(&lp->spi->dev, "buf[1] = %02x\n", buf[1]);
258 spi_message_init(&msg);
259 spi_message_add_tail(&xfer, &msg);
260
261 status = spi_sync(lp->spi, &msg);
262 dev_vdbg(&lp->spi->dev, "status = %d\n", status);
263 if (msg.status)
264 status = msg.status;
265
266 dev_vdbg(&lp->spi->dev, "status = %d\n", status);
267 dev_vdbg(&lp->spi->dev, "buf[0] = %02x\n", buf[0]);
268 dev_vdbg(&lp->spi->dev, "buf[1] = %02x\n", buf[1]);
269
270 return status;
271}
272
273static int
274__at86rf230_read_subreg(struct at86rf230_local *lp,
275 u8 addr, u8 mask, int shift, u8 *data)
276{
277 u8 *buf = lp->buf;
278 int status;
279 struct spi_message msg;
280 struct spi_transfer xfer = {
281 .len = 2,
282 .tx_buf = buf,
283 .rx_buf = buf,
284 };
285
286 buf[0] = (addr & CMD_REG_MASK) | CMD_REG;
287 buf[1] = 0xff;
288 dev_vdbg(&lp->spi->dev, "buf[0] = %02x\n", buf[0]);
289 spi_message_init(&msg);
290 spi_message_add_tail(&xfer, &msg);
291
292 status = spi_sync(lp->spi, &msg);
293 dev_vdbg(&lp->spi->dev, "status = %d\n", status);
294 if (msg.status)
295 status = msg.status;
296
297 dev_vdbg(&lp->spi->dev, "status = %d\n", status);
298 dev_vdbg(&lp->spi->dev, "buf[0] = %02x\n", buf[0]);
299 dev_vdbg(&lp->spi->dev, "buf[1] = %02x\n", buf[1]);
300
301 if (status == 0)
302 *data = buf[1];
303
304 return status;
305}
306
307static int
308at86rf230_read_subreg(struct at86rf230_local *lp,
309 u8 addr, u8 mask, int shift, u8 *data)
310{
311 int status;
312
313 mutex_lock(&lp->bmux);
314 status = __at86rf230_read_subreg(lp, addr, mask, shift, data);
315 mutex_unlock(&lp->bmux);
316
317 return status;
318}
319
320static int
321at86rf230_write_subreg(struct at86rf230_local *lp,
322 u8 addr, u8 mask, int shift, u8 data)
323{
324 int status;
325 u8 val;
326
327 mutex_lock(&lp->bmux);
328 status = __at86rf230_read_subreg(lp, addr, 0xff, 0, &val);
329 if (status)
330 goto out;
331
332 val &= ~mask;
333 val |= (data << shift) & mask;
334
335 status = __at86rf230_write(lp, addr, val);
336out:
337 mutex_unlock(&lp->bmux);
338
339 return status;
340}
341
342static int
343at86rf230_write_fbuf(struct at86rf230_local *lp, u8 *data, u8 len)
344{
345 u8 *buf = lp->buf;
346 int status;
347 struct spi_message msg;
348 struct spi_transfer xfer_head = {
349 .len = 2,
350 .tx_buf = buf,
351
352 };
353 struct spi_transfer xfer_buf = {
354 .len = len,
355 .tx_buf = data,
356 };
357
358 mutex_lock(&lp->bmux);
359 buf[0] = CMD_WRITE | CMD_FB;
360 buf[1] = len + 2; /* 2 bytes for CRC that isn't written */
361
362 dev_vdbg(&lp->spi->dev, "buf[0] = %02x\n", buf[0]);
363 dev_vdbg(&lp->spi->dev, "buf[1] = %02x\n", buf[1]);
364
365 spi_message_init(&msg);
366 spi_message_add_tail(&xfer_head, &msg);
367 spi_message_add_tail(&xfer_buf, &msg);
368
369 status = spi_sync(lp->spi, &msg);
370 dev_vdbg(&lp->spi->dev, "status = %d\n", status);
371 if (msg.status)
372 status = msg.status;
373
374 dev_vdbg(&lp->spi->dev, "status = %d\n", status);
375 dev_vdbg(&lp->spi->dev, "buf[0] = %02x\n", buf[0]);
376 dev_vdbg(&lp->spi->dev, "buf[1] = %02x\n", buf[1]);
377
378 mutex_unlock(&lp->bmux);
379 return status;
380}
381
382static int
383at86rf230_read_fbuf(struct at86rf230_local *lp, u8 *data, u8 *len, u8 *lqi)
384{
385 u8 *buf = lp->buf;
386 int status;
387 struct spi_message msg;
388 struct spi_transfer xfer_head = {
389 .len = 2,
390 .tx_buf = buf,
391 .rx_buf = buf,
392 };
393 struct spi_transfer xfer_head1 = {
394 .len = 2,
395 .tx_buf = buf,
396 .rx_buf = buf,
397 };
398 struct spi_transfer xfer_buf = {
399 .len = 0,
400 .rx_buf = data,
401 };
402
403 mutex_lock(&lp->bmux);
404
405 buf[0] = CMD_FB;
406 buf[1] = 0x00;
407
408 spi_message_init(&msg);
409 spi_message_add_tail(&xfer_head, &msg);
410
411 status = spi_sync(lp->spi, &msg);
412 dev_vdbg(&lp->spi->dev, "status = %d\n", status);
413
414 xfer_buf.len = *(buf + 1) + 1;
415 *len = buf[1];
416
417 buf[0] = CMD_FB;
418 buf[1] = 0x00;
419
420 spi_message_init(&msg);
421 spi_message_add_tail(&xfer_head1, &msg);
422 spi_message_add_tail(&xfer_buf, &msg);
423
424 status = spi_sync(lp->spi, &msg);
425
426 if (msg.status)
427 status = msg.status;
428
429 dev_vdbg(&lp->spi->dev, "status = %d\n", status);
430 dev_vdbg(&lp->spi->dev, "buf[0] = %02x\n", buf[0]);
431 dev_vdbg(&lp->spi->dev, "buf[1] = %02x\n", buf[1]);
432
433 if (status) {
434 if (lqi && (*len > lp->buf[1]))
435 *lqi = data[lp->buf[1]];
436 }
437 mutex_unlock(&lp->bmux);
438
439 return status;
440}
441
442static int
443at86rf230_ed(struct ieee802154_dev *dev, u8 *level)
444{
445 might_sleep();
446 BUG_ON(!level);
447 *level = 0xbe;
448 return 0;
449}
450
451static int
452at86rf230_state(struct ieee802154_dev *dev, int state)
453{
454 struct at86rf230_local *lp = dev->priv;
455 int rc;
456 u8 val;
457 u8 desired_status;
458
459 might_sleep();
460
461 if (state == STATE_FORCE_TX_ON)
462 desired_status = STATE_TX_ON;
463 else if (state == STATE_FORCE_TRX_OFF)
464 desired_status = STATE_TRX_OFF;
465 else
466 desired_status = state;
467
468 do {
469 rc = at86rf230_read_subreg(lp, SR_TRX_STATUS, &val);
470 if (rc)
471 goto err;
472 } while (val == STATE_TRANSITION_IN_PROGRESS);
473
474 if (val == desired_status)
475 return 0;
476
477 /* state is equal to phy states */
478 rc = at86rf230_write_subreg(lp, SR_TRX_CMD, state);
479 if (rc)
480 goto err;
481
482 do {
483 rc = at86rf230_read_subreg(lp, SR_TRX_STATUS, &val);
484 if (rc)
485 goto err;
486 } while (val == STATE_TRANSITION_IN_PROGRESS);
487
488
489 if (val == desired_status)
490 return 0;
491
492 pr_err("unexpected state change: %d, asked for %d\n", val, state);
493 return -EBUSY;
494
495err:
496 pr_err("error: %d\n", rc);
497 return rc;
498}
499
500static int
501at86rf230_start(struct ieee802154_dev *dev)
502{
503 struct at86rf230_local *lp = dev->priv;
504 u8 rc;
505
506 rc = at86rf230_write_subreg(lp, SR_RX_SAFE_MODE, 1);
507 if (rc)
508 return rc;
509
510 return at86rf230_state(dev, STATE_RX_ON);
511}
512
513static void
514at86rf230_stop(struct ieee802154_dev *dev)
515{
516 at86rf230_state(dev, STATE_FORCE_TRX_OFF);
517}
518
519static int
520at86rf230_channel(struct ieee802154_dev *dev, int page, int channel)
521{
522 struct at86rf230_local *lp = dev->priv;
523 int rc;
524
525 might_sleep();
526
527 if (page != 0 || channel < 11 || channel > 26) {
528 WARN_ON(1);
529 return -EINVAL;
530 }
531
532 rc = at86rf230_write_subreg(lp, SR_CHANNEL, channel);
533 msleep(1); /* Wait for PLL */
534 dev->phy->current_channel = channel;
535
536 return 0;
537}
538
539static int
540at86rf230_xmit(struct ieee802154_dev *dev, struct sk_buff *skb)
541{
542 struct at86rf230_local *lp = dev->priv;
543 int rc;
544 unsigned long flags;
545
546 spin_lock(&lp->lock);
547 if (lp->irq_disabled) {
548 spin_unlock(&lp->lock);
549 return -EBUSY;
550 }
551 spin_unlock(&lp->lock);
552
553 might_sleep();
554
555 rc = at86rf230_state(dev, STATE_FORCE_TX_ON);
556 if (rc)
557 goto err;
558
559 spin_lock_irqsave(&lp->lock, flags);
560 lp->is_tx = 1;
561 INIT_COMPLETION(lp->tx_complete);
562 spin_unlock_irqrestore(&lp->lock, flags);
563
564 rc = at86rf230_write_fbuf(lp, skb->data, skb->len);
565 if (rc)
566 goto err_rx;
567
568 rc = at86rf230_write_subreg(lp, SR_TRX_CMD, STATE_BUSY_TX);
569 if (rc)
570 goto err_rx;
571
572 rc = wait_for_completion_interruptible(&lp->tx_complete);
573 if (rc < 0)
574 goto err_rx;
575
576 rc = at86rf230_start(dev);
577
578 return rc;
579
580err_rx:
581 at86rf230_start(dev);
582err:
583 pr_err("error: %d\n", rc);
584
585 spin_lock_irqsave(&lp->lock, flags);
586 lp->is_tx = 0;
587 spin_unlock_irqrestore(&lp->lock, flags);
588
589 return rc;
590}
591
592static int at86rf230_rx(struct at86rf230_local *lp)
593{
594 u8 len = 128, lqi = 0;
595 struct sk_buff *skb;
596
597 skb = alloc_skb(len, GFP_KERNEL);
598
599 if (!skb)
600 return -ENOMEM;
601
602 if (at86rf230_read_fbuf(lp, skb_put(skb, len), &len, &lqi))
603 goto err;
604
605 if (len < 2)
606 goto err;
607
608 skb_trim(skb, len - 2); /* We do not put CRC into the frame */
609
610 ieee802154_rx_irqsafe(lp->dev, skb, lqi);
611
612 dev_dbg(&lp->spi->dev, "READ_FBUF: %d %x\n", len, lqi);
613
614 return 0;
615err:
616 pr_debug("received frame is too small\n");
617
618 kfree_skb(skb);
619 return -EINVAL;
620}
621
622static struct ieee802154_ops at86rf230_ops = {
623 .owner = THIS_MODULE,
624 .xmit = at86rf230_xmit,
625 .ed = at86rf230_ed,
626 .set_channel = at86rf230_channel,
627 .start = at86rf230_start,
628 .stop = at86rf230_stop,
629};
630
631static void at86rf230_irqwork(struct work_struct *work)
632{
633 struct at86rf230_local *lp =
634 container_of(work, struct at86rf230_local, irqwork);
635 u8 status = 0, val;
636 int rc;
637 unsigned long flags;
638
639 rc = at86rf230_read_subreg(lp, RG_IRQ_STATUS, 0xff, 0, &val);
640 status |= val;
641
642 status &= ~IRQ_PLL_LOCK; /* ignore */
643 status &= ~IRQ_RX_START; /* ignore */
644 status &= ~IRQ_AMI; /* ignore */
645 status &= ~IRQ_TRX_UR; /* FIXME: possibly handle ???*/
646
647 if (status & IRQ_TRX_END) {
648 spin_lock_irqsave(&lp->lock, flags);
649 status &= ~IRQ_TRX_END;
650 if (lp->is_tx) {
651 lp->is_tx = 0;
652 spin_unlock_irqrestore(&lp->lock, flags);
653 complete(&lp->tx_complete);
654 } else {
655 spin_unlock_irqrestore(&lp->lock, flags);
656 at86rf230_rx(lp);
657 }
658 }
659
660 spin_lock_irqsave(&lp->lock, flags);
661 lp->irq_disabled = 0;
662 spin_unlock_irqrestore(&lp->lock, flags);
663
664 enable_irq(lp->spi->irq);
665}
666
667static irqreturn_t at86rf230_isr(int irq, void *data)
668{
669 struct at86rf230_local *lp = data;
670
671 disable_irq_nosync(irq);
672
673 spin_lock(&lp->lock);
674 lp->irq_disabled = 1;
675 spin_unlock(&lp->lock);
676
677 schedule_work(&lp->irqwork);
678
679 return IRQ_HANDLED;
680}
681
682
683static int at86rf230_hw_init(struct at86rf230_local *lp)
684{
685 u8 status;
686 int rc;
687
688 rc = at86rf230_read_subreg(lp, SR_TRX_STATUS, &status);
689 if (rc)
690 return rc;
691
692 dev_info(&lp->spi->dev, "Status: %02x\n", status);
693 if (status == STATE_P_ON) {
694 rc = at86rf230_write_subreg(lp, SR_TRX_CMD, STATE_TRX_OFF);
695 if (rc)
696 return rc;
697 msleep(1);
698 rc = at86rf230_read_subreg(lp, SR_TRX_STATUS, &status);
699 if (rc)
700 return rc;
701 dev_info(&lp->spi->dev, "Status: %02x\n", status);
702 }
703
704 rc = at86rf230_write_subreg(lp, SR_IRQ_MASK, 0xff); /* IRQ_TRX_UR |
705 * IRQ_CCA_ED |
706 * IRQ_TRX_END |
707 * IRQ_PLL_UNL |
708 * IRQ_PLL_LOCK
709 */
710 if (rc)
711 return rc;
712
713 /* CLKM changes are applied immediately */
714 rc = at86rf230_write_subreg(lp, SR_CLKM_SHA_SEL, 0x00);
715 if (rc)
716 return rc;
717
718 /* Turn CLKM Off */
719 rc = at86rf230_write_subreg(lp, SR_CLKM_CTRL, 0x00);
720 if (rc)
721 return rc;
722 /* Wait the next SLEEP cycle */
723 msleep(100);
724
725 rc = at86rf230_write_subreg(lp, SR_TRX_CMD, STATE_TX_ON);
726 if (rc)
727 return rc;
728 msleep(1);
729
730 rc = at86rf230_read_subreg(lp, SR_TRX_STATUS, &status);
731 if (rc)
732 return rc;
733 dev_info(&lp->spi->dev, "Status: %02x\n", status);
734
735 rc = at86rf230_read_subreg(lp, SR_DVDD_OK, &status);
736 if (rc)
737 return rc;
738 if (!status) {
739 dev_err(&lp->spi->dev, "DVDD error\n");
740 return -EINVAL;
741 }
742
743 rc = at86rf230_read_subreg(lp, SR_AVDD_OK, &status);
744 if (rc)
745 return rc;
746 if (!status) {
747 dev_err(&lp->spi->dev, "AVDD error\n");
748 return -EINVAL;
749 }
750
751 return 0;
752}
753
754static int at86rf230_suspend(struct spi_device *spi, pm_message_t message)
755{
756 return 0;
757}
758
759static int at86rf230_resume(struct spi_device *spi)
760{
761 return 0;
762}
763
764static int at86rf230_fill_data(struct spi_device *spi)
765{
766 struct at86rf230_local *lp = spi_get_drvdata(spi);
767 struct at86rf230_platform_data *pdata = spi->dev.platform_data;
768
769 if (!pdata) {
770 dev_err(&spi->dev, "no platform_data\n");
771 return -EINVAL;
772 }
773
774 lp->rstn = pdata->rstn;
775 lp->slp_tr = pdata->slp_tr;
776 lp->dig2 = pdata->dig2;
777
778 return 0;
779}
780
781static int __devinit at86rf230_probe(struct spi_device *spi)
782{
783 struct ieee802154_dev *dev;
784 struct at86rf230_local *lp;
785 u8 man_id_0, man_id_1;
786 int rc;
787 const char *chip;
788 int supported = 0;
789
790 if (!spi->irq) {
791 dev_err(&spi->dev, "no IRQ specified\n");
792 return -EINVAL;
793 }
794
795 dev = ieee802154_alloc_device(sizeof(*lp), &at86rf230_ops);
796 if (!dev)
797 return -ENOMEM;
798
799 lp = dev->priv;
800 lp->dev = dev;
801
802 lp->spi = spi;
803
804 dev->priv = lp;
805 dev->parent = &spi->dev;
806 dev->extra_tx_headroom = 0;
807 /* We do support only 2.4 Ghz */
808 dev->phy->channels_supported[0] = 0x7FFF800;
809 dev->flags = IEEE802154_HW_OMIT_CKSUM;
810
811 mutex_init(&lp->bmux);
812 INIT_WORK(&lp->irqwork, at86rf230_irqwork);
813 spin_lock_init(&lp->lock);
814 init_completion(&lp->tx_complete);
815
816 spi_set_drvdata(spi, lp);
817
818 rc = at86rf230_fill_data(spi);
819 if (rc)
820 goto err_fill;
821
822 rc = gpio_request(lp->rstn, "rstn");
823 if (rc)
824 goto err_rstn;
825
826 if (gpio_is_valid(lp->slp_tr)) {
827 rc = gpio_request(lp->slp_tr, "slp_tr");
828 if (rc)
829 goto err_slp_tr;
830 }
831
832 rc = gpio_direction_output(lp->rstn, 1);
833 if (rc)
834 goto err_gpio_dir;
835
836 if (gpio_is_valid(lp->slp_tr)) {
837 rc = gpio_direction_output(lp->slp_tr, 0);
838 if (rc)
839 goto err_gpio_dir;
840 }
841
842 /* Reset */
843 msleep(1);
844 gpio_set_value(lp->rstn, 0);
845 msleep(1);
846 gpio_set_value(lp->rstn, 1);
847 msleep(1);
848
849 rc = at86rf230_read_subreg(lp, SR_MAN_ID_0, &man_id_0);
850 if (rc)
851 goto err_gpio_dir;
852 rc = at86rf230_read_subreg(lp, SR_MAN_ID_1, &man_id_1);
853 if (rc)
854 goto err_gpio_dir;
855
856 if (man_id_1 != 0x00 || man_id_0 != 0x1f) {
857 dev_err(&spi->dev, "Non-Atmel dev found (MAN_ID %02x %02x)\n",
858 man_id_1, man_id_0);
859 rc = -EINVAL;
860 goto err_gpio_dir;
861 }
862
863 rc = at86rf230_read_subreg(lp, SR_PART_NUM, &lp->part);
864 if (rc)
865 goto err_gpio_dir;
866
867 rc = at86rf230_read_subreg(lp, SR_VERSION_NUM, &lp->vers);
868 if (rc)
869 goto err_gpio_dir;
870
871 switch (lp->part) {
872 case 2:
873 chip = "at86rf230";
874 /* supported = 1; FIXME: should be easy to support; */
875 break;
876 case 3:
877 chip = "at86rf231";
878 supported = 1;
879 break;
880 default:
881 chip = "UNKNOWN";
882 break;
883 }
884
885 dev_info(&spi->dev, "Detected %s chip version %d\n", chip, lp->vers);
886 if (!supported) {
887 rc = -ENOTSUPP;
888 goto err_gpio_dir;
889 }
890
891 rc = at86rf230_hw_init(lp);
892 if (rc)
893 goto err_gpio_dir;
894
895 rc = request_irq(spi->irq, at86rf230_isr, IRQF_SHARED,
896 dev_name(&spi->dev), lp);
897 if (rc)
898 goto err_gpio_dir;
899
900 rc = ieee802154_register_device(lp->dev);
901 if (rc)
902 goto err_irq;
903
904 return rc;
905
906 ieee802154_unregister_device(lp->dev);
907err_irq:
908 free_irq(spi->irq, lp);
909 flush_work(&lp->irqwork);
910err_gpio_dir:
911 if (gpio_is_valid(lp->slp_tr))
912 gpio_free(lp->slp_tr);
913err_slp_tr:
914 gpio_free(lp->rstn);
915err_rstn:
916err_fill:
917 spi_set_drvdata(spi, NULL);
918 mutex_destroy(&lp->bmux);
919 ieee802154_free_device(lp->dev);
920 return rc;
921}
922
923static int __devexit at86rf230_remove(struct spi_device *spi)
924{
925 struct at86rf230_local *lp = spi_get_drvdata(spi);
926
927 ieee802154_unregister_device(lp->dev);
928
929 free_irq(spi->irq, lp);
930 flush_work(&lp->irqwork);
931
932 if (gpio_is_valid(lp->slp_tr))
933 gpio_free(lp->slp_tr);
934 gpio_free(lp->rstn);
935
936 spi_set_drvdata(spi, NULL);
937 mutex_destroy(&lp->bmux);
938 ieee802154_free_device(lp->dev);
939
940 dev_dbg(&spi->dev, "unregistered at86rf230\n");
941 return 0;
942}
943
944static struct spi_driver at86rf230_driver = {
945 .driver = {
946 .name = "at86rf230",
947 .owner = THIS_MODULE,
948 },
949 .probe = at86rf230_probe,
950 .remove = __devexit_p(at86rf230_remove),
951 .suspend = at86rf230_suspend,
952 .resume = at86rf230_resume,
953};
954
955module_spi_driver(at86rf230_driver);
956
957MODULE_DESCRIPTION("AT86RF230 Transceiver Driver");
958MODULE_LICENSE("GPL v2");
diff --git a/drivers/net/ieee802154/fakehard.c b/drivers/net/ieee802154/fakehard.c
new file mode 100644
index 000000000000..7d39add7d467
--- /dev/null
+++ b/drivers/net/ieee802154/fakehard.c
@@ -0,0 +1,448 @@
1/*
2 * Sample driver for HardMAC IEEE 802.15.4 devices
3 *
4 * Copyright (C) 2009 Siemens AG
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2
8 * as published by the Free Software Foundation.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License along
16 * with this program; if not, write to the Free Software Foundation, Inc.,
17 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
18 *
19 * Written by:
20 * Dmitry Eremin-Solenikov <dmitry.baryshkov@siemens.com>
21 */
22#include <linux/kernel.h>
23#include <linux/module.h>
24#include <linux/platform_device.h>
25#include <linux/netdevice.h>
26#include <linux/skbuff.h>
27#include <linux/if_arp.h>
28
29#include <net/af_ieee802154.h>
30#include <net/ieee802154_netdev.h>
31#include <net/ieee802154.h>
32#include <net/nl802154.h>
33#include <net/wpan-phy.h>
34
35struct fakehard_priv {
36 struct wpan_phy *phy;
37};
38
39static struct wpan_phy *fake_to_phy(const struct net_device *dev)
40{
41 struct fakehard_priv *priv = netdev_priv(dev);
42 return priv->phy;
43}
44
45/**
46 * fake_get_phy - Return a phy corresponding to this device.
47 * @dev: The network device for which to return the wan-phy object
48 *
49 * This function returns a wpan-phy object corresponding to the passed
50 * network device. Reference counter for wpan-phy object is incremented,
51 * so when the wpan-phy isn't necessary, you should drop the reference
52 * via @wpan_phy_put() call.
53 */
54static struct wpan_phy *fake_get_phy(const struct net_device *dev)
55{
56 struct wpan_phy *phy = fake_to_phy(dev);
57 return to_phy(get_device(&phy->dev));
58}
59
60/**
61 * fake_get_pan_id - Retrieve the PAN ID of the device.
62 * @dev: The network device to retrieve the PAN of.
63 *
64 * Return the ID of the PAN from the PIB.
65 */
66static u16 fake_get_pan_id(const struct net_device *dev)
67{
68 BUG_ON(dev->type != ARPHRD_IEEE802154);
69
70 return 0xeba1;
71}
72
73/**
74 * fake_get_short_addr - Retrieve the short address of the device.
75 * @dev: The network device to retrieve the short address of.
76 *
77 * Returns the IEEE 802.15.4 short-form address cached for this
78 * device. If the device has not yet had a short address assigned
79 * then this should return 0xFFFF to indicate a lack of association.
80 */
81static u16 fake_get_short_addr(const struct net_device *dev)
82{
83 BUG_ON(dev->type != ARPHRD_IEEE802154);
84
85 return 0x1;
86}
87
88/**
89 * fake_get_dsn - Retrieve the DSN of the device.
90 * @dev: The network device to retrieve the DSN for.
91 *
92 * Returns the IEEE 802.15.4 DSN for the network device.
93 * The DSN is the sequence number which will be added to each
94 * packet or MAC command frame by the MAC during transmission.
95 *
96 * DSN means 'Data Sequence Number'.
97 *
98 * Note: This is in section 7.2.1.2 of the IEEE 802.15.4-2006
99 * document.
100 */
101static u8 fake_get_dsn(const struct net_device *dev)
102{
103 BUG_ON(dev->type != ARPHRD_IEEE802154);
104
105 return 0x00; /* DSN are implemented in HW, so return just 0 */
106}
107
108/**
109 * fake_get_bsn - Retrieve the BSN of the device.
110 * @dev: The network device to retrieve the BSN for.
111 *
112 * Returns the IEEE 802.15.4 BSN for the network device.
113 * The BSN is the sequence number which will be added to each
114 * beacon frame sent by the MAC.
115 *
116 * BSN means 'Beacon Sequence Number'.
117 *
118 * Note: This is in section 7.2.1.2 of the IEEE 802.15.4-2006
119 * document.
120 */
121static u8 fake_get_bsn(const struct net_device *dev)
122{
123 BUG_ON(dev->type != ARPHRD_IEEE802154);
124
125 return 0x00; /* BSN are implemented in HW, so return just 0 */
126}
127
128/**
129 * fake_assoc_req - Make an association request to the HW.
130 * @dev: The network device which we are associating to a network.
131 * @addr: The coordinator with which we wish to associate.
132 * @channel: The channel on which to associate.
133 * @cap: The capability information field to use in the association.
134 *
135 * Start an association with a coordinator. The coordinator's address
136 * and PAN ID can be found in @addr.
137 *
138 * Note: This is in section 7.3.1 and 7.5.3.1 of the IEEE
139 * 802.15.4-2006 document.
140 */
141static int fake_assoc_req(struct net_device *dev,
142 struct ieee802154_addr *addr, u8 channel, u8 page, u8 cap)
143{
144 struct wpan_phy *phy = fake_to_phy(dev);
145
146 mutex_lock(&phy->pib_lock);
147 phy->current_channel = channel;
148 phy->current_page = page;
149 mutex_unlock(&phy->pib_lock);
150
151 /* We simply emulate it here */
152 return ieee802154_nl_assoc_confirm(dev, fake_get_short_addr(dev),
153 IEEE802154_SUCCESS);
154}
155
156/**
157 * fake_assoc_resp - Send an association response to a device.
158 * @dev: The network device on which to send the response.
159 * @addr: The address of the device to respond to.
160 * @short_addr: The assigned short address for the device (if any).
161 * @status: The result of the association request.
162 *
163 * Queue the association response of the coordinator to another
164 * device's attempt to associate with the network which we
165 * coordinate. This is then added to the indirect-send queue to be
166 * transmitted to the end device when it polls for data.
167 *
168 * Note: This is in section 7.3.2 and 7.5.3.1 of the IEEE
169 * 802.15.4-2006 document.
170 */
171static int fake_assoc_resp(struct net_device *dev,
172 struct ieee802154_addr *addr, u16 short_addr, u8 status)
173{
174 return 0;
175}
176
177/**
178 * fake_disassoc_req - Disassociate a device from a network.
179 * @dev: The network device on which we're disassociating a device.
180 * @addr: The device to disassociate from the network.
181 * @reason: The reason to give to the device for being disassociated.
182 *
183 * This sends a disassociation notification to the device being
184 * disassociated from the network.
185 *
186 * Note: This is in section 7.5.3.2 of the IEEE 802.15.4-2006
187 * document, with the reason described in 7.3.3.2.
188 */
189static int fake_disassoc_req(struct net_device *dev,
190 struct ieee802154_addr *addr, u8 reason)
191{
192 return ieee802154_nl_disassoc_confirm(dev, IEEE802154_SUCCESS);
193}
194
195/**
196 * fake_start_req - Start an IEEE 802.15.4 PAN.
197 * @dev: The network device on which to start the PAN.
198 * @addr: The coordinator address to use when starting the PAN.
199 * @channel: The channel on which to start the PAN.
200 * @bcn_ord: Beacon order.
201 * @sf_ord: Superframe order.
202 * @pan_coord: Whether or not we are the PAN coordinator or just
203 * requesting a realignment perhaps?
204 * @blx: Battery Life Extension feature bitfield.
205 * @coord_realign: Something to realign something else.
206 *
207 * If pan_coord is non-zero then this starts a network with the
208 * provided parameters, otherwise it attempts a coordinator
209 * realignment of the stated network instead.
210 *
211 * Note: This is in section 7.5.2.3 of the IEEE 802.15.4-2006
212 * document, with 7.3.8 describing coordinator realignment.
213 */
214static int fake_start_req(struct net_device *dev, struct ieee802154_addr *addr,
215 u8 channel, u8 page,
216 u8 bcn_ord, u8 sf_ord, u8 pan_coord, u8 blx,
217 u8 coord_realign)
218{
219 struct wpan_phy *phy = fake_to_phy(dev);
220
221 mutex_lock(&phy->pib_lock);
222 phy->current_channel = channel;
223 phy->current_page = page;
224 mutex_unlock(&phy->pib_lock);
225
226 /* We don't emulate beacons here at all, so START should fail */
227 ieee802154_nl_start_confirm(dev, IEEE802154_INVALID_PARAMETER);
228 return 0;
229}
230
231/**
232 * fake_scan_req - Start a channel scan.
233 * @dev: The network device on which to perform a channel scan.
234 * @type: The type of scan to perform.
235 * @channels: The channel bitmask to scan.
236 * @duration: How long to spend on each channel.
237 *
238 * This starts either a passive (energy) scan or an active (PAN) scan
239 * on the channels indicated in the @channels bitmask. The duration of
240 * the scan is measured in terms of superframe duration. Specifically,
241 * the scan will spend aBaseSuperFrameDuration * ((2^n) + 1) on each
242 * channel.
243 *
244 * Note: This is in section 7.5.2.1 of the IEEE 802.15.4-2006 document.
245 */
246static int fake_scan_req(struct net_device *dev, u8 type, u32 channels,
247 u8 page, u8 duration)
248{
249 u8 edl[27] = {};
250 return ieee802154_nl_scan_confirm(dev, IEEE802154_SUCCESS, type,
251 channels, page,
252 type == IEEE802154_MAC_SCAN_ED ? edl : NULL);
253}
254
255static struct ieee802154_mlme_ops fake_mlme = {
256 .assoc_req = fake_assoc_req,
257 .assoc_resp = fake_assoc_resp,
258 .disassoc_req = fake_disassoc_req,
259 .start_req = fake_start_req,
260 .scan_req = fake_scan_req,
261
262 .get_phy = fake_get_phy,
263
264 .get_pan_id = fake_get_pan_id,
265 .get_short_addr = fake_get_short_addr,
266 .get_dsn = fake_get_dsn,
267 .get_bsn = fake_get_bsn,
268};
269
270static int ieee802154_fake_open(struct net_device *dev)
271{
272 netif_start_queue(dev);
273 return 0;
274}
275
276static int ieee802154_fake_close(struct net_device *dev)
277{
278 netif_stop_queue(dev);
279 return 0;
280}
281
282static netdev_tx_t ieee802154_fake_xmit(struct sk_buff *skb,
283 struct net_device *dev)
284{
285 dev->stats.tx_packets++;
286 dev->stats.tx_bytes += skb->len;
287
288 /* FIXME: do hardware work here ... */
289
290 dev_kfree_skb(skb);
291 return NETDEV_TX_OK;
292}
293
294
295static int ieee802154_fake_ioctl(struct net_device *dev, struct ifreq *ifr,
296 int cmd)
297{
298 struct sockaddr_ieee802154 *sa =
299 (struct sockaddr_ieee802154 *)&ifr->ifr_addr;
300 u16 pan_id, short_addr;
301
302 switch (cmd) {
303 case SIOCGIFADDR:
304 /* FIXME: fixed here, get from device IRL */
305 pan_id = fake_get_pan_id(dev);
306 short_addr = fake_get_short_addr(dev);
307 if (pan_id == IEEE802154_PANID_BROADCAST ||
308 short_addr == IEEE802154_ADDR_BROADCAST)
309 return -EADDRNOTAVAIL;
310
311 sa->family = AF_IEEE802154;
312 sa->addr.addr_type = IEEE802154_ADDR_SHORT;
313 sa->addr.pan_id = pan_id;
314 sa->addr.short_addr = short_addr;
315 return 0;
316 }
317 return -ENOIOCTLCMD;
318}
319
320static int ieee802154_fake_mac_addr(struct net_device *dev, void *p)
321{
322 return -EBUSY; /* HW address is built into the device */
323}
324
325static const struct net_device_ops fake_ops = {
326 .ndo_open = ieee802154_fake_open,
327 .ndo_stop = ieee802154_fake_close,
328 .ndo_start_xmit = ieee802154_fake_xmit,
329 .ndo_do_ioctl = ieee802154_fake_ioctl,
330 .ndo_set_mac_address = ieee802154_fake_mac_addr,
331};
332
333static void ieee802154_fake_destruct(struct net_device *dev)
334{
335 struct wpan_phy *phy = fake_to_phy(dev);
336
337 wpan_phy_unregister(phy);
338 free_netdev(dev);
339 wpan_phy_free(phy);
340}
341
342static void ieee802154_fake_setup(struct net_device *dev)
343{
344 dev->addr_len = IEEE802154_ADDR_LEN;
345 memset(dev->broadcast, 0xff, IEEE802154_ADDR_LEN);
346 dev->features = NETIF_F_HW_CSUM;
347 dev->needed_tailroom = 2; /* FCS */
348 dev->mtu = 127;
349 dev->tx_queue_len = 10;
350 dev->type = ARPHRD_IEEE802154;
351 dev->flags = IFF_NOARP | IFF_BROADCAST;
352 dev->watchdog_timeo = 0;
353 dev->destructor = ieee802154_fake_destruct;
354}
355
356
357static int __devinit ieee802154fake_probe(struct platform_device *pdev)
358{
359 struct net_device *dev;
360 struct fakehard_priv *priv;
361 struct wpan_phy *phy = wpan_phy_alloc(0);
362 int err;
363
364 if (!phy)
365 return -ENOMEM;
366
367 dev = alloc_netdev(sizeof(struct fakehard_priv), "hardwpan%d", ieee802154_fake_setup);
368 if (!dev) {
369 wpan_phy_free(phy);
370 return -ENOMEM;
371 }
372
373 memcpy(dev->dev_addr, "\xba\xbe\xca\xfe\xde\xad\xbe\xef",
374 dev->addr_len);
375 memcpy(dev->perm_addr, dev->dev_addr, dev->addr_len);
376
377 /*
378 * For now we'd like to emulate 2.4 GHz-only device,
379 * both O-QPSK and CSS
380 */
381 /* 2.4 GHz O-QPSK 802.15.4-2003 */
382 phy->channels_supported[0] |= 0x7FFF800;
383 /* 2.4 GHz CSS 802.15.4a-2007 */
384 phy->channels_supported[3] |= 0x3fff;
385
386 phy->transmit_power = 0xbf;
387
388 dev->netdev_ops = &fake_ops;
389 dev->ml_priv = &fake_mlme;
390
391 priv = netdev_priv(dev);
392 priv->phy = phy;
393
394 wpan_phy_set_dev(phy, &pdev->dev);
395 SET_NETDEV_DEV(dev, &phy->dev);
396
397 platform_set_drvdata(pdev, dev);
398
399 err = wpan_phy_register(phy);
400 if (err)
401 goto out;
402
403 err = register_netdev(dev);
404 if (err < 0)
405 goto out;
406
407 dev_info(&pdev->dev, "Added ieee802154 HardMAC hardware\n");
408 return 0;
409
410out:
411 unregister_netdev(dev);
412 return err;
413}
414
415static int __devexit ieee802154fake_remove(struct platform_device *pdev)
416{
417 struct net_device *dev = platform_get_drvdata(pdev);
418 unregister_netdev(dev);
419 return 0;
420}
421
422static struct platform_device *ieee802154fake_dev;
423
424static struct platform_driver ieee802154fake_driver = {
425 .probe = ieee802154fake_probe,
426 .remove = __devexit_p(ieee802154fake_remove),
427 .driver = {
428 .name = "ieee802154hardmac",
429 .owner = THIS_MODULE,
430 },
431};
432
433static __init int fake_init(void)
434{
435 ieee802154fake_dev = platform_device_register_simple(
436 "ieee802154hardmac", -1, NULL, 0);
437 return platform_driver_register(&ieee802154fake_driver);
438}
439
440static __exit void fake_exit(void)
441{
442 platform_driver_unregister(&ieee802154fake_driver);
443 platform_device_unregister(ieee802154fake_dev);
444}
445
446module_init(fake_init);
447module_exit(fake_exit);
448MODULE_LICENSE("GPL");
diff --git a/drivers/net/ieee802154/fakelb.c b/drivers/net/ieee802154/fakelb.c
new file mode 100644
index 000000000000..e7456fcd0913
--- /dev/null
+++ b/drivers/net/ieee802154/fakelb.c
@@ -0,0 +1,294 @@
1/*
2 * Loopback IEEE 802.15.4 interface
3 *
4 * Copyright 2007-2012 Siemens AG
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2
8 * as published by the Free Software Foundation.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License along
16 * with this program; if not, write to the Free Software Foundation, Inc.,
17 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
18 *
19 * Written by:
20 * Sergey Lapin <slapin@ossfans.org>
21 * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com>
22 * Alexander Smirnov <alex.bluesman.smirnov@gmail.com>
23 */
24
25#include <linux/module.h>
26#include <linux/timer.h>
27#include <linux/platform_device.h>
28#include <linux/netdevice.h>
29#include <linux/spinlock.h>
30#include <net/mac802154.h>
31#include <net/wpan-phy.h>
32
33static int numlbs = 1;
34
35struct fakelb_dev_priv {
36 struct ieee802154_dev *dev;
37
38 struct list_head list;
39 struct fakelb_priv *fake;
40
41 spinlock_t lock;
42 bool working;
43};
44
45struct fakelb_priv {
46 struct list_head list;
47 rwlock_t lock;
48};
49
50static int
51fakelb_hw_ed(struct ieee802154_dev *dev, u8 *level)
52{
53 might_sleep();
54 BUG_ON(!level);
55 *level = 0xbe;
56
57 return 0;
58}
59
60static int
61fakelb_hw_channel(struct ieee802154_dev *dev, int page, int channel)
62{
63 pr_debug("set channel to %d\n", channel);
64
65 might_sleep();
66 dev->phy->current_page = page;
67 dev->phy->current_channel = channel;
68
69 return 0;
70}
71
72static void
73fakelb_hw_deliver(struct fakelb_dev_priv *priv, struct sk_buff *skb)
74{
75 struct sk_buff *newskb;
76
77 spin_lock(&priv->lock);
78 if (priv->working) {
79 newskb = pskb_copy(skb, GFP_ATOMIC);
80 ieee802154_rx_irqsafe(priv->dev, newskb, 0xcc);
81 }
82 spin_unlock(&priv->lock);
83}
84
85static int
86fakelb_hw_xmit(struct ieee802154_dev *dev, struct sk_buff *skb)
87{
88 struct fakelb_dev_priv *priv = dev->priv;
89 struct fakelb_priv *fake = priv->fake;
90
91 might_sleep();
92
93 read_lock_bh(&fake->lock);
94 if (priv->list.next == priv->list.prev) {
95 /* we are the only one device */
96 fakelb_hw_deliver(priv, skb);
97 } else {
98 struct fakelb_dev_priv *dp;
99 list_for_each_entry(dp, &priv->fake->list, list) {
100 if (dp != priv &&
101 (dp->dev->phy->current_channel ==
102 priv->dev->phy->current_channel))
103 fakelb_hw_deliver(dp, skb);
104 }
105 }
106 read_unlock_bh(&fake->lock);
107
108 return 0;
109}
110
111static int
112fakelb_hw_start(struct ieee802154_dev *dev) {
113 struct fakelb_dev_priv *priv = dev->priv;
114 int ret = 0;
115
116 spin_lock(&priv->lock);
117 if (priv->working)
118 ret = -EBUSY;
119 else
120 priv->working = 1;
121 spin_unlock(&priv->lock);
122
123 return ret;
124}
125
126static void
127fakelb_hw_stop(struct ieee802154_dev *dev) {
128 struct fakelb_dev_priv *priv = dev->priv;
129
130 spin_lock(&priv->lock);
131 priv->working = 0;
132 spin_unlock(&priv->lock);
133}
134
135static struct ieee802154_ops fakelb_ops = {
136 .owner = THIS_MODULE,
137 .xmit = fakelb_hw_xmit,
138 .ed = fakelb_hw_ed,
139 .set_channel = fakelb_hw_channel,
140 .start = fakelb_hw_start,
141 .stop = fakelb_hw_stop,
142};
143
144/* Number of dummy devices to be set up by this module. */
145module_param(numlbs, int, 0);
146MODULE_PARM_DESC(numlbs, " number of pseudo devices");
147
148static int fakelb_add_one(struct device *dev, struct fakelb_priv *fake)
149{
150 struct fakelb_dev_priv *priv;
151 int err;
152 struct ieee802154_dev *ieee;
153
154 ieee = ieee802154_alloc_device(sizeof(*priv), &fakelb_ops);
155 if (!ieee)
156 return -ENOMEM;
157
158 priv = ieee->priv;
159 priv->dev = ieee;
160
161 /* 868 MHz BPSK 802.15.4-2003 */
162 ieee->phy->channels_supported[0] |= 1;
163 /* 915 MHz BPSK 802.15.4-2003 */
164 ieee->phy->channels_supported[0] |= 0x7fe;
165 /* 2.4 GHz O-QPSK 802.15.4-2003 */
166 ieee->phy->channels_supported[0] |= 0x7FFF800;
167 /* 868 MHz ASK 802.15.4-2006 */
168 ieee->phy->channels_supported[1] |= 1;
169 /* 915 MHz ASK 802.15.4-2006 */
170 ieee->phy->channels_supported[1] |= 0x7fe;
171 /* 868 MHz O-QPSK 802.15.4-2006 */
172 ieee->phy->channels_supported[2] |= 1;
173 /* 915 MHz O-QPSK 802.15.4-2006 */
174 ieee->phy->channels_supported[2] |= 0x7fe;
175 /* 2.4 GHz CSS 802.15.4a-2007 */
176 ieee->phy->channels_supported[3] |= 0x3fff;
177 /* UWB Sub-gigahertz 802.15.4a-2007 */
178 ieee->phy->channels_supported[4] |= 1;
179 /* UWB Low band 802.15.4a-2007 */
180 ieee->phy->channels_supported[4] |= 0x1e;
181 /* UWB High band 802.15.4a-2007 */
182 ieee->phy->channels_supported[4] |= 0xffe0;
183 /* 750 MHz O-QPSK 802.15.4c-2009 */
184 ieee->phy->channels_supported[5] |= 0xf;
185 /* 750 MHz MPSK 802.15.4c-2009 */
186 ieee->phy->channels_supported[5] |= 0xf0;
187 /* 950 MHz BPSK 802.15.4d-2009 */
188 ieee->phy->channels_supported[6] |= 0x3ff;
189 /* 950 MHz GFSK 802.15.4d-2009 */
190 ieee->phy->channels_supported[6] |= 0x3ffc00;
191
192 INIT_LIST_HEAD(&priv->list);
193 priv->fake = fake;
194
195 spin_lock_init(&priv->lock);
196
197 ieee->parent = dev;
198
199 err = ieee802154_register_device(ieee);
200 if (err)
201 goto err_reg;
202
203 write_lock_bh(&fake->lock);
204 list_add_tail(&priv->list, &fake->list);
205 write_unlock_bh(&fake->lock);
206
207 return 0;
208
209err_reg:
210 ieee802154_free_device(priv->dev);
211 return err;
212}
213
214static void fakelb_del(struct fakelb_dev_priv *priv)
215{
216 write_lock_bh(&priv->fake->lock);
217 list_del(&priv->list);
218 write_unlock_bh(&priv->fake->lock);
219
220 ieee802154_unregister_device(priv->dev);
221 ieee802154_free_device(priv->dev);
222}
223
224static int __devinit fakelb_probe(struct platform_device *pdev)
225{
226 struct fakelb_priv *priv;
227 struct fakelb_dev_priv *dp;
228 int err = -ENOMEM;
229 int i;
230
231 priv = kzalloc(sizeof(struct fakelb_priv), GFP_KERNEL);
232 if (!priv)
233 goto err_alloc;
234
235 INIT_LIST_HEAD(&priv->list);
236 rwlock_init(&priv->lock);
237
238 for (i = 0; i < numlbs; i++) {
239 err = fakelb_add_one(&pdev->dev, priv);
240 if (err < 0)
241 goto err_slave;
242 }
243
244 platform_set_drvdata(pdev, priv);
245 dev_info(&pdev->dev, "added ieee802154 hardware\n");
246 return 0;
247
248err_slave:
249 list_for_each_entry(dp, &priv->list, list)
250 fakelb_del(dp);
251 kfree(priv);
252err_alloc:
253 return err;
254}
255
256static int __devexit fakelb_remove(struct platform_device *pdev)
257{
258 struct fakelb_priv *priv = platform_get_drvdata(pdev);
259 struct fakelb_dev_priv *dp, *temp;
260
261 list_for_each_entry_safe(dp, temp, &priv->list, list)
262 fakelb_del(dp);
263 kfree(priv);
264
265 return 0;
266}
267
268static struct platform_device *ieee802154fake_dev;
269
270static struct platform_driver ieee802154fake_driver = {
271 .probe = fakelb_probe,
272 .remove = __devexit_p(fakelb_remove),
273 .driver = {
274 .name = "ieee802154fakelb",
275 .owner = THIS_MODULE,
276 },
277};
278
279static __init int fakelb_init_module(void)
280{
281 ieee802154fake_dev = platform_device_register_simple(
282 "ieee802154fakelb", -1, NULL, 0);
283 return platform_driver_register(&ieee802154fake_driver);
284}
285
286static __exit void fake_remove_module(void)
287{
288 platform_driver_unregister(&ieee802154fake_driver);
289 platform_device_unregister(ieee802154fake_dev);
290}
291
292module_init(fakelb_init_module);
293module_exit(fake_remove_module);
294MODULE_LICENSE("GPL");
generated by cgit v1.2.2 (git 2.25.0) at 2025-01-28 01:39:15 -0500