mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-12-21 21:24:52 +07:00
0be7fc7e08
It seems that this is a copy/paste error and the proper bit masking is:
BIT_TXNIE | BIT_RXIE
This issue was detected with the help of Coccinelle.
Reported-by: Julia Lawall <julia.lawall@lip6.fr>
Signed-off-by: Gustavo A. R. Silva <garsilva@embeddedor.com>
Fixes: 7d840545e5
("mrf24j40: replace magic numbers")
Acked-by: Alan Ott <alan@signal11.us>
Signed-off-by: Stefan Schmidt <stefan@osg.samsung.com>
1413 lines
36 KiB
C
1413 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/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");
|