| /* | 
|  * Driver for Microchip MRF24J40 802.15.4 Wireless-PAN Networking controller | 
|  * | 
|  * Copyright (C) 2012 Alan Ott <alan@signal11.us> | 
|  *                    Signal 11 Software | 
|  * | 
|  * This program is free software; you can redistribute it and/or modify | 
|  * it under the terms of the GNU General Public License as published by | 
|  * the Free Software Foundation; either version 2 of the License, or | 
|  * (at your option) any later version. | 
|  * | 
|  * This program is distributed in the hope that it will be useful, | 
|  * but WITHOUT ANY WARRANTY; without even the implied warranty of | 
|  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
|  * GNU General Public License for more details. | 
|  */ | 
|   | 
| #include <linux/spi/spi.h> | 
| #include <linux/interrupt.h> | 
| #include <linux/module.h> | 
| #include <linux/of.h> | 
| #include <linux/regmap.h> | 
| #include <linux/ieee802154.h> | 
| #include <linux/irq.h> | 
| #include <net/cfg802154.h> | 
| #include <net/mac802154.h> | 
|   | 
| /* MRF24J40 Short Address Registers */ | 
| #define REG_RXMCR    0x00  /* Receive MAC control */ | 
| #define BIT_PROMI    BIT(0) | 
| #define BIT_ERRPKT    BIT(1) | 
| #define BIT_NOACKRSP    BIT(5) | 
| #define BIT_PANCOORD    BIT(3) | 
|   | 
| #define REG_PANIDL    0x01  /* PAN ID (low) */ | 
| #define REG_PANIDH    0x02  /* PAN ID (high) */ | 
| #define REG_SADRL    0x03  /* Short address (low) */ | 
| #define REG_SADRH    0x04  /* Short address (high) */ | 
| #define REG_EADR0    0x05  /* Long address (low) (high is EADR7) */ | 
| #define REG_EADR1    0x06 | 
| #define REG_EADR2    0x07 | 
| #define REG_EADR3    0x08 | 
| #define REG_EADR4    0x09 | 
| #define REG_EADR5    0x0A | 
| #define REG_EADR6    0x0B | 
| #define REG_EADR7    0x0C | 
| #define REG_RXFLUSH    0x0D | 
| #define REG_ORDER    0x10 | 
| #define REG_TXMCR    0x11  /* Transmit MAC control */ | 
| #define TXMCR_MIN_BE_SHIFT        3 | 
| #define TXMCR_MIN_BE_MASK        0x18 | 
| #define TXMCR_CSMA_RETRIES_SHIFT    0 | 
| #define TXMCR_CSMA_RETRIES_MASK        0x07 | 
|   | 
| #define REG_ACKTMOUT    0x12 | 
| #define REG_ESLOTG1    0x13 | 
| #define REG_SYMTICKL    0x14 | 
| #define REG_SYMTICKH    0x15 | 
| #define REG_PACON0    0x16  /* Power Amplifier Control */ | 
| #define REG_PACON1    0x17  /* Power Amplifier Control */ | 
| #define REG_PACON2    0x18  /* Power Amplifier Control */ | 
| #define REG_TXBCON0    0x1A | 
| #define REG_TXNCON    0x1B  /* Transmit Normal FIFO Control */ | 
| #define BIT_TXNTRIG    BIT(0) | 
| #define BIT_TXNSECEN    BIT(1) | 
| #define BIT_TXNACKREQ    BIT(2) | 
|   | 
| #define REG_TXG1CON    0x1C | 
| #define REG_TXG2CON    0x1D | 
| #define REG_ESLOTG23    0x1E | 
| #define REG_ESLOTG45    0x1F | 
| #define REG_ESLOTG67    0x20 | 
| #define REG_TXPEND    0x21 | 
| #define REG_WAKECON    0x22 | 
| #define REG_FROMOFFSET    0x23 | 
| #define REG_TXSTAT    0x24  /* TX MAC Status Register */ | 
| #define REG_TXBCON1    0x25 | 
| #define REG_GATECLK    0x26 | 
| #define REG_TXTIME    0x27 | 
| #define REG_HSYMTMRL    0x28 | 
| #define REG_HSYMTMRH    0x29 | 
| #define REG_SOFTRST    0x2A  /* Soft Reset */ | 
| #define REG_SECCON0    0x2C | 
| #define REG_SECCON1    0x2D | 
| #define REG_TXSTBL    0x2E  /* TX Stabilization */ | 
| #define REG_RXSR    0x30 | 
| #define REG_INTSTAT    0x31  /* Interrupt Status */ | 
| #define BIT_TXNIF    BIT(0) | 
| #define BIT_RXIF    BIT(3) | 
| #define BIT_SECIF    BIT(4) | 
| #define BIT_SECIGNORE    BIT(7) | 
|   | 
| #define REG_INTCON    0x32  /* Interrupt Control */ | 
| #define BIT_TXNIE    BIT(0) | 
| #define BIT_RXIE    BIT(3) | 
| #define BIT_SECIE    BIT(4) | 
|   | 
| #define REG_GPIO    0x33  /* GPIO */ | 
| #define REG_TRISGPIO    0x34  /* GPIO direction */ | 
| #define REG_SLPACK    0x35 | 
| #define REG_RFCTL    0x36  /* RF Control Mode Register */ | 
| #define BIT_RFRST    BIT(2) | 
|   | 
| #define REG_SECCR2    0x37 | 
| #define REG_BBREG0    0x38 | 
| #define REG_BBREG1    0x39  /* Baseband Registers */ | 
| #define BIT_RXDECINV    BIT(2) | 
|   | 
| #define REG_BBREG2    0x3A  /* */ | 
| #define BBREG2_CCA_MODE_SHIFT    6 | 
| #define BBREG2_CCA_MODE_MASK    0xc0 | 
|   | 
| #define REG_BBREG3    0x3B | 
| #define REG_BBREG4    0x3C | 
| #define REG_BBREG6    0x3E  /* */ | 
| #define REG_CCAEDTH    0x3F  /* Energy Detection Threshold */ | 
|   | 
| /* MRF24J40 Long Address Registers */ | 
| #define REG_RFCON0    0x200  /* RF Control Registers */ | 
| #define RFCON0_CH_SHIFT    4 | 
| #define RFCON0_CH_MASK    0xf0 | 
| #define RFOPT_RECOMMEND    3 | 
|   | 
| #define REG_RFCON1    0x201 | 
| #define REG_RFCON2    0x202 | 
| #define REG_RFCON3    0x203 | 
|   | 
| #define TXPWRL_MASK    0xc0 | 
| #define TXPWRL_SHIFT    6 | 
| #define TXPWRL_30    0x3 | 
| #define TXPWRL_20    0x2 | 
| #define TXPWRL_10    0x1 | 
| #define TXPWRL_0    0x0 | 
|   | 
| #define TXPWRS_MASK    0x38 | 
| #define TXPWRS_SHIFT    3 | 
| #define TXPWRS_6_3    0x7 | 
| #define TXPWRS_4_9    0x6 | 
| #define TXPWRS_3_7    0x5 | 
| #define TXPWRS_2_8    0x4 | 
| #define TXPWRS_1_9    0x3 | 
| #define TXPWRS_1_2    0x2 | 
| #define TXPWRS_0_5    0x1 | 
| #define TXPWRS_0    0x0 | 
|   | 
| #define REG_RFCON5    0x205 | 
| #define REG_RFCON6    0x206 | 
| #define REG_RFCON7    0x207 | 
| #define REG_RFCON8    0x208 | 
| #define REG_SLPCAL0    0x209 | 
| #define REG_SLPCAL1    0x20A | 
| #define REG_SLPCAL2    0x20B | 
| #define REG_RFSTATE    0x20F | 
| #define REG_RSSI    0x210 | 
| #define REG_SLPCON0    0x211  /* Sleep Clock Control Registers */ | 
| #define BIT_INTEDGE    BIT(1) | 
|   | 
| #define REG_SLPCON1    0x220 | 
| #define REG_WAKETIMEL    0x222  /* Wake-up Time Match Value Low */ | 
| #define REG_WAKETIMEH    0x223  /* Wake-up Time Match Value High */ | 
| #define REG_REMCNTL    0x224 | 
| #define REG_REMCNTH    0x225 | 
| #define REG_MAINCNT0    0x226 | 
| #define REG_MAINCNT1    0x227 | 
| #define REG_MAINCNT2    0x228 | 
| #define REG_MAINCNT3    0x229 | 
| #define REG_TESTMODE    0x22F  /* Test mode */ | 
| #define REG_ASSOEAR0    0x230 | 
| #define REG_ASSOEAR1    0x231 | 
| #define REG_ASSOEAR2    0x232 | 
| #define REG_ASSOEAR3    0x233 | 
| #define REG_ASSOEAR4    0x234 | 
| #define REG_ASSOEAR5    0x235 | 
| #define REG_ASSOEAR6    0x236 | 
| #define REG_ASSOEAR7    0x237 | 
| #define REG_ASSOSAR0    0x238 | 
| #define REG_ASSOSAR1    0x239 | 
| #define REG_UNONCE0    0x240 | 
| #define REG_UNONCE1    0x241 | 
| #define REG_UNONCE2    0x242 | 
| #define REG_UNONCE3    0x243 | 
| #define REG_UNONCE4    0x244 | 
| #define REG_UNONCE5    0x245 | 
| #define REG_UNONCE6    0x246 | 
| #define REG_UNONCE7    0x247 | 
| #define REG_UNONCE8    0x248 | 
| #define REG_UNONCE9    0x249 | 
| #define REG_UNONCE10    0x24A | 
| #define REG_UNONCE11    0x24B | 
| #define REG_UNONCE12    0x24C | 
| #define REG_RX_FIFO    0x300  /* Receive FIFO */ | 
|   | 
| /* Device configuration: Only channels 11-26 on page 0 are supported. */ | 
| #define MRF24J40_CHAN_MIN 11 | 
| #define MRF24J40_CHAN_MAX 26 | 
| #define CHANNEL_MASK (((u32)1 << (MRF24J40_CHAN_MAX + 1)) \ | 
|               - ((u32)1 << MRF24J40_CHAN_MIN)) | 
|   | 
| #define TX_FIFO_SIZE 128 /* From datasheet */ | 
| #define RX_FIFO_SIZE 144 /* From datasheet */ | 
| #define SET_CHANNEL_DELAY_US 192 /* From datasheet */ | 
|   | 
| enum mrf24j40_modules { MRF24J40, MRF24J40MA, MRF24J40MC }; | 
|   | 
| /* Device Private Data */ | 
| struct mrf24j40 { | 
|     struct spi_device *spi; | 
|     struct ieee802154_hw *hw; | 
|   | 
|     struct regmap *regmap_short; | 
|     struct regmap *regmap_long; | 
|   | 
|     /* for writing txfifo */ | 
|     struct spi_message tx_msg; | 
|     u8 tx_hdr_buf[2]; | 
|     struct spi_transfer tx_hdr_trx; | 
|     u8 tx_len_buf[2]; | 
|     struct spi_transfer tx_len_trx; | 
|     struct spi_transfer tx_buf_trx; | 
|     struct sk_buff *tx_skb; | 
|   | 
|     /* post transmit message to send frame out  */ | 
|     struct spi_message tx_post_msg; | 
|     u8 tx_post_buf[2]; | 
|     struct spi_transfer tx_post_trx; | 
|   | 
|     /* for protect/unprotect/read length rxfifo */ | 
|     struct spi_message rx_msg; | 
|     u8 rx_buf[3]; | 
|     struct spi_transfer rx_trx; | 
|   | 
|     /* receive handling */ | 
|     struct spi_message rx_buf_msg; | 
|     u8 rx_addr_buf[2]; | 
|     struct spi_transfer rx_addr_trx; | 
|     u8 rx_lqi_buf[2]; | 
|     struct spi_transfer rx_lqi_trx; | 
|     u8 rx_fifo_buf[RX_FIFO_SIZE]; | 
|     struct spi_transfer rx_fifo_buf_trx; | 
|   | 
|     /* isr handling for reading intstat */ | 
|     struct spi_message irq_msg; | 
|     u8 irq_buf[2]; | 
|     struct spi_transfer irq_trx; | 
| }; | 
|   | 
| /* regmap information for short address register access */ | 
| #define MRF24J40_SHORT_WRITE    0x01 | 
| #define MRF24J40_SHORT_READ    0x00 | 
| #define MRF24J40_SHORT_NUMREGS    0x3F | 
|   | 
| /* regmap information for long address register access */ | 
| #define MRF24J40_LONG_ACCESS    0x80 | 
| #define MRF24J40_LONG_NUMREGS    0x38F | 
|   | 
| /* Read/Write SPI Commands for Short and Long Address registers. */ | 
| #define MRF24J40_READSHORT(reg) ((reg) << 1) | 
| #define MRF24J40_WRITESHORT(reg) ((reg) << 1 | 1) | 
| #define MRF24J40_READLONG(reg) (1 << 15 | (reg) << 5) | 
| #define MRF24J40_WRITELONG(reg) (1 << 15 | (reg) << 5 | 1 << 4) | 
|   | 
| /* The datasheet indicates the theoretical maximum for SCK to be 10MHz */ | 
| #define MAX_SPI_SPEED_HZ 10000000 | 
|   | 
| #define printdev(X) (&X->spi->dev) | 
|   | 
| static bool | 
| mrf24j40_short_reg_writeable(struct device *dev, unsigned int reg) | 
| { | 
|     switch (reg) { | 
|     case REG_RXMCR: | 
|     case REG_PANIDL: | 
|     case REG_PANIDH: | 
|     case REG_SADRL: | 
|     case REG_SADRH: | 
|     case REG_EADR0: | 
|     case REG_EADR1: | 
|     case REG_EADR2: | 
|     case REG_EADR3: | 
|     case REG_EADR4: | 
|     case REG_EADR5: | 
|     case REG_EADR6: | 
|     case REG_EADR7: | 
|     case REG_RXFLUSH: | 
|     case REG_ORDER: | 
|     case REG_TXMCR: | 
|     case REG_ACKTMOUT: | 
|     case REG_ESLOTG1: | 
|     case REG_SYMTICKL: | 
|     case REG_SYMTICKH: | 
|     case REG_PACON0: | 
|     case REG_PACON1: | 
|     case REG_PACON2: | 
|     case REG_TXBCON0: | 
|     case REG_TXNCON: | 
|     case REG_TXG1CON: | 
|     case REG_TXG2CON: | 
|     case REG_ESLOTG23: | 
|     case REG_ESLOTG45: | 
|     case REG_ESLOTG67: | 
|     case REG_TXPEND: | 
|     case REG_WAKECON: | 
|     case REG_FROMOFFSET: | 
|     case REG_TXBCON1: | 
|     case REG_GATECLK: | 
|     case REG_TXTIME: | 
|     case REG_HSYMTMRL: | 
|     case REG_HSYMTMRH: | 
|     case REG_SOFTRST: | 
|     case REG_SECCON0: | 
|     case REG_SECCON1: | 
|     case REG_TXSTBL: | 
|     case REG_RXSR: | 
|     case REG_INTCON: | 
|     case REG_TRISGPIO: | 
|     case REG_GPIO: | 
|     case REG_RFCTL: | 
|     case REG_SECCR2: | 
|     case REG_SLPACK: | 
|     case REG_BBREG0: | 
|     case REG_BBREG1: | 
|     case REG_BBREG2: | 
|     case REG_BBREG3: | 
|     case REG_BBREG4: | 
|     case REG_BBREG6: | 
|     case REG_CCAEDTH: | 
|         return true; | 
|     default: | 
|         return false; | 
|     } | 
| } | 
|   | 
| static bool | 
| mrf24j40_short_reg_readable(struct device *dev, unsigned int reg) | 
| { | 
|     bool rc; | 
|   | 
|     /* all writeable are also readable */ | 
|     rc = mrf24j40_short_reg_writeable(dev, reg); | 
|     if (rc) | 
|         return rc; | 
|   | 
|     /* readonly regs */ | 
|     switch (reg) { | 
|     case REG_TXSTAT: | 
|     case REG_INTSTAT: | 
|         return true; | 
|     default: | 
|         return false; | 
|     } | 
| } | 
|   | 
| static bool | 
| mrf24j40_short_reg_volatile(struct device *dev, unsigned int reg) | 
| { | 
|     /* can be changed during runtime */ | 
|     switch (reg) { | 
|     case REG_TXSTAT: | 
|     case REG_INTSTAT: | 
|     case REG_RXFLUSH: | 
|     case REG_TXNCON: | 
|     case REG_SOFTRST: | 
|     case REG_RFCTL: | 
|     case REG_TXBCON0: | 
|     case REG_TXG1CON: | 
|     case REG_TXG2CON: | 
|     case REG_TXBCON1: | 
|     case REG_SECCON0: | 
|     case REG_RXSR: | 
|     case REG_SLPACK: | 
|     case REG_SECCR2: | 
|     case REG_BBREG6: | 
|     /* use them in spi_async and regmap so it's volatile */ | 
|     case REG_BBREG1: | 
|         return true; | 
|     default: | 
|         return false; | 
|     } | 
| } | 
|   | 
| static bool | 
| mrf24j40_short_reg_precious(struct device *dev, unsigned int reg) | 
| { | 
|     /* don't clear irq line on read */ | 
|     switch (reg) { | 
|     case REG_INTSTAT: | 
|         return true; | 
|     default: | 
|         return false; | 
|     } | 
| } | 
|   | 
| static const struct regmap_config mrf24j40_short_regmap = { | 
|     .name = "mrf24j40_short", | 
|     .reg_bits = 7, | 
|     .val_bits = 8, | 
|     .pad_bits = 1, | 
|     .write_flag_mask = MRF24J40_SHORT_WRITE, | 
|     .read_flag_mask = MRF24J40_SHORT_READ, | 
|     .cache_type = REGCACHE_RBTREE, | 
|     .max_register = MRF24J40_SHORT_NUMREGS, | 
|     .writeable_reg = mrf24j40_short_reg_writeable, | 
|     .readable_reg = mrf24j40_short_reg_readable, | 
|     .volatile_reg = mrf24j40_short_reg_volatile, | 
|     .precious_reg = mrf24j40_short_reg_precious, | 
| }; | 
|   | 
| static bool | 
| mrf24j40_long_reg_writeable(struct device *dev, unsigned int reg) | 
| { | 
|     switch (reg) { | 
|     case REG_RFCON0: | 
|     case REG_RFCON1: | 
|     case REG_RFCON2: | 
|     case REG_RFCON3: | 
|     case REG_RFCON5: | 
|     case REG_RFCON6: | 
|     case REG_RFCON7: | 
|     case REG_RFCON8: | 
|     case REG_SLPCAL2: | 
|     case REG_SLPCON0: | 
|     case REG_SLPCON1: | 
|     case REG_WAKETIMEL: | 
|     case REG_WAKETIMEH: | 
|     case REG_REMCNTL: | 
|     case REG_REMCNTH: | 
|     case REG_MAINCNT0: | 
|     case REG_MAINCNT1: | 
|     case REG_MAINCNT2: | 
|     case REG_MAINCNT3: | 
|     case REG_TESTMODE: | 
|     case REG_ASSOEAR0: | 
|     case REG_ASSOEAR1: | 
|     case REG_ASSOEAR2: | 
|     case REG_ASSOEAR3: | 
|     case REG_ASSOEAR4: | 
|     case REG_ASSOEAR5: | 
|     case REG_ASSOEAR6: | 
|     case REG_ASSOEAR7: | 
|     case REG_ASSOSAR0: | 
|     case REG_ASSOSAR1: | 
|     case REG_UNONCE0: | 
|     case REG_UNONCE1: | 
|     case REG_UNONCE2: | 
|     case REG_UNONCE3: | 
|     case REG_UNONCE4: | 
|     case REG_UNONCE5: | 
|     case REG_UNONCE6: | 
|     case REG_UNONCE7: | 
|     case REG_UNONCE8: | 
|     case REG_UNONCE9: | 
|     case REG_UNONCE10: | 
|     case REG_UNONCE11: | 
|     case REG_UNONCE12: | 
|         return true; | 
|     default: | 
|         return false; | 
|     } | 
| } | 
|   | 
| static bool | 
| mrf24j40_long_reg_readable(struct device *dev, unsigned int reg) | 
| { | 
|     bool rc; | 
|   | 
|     /* all writeable are also readable */ | 
|     rc = mrf24j40_long_reg_writeable(dev, reg); | 
|     if (rc) | 
|         return rc; | 
|   | 
|     /* readonly regs */ | 
|     switch (reg) { | 
|     case REG_SLPCAL0: | 
|     case REG_SLPCAL1: | 
|     case REG_RFSTATE: | 
|     case REG_RSSI: | 
|         return true; | 
|     default: | 
|         return false; | 
|     } | 
| } | 
|   | 
| static bool | 
| mrf24j40_long_reg_volatile(struct device *dev, unsigned int reg) | 
| { | 
|     /* can be changed during runtime */ | 
|     switch (reg) { | 
|     case REG_SLPCAL0: | 
|     case REG_SLPCAL1: | 
|     case REG_SLPCAL2: | 
|     case REG_RFSTATE: | 
|     case REG_RSSI: | 
|     case REG_MAINCNT3: | 
|         return true; | 
|     default: | 
|         return false; | 
|     } | 
| } | 
|   | 
| static const struct regmap_config mrf24j40_long_regmap = { | 
|     .name = "mrf24j40_long", | 
|     .reg_bits = 11, | 
|     .val_bits = 8, | 
|     .pad_bits = 5, | 
|     .write_flag_mask = MRF24J40_LONG_ACCESS, | 
|     .read_flag_mask = MRF24J40_LONG_ACCESS, | 
|     .cache_type = REGCACHE_RBTREE, | 
|     .max_register = MRF24J40_LONG_NUMREGS, | 
|     .writeable_reg = mrf24j40_long_reg_writeable, | 
|     .readable_reg = mrf24j40_long_reg_readable, | 
|     .volatile_reg = mrf24j40_long_reg_volatile, | 
| }; | 
|   | 
| static int mrf24j40_long_regmap_write(void *context, const void *data, | 
|                       size_t count) | 
| { | 
|     struct spi_device *spi = context; | 
|     u8 buf[3]; | 
|   | 
|     if (count > 3) | 
|         return -EINVAL; | 
|   | 
|     /* regmap supports read/write mask only in frist byte | 
|      * long write access need to set the 12th bit, so we | 
|      * make special handling for write. | 
|      */ | 
|     memcpy(buf, data, count); | 
|     buf[1] |= (1 << 4); | 
|   | 
|     return spi_write(spi, buf, count); | 
| } | 
|   | 
| static int | 
| mrf24j40_long_regmap_read(void *context, const void *reg, size_t reg_size, | 
|               void *val, size_t val_size) | 
| { | 
|     struct spi_device *spi = context; | 
|   | 
|     return spi_write_then_read(spi, reg, reg_size, val, val_size); | 
| } | 
|   | 
| static const struct regmap_bus mrf24j40_long_regmap_bus = { | 
|     .write = mrf24j40_long_regmap_write, | 
|     .read = mrf24j40_long_regmap_read, | 
|     .reg_format_endian_default = REGMAP_ENDIAN_BIG, | 
|     .val_format_endian_default = REGMAP_ENDIAN_BIG, | 
| }; | 
|   | 
| static void write_tx_buf_complete(void *context) | 
| { | 
|     struct mrf24j40 *devrec = context; | 
|     __le16 fc = ieee802154_get_fc_from_skb(devrec->tx_skb); | 
|     u8 val = BIT_TXNTRIG; | 
|     int ret; | 
|   | 
|     if (ieee802154_is_secen(fc)) | 
|         val |= BIT_TXNSECEN; | 
|   | 
|     if (ieee802154_is_ackreq(fc)) | 
|         val |= BIT_TXNACKREQ; | 
|   | 
|     devrec->tx_post_msg.complete = NULL; | 
|     devrec->tx_post_buf[0] = MRF24J40_WRITESHORT(REG_TXNCON); | 
|     devrec->tx_post_buf[1] = val; | 
|   | 
|     ret = spi_async(devrec->spi, &devrec->tx_post_msg); | 
|     if (ret) | 
|         dev_err(printdev(devrec), "SPI write Failed for transmit buf\n"); | 
| } | 
|   | 
| /* This function relies on an undocumented write method. Once a write command | 
|    and address is set, as many bytes of data as desired can be clocked into | 
|    the device. The datasheet only shows setting one byte at a time. */ | 
| static int write_tx_buf(struct mrf24j40 *devrec, u16 reg, | 
|             const u8 *data, size_t length) | 
| { | 
|     u16 cmd; | 
|     int ret; | 
|   | 
|     /* Range check the length. 2 bytes are used for the length fields.*/ | 
|     if (length > TX_FIFO_SIZE-2) { | 
|         dev_err(printdev(devrec), "write_tx_buf() was passed too large a buffer. Performing short write.\n"); | 
|         length = TX_FIFO_SIZE-2; | 
|     } | 
|   | 
|     cmd = MRF24J40_WRITELONG(reg); | 
|     devrec->tx_hdr_buf[0] = cmd >> 8 & 0xff; | 
|     devrec->tx_hdr_buf[1] = cmd & 0xff; | 
|     devrec->tx_len_buf[0] = 0x0; /* Header Length. Set to 0 for now. TODO */ | 
|     devrec->tx_len_buf[1] = length; /* Total length */ | 
|     devrec->tx_buf_trx.tx_buf = data; | 
|     devrec->tx_buf_trx.len = length; | 
|   | 
|     ret = spi_async(devrec->spi, &devrec->tx_msg); | 
|     if (ret) | 
|         dev_err(printdev(devrec), "SPI write Failed for TX buf\n"); | 
|   | 
|     return ret; | 
| } | 
|   | 
| static int mrf24j40_tx(struct ieee802154_hw *hw, struct sk_buff *skb) | 
| { | 
|     struct mrf24j40 *devrec = hw->priv; | 
|   | 
|     dev_dbg(printdev(devrec), "tx packet of %d bytes\n", skb->len); | 
|     devrec->tx_skb = skb; | 
|   | 
|     return write_tx_buf(devrec, 0x000, skb->data, skb->len); | 
| } | 
|   | 
| static int mrf24j40_ed(struct ieee802154_hw *hw, u8 *level) | 
| { | 
|     /* TODO: */ | 
|     pr_warn("mrf24j40: ed not implemented\n"); | 
|     *level = 0; | 
|     return 0; | 
| } | 
|   | 
| static int mrf24j40_start(struct ieee802154_hw *hw) | 
| { | 
|     struct mrf24j40 *devrec = hw->priv; | 
|   | 
|     dev_dbg(printdev(devrec), "start\n"); | 
|   | 
|     /* Clear TXNIE and RXIE. Enable interrupts */ | 
|     return regmap_update_bits(devrec->regmap_short, REG_INTCON, | 
|                   BIT_TXNIE | BIT_RXIE | BIT_SECIE, 0); | 
| } | 
|   | 
| static void mrf24j40_stop(struct ieee802154_hw *hw) | 
| { | 
|     struct mrf24j40 *devrec = hw->priv; | 
|   | 
|     dev_dbg(printdev(devrec), "stop\n"); | 
|   | 
|     /* Set TXNIE and RXIE. Disable Interrupts */ | 
|     regmap_update_bits(devrec->regmap_short, REG_INTCON, | 
|                BIT_TXNIE | BIT_RXIE, BIT_TXNIE | BIT_RXIE); | 
| } | 
|   | 
| static int mrf24j40_set_channel(struct ieee802154_hw *hw, u8 page, u8 channel) | 
| { | 
|     struct mrf24j40 *devrec = hw->priv; | 
|     u8 val; | 
|     int ret; | 
|   | 
|     dev_dbg(printdev(devrec), "Set Channel %d\n", channel); | 
|   | 
|     WARN_ON(page != 0); | 
|     WARN_ON(channel < MRF24J40_CHAN_MIN); | 
|     WARN_ON(channel > MRF24J40_CHAN_MAX); | 
|   | 
|     /* Set Channel TODO */ | 
|     val = (channel - 11) << RFCON0_CH_SHIFT | RFOPT_RECOMMEND; | 
|     ret = regmap_update_bits(devrec->regmap_long, REG_RFCON0, | 
|                  RFCON0_CH_MASK, val); | 
|     if (ret) | 
|         return ret; | 
|   | 
|     /* RF Reset */ | 
|     ret = regmap_update_bits(devrec->regmap_short, REG_RFCTL, BIT_RFRST, | 
|                  BIT_RFRST); | 
|     if (ret) | 
|         return ret; | 
|   | 
|     ret = regmap_update_bits(devrec->regmap_short, REG_RFCTL, BIT_RFRST, 0); | 
|     if (!ret) | 
|         udelay(SET_CHANNEL_DELAY_US); /* per datasheet */ | 
|   | 
|     return ret; | 
| } | 
|   | 
| static int mrf24j40_filter(struct ieee802154_hw *hw, | 
|                struct ieee802154_hw_addr_filt *filt, | 
|                unsigned long changed) | 
| { | 
|     struct mrf24j40 *devrec = hw->priv; | 
|   | 
|     dev_dbg(printdev(devrec), "filter\n"); | 
|   | 
|     if (changed & IEEE802154_AFILT_SADDR_CHANGED) { | 
|         /* Short Addr */ | 
|         u8 addrh, addrl; | 
|   | 
|         addrh = le16_to_cpu(filt->short_addr) >> 8 & 0xff; | 
|         addrl = le16_to_cpu(filt->short_addr) & 0xff; | 
|   | 
|         regmap_write(devrec->regmap_short, REG_SADRH, addrh); | 
|         regmap_write(devrec->regmap_short, REG_SADRL, addrl); | 
|         dev_dbg(printdev(devrec), | 
|             "Set short addr to %04hx\n", filt->short_addr); | 
|     } | 
|   | 
|     if (changed & IEEE802154_AFILT_IEEEADDR_CHANGED) { | 
|         /* Device Address */ | 
|         u8 i, addr[8]; | 
|   | 
|         memcpy(addr, &filt->ieee_addr, 8); | 
|         for (i = 0; i < 8; i++) | 
|             regmap_write(devrec->regmap_short, REG_EADR0 + i, | 
|                      addr[i]); | 
|   | 
| #ifdef DEBUG | 
|         pr_debug("Set long addr to: "); | 
|         for (i = 0; i < 8; i++) | 
|             pr_debug("%02hhx ", addr[7 - i]); | 
|         pr_debug("\n"); | 
| #endif | 
|     } | 
|   | 
|     if (changed & IEEE802154_AFILT_PANID_CHANGED) { | 
|         /* PAN ID */ | 
|         u8 panidl, panidh; | 
|   | 
|         panidh = le16_to_cpu(filt->pan_id) >> 8 & 0xff; | 
|         panidl = le16_to_cpu(filt->pan_id) & 0xff; | 
|         regmap_write(devrec->regmap_short, REG_PANIDH, panidh); | 
|         regmap_write(devrec->regmap_short, REG_PANIDL, panidl); | 
|   | 
|         dev_dbg(printdev(devrec), "Set PANID to %04hx\n", filt->pan_id); | 
|     } | 
|   | 
|     if (changed & IEEE802154_AFILT_PANC_CHANGED) { | 
|         /* Pan Coordinator */ | 
|         u8 val; | 
|         int ret; | 
|   | 
|         if (filt->pan_coord) | 
|             val = BIT_PANCOORD; | 
|         else | 
|             val = 0; | 
|         ret = regmap_update_bits(devrec->regmap_short, REG_RXMCR, | 
|                      BIT_PANCOORD, val); | 
|         if (ret) | 
|             return ret; | 
|   | 
|         /* REG_SLOTTED is maintained as default (unslotted/CSMA-CA). | 
|          * REG_ORDER is maintained as default (no beacon/superframe). | 
|          */ | 
|   | 
|         dev_dbg(printdev(devrec), "Set Pan Coord to %s\n", | 
|             filt->pan_coord ? "on" : "off"); | 
|     } | 
|   | 
|     return 0; | 
| } | 
|   | 
| static void mrf24j40_handle_rx_read_buf_unlock(struct mrf24j40 *devrec) | 
| { | 
|     int ret; | 
|   | 
|     /* Turn back on reception of packets off the air. */ | 
|     devrec->rx_msg.complete = NULL; | 
|     devrec->rx_buf[0] = MRF24J40_WRITESHORT(REG_BBREG1); | 
|     devrec->rx_buf[1] = 0x00; /* CLR RXDECINV */ | 
|     ret = spi_async(devrec->spi, &devrec->rx_msg); | 
|     if (ret) | 
|         dev_err(printdev(devrec), "failed to unlock rx buffer\n"); | 
| } | 
|   | 
| static void mrf24j40_handle_rx_read_buf_complete(void *context) | 
| { | 
|     struct mrf24j40 *devrec = context; | 
|     u8 len = devrec->rx_buf[2]; | 
|     u8 rx_local_buf[RX_FIFO_SIZE]; | 
|     struct sk_buff *skb; | 
|   | 
|     memcpy(rx_local_buf, devrec->rx_fifo_buf, len); | 
|     mrf24j40_handle_rx_read_buf_unlock(devrec); | 
|   | 
|     skb = dev_alloc_skb(IEEE802154_MTU); | 
|     if (!skb) { | 
|         dev_err(printdev(devrec), "failed to allocate skb\n"); | 
|         return; | 
|     } | 
|   | 
|     skb_put_data(skb, rx_local_buf, len); | 
|     ieee802154_rx_irqsafe(devrec->hw, skb, 0); | 
|   | 
| #ifdef DEBUG | 
|      print_hex_dump(KERN_DEBUG, "mrf24j40 rx: ", DUMP_PREFIX_OFFSET, 16, 1, | 
|             rx_local_buf, len, 0); | 
|      pr_debug("mrf24j40 rx: lqi: %02hhx rssi: %02hhx\n", | 
|           devrec->rx_lqi_buf[0], devrec->rx_lqi_buf[1]); | 
| #endif | 
| } | 
|   | 
| static void mrf24j40_handle_rx_read_buf(void *context) | 
| { | 
|     struct mrf24j40 *devrec = context; | 
|     u16 cmd; | 
|     int ret; | 
|   | 
|     /* if length is invalid read the full MTU */ | 
|     if (!ieee802154_is_valid_psdu_len(devrec->rx_buf[2])) | 
|         devrec->rx_buf[2] = IEEE802154_MTU; | 
|   | 
|     cmd = MRF24J40_READLONG(REG_RX_FIFO + 1); | 
|     devrec->rx_addr_buf[0] = cmd >> 8 & 0xff; | 
|     devrec->rx_addr_buf[1] = cmd & 0xff; | 
|     devrec->rx_fifo_buf_trx.len = devrec->rx_buf[2]; | 
|     ret = spi_async(devrec->spi, &devrec->rx_buf_msg); | 
|     if (ret) { | 
|         dev_err(printdev(devrec), "failed to read rx buffer\n"); | 
|         mrf24j40_handle_rx_read_buf_unlock(devrec); | 
|     } | 
| } | 
|   | 
| static void mrf24j40_handle_rx_read_len(void *context) | 
| { | 
|     struct mrf24j40 *devrec = context; | 
|     u16 cmd; | 
|     int ret; | 
|   | 
|     /* read the length of received frame */ | 
|     devrec->rx_msg.complete = mrf24j40_handle_rx_read_buf; | 
|     devrec->rx_trx.len = 3; | 
|     cmd = MRF24J40_READLONG(REG_RX_FIFO); | 
|     devrec->rx_buf[0] = cmd >> 8 & 0xff; | 
|     devrec->rx_buf[1] = cmd & 0xff; | 
|   | 
|     ret = spi_async(devrec->spi, &devrec->rx_msg); | 
|     if (ret) { | 
|         dev_err(printdev(devrec), "failed to read rx buffer length\n"); | 
|         mrf24j40_handle_rx_read_buf_unlock(devrec); | 
|     } | 
| } | 
|   | 
| static int mrf24j40_handle_rx(struct mrf24j40 *devrec) | 
| { | 
|     /* Turn off reception of packets off the air. This prevents the | 
|      * device from overwriting the buffer while we're reading it. | 
|      */ | 
|     devrec->rx_msg.complete = mrf24j40_handle_rx_read_len; | 
|     devrec->rx_trx.len = 2; | 
|     devrec->rx_buf[0] = MRF24J40_WRITESHORT(REG_BBREG1); | 
|     devrec->rx_buf[1] = BIT_RXDECINV; /* SET RXDECINV */ | 
|   | 
|     return spi_async(devrec->spi, &devrec->rx_msg); | 
| } | 
|   | 
| static int | 
| mrf24j40_csma_params(struct ieee802154_hw *hw, u8 min_be, u8 max_be, | 
|              u8 retries) | 
| { | 
|     struct mrf24j40 *devrec = hw->priv; | 
|     u8 val; | 
|   | 
|     /* min_be */ | 
|     val = min_be << TXMCR_MIN_BE_SHIFT; | 
|     /* csma backoffs */ | 
|     val |= retries << TXMCR_CSMA_RETRIES_SHIFT; | 
|   | 
|     return regmap_update_bits(devrec->regmap_short, REG_TXMCR, | 
|                   TXMCR_MIN_BE_MASK | TXMCR_CSMA_RETRIES_MASK, | 
|                   val); | 
| } | 
|   | 
| static int mrf24j40_set_cca_mode(struct ieee802154_hw *hw, | 
|                  const struct wpan_phy_cca *cca) | 
| { | 
|     struct mrf24j40 *devrec = hw->priv; | 
|     u8 val; | 
|   | 
|     /* mapping 802.15.4 to driver spec */ | 
|     switch (cca->mode) { | 
|     case NL802154_CCA_ENERGY: | 
|         val = 2; | 
|         break; | 
|     case NL802154_CCA_CARRIER: | 
|         val = 1; | 
|         break; | 
|     case NL802154_CCA_ENERGY_CARRIER: | 
|         switch (cca->opt) { | 
|         case NL802154_CCA_OPT_ENERGY_CARRIER_AND: | 
|             val = 3; | 
|             break; | 
|         default: | 
|             return -EINVAL; | 
|         } | 
|         break; | 
|     default: | 
|         return -EINVAL; | 
|     } | 
|   | 
|     return regmap_update_bits(devrec->regmap_short, REG_BBREG2, | 
|                   BBREG2_CCA_MODE_MASK, | 
|                   val << BBREG2_CCA_MODE_SHIFT); | 
| } | 
|   | 
| /* array for representing ed levels */ | 
| static const s32 mrf24j40_ed_levels[] = { | 
|     -9000, -8900, -8800, -8700, -8600, -8500, -8400, -8300, -8200, -8100, | 
|     -8000, -7900, -7800, -7700, -7600, -7500, -7400, -7300, -7200, -7100, | 
|     -7000, -6900, -6800, -6700, -6600, -6500, -6400, -6300, -6200, -6100, | 
|     -6000, -5900, -5800, -5700, -5600, -5500, -5400, -5300, -5200, -5100, | 
|     -5000, -4900, -4800, -4700, -4600, -4500, -4400, -4300, -4200, -4100, | 
|     -4000, -3900, -3800, -3700, -3600, -3500 | 
| }; | 
|   | 
| /* map ed levels to register value */ | 
| static const s32 mrf24j40_ed_levels_map[][2] = { | 
|     { -9000, 0 }, { -8900, 1 }, { -8800, 2 }, { -8700, 5 }, { -8600, 9 }, | 
|     { -8500, 13 }, { -8400, 18 }, { -8300, 23 }, { -8200, 27 }, | 
|     { -8100, 32 }, { -8000, 37 }, { -7900, 43 }, { -7800, 48 }, | 
|     { -7700, 53 }, { -7600, 58 }, { -7500, 63 }, { -7400, 68 }, | 
|     { -7300, 73 }, { -7200, 78 }, { -7100, 83 }, { -7000, 89 }, | 
|     { -6900, 95 }, { -6800, 100 }, { -6700, 107 }, { -6600, 111 }, | 
|     { -6500, 117 }, { -6400, 121 }, { -6300, 125 }, { -6200, 129 }, | 
|     { -6100, 133 },    { -6000, 138 }, { -5900, 143 }, { -5800, 148 }, | 
|     { -5700, 153 }, { -5600, 159 },    { -5500, 165 }, { -5400, 170 }, | 
|     { -5300, 176 }, { -5200, 183 }, { -5100, 188 }, { -5000, 193 }, | 
|     { -4900, 198 }, { -4800, 203 }, { -4700, 207 }, { -4600, 212 }, | 
|     { -4500, 216 }, { -4400, 221 }, { -4300, 225 }, { -4200, 228 }, | 
|     { -4100, 233 }, { -4000, 239 }, { -3900, 245 }, { -3800, 250 }, | 
|     { -3700, 253 }, { -3600, 254 }, { -3500, 255 }, | 
| }; | 
|   | 
| static int mrf24j40_set_cca_ed_level(struct ieee802154_hw *hw, s32 mbm) | 
| { | 
|     struct mrf24j40 *devrec = hw->priv; | 
|     int i; | 
|   | 
|     for (i = 0; i < ARRAY_SIZE(mrf24j40_ed_levels_map); i++) { | 
|         if (mrf24j40_ed_levels_map[i][0] == mbm) | 
|             return regmap_write(devrec->regmap_short, REG_CCAEDTH, | 
|                         mrf24j40_ed_levels_map[i][1]); | 
|     } | 
|   | 
|     return -EINVAL; | 
| } | 
|   | 
| static const s32 mrf24j40ma_powers[] = { | 
|     0, -50, -120, -190, -280, -370, -490, -630, -1000, -1050, -1120, -1190, | 
|     -1280, -1370, -1490, -1630, -2000, -2050, -2120, -2190, -2280, -2370, | 
|     -2490, -2630, -3000, -3050, -3120, -3190, -3280, -3370, -3490, -3630, | 
| }; | 
|   | 
| static int mrf24j40_set_txpower(struct ieee802154_hw *hw, s32 mbm) | 
| { | 
|     struct mrf24j40 *devrec = hw->priv; | 
|     s32 small_scale; | 
|     u8 val; | 
|   | 
|     if (0 >= mbm && mbm > -1000) { | 
|         val = TXPWRL_0 << TXPWRL_SHIFT; | 
|         small_scale = mbm; | 
|     } else if (-1000 >= mbm && mbm > -2000) { | 
|         val = TXPWRL_10 << TXPWRL_SHIFT; | 
|         small_scale = mbm + 1000; | 
|     } else if (-2000 >= mbm && mbm > -3000) { | 
|         val = TXPWRL_20 << TXPWRL_SHIFT; | 
|         small_scale = mbm + 2000; | 
|     } else if (-3000 >= mbm && mbm > -4000) { | 
|         val = TXPWRL_30 << TXPWRL_SHIFT; | 
|         small_scale = mbm + 3000; | 
|     } else { | 
|         return -EINVAL; | 
|     } | 
|   | 
|     switch (small_scale) { | 
|     case 0: | 
|         val |= (TXPWRS_0 << TXPWRS_SHIFT); | 
|         break; | 
|     case -50: | 
|         val |= (TXPWRS_0_5 << TXPWRS_SHIFT); | 
|         break; | 
|     case -120: | 
|         val |= (TXPWRS_1_2 << TXPWRS_SHIFT); | 
|         break; | 
|     case -190: | 
|         val |= (TXPWRS_1_9 << TXPWRS_SHIFT); | 
|         break; | 
|     case -280: | 
|         val |= (TXPWRS_2_8 << TXPWRS_SHIFT); | 
|         break; | 
|     case -370: | 
|         val |= (TXPWRS_3_7 << TXPWRS_SHIFT); | 
|         break; | 
|     case -490: | 
|         val |= (TXPWRS_4_9 << TXPWRS_SHIFT); | 
|         break; | 
|     case -630: | 
|         val |= (TXPWRS_6_3 << TXPWRS_SHIFT); | 
|         break; | 
|     default: | 
|         return -EINVAL; | 
|     } | 
|   | 
|     return regmap_update_bits(devrec->regmap_long, REG_RFCON3, | 
|                   TXPWRL_MASK | TXPWRS_MASK, val); | 
| } | 
|   | 
| static int mrf24j40_set_promiscuous_mode(struct ieee802154_hw *hw, bool on) | 
| { | 
|     struct mrf24j40 *devrec = hw->priv; | 
|     int ret; | 
|   | 
|     if (on) { | 
|         /* set PROMI, ERRPKT and NOACKRSP */ | 
|         ret = regmap_update_bits(devrec->regmap_short, REG_RXMCR, | 
|                      BIT_PROMI | BIT_ERRPKT | BIT_NOACKRSP, | 
|                      BIT_PROMI | BIT_ERRPKT | BIT_NOACKRSP); | 
|     } else { | 
|         /* clear PROMI, ERRPKT and NOACKRSP */ | 
|         ret = regmap_update_bits(devrec->regmap_short, REG_RXMCR, | 
|                      BIT_PROMI | BIT_ERRPKT | BIT_NOACKRSP, | 
|                      0); | 
|     } | 
|   | 
|     return ret; | 
| } | 
|   | 
| static const struct ieee802154_ops mrf24j40_ops = { | 
|     .owner = THIS_MODULE, | 
|     .xmit_async = mrf24j40_tx, | 
|     .ed = mrf24j40_ed, | 
|     .start = mrf24j40_start, | 
|     .stop = mrf24j40_stop, | 
|     .set_channel = mrf24j40_set_channel, | 
|     .set_hw_addr_filt = mrf24j40_filter, | 
|     .set_csma_params = mrf24j40_csma_params, | 
|     .set_cca_mode = mrf24j40_set_cca_mode, | 
|     .set_cca_ed_level = mrf24j40_set_cca_ed_level, | 
|     .set_txpower = mrf24j40_set_txpower, | 
|     .set_promiscuous_mode = mrf24j40_set_promiscuous_mode, | 
| }; | 
|   | 
| static void mrf24j40_intstat_complete(void *context) | 
| { | 
|     struct mrf24j40 *devrec = context; | 
|     u8 intstat = devrec->irq_buf[1]; | 
|   | 
|     enable_irq(devrec->spi->irq); | 
|   | 
|     /* Ignore Rx security decryption */ | 
|     if (intstat & BIT_SECIF) | 
|         regmap_write_async(devrec->regmap_short, REG_SECCON0, | 
|                    BIT_SECIGNORE); | 
|   | 
|     /* Check for TX complete */ | 
|     if (intstat & BIT_TXNIF) | 
|         ieee802154_xmit_complete(devrec->hw, devrec->tx_skb, false); | 
|   | 
|     /* Check for Rx */ | 
|     if (intstat & BIT_RXIF) | 
|         mrf24j40_handle_rx(devrec); | 
| } | 
|   | 
| static irqreturn_t mrf24j40_isr(int irq, void *data) | 
| { | 
|     struct mrf24j40 *devrec = data; | 
|     int ret; | 
|   | 
|     disable_irq_nosync(irq); | 
|   | 
|     devrec->irq_buf[0] = MRF24J40_READSHORT(REG_INTSTAT); | 
|     devrec->irq_buf[1] = 0; | 
|   | 
|     /* Read the interrupt status */ | 
|     ret = spi_async(devrec->spi, &devrec->irq_msg); | 
|     if (ret) { | 
|         enable_irq(irq); | 
|         return IRQ_NONE; | 
|     } | 
|   | 
|     return IRQ_HANDLED; | 
| } | 
|   | 
| static int mrf24j40_hw_init(struct mrf24j40 *devrec) | 
| { | 
|     u32 irq_type; | 
|     int ret; | 
|   | 
|     /* Initialize the device. | 
|         From datasheet section 3.2: Initialization. */ | 
|     ret = regmap_write(devrec->regmap_short, REG_SOFTRST, 0x07); | 
|     if (ret) | 
|         goto err_ret; | 
|   | 
|     ret = regmap_write(devrec->regmap_short, REG_PACON2, 0x98); | 
|     if (ret) | 
|         goto err_ret; | 
|   | 
|     ret = regmap_write(devrec->regmap_short, REG_TXSTBL, 0x95); | 
|     if (ret) | 
|         goto err_ret; | 
|   | 
|     ret = regmap_write(devrec->regmap_long, REG_RFCON0, 0x03); | 
|     if (ret) | 
|         goto err_ret; | 
|   | 
|     ret = regmap_write(devrec->regmap_long, REG_RFCON1, 0x01); | 
|     if (ret) | 
|         goto err_ret; | 
|   | 
|     ret = regmap_write(devrec->regmap_long, REG_RFCON2, 0x80); | 
|     if (ret) | 
|         goto err_ret; | 
|   | 
|     ret = regmap_write(devrec->regmap_long, REG_RFCON6, 0x90); | 
|     if (ret) | 
|         goto err_ret; | 
|   | 
|     ret = regmap_write(devrec->regmap_long, REG_RFCON7, 0x80); | 
|     if (ret) | 
|         goto err_ret; | 
|   | 
|     ret = regmap_write(devrec->regmap_long, REG_RFCON8, 0x10); | 
|     if (ret) | 
|         goto err_ret; | 
|   | 
|     ret = regmap_write(devrec->regmap_long, REG_SLPCON1, 0x21); | 
|     if (ret) | 
|         goto err_ret; | 
|   | 
|     ret = regmap_write(devrec->regmap_short, REG_BBREG2, 0x80); | 
|     if (ret) | 
|         goto err_ret; | 
|   | 
|     ret = regmap_write(devrec->regmap_short, REG_CCAEDTH, 0x60); | 
|     if (ret) | 
|         goto err_ret; | 
|   | 
|     ret = regmap_write(devrec->regmap_short, REG_BBREG6, 0x40); | 
|     if (ret) | 
|         goto err_ret; | 
|   | 
|     ret = regmap_write(devrec->regmap_short, REG_RFCTL, 0x04); | 
|     if (ret) | 
|         goto err_ret; | 
|   | 
|     ret = regmap_write(devrec->regmap_short, REG_RFCTL, 0x0); | 
|     if (ret) | 
|         goto err_ret; | 
|   | 
|     udelay(192); | 
|   | 
|     /* Set RX Mode. RXMCR<1:0>: 0x0 normal, 0x1 promisc, 0x2 error */ | 
|     ret = regmap_update_bits(devrec->regmap_short, REG_RXMCR, 0x03, 0x00); | 
|     if (ret) | 
|         goto err_ret; | 
|   | 
|     if (spi_get_device_id(devrec->spi)->driver_data == MRF24J40MC) { | 
|         /* Enable external amplifier. | 
|          * From MRF24J40MC datasheet section 1.3: Operation. | 
|          */ | 
|         regmap_update_bits(devrec->regmap_long, REG_TESTMODE, 0x07, | 
|                    0x07); | 
|   | 
|         /* Set GPIO3 as output. */ | 
|         regmap_update_bits(devrec->regmap_short, REG_TRISGPIO, 0x08, | 
|                    0x08); | 
|   | 
|         /* Set GPIO3 HIGH to enable U5 voltage regulator */ | 
|         regmap_update_bits(devrec->regmap_short, REG_GPIO, 0x08, 0x08); | 
|   | 
|         /* Reduce TX pwr to meet FCC requirements. | 
|          * From MRF24J40MC datasheet section 3.1.1 | 
|          */ | 
|         regmap_write(devrec->regmap_long, REG_RFCON3, 0x28); | 
|     } | 
|   | 
|     irq_type = irq_get_trigger_type(devrec->spi->irq); | 
|     if (irq_type == IRQ_TYPE_EDGE_RISING || | 
|         irq_type == IRQ_TYPE_EDGE_FALLING) | 
|         dev_warn(&devrec->spi->dev, | 
|              "Using edge triggered irq's are not recommended, because it can cause races and result in a non-functional driver!\n"); | 
|     switch (irq_type) { | 
|     case IRQ_TYPE_EDGE_RISING: | 
|     case IRQ_TYPE_LEVEL_HIGH: | 
|         /* set interrupt polarity to rising */ | 
|         ret = regmap_update_bits(devrec->regmap_long, REG_SLPCON0, | 
|                      BIT_INTEDGE, BIT_INTEDGE); | 
|         if (ret) | 
|             goto err_ret; | 
|         break; | 
|     default: | 
|         /* default is falling edge */ | 
|         break; | 
|     } | 
|   | 
|     return 0; | 
|   | 
| err_ret: | 
|     return ret; | 
| } | 
|   | 
| static void | 
| mrf24j40_setup_tx_spi_messages(struct mrf24j40 *devrec) | 
| { | 
|     spi_message_init(&devrec->tx_msg); | 
|     devrec->tx_msg.context = devrec; | 
|     devrec->tx_msg.complete = write_tx_buf_complete; | 
|     devrec->tx_hdr_trx.len = 2; | 
|     devrec->tx_hdr_trx.tx_buf = devrec->tx_hdr_buf; | 
|     spi_message_add_tail(&devrec->tx_hdr_trx, &devrec->tx_msg); | 
|     devrec->tx_len_trx.len = 2; | 
|     devrec->tx_len_trx.tx_buf = devrec->tx_len_buf; | 
|     spi_message_add_tail(&devrec->tx_len_trx, &devrec->tx_msg); | 
|     spi_message_add_tail(&devrec->tx_buf_trx, &devrec->tx_msg); | 
|   | 
|     spi_message_init(&devrec->tx_post_msg); | 
|     devrec->tx_post_msg.context = devrec; | 
|     devrec->tx_post_trx.len = 2; | 
|     devrec->tx_post_trx.tx_buf = devrec->tx_post_buf; | 
|     spi_message_add_tail(&devrec->tx_post_trx, &devrec->tx_post_msg); | 
| } | 
|   | 
| static void | 
| mrf24j40_setup_rx_spi_messages(struct mrf24j40 *devrec) | 
| { | 
|     spi_message_init(&devrec->rx_msg); | 
|     devrec->rx_msg.context = devrec; | 
|     devrec->rx_trx.len = 2; | 
|     devrec->rx_trx.tx_buf = devrec->rx_buf; | 
|     devrec->rx_trx.rx_buf = devrec->rx_buf; | 
|     spi_message_add_tail(&devrec->rx_trx, &devrec->rx_msg); | 
|   | 
|     spi_message_init(&devrec->rx_buf_msg); | 
|     devrec->rx_buf_msg.context = devrec; | 
|     devrec->rx_buf_msg.complete = mrf24j40_handle_rx_read_buf_complete; | 
|     devrec->rx_addr_trx.len = 2; | 
|     devrec->rx_addr_trx.tx_buf = devrec->rx_addr_buf; | 
|     spi_message_add_tail(&devrec->rx_addr_trx, &devrec->rx_buf_msg); | 
|     devrec->rx_fifo_buf_trx.rx_buf = devrec->rx_fifo_buf; | 
|     spi_message_add_tail(&devrec->rx_fifo_buf_trx, &devrec->rx_buf_msg); | 
|     devrec->rx_lqi_trx.len = 2; | 
|     devrec->rx_lqi_trx.rx_buf = devrec->rx_lqi_buf; | 
|     spi_message_add_tail(&devrec->rx_lqi_trx, &devrec->rx_buf_msg); | 
| } | 
|   | 
| static void | 
| mrf24j40_setup_irq_spi_messages(struct mrf24j40 *devrec) | 
| { | 
|     spi_message_init(&devrec->irq_msg); | 
|     devrec->irq_msg.context = devrec; | 
|     devrec->irq_msg.complete = mrf24j40_intstat_complete; | 
|     devrec->irq_trx.len = 2; | 
|     devrec->irq_trx.tx_buf = devrec->irq_buf; | 
|     devrec->irq_trx.rx_buf = devrec->irq_buf; | 
|     spi_message_add_tail(&devrec->irq_trx, &devrec->irq_msg); | 
| } | 
|   | 
| static void  mrf24j40_phy_setup(struct mrf24j40 *devrec) | 
| { | 
|     ieee802154_random_extended_addr(&devrec->hw->phy->perm_extended_addr); | 
|     devrec->hw->phy->current_channel = 11; | 
|   | 
|     /* mrf24j40 supports max_minbe 0 - 3 */ | 
|     devrec->hw->phy->supported.max_minbe = 3; | 
|     /* datasheet doesn't say anything about max_be, but we have min_be | 
|      * So we assume the max_be default. | 
|      */ | 
|     devrec->hw->phy->supported.min_maxbe = 5; | 
|     devrec->hw->phy->supported.max_maxbe = 5; | 
|   | 
|     devrec->hw->phy->cca.mode = NL802154_CCA_CARRIER; | 
|     devrec->hw->phy->supported.cca_modes = BIT(NL802154_CCA_ENERGY) | | 
|                            BIT(NL802154_CCA_CARRIER) | | 
|                            BIT(NL802154_CCA_ENERGY_CARRIER); | 
|     devrec->hw->phy->supported.cca_opts = BIT(NL802154_CCA_OPT_ENERGY_CARRIER_AND); | 
|   | 
|     devrec->hw->phy->cca_ed_level = -6900; | 
|     devrec->hw->phy->supported.cca_ed_levels = mrf24j40_ed_levels; | 
|     devrec->hw->phy->supported.cca_ed_levels_size = ARRAY_SIZE(mrf24j40_ed_levels); | 
|   | 
|     switch (spi_get_device_id(devrec->spi)->driver_data) { | 
|     case MRF24J40: | 
|     case MRF24J40MA: | 
|         devrec->hw->phy->supported.tx_powers = mrf24j40ma_powers; | 
|         devrec->hw->phy->supported.tx_powers_size = ARRAY_SIZE(mrf24j40ma_powers); | 
|         devrec->hw->phy->flags |= WPAN_PHY_FLAG_TXPOWER; | 
|         break; | 
|     default: | 
|         break; | 
|     } | 
| } | 
|   | 
| static int mrf24j40_probe(struct spi_device *spi) | 
| { | 
|     int ret = -ENOMEM, irq_type; | 
|     struct ieee802154_hw *hw; | 
|     struct mrf24j40 *devrec; | 
|   | 
|     dev_info(&spi->dev, "probe(). IRQ: %d\n", spi->irq); | 
|   | 
|     /* Register with the 802154 subsystem */ | 
|   | 
|     hw = ieee802154_alloc_hw(sizeof(*devrec), &mrf24j40_ops); | 
|     if (!hw) | 
|         goto err_ret; | 
|   | 
|     devrec = hw->priv; | 
|     devrec->spi = spi; | 
|     spi_set_drvdata(spi, devrec); | 
|     devrec->hw = hw; | 
|     devrec->hw->parent = &spi->dev; | 
|     devrec->hw->phy->supported.channels[0] = CHANNEL_MASK; | 
|     devrec->hw->flags = IEEE802154_HW_TX_OMIT_CKSUM | IEEE802154_HW_AFILT | | 
|                 IEEE802154_HW_CSMA_PARAMS | | 
|                 IEEE802154_HW_PROMISCUOUS; | 
|   | 
|     devrec->hw->phy->flags = WPAN_PHY_FLAG_CCA_MODE | | 
|                  WPAN_PHY_FLAG_CCA_ED_LEVEL; | 
|   | 
|     mrf24j40_setup_tx_spi_messages(devrec); | 
|     mrf24j40_setup_rx_spi_messages(devrec); | 
|     mrf24j40_setup_irq_spi_messages(devrec); | 
|   | 
|     devrec->regmap_short = devm_regmap_init_spi(spi, | 
|                             &mrf24j40_short_regmap); | 
|     if (IS_ERR(devrec->regmap_short)) { | 
|         ret = PTR_ERR(devrec->regmap_short); | 
|         dev_err(&spi->dev, "Failed to allocate short register map: %d\n", | 
|             ret); | 
|         goto err_register_device; | 
|     } | 
|   | 
|     devrec->regmap_long = devm_regmap_init(&spi->dev, | 
|                            &mrf24j40_long_regmap_bus, | 
|                            spi, &mrf24j40_long_regmap); | 
|     if (IS_ERR(devrec->regmap_long)) { | 
|         ret = PTR_ERR(devrec->regmap_long); | 
|         dev_err(&spi->dev, "Failed to allocate long register map: %d\n", | 
|             ret); | 
|         goto err_register_device; | 
|     } | 
|   | 
|     if (spi->max_speed_hz > MAX_SPI_SPEED_HZ) { | 
|         dev_warn(&spi->dev, "spi clock above possible maximum: %d", | 
|              MAX_SPI_SPEED_HZ); | 
|         ret = -EINVAL; | 
|         goto err_register_device; | 
|     } | 
|   | 
|     ret = mrf24j40_hw_init(devrec); | 
|     if (ret) | 
|         goto err_register_device; | 
|   | 
|     mrf24j40_phy_setup(devrec); | 
|   | 
|     /* request IRQF_TRIGGER_LOW as fallback default */ | 
|     irq_type = irq_get_trigger_type(spi->irq); | 
|     if (!irq_type) | 
|         irq_type = IRQF_TRIGGER_LOW; | 
|   | 
|     ret = devm_request_irq(&spi->dev, spi->irq, mrf24j40_isr, | 
|                    irq_type, dev_name(&spi->dev), devrec); | 
|     if (ret) { | 
|         dev_err(printdev(devrec), "Unable to get IRQ"); | 
|         goto err_register_device; | 
|     } | 
|   | 
|     dev_dbg(printdev(devrec), "registered mrf24j40\n"); | 
|     ret = ieee802154_register_hw(devrec->hw); | 
|     if (ret) | 
|         goto err_register_device; | 
|   | 
|     return 0; | 
|   | 
| err_register_device: | 
|     ieee802154_free_hw(devrec->hw); | 
| err_ret: | 
|     return ret; | 
| } | 
|   | 
| static int mrf24j40_remove(struct spi_device *spi) | 
| { | 
|     struct mrf24j40 *devrec = spi_get_drvdata(spi); | 
|   | 
|     dev_dbg(printdev(devrec), "remove\n"); | 
|   | 
|     ieee802154_unregister_hw(devrec->hw); | 
|     ieee802154_free_hw(devrec->hw); | 
|     /* TODO: Will ieee802154_free_device() wait until ->xmit() is | 
|      * complete? */ | 
|   | 
|     return 0; | 
| } | 
|   | 
| static const struct of_device_id mrf24j40_of_match[] = { | 
|     { .compatible = "microchip,mrf24j40", .data = (void *)MRF24J40 }, | 
|     { .compatible = "microchip,mrf24j40ma", .data = (void *)MRF24J40MA }, | 
|     { .compatible = "microchip,mrf24j40mc", .data = (void *)MRF24J40MC }, | 
|     { }, | 
| }; | 
| MODULE_DEVICE_TABLE(of, mrf24j40_of_match); | 
|   | 
| static const struct spi_device_id mrf24j40_ids[] = { | 
|     { "mrf24j40", MRF24J40 }, | 
|     { "mrf24j40ma", MRF24J40MA }, | 
|     { "mrf24j40mc", MRF24J40MC }, | 
|     { }, | 
| }; | 
| MODULE_DEVICE_TABLE(spi, mrf24j40_ids); | 
|   | 
| static struct spi_driver mrf24j40_driver = { | 
|     .driver = { | 
|         .of_match_table = of_match_ptr(mrf24j40_of_match), | 
|         .name = "mrf24j40", | 
|     }, | 
|     .id_table = mrf24j40_ids, | 
|     .probe = mrf24j40_probe, | 
|     .remove = mrf24j40_remove, | 
| }; | 
|   | 
| module_spi_driver(mrf24j40_driver); | 
|   | 
| MODULE_LICENSE("GPL"); | 
| MODULE_AUTHOR("Alan Ott"); | 
| MODULE_DESCRIPTION("MRF24J40 SPI 802.15.4 Controller Driver"); |