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 
38 struct 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 
243 static 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 
273 static 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 
307 static int
308 at86rf230_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 
320 static int
321 at86rf230_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);
336 out:
337 	mutex_unlock(&lp->bmux);
338 
339 	return status;
340 }
341 
342 static int
343 at86rf230_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 
382 static int
383 at86rf230_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 
442 static int
443 at86rf230_ed(struct ieee802154_dev *dev, u8 *level)
444 {
445 	might_sleep();
446 	BUG_ON(!level);
447 	*level = 0xbe;
448 	return 0;
449 }
450 
451 static int
452 at86rf230_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 
495 err:
496 	pr_err("error: %d\n", rc);
497 	return rc;
498 }
499 
500 static int
501 at86rf230_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 
513 static void
514 at86rf230_stop(struct ieee802154_dev *dev)
515 {
516 	at86rf230_state(dev, STATE_FORCE_TRX_OFF);
517 }
518 
519 static int
520 at86rf230_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 
539 static int
540 at86rf230_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 
580 err_rx:
581 	at86rf230_start(dev);
582 err:
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 
592 static 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;
615 err:
616 	pr_debug("received frame is too small\n");
617 
618 	kfree_skb(skb);
619 	return -EINVAL;
620 }
621 
622 static 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 
631 static 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 
667 static 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 
683 static 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 
754 static int at86rf230_suspend(struct spi_device *spi, pm_message_t message)
755 {
756 	return 0;
757 }
758 
759 static int at86rf230_resume(struct spi_device *spi)
760 {
761 	return 0;
762 }
763 
764 static 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 
781 static int 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);
907 err_irq:
908 	free_irq(spi->irq, lp);
909 	flush_work(&lp->irqwork);
910 err_gpio_dir:
911 	if (gpio_is_valid(lp->slp_tr))
912 		gpio_free(lp->slp_tr);
913 err_slp_tr:
914 	gpio_free(lp->rstn);
915 err_rstn:
916 err_fill:
917 	spi_set_drvdata(spi, NULL);
918 	mutex_destroy(&lp->bmux);
919 	ieee802154_free_device(lp->dev);
920 	return rc;
921 }
922 
923 static int 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 
944 static struct spi_driver at86rf230_driver = {
945 	.driver = {
946 		.name	= "at86rf230",
947 		.owner	= THIS_MODULE,
948 	},
949 	.probe      = at86rf230_probe,
950 	.remove     = at86rf230_remove,
951 	.suspend    = at86rf230_suspend,
952 	.resume     = at86rf230_resume,
953 };
954 
955 module_spi_driver(at86rf230_driver);
956 
957 MODULE_DESCRIPTION("AT86RF230 Transceiver Driver");
958 MODULE_LICENSE("GPL v2");
959