mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-12-27 14:28:55 +07:00
3faf564372
isr function issues SPI read command to mrf to obtain INTSTAT. SPI transfer is 2 bytes, but value of 2nd byte is not defined. This had the effect that only the first ISR worked as intended. The second ISR read incorrect INTSTAT values. Observed on Raspberry PI B+. Signed-off-by: Walter Mack <wmack@componentsw.com> Signed-off-by: Marcel Holtmann <marcel@holtmann.org>
1411 lines
36 KiB
C
1411 lines
36 KiB
C
/*
|
|
* 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");
|