drivers/ieee802154/at86rf230.c

   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 __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);
 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 __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
 944 static 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
 955 static int __init at86rf230_init(void)
 956 {
 957         return spi_register_driver(&at86rf230_driver);
 958 }
 959 module_init(at86rf230_init);
 960
 961 static void __exit at86rf230_exit(void)
 962 {
 963         spi_unregister_driver(&at86rf230_driver);
 964 }
 965 module_exit(at86rf230_exit);
 966
 967 MODULE_DESCRIPTION("AT86RF230 Transceiver Driver");
 968 MODULE_LICENSE("GPL v2");