| /* | |
| * 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/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_TXNIE, BIT_TXNIE | BIT_TXNIE); | |
| } | |
| 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; | |
| } | |
| memcpy(skb_put(skb, len), 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); | |
| return -EINVAL; | |
| } | |
| 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"); |