mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-12-24 12:29:44 +07:00
a9a08845e9
This is the mindless scripted replacement of kernel use of POLL* variables as described by Al, done by this script: for V in IN OUT PRI ERR RDNORM RDBAND WRNORM WRBAND HUP RDHUP NVAL MSG; do L=`git grep -l -w POLL$V | grep -v '^t' | grep -v /um/ | grep -v '^sa' | grep -v '/poll.h$'|grep -v '^D'` for f in $L; do sed -i "-es/^\([^\"]*\)\(\<POLL$V\>\)/\\1E\\2/" $f; done done with de-mangling cleanups yet to come. NOTE! On almost all architectures, the EPOLL* constants have the same values as the POLL* constants do. But they keyword here is "almost". For various bad reasons they aren't the same, and epoll() doesn't actually work quite correctly in some cases due to this on Sparc et al. The next patch from Al will sort out the final differences, and we should be all done. Scripted-by: Al Viro <viro@zeniv.linux.org.uk> Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
3237 lines
84 KiB
C
3237 lines
84 KiB
C
/*
|
|
* http://www.cascoda.com/products/ca-821x/
|
|
* Copyright (c) 2016, Cascoda, Ltd.
|
|
* All rights reserved.
|
|
*
|
|
* This code is dual-licensed under both GPLv2 and 3-clause BSD. What follows is
|
|
* the license notice for both respectively.
|
|
*
|
|
*******************************************************************************
|
|
*
|
|
* 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.
|
|
*
|
|
*******************************************************************************
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions are met:
|
|
*
|
|
* 1. Redistributions of source code must retain the above copyright notice,
|
|
* this list of conditions and the following disclaimer.
|
|
*
|
|
* 2. Redistributions in binary form must reproduce the above copyright notice,
|
|
* this list of conditions and the following disclaimer in the documentation
|
|
* and/or other materials provided with the distribution.
|
|
*
|
|
* 3. Neither the name of the copyright holder nor the names of its contributors
|
|
* may be used to endorse or promote products derived from this software without
|
|
* specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
|
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDERS OR CONTRIBUTORS BE
|
|
* LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
|
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
|
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
|
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
|
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
|
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
|
* POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
|
|
#include <linux/cdev.h>
|
|
#include <linux/clk-provider.h>
|
|
#include <linux/debugfs.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/gpio.h>
|
|
#include <linux/ieee802154.h>
|
|
#include <linux/kfifo.h>
|
|
#include <linux/of.h>
|
|
#include <linux/of_device.h>
|
|
#include <linux/of_gpio.h>
|
|
#include <linux/module.h>
|
|
#include <linux/mutex.h>
|
|
#include <linux/poll.h>
|
|
#include <linux/skbuff.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/spi/spi.h>
|
|
#include <linux/spinlock.h>
|
|
#include <linux/string.h>
|
|
#include <linux/workqueue.h>
|
|
#include <linux/interrupt.h>
|
|
|
|
#include <net/ieee802154_netdev.h>
|
|
#include <net/mac802154.h>
|
|
|
|
#define DRIVER_NAME "ca8210"
|
|
|
|
/* external clock frequencies */
|
|
#define ONE_MHZ 1000000
|
|
#define TWO_MHZ (2 * ONE_MHZ)
|
|
#define FOUR_MHZ (4 * ONE_MHZ)
|
|
#define EIGHT_MHZ (8 * ONE_MHZ)
|
|
#define SIXTEEN_MHZ (16 * ONE_MHZ)
|
|
|
|
/* spi constants */
|
|
#define CA8210_SPI_BUF_SIZE 256
|
|
#define CA8210_SYNC_TIMEOUT 1000 /* Timeout for synchronous commands [ms] */
|
|
|
|
/* test interface constants */
|
|
#define CA8210_TEST_INT_FILE_NAME "ca8210_test"
|
|
#define CA8210_TEST_INT_FIFO_SIZE 256
|
|
|
|
/* MAC status enumerations */
|
|
#define MAC_SUCCESS (0x00)
|
|
#define MAC_ERROR (0x01)
|
|
#define MAC_CANCELLED (0x02)
|
|
#define MAC_READY_FOR_POLL (0x03)
|
|
#define MAC_COUNTER_ERROR (0xDB)
|
|
#define MAC_IMPROPER_KEY_TYPE (0xDC)
|
|
#define MAC_IMPROPER_SECURITY_LEVEL (0xDD)
|
|
#define MAC_UNSUPPORTED_LEGACY (0xDE)
|
|
#define MAC_UNSUPPORTED_SECURITY (0xDF)
|
|
#define MAC_BEACON_LOST (0xE0)
|
|
#define MAC_CHANNEL_ACCESS_FAILURE (0xE1)
|
|
#define MAC_DENIED (0xE2)
|
|
#define MAC_DISABLE_TRX_FAILURE (0xE3)
|
|
#define MAC_SECURITY_ERROR (0xE4)
|
|
#define MAC_FRAME_TOO_LONG (0xE5)
|
|
#define MAC_INVALID_GTS (0xE6)
|
|
#define MAC_INVALID_HANDLE (0xE7)
|
|
#define MAC_INVALID_PARAMETER (0xE8)
|
|
#define MAC_NO_ACK (0xE9)
|
|
#define MAC_NO_BEACON (0xEA)
|
|
#define MAC_NO_DATA (0xEB)
|
|
#define MAC_NO_SHORT_ADDRESS (0xEC)
|
|
#define MAC_OUT_OF_CAP (0xED)
|
|
#define MAC_PAN_ID_CONFLICT (0xEE)
|
|
#define MAC_REALIGNMENT (0xEF)
|
|
#define MAC_TRANSACTION_EXPIRED (0xF0)
|
|
#define MAC_TRANSACTION_OVERFLOW (0xF1)
|
|
#define MAC_TX_ACTIVE (0xF2)
|
|
#define MAC_UNAVAILABLE_KEY (0xF3)
|
|
#define MAC_UNSUPPORTED_ATTRIBUTE (0xF4)
|
|
#define MAC_INVALID_ADDRESS (0xF5)
|
|
#define MAC_ON_TIME_TOO_LONG (0xF6)
|
|
#define MAC_PAST_TIME (0xF7)
|
|
#define MAC_TRACKING_OFF (0xF8)
|
|
#define MAC_INVALID_INDEX (0xF9)
|
|
#define MAC_LIMIT_REACHED (0xFA)
|
|
#define MAC_READ_ONLY (0xFB)
|
|
#define MAC_SCAN_IN_PROGRESS (0xFC)
|
|
#define MAC_SUPERFRAME_OVERLAP (0xFD)
|
|
#define MAC_SYSTEM_ERROR (0xFF)
|
|
|
|
/* HWME attribute IDs */
|
|
#define HWME_EDTHRESHOLD (0x04)
|
|
#define HWME_EDVALUE (0x06)
|
|
#define HWME_SYSCLKOUT (0x0F)
|
|
#define HWME_LQILIMIT (0x11)
|
|
|
|
/* TDME attribute IDs */
|
|
#define TDME_CHANNEL (0x00)
|
|
#define TDME_ATM_CONFIG (0x06)
|
|
|
|
#define MAX_HWME_ATTRIBUTE_SIZE 16
|
|
#define MAX_TDME_ATTRIBUTE_SIZE 2
|
|
|
|
/* PHY/MAC PIB Attribute Enumerations */
|
|
#define PHY_CURRENT_CHANNEL (0x00)
|
|
#define PHY_TRANSMIT_POWER (0x02)
|
|
#define PHY_CCA_MODE (0x03)
|
|
#define MAC_ASSOCIATION_PERMIT (0x41)
|
|
#define MAC_AUTO_REQUEST (0x42)
|
|
#define MAC_BATT_LIFE_EXT (0x43)
|
|
#define MAC_BATT_LIFE_EXT_PERIODS (0x44)
|
|
#define MAC_BEACON_PAYLOAD (0x45)
|
|
#define MAC_BEACON_PAYLOAD_LENGTH (0x46)
|
|
#define MAC_BEACON_ORDER (0x47)
|
|
#define MAC_GTS_PERMIT (0x4d)
|
|
#define MAC_MAX_CSMA_BACKOFFS (0x4e)
|
|
#define MAC_MIN_BE (0x4f)
|
|
#define MAC_PAN_ID (0x50)
|
|
#define MAC_PROMISCUOUS_MODE (0x51)
|
|
#define MAC_RX_ON_WHEN_IDLE (0x52)
|
|
#define MAC_SHORT_ADDRESS (0x53)
|
|
#define MAC_SUPERFRAME_ORDER (0x54)
|
|
#define MAC_ASSOCIATED_PAN_COORD (0x56)
|
|
#define MAC_MAX_BE (0x57)
|
|
#define MAC_MAX_FRAME_RETRIES (0x59)
|
|
#define MAC_RESPONSE_WAIT_TIME (0x5A)
|
|
#define MAC_SECURITY_ENABLED (0x5D)
|
|
|
|
#define MAC_AUTO_REQUEST_SECURITY_LEVEL (0x78)
|
|
#define MAC_AUTO_REQUEST_KEY_ID_MODE (0x79)
|
|
|
|
#define NS_IEEE_ADDRESS (0xFF) /* Non-standard IEEE address */
|
|
|
|
/* MAC Address Mode Definitions */
|
|
#define MAC_MODE_NO_ADDR (0x00)
|
|
#define MAC_MODE_SHORT_ADDR (0x02)
|
|
#define MAC_MODE_LONG_ADDR (0x03)
|
|
|
|
/* MAC constants */
|
|
#define MAX_BEACON_OVERHEAD (75)
|
|
#define MAX_BEACON_PAYLOAD_LENGTH (IEEE802154_MTU - MAX_BEACON_OVERHEAD)
|
|
|
|
#define MAX_ATTRIBUTE_SIZE (122)
|
|
#define MAX_DATA_SIZE (114)
|
|
|
|
#define CA8210_VALID_CHANNELS (0x07FFF800)
|
|
|
|
/* MAC workarounds for V1.1 and MPW silicon (V0.x) */
|
|
#define CA8210_MAC_WORKAROUNDS (0)
|
|
#define CA8210_MAC_MPW (0)
|
|
|
|
/* memory manipulation macros */
|
|
#define LS_BYTE(x) ((u8)((x) & 0xFF))
|
|
#define MS_BYTE(x) ((u8)(((x) >> 8) & 0xFF))
|
|
|
|
/* message ID codes in SPI commands */
|
|
/* downstream */
|
|
#define MCPS_DATA_REQUEST (0x00)
|
|
#define MLME_ASSOCIATE_REQUEST (0x02)
|
|
#define MLME_ASSOCIATE_RESPONSE (0x03)
|
|
#define MLME_DISASSOCIATE_REQUEST (0x04)
|
|
#define MLME_GET_REQUEST (0x05)
|
|
#define MLME_ORPHAN_RESPONSE (0x06)
|
|
#define MLME_RESET_REQUEST (0x07)
|
|
#define MLME_RX_ENABLE_REQUEST (0x08)
|
|
#define MLME_SCAN_REQUEST (0x09)
|
|
#define MLME_SET_REQUEST (0x0A)
|
|
#define MLME_START_REQUEST (0x0B)
|
|
#define MLME_POLL_REQUEST (0x0D)
|
|
#define HWME_SET_REQUEST (0x0E)
|
|
#define HWME_GET_REQUEST (0x0F)
|
|
#define TDME_SETSFR_REQUEST (0x11)
|
|
#define TDME_GETSFR_REQUEST (0x12)
|
|
#define TDME_SET_REQUEST (0x14)
|
|
/* upstream */
|
|
#define MCPS_DATA_INDICATION (0x00)
|
|
#define MCPS_DATA_CONFIRM (0x01)
|
|
#define MLME_RESET_CONFIRM (0x0A)
|
|
#define MLME_SET_CONFIRM (0x0E)
|
|
#define MLME_START_CONFIRM (0x0F)
|
|
#define HWME_SET_CONFIRM (0x12)
|
|
#define HWME_GET_CONFIRM (0x13)
|
|
#define HWME_WAKEUP_INDICATION (0x15)
|
|
#define TDME_SETSFR_CONFIRM (0x17)
|
|
|
|
/* SPI command IDs */
|
|
/* bit indicating a confirm or indication from slave to master */
|
|
#define SPI_S2M (0x20)
|
|
/* bit indicating a synchronous message */
|
|
#define SPI_SYN (0x40)
|
|
|
|
/* SPI command definitions */
|
|
#define SPI_IDLE (0xFF)
|
|
#define SPI_NACK (0xF0)
|
|
|
|
#define SPI_MCPS_DATA_REQUEST (MCPS_DATA_REQUEST)
|
|
#define SPI_MCPS_DATA_INDICATION (MCPS_DATA_INDICATION + SPI_S2M)
|
|
#define SPI_MCPS_DATA_CONFIRM (MCPS_DATA_CONFIRM + SPI_S2M)
|
|
|
|
#define SPI_MLME_ASSOCIATE_REQUEST (MLME_ASSOCIATE_REQUEST)
|
|
#define SPI_MLME_RESET_REQUEST (MLME_RESET_REQUEST + SPI_SYN)
|
|
#define SPI_MLME_SET_REQUEST (MLME_SET_REQUEST + SPI_SYN)
|
|
#define SPI_MLME_START_REQUEST (MLME_START_REQUEST + SPI_SYN)
|
|
#define SPI_MLME_RESET_CONFIRM (MLME_RESET_CONFIRM + SPI_S2M + SPI_SYN)
|
|
#define SPI_MLME_SET_CONFIRM (MLME_SET_CONFIRM + SPI_S2M + SPI_SYN)
|
|
#define SPI_MLME_START_CONFIRM (MLME_START_CONFIRM + SPI_S2M + SPI_SYN)
|
|
|
|
#define SPI_HWME_SET_REQUEST (HWME_SET_REQUEST + SPI_SYN)
|
|
#define SPI_HWME_GET_REQUEST (HWME_GET_REQUEST + SPI_SYN)
|
|
#define SPI_HWME_SET_CONFIRM (HWME_SET_CONFIRM + SPI_S2M + SPI_SYN)
|
|
#define SPI_HWME_GET_CONFIRM (HWME_GET_CONFIRM + SPI_S2M + SPI_SYN)
|
|
#define SPI_HWME_WAKEUP_INDICATION (HWME_WAKEUP_INDICATION + SPI_S2M)
|
|
|
|
#define SPI_TDME_SETSFR_REQUEST (TDME_SETSFR_REQUEST + SPI_SYN)
|
|
#define SPI_TDME_SET_REQUEST (TDME_SET_REQUEST + SPI_SYN)
|
|
#define SPI_TDME_SETSFR_CONFIRM (TDME_SETSFR_CONFIRM + SPI_S2M + SPI_SYN)
|
|
|
|
/* TDME SFR addresses */
|
|
/* Page 0 */
|
|
#define CA8210_SFR_PACFG (0xB1)
|
|
#define CA8210_SFR_MACCON (0xD8)
|
|
#define CA8210_SFR_PACFGIB (0xFE)
|
|
/* Page 1 */
|
|
#define CA8210_SFR_LOTXCAL (0xBF)
|
|
#define CA8210_SFR_PTHRH (0xD1)
|
|
#define CA8210_SFR_PRECFG (0xD3)
|
|
#define CA8210_SFR_LNAGX40 (0xE1)
|
|
#define CA8210_SFR_LNAGX41 (0xE2)
|
|
#define CA8210_SFR_LNAGX42 (0xE3)
|
|
#define CA8210_SFR_LNAGX43 (0xE4)
|
|
#define CA8210_SFR_LNAGX44 (0xE5)
|
|
#define CA8210_SFR_LNAGX45 (0xE6)
|
|
#define CA8210_SFR_LNAGX46 (0xE7)
|
|
#define CA8210_SFR_LNAGX47 (0xE9)
|
|
|
|
#define PACFGIB_DEFAULT_CURRENT (0x3F)
|
|
#define PTHRH_DEFAULT_THRESHOLD (0x5A)
|
|
#define LNAGX40_DEFAULT_GAIN (0x29) /* 10dB */
|
|
#define LNAGX41_DEFAULT_GAIN (0x54) /* 21dB */
|
|
#define LNAGX42_DEFAULT_GAIN (0x6C) /* 27dB */
|
|
#define LNAGX43_DEFAULT_GAIN (0x7A) /* 30dB */
|
|
#define LNAGX44_DEFAULT_GAIN (0x84) /* 33dB */
|
|
#define LNAGX45_DEFAULT_GAIN (0x8B) /* 34dB */
|
|
#define LNAGX46_DEFAULT_GAIN (0x92) /* 36dB */
|
|
#define LNAGX47_DEFAULT_GAIN (0x96) /* 37dB */
|
|
|
|
#define CA8210_IOCTL_HARD_RESET (0x00)
|
|
|
|
/* Structs/Enums */
|
|
|
|
/**
|
|
* struct cas_control - spi transfer structure
|
|
* @msg: spi_message for each exchange
|
|
* @transfer: spi_transfer for each exchange
|
|
* @tx_buf: source array for transmission
|
|
* @tx_in_buf: array storing bytes received during transmission
|
|
* @priv: pointer to private data
|
|
*
|
|
* This structure stores all the necessary data passed around during a single
|
|
* spi exchange.
|
|
*/
|
|
struct cas_control {
|
|
struct spi_message msg;
|
|
struct spi_transfer transfer;
|
|
|
|
u8 tx_buf[CA8210_SPI_BUF_SIZE];
|
|
u8 tx_in_buf[CA8210_SPI_BUF_SIZE];
|
|
|
|
struct ca8210_priv *priv;
|
|
};
|
|
|
|
/**
|
|
* struct ca8210_test - ca8210 test interface structure
|
|
* @ca8210_dfs_spi_int: pointer to the entry in the debug fs for this device
|
|
* @up_fifo: fifo for upstream messages
|
|
*
|
|
* This structure stores all the data pertaining to the debug interface
|
|
*/
|
|
struct ca8210_test {
|
|
struct dentry *ca8210_dfs_spi_int;
|
|
struct kfifo up_fifo;
|
|
wait_queue_head_t readq;
|
|
};
|
|
|
|
/**
|
|
* struct ca8210_priv - ca8210 private data structure
|
|
* @spi: pointer to the ca8210 spi device object
|
|
* @hw: pointer to the ca8210 ieee802154_hw object
|
|
* @hw_registered: true if hw has been registered with ieee802154
|
|
* @lock: spinlock protecting the private data area
|
|
* @mlme_workqueue: workqueue for triggering MLME Reset
|
|
* @irq_workqueue: workqueue for irq processing
|
|
* @tx_skb: current socket buffer to transmit
|
|
* @nextmsduhandle: msdu handle to pass to the 15.4 MAC layer for the
|
|
* next transmission
|
|
* @clk: external clock provided by the ca8210
|
|
* @last_dsn: sequence number of last data packet received, for
|
|
* resend detection
|
|
* @test: test interface data section for this instance
|
|
* @async_tx_pending: true if an asynchronous transmission was started and
|
|
* is not complete
|
|
* @sync_command_response: pointer to buffer to fill with sync response
|
|
* @ca8210_is_awake: nonzero if ca8210 is initialised, ready for comms
|
|
* @sync_down: counts number of downstream synchronous commands
|
|
* @sync_up: counts number of upstream synchronous commands
|
|
* @spi_transfer_complete completion object for a single spi_transfer
|
|
* @sync_exchange_complete completion object for a complete synchronous API
|
|
* exchange
|
|
* @promiscuous whether the ca8210 is in promiscuous mode or not
|
|
* @retries: records how many times the current pending spi
|
|
* transfer has been retried
|
|
*/
|
|
struct ca8210_priv {
|
|
struct spi_device *spi;
|
|
struct ieee802154_hw *hw;
|
|
bool hw_registered;
|
|
spinlock_t lock;
|
|
struct workqueue_struct *mlme_workqueue;
|
|
struct workqueue_struct *irq_workqueue;
|
|
struct sk_buff *tx_skb;
|
|
u8 nextmsduhandle;
|
|
struct clk *clk;
|
|
int last_dsn;
|
|
struct ca8210_test test;
|
|
bool async_tx_pending;
|
|
u8 *sync_command_response;
|
|
struct completion ca8210_is_awake;
|
|
int sync_down, sync_up;
|
|
struct completion spi_transfer_complete, sync_exchange_complete;
|
|
bool promiscuous;
|
|
int retries;
|
|
};
|
|
|
|
/**
|
|
* struct work_priv_container - link between a work object and the relevant
|
|
* device's private data
|
|
* @work: work object being executed
|
|
* @priv: device's private data section
|
|
*
|
|
*/
|
|
struct work_priv_container {
|
|
struct work_struct work;
|
|
struct ca8210_priv *priv;
|
|
};
|
|
|
|
/**
|
|
* struct ca8210_platform_data - ca8210 platform data structure
|
|
* @extclockenable: true if the external clock is to be enabled
|
|
* @extclockfreq: frequency of the external clock
|
|
* @extclockgpio: ca8210 output gpio of the external clock
|
|
* @gpio_reset: gpio number of ca8210 reset line
|
|
* @gpio_irq: gpio number of ca8210 interrupt line
|
|
* @irq_id: identifier for the ca8210 irq
|
|
*
|
|
*/
|
|
struct ca8210_platform_data {
|
|
bool extclockenable;
|
|
unsigned int extclockfreq;
|
|
unsigned int extclockgpio;
|
|
int gpio_reset;
|
|
int gpio_irq;
|
|
int irq_id;
|
|
};
|
|
|
|
/**
|
|
* struct fulladdr - full MAC addressing information structure
|
|
* @mode: address mode (none, short, extended)
|
|
* @pan_id: 16-bit LE pan id
|
|
* @address: LE address, variable length as specified by mode
|
|
*
|
|
*/
|
|
struct fulladdr {
|
|
u8 mode;
|
|
u8 pan_id[2];
|
|
u8 address[8];
|
|
};
|
|
|
|
/**
|
|
* union macaddr: generic MAC address container
|
|
* @short_addr: 16-bit short address
|
|
* @ieee_address: 64-bit extended address as LE byte array
|
|
*
|
|
*/
|
|
union macaddr {
|
|
u16 short_address;
|
|
u8 ieee_address[8];
|
|
};
|
|
|
|
/**
|
|
* struct secspec: security specification for SAP commands
|
|
* @security_level: 0-7, controls level of authentication & encryption
|
|
* @key_id_mode: 0-3, specifies how to obtain key
|
|
* @key_source: extended key retrieval data
|
|
* @key_index: single-byte key identifier
|
|
*
|
|
*/
|
|
struct secspec {
|
|
u8 security_level;
|
|
u8 key_id_mode;
|
|
u8 key_source[8];
|
|
u8 key_index;
|
|
};
|
|
|
|
/* downlink functions parameter set definitions */
|
|
struct mcps_data_request_pset {
|
|
u8 src_addr_mode;
|
|
struct fulladdr dst;
|
|
u8 msdu_length;
|
|
u8 msdu_handle;
|
|
u8 tx_options;
|
|
u8 msdu[MAX_DATA_SIZE];
|
|
};
|
|
|
|
struct mlme_set_request_pset {
|
|
u8 pib_attribute;
|
|
u8 pib_attribute_index;
|
|
u8 pib_attribute_length;
|
|
u8 pib_attribute_value[MAX_ATTRIBUTE_SIZE];
|
|
};
|
|
|
|
struct hwme_set_request_pset {
|
|
u8 hw_attribute;
|
|
u8 hw_attribute_length;
|
|
u8 hw_attribute_value[MAX_HWME_ATTRIBUTE_SIZE];
|
|
};
|
|
|
|
struct hwme_get_request_pset {
|
|
u8 hw_attribute;
|
|
};
|
|
|
|
struct tdme_setsfr_request_pset {
|
|
u8 sfr_page;
|
|
u8 sfr_address;
|
|
u8 sfr_value;
|
|
};
|
|
|
|
/* uplink functions parameter set definitions */
|
|
struct hwme_set_confirm_pset {
|
|
u8 status;
|
|
u8 hw_attribute;
|
|
};
|
|
|
|
struct hwme_get_confirm_pset {
|
|
u8 status;
|
|
u8 hw_attribute;
|
|
u8 hw_attribute_length;
|
|
u8 hw_attribute_value[MAX_HWME_ATTRIBUTE_SIZE];
|
|
};
|
|
|
|
struct tdme_setsfr_confirm_pset {
|
|
u8 status;
|
|
u8 sfr_page;
|
|
u8 sfr_address;
|
|
};
|
|
|
|
struct mac_message {
|
|
u8 command_id;
|
|
u8 length;
|
|
union {
|
|
struct mcps_data_request_pset data_req;
|
|
struct mlme_set_request_pset set_req;
|
|
struct hwme_set_request_pset hwme_set_req;
|
|
struct hwme_get_request_pset hwme_get_req;
|
|
struct tdme_setsfr_request_pset tdme_set_sfr_req;
|
|
struct hwme_set_confirm_pset hwme_set_cnf;
|
|
struct hwme_get_confirm_pset hwme_get_cnf;
|
|
struct tdme_setsfr_confirm_pset tdme_set_sfr_cnf;
|
|
u8 u8param;
|
|
u8 status;
|
|
u8 payload[148];
|
|
} pdata;
|
|
};
|
|
|
|
union pa_cfg_sfr {
|
|
struct {
|
|
u8 bias_current_trim : 3;
|
|
u8 /* reserved */ : 1;
|
|
u8 buffer_capacitor_trim : 3;
|
|
u8 boost : 1;
|
|
};
|
|
u8 paib;
|
|
};
|
|
|
|
struct preamble_cfg_sfr {
|
|
u8 timeout_symbols : 3;
|
|
u8 acquisition_symbols : 3;
|
|
u8 search_symbols : 2;
|
|
};
|
|
|
|
static int (*cascoda_api_upstream)(
|
|
const u8 *buf,
|
|
size_t len,
|
|
void *device_ref
|
|
);
|
|
|
|
/**
|
|
* link_to_linux_err() - Translates an 802.15.4 return code into the closest
|
|
* linux error
|
|
* @link_status: 802.15.4 status code
|
|
*
|
|
* Return: 0 or Linux error code
|
|
*/
|
|
static int link_to_linux_err(int link_status)
|
|
{
|
|
if (link_status < 0) {
|
|
/* status is already a Linux code */
|
|
return link_status;
|
|
}
|
|
switch (link_status) {
|
|
case MAC_SUCCESS:
|
|
case MAC_REALIGNMENT:
|
|
return 0;
|
|
case MAC_IMPROPER_KEY_TYPE:
|
|
return -EKEYREJECTED;
|
|
case MAC_IMPROPER_SECURITY_LEVEL:
|
|
case MAC_UNSUPPORTED_LEGACY:
|
|
case MAC_DENIED:
|
|
return -EACCES;
|
|
case MAC_BEACON_LOST:
|
|
case MAC_NO_ACK:
|
|
case MAC_NO_BEACON:
|
|
return -ENETUNREACH;
|
|
case MAC_CHANNEL_ACCESS_FAILURE:
|
|
case MAC_TX_ACTIVE:
|
|
case MAC_SCAN_IN_PROGRESS:
|
|
return -EBUSY;
|
|
case MAC_DISABLE_TRX_FAILURE:
|
|
case MAC_OUT_OF_CAP:
|
|
return -EAGAIN;
|
|
case MAC_FRAME_TOO_LONG:
|
|
return -EMSGSIZE;
|
|
case MAC_INVALID_GTS:
|
|
case MAC_PAST_TIME:
|
|
return -EBADSLT;
|
|
case MAC_INVALID_HANDLE:
|
|
return -EBADMSG;
|
|
case MAC_INVALID_PARAMETER:
|
|
case MAC_UNSUPPORTED_ATTRIBUTE:
|
|
case MAC_ON_TIME_TOO_LONG:
|
|
case MAC_INVALID_INDEX:
|
|
return -EINVAL;
|
|
case MAC_NO_DATA:
|
|
return -ENODATA;
|
|
case MAC_NO_SHORT_ADDRESS:
|
|
return -EFAULT;
|
|
case MAC_PAN_ID_CONFLICT:
|
|
return -EADDRINUSE;
|
|
case MAC_TRANSACTION_EXPIRED:
|
|
return -ETIME;
|
|
case MAC_TRANSACTION_OVERFLOW:
|
|
return -ENOBUFS;
|
|
case MAC_UNAVAILABLE_KEY:
|
|
return -ENOKEY;
|
|
case MAC_INVALID_ADDRESS:
|
|
return -ENXIO;
|
|
case MAC_TRACKING_OFF:
|
|
case MAC_SUPERFRAME_OVERLAP:
|
|
return -EREMOTEIO;
|
|
case MAC_LIMIT_REACHED:
|
|
return -EDQUOT;
|
|
case MAC_READ_ONLY:
|
|
return -EROFS;
|
|
default:
|
|
return -EPROTO;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* ca8210_test_int_driver_write() - Writes a message to the test interface to be
|
|
* read by the userspace
|
|
* @buf: Buffer containing upstream message
|
|
* @len: length of message to write
|
|
* @spi: SPI device of message originator
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_test_int_driver_write(
|
|
const u8 *buf,
|
|
size_t len,
|
|
void *spi
|
|
)
|
|
{
|
|
struct ca8210_priv *priv = spi_get_drvdata(spi);
|
|
struct ca8210_test *test = &priv->test;
|
|
char *fifo_buffer;
|
|
int i;
|
|
|
|
dev_dbg(
|
|
&priv->spi->dev,
|
|
"test_interface: Buffering upstream message:\n"
|
|
);
|
|
for (i = 0; i < len; i++)
|
|
dev_dbg(&priv->spi->dev, "%#03x\n", buf[i]);
|
|
|
|
fifo_buffer = kmalloc(len, GFP_KERNEL);
|
|
if (!fifo_buffer)
|
|
return -ENOMEM;
|
|
memcpy(fifo_buffer, buf, len);
|
|
kfifo_in(&test->up_fifo, &fifo_buffer, 4);
|
|
wake_up_interruptible(&priv->test.readq);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* SPI Operation */
|
|
|
|
static int ca8210_net_rx(
|
|
struct ieee802154_hw *hw,
|
|
u8 *command,
|
|
size_t len
|
|
);
|
|
static u8 mlme_reset_request_sync(
|
|
u8 set_default_pib,
|
|
void *device_ref
|
|
);
|
|
static int ca8210_spi_transfer(
|
|
struct spi_device *spi,
|
|
const u8 *buf,
|
|
size_t len
|
|
);
|
|
|
|
/**
|
|
* ca8210_reset_send() - Hard resets the ca8210 for a given time
|
|
* @spi: Pointer to target ca8210 spi device
|
|
* @ms: Milliseconds to hold the reset line low for
|
|
*/
|
|
static void ca8210_reset_send(struct spi_device *spi, unsigned int ms)
|
|
{
|
|
struct ca8210_platform_data *pdata = spi->dev.platform_data;
|
|
struct ca8210_priv *priv = spi_get_drvdata(spi);
|
|
long status;
|
|
|
|
gpio_set_value(pdata->gpio_reset, 0);
|
|
reinit_completion(&priv->ca8210_is_awake);
|
|
msleep(ms);
|
|
gpio_set_value(pdata->gpio_reset, 1);
|
|
priv->promiscuous = false;
|
|
|
|
/* Wait until wakeup indication seen */
|
|
status = wait_for_completion_interruptible_timeout(
|
|
&priv->ca8210_is_awake,
|
|
msecs_to_jiffies(CA8210_SYNC_TIMEOUT)
|
|
);
|
|
if (status == 0) {
|
|
dev_crit(
|
|
&spi->dev,
|
|
"Fatal: No wakeup from ca8210 after reset!\n"
|
|
);
|
|
}
|
|
|
|
dev_dbg(&spi->dev, "Reset the device\n");
|
|
}
|
|
|
|
/**
|
|
* ca8210_mlme_reset_worker() - Resets the MLME, Called when the MAC OVERFLOW
|
|
* condition happens.
|
|
* @work: Pointer to work being executed
|
|
*/
|
|
static void ca8210_mlme_reset_worker(struct work_struct *work)
|
|
{
|
|
struct work_priv_container *wpc = container_of(
|
|
work,
|
|
struct work_priv_container,
|
|
work
|
|
);
|
|
struct ca8210_priv *priv = wpc->priv;
|
|
|
|
mlme_reset_request_sync(0, priv->spi);
|
|
kfree(wpc);
|
|
}
|
|
|
|
/**
|
|
* ca8210_rx_done() - Calls various message dispatches responding to a received
|
|
* command
|
|
* @arg: Pointer to the cas_control object for the relevant spi transfer
|
|
*
|
|
* Presents a received SAP command from the ca8210 to the Cascoda EVBME, test
|
|
* interface and network driver.
|
|
*/
|
|
static void ca8210_rx_done(struct cas_control *cas_ctl)
|
|
{
|
|
u8 *buf;
|
|
u8 len;
|
|
struct work_priv_container *mlme_reset_wpc;
|
|
struct ca8210_priv *priv = cas_ctl->priv;
|
|
|
|
buf = cas_ctl->tx_in_buf;
|
|
len = buf[1] + 2;
|
|
if (len > CA8210_SPI_BUF_SIZE) {
|
|
dev_crit(
|
|
&priv->spi->dev,
|
|
"Received packet len (%d) erroneously long\n",
|
|
len
|
|
);
|
|
goto finish;
|
|
}
|
|
|
|
if (buf[0] & SPI_SYN) {
|
|
if (priv->sync_command_response) {
|
|
memcpy(priv->sync_command_response, buf, len);
|
|
complete(&priv->sync_exchange_complete);
|
|
} else {
|
|
if (cascoda_api_upstream)
|
|
cascoda_api_upstream(buf, len, priv->spi);
|
|
priv->sync_up++;
|
|
}
|
|
} else {
|
|
if (cascoda_api_upstream)
|
|
cascoda_api_upstream(buf, len, priv->spi);
|
|
}
|
|
|
|
ca8210_net_rx(priv->hw, buf, len);
|
|
if (buf[0] == SPI_MCPS_DATA_CONFIRM) {
|
|
if (buf[3] == MAC_TRANSACTION_OVERFLOW) {
|
|
dev_info(
|
|
&priv->spi->dev,
|
|
"Waiting for transaction overflow to stabilise...\n");
|
|
msleep(2000);
|
|
dev_info(
|
|
&priv->spi->dev,
|
|
"Resetting MAC...\n");
|
|
|
|
mlme_reset_wpc = kmalloc(sizeof(*mlme_reset_wpc),
|
|
GFP_KERNEL);
|
|
if (!mlme_reset_wpc)
|
|
goto finish;
|
|
INIT_WORK(
|
|
&mlme_reset_wpc->work,
|
|
ca8210_mlme_reset_worker
|
|
);
|
|
mlme_reset_wpc->priv = priv;
|
|
queue_work(priv->mlme_workqueue, &mlme_reset_wpc->work);
|
|
}
|
|
} else if (buf[0] == SPI_HWME_WAKEUP_INDICATION) {
|
|
dev_notice(
|
|
&priv->spi->dev,
|
|
"Wakeup indication received, reason:\n"
|
|
);
|
|
switch (buf[2]) {
|
|
case 0:
|
|
dev_notice(
|
|
&priv->spi->dev,
|
|
"Transceiver woken up from Power Up / System Reset\n"
|
|
);
|
|
break;
|
|
case 1:
|
|
dev_notice(
|
|
&priv->spi->dev,
|
|
"Watchdog Timer Time-Out\n"
|
|
);
|
|
break;
|
|
case 2:
|
|
dev_notice(
|
|
&priv->spi->dev,
|
|
"Transceiver woken up from Power-Off by Sleep Timer Time-Out\n");
|
|
break;
|
|
case 3:
|
|
dev_notice(
|
|
&priv->spi->dev,
|
|
"Transceiver woken up from Power-Off by GPIO Activity\n"
|
|
);
|
|
break;
|
|
case 4:
|
|
dev_notice(
|
|
&priv->spi->dev,
|
|
"Transceiver woken up from Standby by Sleep Timer Time-Out\n"
|
|
);
|
|
break;
|
|
case 5:
|
|
dev_notice(
|
|
&priv->spi->dev,
|
|
"Transceiver woken up from Standby by GPIO Activity\n"
|
|
);
|
|
break;
|
|
case 6:
|
|
dev_notice(
|
|
&priv->spi->dev,
|
|
"Sleep-Timer Time-Out in Active Mode\n"
|
|
);
|
|
break;
|
|
default:
|
|
dev_warn(&priv->spi->dev, "Wakeup reason unknown\n");
|
|
break;
|
|
}
|
|
complete(&priv->ca8210_is_awake);
|
|
}
|
|
|
|
finish:;
|
|
}
|
|
|
|
static int ca8210_remove(struct spi_device *spi_device);
|
|
|
|
/**
|
|
* ca8210_spi_transfer_complete() - Called when a single spi transfer has
|
|
* completed
|
|
* @context: Pointer to the cas_control object for the finished transfer
|
|
*/
|
|
static void ca8210_spi_transfer_complete(void *context)
|
|
{
|
|
struct cas_control *cas_ctl = context;
|
|
struct ca8210_priv *priv = cas_ctl->priv;
|
|
bool duplex_rx = false;
|
|
int i;
|
|
u8 retry_buffer[CA8210_SPI_BUF_SIZE];
|
|
|
|
if (
|
|
cas_ctl->tx_in_buf[0] == SPI_NACK ||
|
|
(cas_ctl->tx_in_buf[0] == SPI_IDLE &&
|
|
cas_ctl->tx_in_buf[1] == SPI_NACK)
|
|
) {
|
|
/* ca8210 is busy */
|
|
dev_info(&priv->spi->dev, "ca8210 was busy during attempted write\n");
|
|
if (cas_ctl->tx_buf[0] == SPI_IDLE) {
|
|
dev_warn(
|
|
&priv->spi->dev,
|
|
"IRQ servicing NACKd, dropping transfer\n"
|
|
);
|
|
kfree(cas_ctl);
|
|
return;
|
|
}
|
|
if (priv->retries > 3) {
|
|
dev_err(&priv->spi->dev, "too many retries!\n");
|
|
kfree(cas_ctl);
|
|
ca8210_remove(priv->spi);
|
|
return;
|
|
}
|
|
memcpy(retry_buffer, cas_ctl->tx_buf, CA8210_SPI_BUF_SIZE);
|
|
kfree(cas_ctl);
|
|
ca8210_spi_transfer(
|
|
priv->spi,
|
|
retry_buffer,
|
|
CA8210_SPI_BUF_SIZE
|
|
);
|
|
priv->retries++;
|
|
dev_info(&priv->spi->dev, "retried spi write\n");
|
|
return;
|
|
} else if (
|
|
cas_ctl->tx_in_buf[0] != SPI_IDLE &&
|
|
cas_ctl->tx_in_buf[0] != SPI_NACK
|
|
) {
|
|
duplex_rx = true;
|
|
}
|
|
|
|
if (duplex_rx) {
|
|
dev_dbg(&priv->spi->dev, "READ CMD DURING TX\n");
|
|
for (i = 0; i < cas_ctl->tx_in_buf[1] + 2; i++)
|
|
dev_dbg(
|
|
&priv->spi->dev,
|
|
"%#03x\n",
|
|
cas_ctl->tx_in_buf[i]
|
|
);
|
|
ca8210_rx_done(cas_ctl);
|
|
}
|
|
complete(&priv->spi_transfer_complete);
|
|
kfree(cas_ctl);
|
|
priv->retries = 0;
|
|
}
|
|
|
|
/**
|
|
* ca8210_spi_transfer() - Initiate duplex spi transfer with ca8210
|
|
* @spi: Pointer to spi device for transfer
|
|
* @buf: Octet array to send
|
|
* @len: length of the buffer being sent
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_spi_transfer(
|
|
struct spi_device *spi,
|
|
const u8 *buf,
|
|
size_t len
|
|
)
|
|
{
|
|
int i, status = 0;
|
|
struct ca8210_priv *priv;
|
|
struct cas_control *cas_ctl;
|
|
|
|
if (!spi) {
|
|
pr_crit("NULL spi device passed to %s\n", __func__);
|
|
return -ENODEV;
|
|
}
|
|
|
|
priv = spi_get_drvdata(spi);
|
|
reinit_completion(&priv->spi_transfer_complete);
|
|
|
|
dev_dbg(&spi->dev, "%s called\n", __func__);
|
|
|
|
cas_ctl = kmalloc(sizeof(*cas_ctl), GFP_ATOMIC);
|
|
if (!cas_ctl)
|
|
return -ENOMEM;
|
|
|
|
cas_ctl->priv = priv;
|
|
memset(cas_ctl->tx_buf, SPI_IDLE, CA8210_SPI_BUF_SIZE);
|
|
memset(cas_ctl->tx_in_buf, SPI_IDLE, CA8210_SPI_BUF_SIZE);
|
|
memcpy(cas_ctl->tx_buf, buf, len);
|
|
|
|
for (i = 0; i < len; i++)
|
|
dev_dbg(&spi->dev, "%#03x\n", cas_ctl->tx_buf[i]);
|
|
|
|
spi_message_init(&cas_ctl->msg);
|
|
|
|
cas_ctl->transfer.tx_nbits = 1; /* 1 MOSI line */
|
|
cas_ctl->transfer.rx_nbits = 1; /* 1 MISO line */
|
|
cas_ctl->transfer.speed_hz = 0; /* Use device setting */
|
|
cas_ctl->transfer.bits_per_word = 0; /* Use device setting */
|
|
cas_ctl->transfer.tx_buf = cas_ctl->tx_buf;
|
|
cas_ctl->transfer.rx_buf = cas_ctl->tx_in_buf;
|
|
cas_ctl->transfer.delay_usecs = 0;
|
|
cas_ctl->transfer.cs_change = 0;
|
|
cas_ctl->transfer.len = sizeof(struct mac_message);
|
|
cas_ctl->msg.complete = ca8210_spi_transfer_complete;
|
|
cas_ctl->msg.context = cas_ctl;
|
|
|
|
spi_message_add_tail(
|
|
&cas_ctl->transfer,
|
|
&cas_ctl->msg
|
|
);
|
|
|
|
status = spi_async(spi, &cas_ctl->msg);
|
|
if (status < 0) {
|
|
dev_crit(
|
|
&spi->dev,
|
|
"status %d from spi_sync in write\n",
|
|
status
|
|
);
|
|
}
|
|
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* ca8210_spi_exchange() - Exchange API/SAP commands with the radio
|
|
* @buf: Octet array of command being sent downstream
|
|
* @len: length of buf
|
|
* @response: buffer for storing synchronous response
|
|
* @device_ref: spi_device pointer for ca8210
|
|
*
|
|
* Effectively calls ca8210_spi_transfer to write buf[] to the spi, then for
|
|
* synchronous commands waits for the corresponding response to be read from
|
|
* the spi before returning. The response is written to the response parameter.
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_spi_exchange(
|
|
const u8 *buf,
|
|
size_t len,
|
|
u8 *response,
|
|
void *device_ref
|
|
)
|
|
{
|
|
int status = 0;
|
|
struct spi_device *spi = device_ref;
|
|
struct ca8210_priv *priv = spi->dev.driver_data;
|
|
long wait_remaining;
|
|
|
|
if ((buf[0] & SPI_SYN) && response) { /* if sync wait for confirm */
|
|
reinit_completion(&priv->sync_exchange_complete);
|
|
priv->sync_command_response = response;
|
|
}
|
|
|
|
do {
|
|
reinit_completion(&priv->spi_transfer_complete);
|
|
status = ca8210_spi_transfer(priv->spi, buf, len);
|
|
if (status) {
|
|
dev_warn(
|
|
&spi->dev,
|
|
"spi write failed, returned %d\n",
|
|
status
|
|
);
|
|
if (status == -EBUSY)
|
|
continue;
|
|
if (((buf[0] & SPI_SYN) && response))
|
|
complete(&priv->sync_exchange_complete);
|
|
goto cleanup;
|
|
}
|
|
|
|
wait_remaining = wait_for_completion_interruptible_timeout(
|
|
&priv->spi_transfer_complete,
|
|
msecs_to_jiffies(1000)
|
|
);
|
|
if (wait_remaining == -ERESTARTSYS) {
|
|
status = -ERESTARTSYS;
|
|
} else if (wait_remaining == 0) {
|
|
dev_err(
|
|
&spi->dev,
|
|
"SPI downstream transfer timed out!\n"
|
|
);
|
|
status = -ETIME;
|
|
goto cleanup;
|
|
}
|
|
} while (status < 0);
|
|
|
|
if (!((buf[0] & SPI_SYN) && response))
|
|
goto cleanup;
|
|
|
|
wait_remaining = wait_for_completion_interruptible_timeout(
|
|
&priv->sync_exchange_complete,
|
|
msecs_to_jiffies(CA8210_SYNC_TIMEOUT)
|
|
);
|
|
if (wait_remaining == -ERESTARTSYS) {
|
|
status = -ERESTARTSYS;
|
|
} else if (wait_remaining == 0) {
|
|
dev_err(
|
|
&spi->dev,
|
|
"Synchronous confirm timeout\n"
|
|
);
|
|
status = -ETIME;
|
|
}
|
|
|
|
cleanup:
|
|
priv->sync_command_response = NULL;
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* ca8210_interrupt_handler() - Called when an irq is received from the ca8210
|
|
* @irq: Id of the irq being handled
|
|
* @dev_id: Pointer passed by the system, pointing to the ca8210's private data
|
|
*
|
|
* This function is called when the irq line from the ca8210 is asserted,
|
|
* signifying that the ca8210 has a message to send upstream to us. Starts the
|
|
* asynchronous spi read.
|
|
*
|
|
* Return: irq return code
|
|
*/
|
|
static irqreturn_t ca8210_interrupt_handler(int irq, void *dev_id)
|
|
{
|
|
struct ca8210_priv *priv = dev_id;
|
|
int status;
|
|
|
|
dev_dbg(&priv->spi->dev, "irq: Interrupt occurred\n");
|
|
do {
|
|
status = ca8210_spi_transfer(priv->spi, NULL, 0);
|
|
if (status && (status != -EBUSY)) {
|
|
dev_warn(
|
|
&priv->spi->dev,
|
|
"spi read failed, returned %d\n",
|
|
status
|
|
);
|
|
}
|
|
} while (status == -EBUSY);
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
static int (*cascoda_api_downstream)(
|
|
const u8 *buf,
|
|
size_t len,
|
|
u8 *response,
|
|
void *device_ref
|
|
) = ca8210_spi_exchange;
|
|
|
|
/* Cascoda API / 15.4 SAP Primitives */
|
|
|
|
/**
|
|
* tdme_setsfr_request_sync() - TDME_SETSFR_request/confirm according to API
|
|
* @sfr_page: SFR Page
|
|
* @sfr_address: SFR Address
|
|
* @sfr_value: SFR Value
|
|
* @device_ref: Nondescript pointer to target device
|
|
*
|
|
* Return: 802.15.4 status code of TDME-SETSFR.confirm
|
|
*/
|
|
static u8 tdme_setsfr_request_sync(
|
|
u8 sfr_page,
|
|
u8 sfr_address,
|
|
u8 sfr_value,
|
|
void *device_ref
|
|
)
|
|
{
|
|
int ret;
|
|
struct mac_message command, response;
|
|
struct spi_device *spi = device_ref;
|
|
|
|
command.command_id = SPI_TDME_SETSFR_REQUEST;
|
|
command.length = 3;
|
|
command.pdata.tdme_set_sfr_req.sfr_page = sfr_page;
|
|
command.pdata.tdme_set_sfr_req.sfr_address = sfr_address;
|
|
command.pdata.tdme_set_sfr_req.sfr_value = sfr_value;
|
|
response.command_id = SPI_IDLE;
|
|
ret = cascoda_api_downstream(
|
|
&command.command_id,
|
|
command.length + 2,
|
|
&response.command_id,
|
|
device_ref
|
|
);
|
|
if (ret) {
|
|
dev_crit(&spi->dev, "cascoda_api_downstream returned %d", ret);
|
|
return MAC_SYSTEM_ERROR;
|
|
}
|
|
|
|
if (response.command_id != SPI_TDME_SETSFR_CONFIRM) {
|
|
dev_crit(
|
|
&spi->dev,
|
|
"sync response to SPI_TDME_SETSFR_REQUEST was not SPI_TDME_SETSFR_CONFIRM, it was %d\n",
|
|
response.command_id
|
|
);
|
|
return MAC_SYSTEM_ERROR;
|
|
}
|
|
|
|
return response.pdata.tdme_set_sfr_cnf.status;
|
|
}
|
|
|
|
/**
|
|
* tdme_chipinit() - TDME Chip Register Default Initialisation Macro
|
|
* @device_ref: Nondescript pointer to target device
|
|
*
|
|
* Return: 802.15.4 status code of API calls
|
|
*/
|
|
static u8 tdme_chipinit(void *device_ref)
|
|
{
|
|
u8 status = MAC_SUCCESS;
|
|
u8 sfr_address;
|
|
struct spi_device *spi = device_ref;
|
|
struct preamble_cfg_sfr pre_cfg_value = {
|
|
.timeout_symbols = 3,
|
|
.acquisition_symbols = 3,
|
|
.search_symbols = 1,
|
|
};
|
|
/* LNA Gain Settings */
|
|
status = tdme_setsfr_request_sync(
|
|
1, (sfr_address = CA8210_SFR_LNAGX40),
|
|
LNAGX40_DEFAULT_GAIN, device_ref);
|
|
if (status)
|
|
goto finish;
|
|
status = tdme_setsfr_request_sync(
|
|
1, (sfr_address = CA8210_SFR_LNAGX41),
|
|
LNAGX41_DEFAULT_GAIN, device_ref);
|
|
if (status)
|
|
goto finish;
|
|
status = tdme_setsfr_request_sync(
|
|
1, (sfr_address = CA8210_SFR_LNAGX42),
|
|
LNAGX42_DEFAULT_GAIN, device_ref);
|
|
if (status)
|
|
goto finish;
|
|
status = tdme_setsfr_request_sync(
|
|
1, (sfr_address = CA8210_SFR_LNAGX43),
|
|
LNAGX43_DEFAULT_GAIN, device_ref);
|
|
if (status)
|
|
goto finish;
|
|
status = tdme_setsfr_request_sync(
|
|
1, (sfr_address = CA8210_SFR_LNAGX44),
|
|
LNAGX44_DEFAULT_GAIN, device_ref);
|
|
if (status)
|
|
goto finish;
|
|
status = tdme_setsfr_request_sync(
|
|
1, (sfr_address = CA8210_SFR_LNAGX45),
|
|
LNAGX45_DEFAULT_GAIN, device_ref);
|
|
if (status)
|
|
goto finish;
|
|
status = tdme_setsfr_request_sync(
|
|
1, (sfr_address = CA8210_SFR_LNAGX46),
|
|
LNAGX46_DEFAULT_GAIN, device_ref);
|
|
if (status)
|
|
goto finish;
|
|
status = tdme_setsfr_request_sync(
|
|
1, (sfr_address = CA8210_SFR_LNAGX47),
|
|
LNAGX47_DEFAULT_GAIN, device_ref);
|
|
if (status)
|
|
goto finish;
|
|
/* Preamble Timing Config */
|
|
status = tdme_setsfr_request_sync(
|
|
1, (sfr_address = CA8210_SFR_PRECFG),
|
|
*((u8 *)&pre_cfg_value), device_ref);
|
|
if (status)
|
|
goto finish;
|
|
/* Preamble Threshold High */
|
|
status = tdme_setsfr_request_sync(
|
|
1, (sfr_address = CA8210_SFR_PTHRH),
|
|
PTHRH_DEFAULT_THRESHOLD, device_ref);
|
|
if (status)
|
|
goto finish;
|
|
/* Tx Output Power 8 dBm */
|
|
status = tdme_setsfr_request_sync(
|
|
0, (sfr_address = CA8210_SFR_PACFGIB),
|
|
PACFGIB_DEFAULT_CURRENT, device_ref);
|
|
if (status)
|
|
goto finish;
|
|
|
|
finish:
|
|
if (status != MAC_SUCCESS) {
|
|
dev_err(
|
|
&spi->dev,
|
|
"failed to set sfr at %#03x, status = %#03x\n",
|
|
sfr_address,
|
|
status
|
|
);
|
|
}
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* tdme_channelinit() - TDME Channel Register Default Initialisation Macro (Tx)
|
|
* @channel: 802.15.4 channel to initialise chip for
|
|
* @device_ref: Nondescript pointer to target device
|
|
*
|
|
* Return: 802.15.4 status code of API calls
|
|
*/
|
|
static u8 tdme_channelinit(u8 channel, void *device_ref)
|
|
{
|
|
/* Transceiver front-end local oscillator tx two-point calibration
|
|
* value. Tuned for the hardware.
|
|
*/
|
|
u8 txcalval;
|
|
|
|
if (channel >= 25)
|
|
txcalval = 0xA7;
|
|
else if (channel >= 23)
|
|
txcalval = 0xA8;
|
|
else if (channel >= 22)
|
|
txcalval = 0xA9;
|
|
else if (channel >= 20)
|
|
txcalval = 0xAA;
|
|
else if (channel >= 17)
|
|
txcalval = 0xAB;
|
|
else if (channel >= 16)
|
|
txcalval = 0xAC;
|
|
else if (channel >= 14)
|
|
txcalval = 0xAD;
|
|
else if (channel >= 12)
|
|
txcalval = 0xAE;
|
|
else
|
|
txcalval = 0xAF;
|
|
|
|
return tdme_setsfr_request_sync(
|
|
1,
|
|
CA8210_SFR_LOTXCAL,
|
|
txcalval,
|
|
device_ref
|
|
); /* LO Tx Cal */
|
|
}
|
|
|
|
/**
|
|
* tdme_checkpibattribute() - Checks Attribute Values that are not checked in
|
|
* MAC
|
|
* @pib_attribute: Attribute Number
|
|
* @pib_attribute_length: Attribute length
|
|
* @pib_attribute_value: Pointer to Attribute Value
|
|
* @device_ref: Nondescript pointer to target device
|
|
*
|
|
* Return: 802.15.4 status code of checks
|
|
*/
|
|
static u8 tdme_checkpibattribute(
|
|
u8 pib_attribute,
|
|
u8 pib_attribute_length,
|
|
const void *pib_attribute_value
|
|
)
|
|
{
|
|
u8 status = MAC_SUCCESS;
|
|
u8 value;
|
|
|
|
value = *((u8 *)pib_attribute_value);
|
|
|
|
switch (pib_attribute) {
|
|
/* PHY */
|
|
case PHY_TRANSMIT_POWER:
|
|
if (value > 0x3F)
|
|
status = MAC_INVALID_PARAMETER;
|
|
break;
|
|
case PHY_CCA_MODE:
|
|
if (value > 0x03)
|
|
status = MAC_INVALID_PARAMETER;
|
|
break;
|
|
/* MAC */
|
|
case MAC_BATT_LIFE_EXT_PERIODS:
|
|
if (value < 6 || value > 41)
|
|
status = MAC_INVALID_PARAMETER;
|
|
break;
|
|
case MAC_BEACON_PAYLOAD:
|
|
if (pib_attribute_length > MAX_BEACON_PAYLOAD_LENGTH)
|
|
status = MAC_INVALID_PARAMETER;
|
|
break;
|
|
case MAC_BEACON_PAYLOAD_LENGTH:
|
|
if (value > MAX_BEACON_PAYLOAD_LENGTH)
|
|
status = MAC_INVALID_PARAMETER;
|
|
break;
|
|
case MAC_BEACON_ORDER:
|
|
if (value > 15)
|
|
status = MAC_INVALID_PARAMETER;
|
|
break;
|
|
case MAC_MAX_BE:
|
|
if (value < 3 || value > 8)
|
|
status = MAC_INVALID_PARAMETER;
|
|
break;
|
|
case MAC_MAX_CSMA_BACKOFFS:
|
|
if (value > 5)
|
|
status = MAC_INVALID_PARAMETER;
|
|
break;
|
|
case MAC_MAX_FRAME_RETRIES:
|
|
if (value > 7)
|
|
status = MAC_INVALID_PARAMETER;
|
|
break;
|
|
case MAC_MIN_BE:
|
|
if (value > 8)
|
|
status = MAC_INVALID_PARAMETER;
|
|
break;
|
|
case MAC_RESPONSE_WAIT_TIME:
|
|
if (value < 2 || value > 64)
|
|
status = MAC_INVALID_PARAMETER;
|
|
break;
|
|
case MAC_SUPERFRAME_ORDER:
|
|
if (value > 15)
|
|
status = MAC_INVALID_PARAMETER;
|
|
break;
|
|
/* boolean */
|
|
case MAC_ASSOCIATED_PAN_COORD:
|
|
case MAC_ASSOCIATION_PERMIT:
|
|
case MAC_AUTO_REQUEST:
|
|
case MAC_BATT_LIFE_EXT:
|
|
case MAC_GTS_PERMIT:
|
|
case MAC_PROMISCUOUS_MODE:
|
|
case MAC_RX_ON_WHEN_IDLE:
|
|
case MAC_SECURITY_ENABLED:
|
|
if (value > 1)
|
|
status = MAC_INVALID_PARAMETER;
|
|
break;
|
|
/* MAC SEC */
|
|
case MAC_AUTO_REQUEST_SECURITY_LEVEL:
|
|
if (value > 7)
|
|
status = MAC_INVALID_PARAMETER;
|
|
break;
|
|
case MAC_AUTO_REQUEST_KEY_ID_MODE:
|
|
if (value > 3)
|
|
status = MAC_INVALID_PARAMETER;
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* tdme_settxpower() - Sets the tx power for MLME_SET phyTransmitPower
|
|
* @txp: Transmit Power
|
|
* @device_ref: Nondescript pointer to target device
|
|
*
|
|
* Normalised to 802.15.4 Definition (6-bit, signed):
|
|
* Bit 7-6: not used
|
|
* Bit 5-0: tx power (-32 - +31 dB)
|
|
*
|
|
* Return: 802.15.4 status code of api calls
|
|
*/
|
|
static u8 tdme_settxpower(u8 txp, void *device_ref)
|
|
{
|
|
u8 status;
|
|
s8 txp_val;
|
|
u8 txp_ext;
|
|
union pa_cfg_sfr pa_cfg_val;
|
|
|
|
/* extend from 6 to 8 bit */
|
|
txp_ext = 0x3F & txp;
|
|
if (txp_ext & 0x20)
|
|
txp_ext += 0xC0;
|
|
txp_val = (s8)txp_ext;
|
|
|
|
if (CA8210_MAC_MPW) {
|
|
if (txp_val > 0) {
|
|
/* 8 dBm: ptrim = 5, itrim = +3 => +4 dBm */
|
|
pa_cfg_val.bias_current_trim = 3;
|
|
pa_cfg_val.buffer_capacitor_trim = 5;
|
|
pa_cfg_val.boost = 1;
|
|
} else {
|
|
/* 0 dBm: ptrim = 7, itrim = +3 => -6 dBm */
|
|
pa_cfg_val.bias_current_trim = 3;
|
|
pa_cfg_val.buffer_capacitor_trim = 7;
|
|
pa_cfg_val.boost = 0;
|
|
}
|
|
/* write PACFG */
|
|
status = tdme_setsfr_request_sync(
|
|
0,
|
|
CA8210_SFR_PACFG,
|
|
pa_cfg_val.paib,
|
|
device_ref
|
|
);
|
|
} else {
|
|
/* Look-Up Table for Setting Current and Frequency Trim values
|
|
* for desired Output Power
|
|
*/
|
|
if (txp_val > 8) {
|
|
pa_cfg_val.paib = 0x3F;
|
|
} else if (txp_val == 8) {
|
|
pa_cfg_val.paib = 0x32;
|
|
} else if (txp_val == 7) {
|
|
pa_cfg_val.paib = 0x22;
|
|
} else if (txp_val == 6) {
|
|
pa_cfg_val.paib = 0x18;
|
|
} else if (txp_val == 5) {
|
|
pa_cfg_val.paib = 0x10;
|
|
} else if (txp_val == 4) {
|
|
pa_cfg_val.paib = 0x0C;
|
|
} else if (txp_val == 3) {
|
|
pa_cfg_val.paib = 0x08;
|
|
} else if (txp_val == 2) {
|
|
pa_cfg_val.paib = 0x05;
|
|
} else if (txp_val == 1) {
|
|
pa_cfg_val.paib = 0x03;
|
|
} else if (txp_val == 0) {
|
|
pa_cfg_val.paib = 0x01;
|
|
} else { /* < 0 */
|
|
pa_cfg_val.paib = 0x00;
|
|
}
|
|
/* write PACFGIB */
|
|
status = tdme_setsfr_request_sync(
|
|
0,
|
|
CA8210_SFR_PACFGIB,
|
|
pa_cfg_val.paib,
|
|
device_ref
|
|
);
|
|
}
|
|
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* mcps_data_request() - mcps_data_request (Send Data) according to API Spec
|
|
* @src_addr_mode: Source Addressing Mode
|
|
* @dst_address_mode: Destination Addressing Mode
|
|
* @dst_pan_id: Destination PAN ID
|
|
* @dst_addr: Pointer to Destination Address
|
|
* @msdu_length: length of Data
|
|
* @msdu: Pointer to Data
|
|
* @msdu_handle: Handle of Data
|
|
* @tx_options: Tx Options Bit Field
|
|
* @security: Pointer to Security Structure or NULL
|
|
* @device_ref: Nondescript pointer to target device
|
|
*
|
|
* Return: 802.15.4 status code of action
|
|
*/
|
|
static u8 mcps_data_request(
|
|
u8 src_addr_mode,
|
|
u8 dst_address_mode,
|
|
u16 dst_pan_id,
|
|
union macaddr *dst_addr,
|
|
u8 msdu_length,
|
|
u8 *msdu,
|
|
u8 msdu_handle,
|
|
u8 tx_options,
|
|
struct secspec *security,
|
|
void *device_ref
|
|
)
|
|
{
|
|
struct secspec *psec;
|
|
struct mac_message command;
|
|
|
|
command.command_id = SPI_MCPS_DATA_REQUEST;
|
|
command.pdata.data_req.src_addr_mode = src_addr_mode;
|
|
command.pdata.data_req.dst.mode = dst_address_mode;
|
|
if (dst_address_mode != MAC_MODE_NO_ADDR) {
|
|
command.pdata.data_req.dst.pan_id[0] = LS_BYTE(dst_pan_id);
|
|
command.pdata.data_req.dst.pan_id[1] = MS_BYTE(dst_pan_id);
|
|
if (dst_address_mode == MAC_MODE_SHORT_ADDR) {
|
|
command.pdata.data_req.dst.address[0] = LS_BYTE(
|
|
dst_addr->short_address
|
|
);
|
|
command.pdata.data_req.dst.address[1] = MS_BYTE(
|
|
dst_addr->short_address
|
|
);
|
|
} else { /* MAC_MODE_LONG_ADDR*/
|
|
memcpy(
|
|
command.pdata.data_req.dst.address,
|
|
dst_addr->ieee_address,
|
|
8
|
|
);
|
|
}
|
|
}
|
|
command.pdata.data_req.msdu_length = msdu_length;
|
|
command.pdata.data_req.msdu_handle = msdu_handle;
|
|
command.pdata.data_req.tx_options = tx_options;
|
|
memcpy(command.pdata.data_req.msdu, msdu, msdu_length);
|
|
psec = (struct secspec *)(command.pdata.data_req.msdu + msdu_length);
|
|
command.length = sizeof(struct mcps_data_request_pset) -
|
|
MAX_DATA_SIZE + msdu_length;
|
|
if (!security || security->security_level == 0) {
|
|
psec->security_level = 0;
|
|
command.length += 1;
|
|
} else {
|
|
*psec = *security;
|
|
command.length += sizeof(struct secspec);
|
|
}
|
|
|
|
if (ca8210_spi_transfer(device_ref, &command.command_id,
|
|
command.length + 2))
|
|
return MAC_SYSTEM_ERROR;
|
|
|
|
return MAC_SUCCESS;
|
|
}
|
|
|
|
/**
|
|
* mlme_reset_request_sync() - MLME_RESET_request/confirm according to API Spec
|
|
* @set_default_pib: Set defaults in PIB
|
|
* @device_ref: Nondescript pointer to target device
|
|
*
|
|
* Return: 802.15.4 status code of MLME-RESET.confirm
|
|
*/
|
|
static u8 mlme_reset_request_sync(
|
|
u8 set_default_pib,
|
|
void *device_ref
|
|
)
|
|
{
|
|
u8 status;
|
|
struct mac_message command, response;
|
|
struct spi_device *spi = device_ref;
|
|
|
|
command.command_id = SPI_MLME_RESET_REQUEST;
|
|
command.length = 1;
|
|
command.pdata.u8param = set_default_pib;
|
|
|
|
if (cascoda_api_downstream(
|
|
&command.command_id,
|
|
command.length + 2,
|
|
&response.command_id,
|
|
device_ref)) {
|
|
dev_err(&spi->dev, "cascoda_api_downstream failed\n");
|
|
return MAC_SYSTEM_ERROR;
|
|
}
|
|
|
|
if (response.command_id != SPI_MLME_RESET_CONFIRM)
|
|
return MAC_SYSTEM_ERROR;
|
|
|
|
status = response.pdata.status;
|
|
|
|
/* reset COORD Bit for Channel Filtering as Coordinator */
|
|
if (CA8210_MAC_WORKAROUNDS && set_default_pib && !status) {
|
|
status = tdme_setsfr_request_sync(
|
|
0,
|
|
CA8210_SFR_MACCON,
|
|
0,
|
|
device_ref
|
|
);
|
|
}
|
|
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* mlme_set_request_sync() - MLME_SET_request/confirm according to API Spec
|
|
* @pib_attribute: Attribute Number
|
|
* @pib_attribute_index: Index within Attribute if an Array
|
|
* @pib_attribute_length: Attribute length
|
|
* @pib_attribute_value: Pointer to Attribute Value
|
|
* @device_ref: Nondescript pointer to target device
|
|
*
|
|
* Return: 802.15.4 status code of MLME-SET.confirm
|
|
*/
|
|
static u8 mlme_set_request_sync(
|
|
u8 pib_attribute,
|
|
u8 pib_attribute_index,
|
|
u8 pib_attribute_length,
|
|
const void *pib_attribute_value,
|
|
void *device_ref
|
|
)
|
|
{
|
|
u8 status;
|
|
struct mac_message command, response;
|
|
|
|
/* pre-check the validity of pib_attribute values that are not checked
|
|
* in MAC
|
|
*/
|
|
if (tdme_checkpibattribute(
|
|
pib_attribute, pib_attribute_length, pib_attribute_value)) {
|
|
return MAC_INVALID_PARAMETER;
|
|
}
|
|
|
|
if (pib_attribute == PHY_CURRENT_CHANNEL) {
|
|
status = tdme_channelinit(
|
|
*((u8 *)pib_attribute_value),
|
|
device_ref
|
|
);
|
|
if (status)
|
|
return status;
|
|
}
|
|
|
|
if (pib_attribute == PHY_TRANSMIT_POWER) {
|
|
return tdme_settxpower(
|
|
*((u8 *)pib_attribute_value),
|
|
device_ref
|
|
);
|
|
}
|
|
|
|
command.command_id = SPI_MLME_SET_REQUEST;
|
|
command.length = sizeof(struct mlme_set_request_pset) -
|
|
MAX_ATTRIBUTE_SIZE + pib_attribute_length;
|
|
command.pdata.set_req.pib_attribute = pib_attribute;
|
|
command.pdata.set_req.pib_attribute_index = pib_attribute_index;
|
|
command.pdata.set_req.pib_attribute_length = pib_attribute_length;
|
|
memcpy(
|
|
command.pdata.set_req.pib_attribute_value,
|
|
pib_attribute_value,
|
|
pib_attribute_length
|
|
);
|
|
|
|
if (cascoda_api_downstream(
|
|
&command.command_id,
|
|
command.length + 2,
|
|
&response.command_id,
|
|
device_ref)) {
|
|
return MAC_SYSTEM_ERROR;
|
|
}
|
|
|
|
if (response.command_id != SPI_MLME_SET_CONFIRM)
|
|
return MAC_SYSTEM_ERROR;
|
|
|
|
return response.pdata.status;
|
|
}
|
|
|
|
/**
|
|
* hwme_set_request_sync() - HWME_SET_request/confirm according to API Spec
|
|
* @hw_attribute: Attribute Number
|
|
* @hw_attribute_length: Attribute length
|
|
* @hw_attribute_value: Pointer to Attribute Value
|
|
* @device_ref: Nondescript pointer to target device
|
|
*
|
|
* Return: 802.15.4 status code of HWME-SET.confirm
|
|
*/
|
|
static u8 hwme_set_request_sync(
|
|
u8 hw_attribute,
|
|
u8 hw_attribute_length,
|
|
u8 *hw_attribute_value,
|
|
void *device_ref
|
|
)
|
|
{
|
|
struct mac_message command, response;
|
|
|
|
command.command_id = SPI_HWME_SET_REQUEST;
|
|
command.length = 2 + hw_attribute_length;
|
|
command.pdata.hwme_set_req.hw_attribute = hw_attribute;
|
|
command.pdata.hwme_set_req.hw_attribute_length = hw_attribute_length;
|
|
memcpy(
|
|
command.pdata.hwme_set_req.hw_attribute_value,
|
|
hw_attribute_value,
|
|
hw_attribute_length
|
|
);
|
|
|
|
if (cascoda_api_downstream(
|
|
&command.command_id,
|
|
command.length + 2,
|
|
&response.command_id,
|
|
device_ref)) {
|
|
return MAC_SYSTEM_ERROR;
|
|
}
|
|
|
|
if (response.command_id != SPI_HWME_SET_CONFIRM)
|
|
return MAC_SYSTEM_ERROR;
|
|
|
|
return response.pdata.hwme_set_cnf.status;
|
|
}
|
|
|
|
/**
|
|
* hwme_get_request_sync() - HWME_GET_request/confirm according to API Spec
|
|
* @hw_attribute: Attribute Number
|
|
* @hw_attribute_length: Attribute length
|
|
* @hw_attribute_value: Pointer to Attribute Value
|
|
* @device_ref: Nondescript pointer to target device
|
|
*
|
|
* Return: 802.15.4 status code of HWME-GET.confirm
|
|
*/
|
|
static u8 hwme_get_request_sync(
|
|
u8 hw_attribute,
|
|
u8 *hw_attribute_length,
|
|
u8 *hw_attribute_value,
|
|
void *device_ref
|
|
)
|
|
{
|
|
struct mac_message command, response;
|
|
|
|
command.command_id = SPI_HWME_GET_REQUEST;
|
|
command.length = 1;
|
|
command.pdata.hwme_get_req.hw_attribute = hw_attribute;
|
|
|
|
if (cascoda_api_downstream(
|
|
&command.command_id,
|
|
command.length + 2,
|
|
&response.command_id,
|
|
device_ref)) {
|
|
return MAC_SYSTEM_ERROR;
|
|
}
|
|
|
|
if (response.command_id != SPI_HWME_GET_CONFIRM)
|
|
return MAC_SYSTEM_ERROR;
|
|
|
|
if (response.pdata.hwme_get_cnf.status == MAC_SUCCESS) {
|
|
*hw_attribute_length =
|
|
response.pdata.hwme_get_cnf.hw_attribute_length;
|
|
memcpy(
|
|
hw_attribute_value,
|
|
response.pdata.hwme_get_cnf.hw_attribute_value,
|
|
*hw_attribute_length
|
|
);
|
|
}
|
|
|
|
return response.pdata.hwme_get_cnf.status;
|
|
}
|
|
|
|
/* Network driver operation */
|
|
|
|
/**
|
|
* ca8210_async_xmit_complete() - Called to announce that an asynchronous
|
|
* transmission has finished
|
|
* @hw: ieee802154_hw of ca8210 that has finished exchange
|
|
* @msduhandle: Identifier of transmission that has completed
|
|
* @status: Returned 802.15.4 status code of the transmission
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_async_xmit_complete(
|
|
struct ieee802154_hw *hw,
|
|
u8 msduhandle,
|
|
u8 status)
|
|
{
|
|
struct ca8210_priv *priv = hw->priv;
|
|
|
|
if (priv->nextmsduhandle != msduhandle) {
|
|
dev_err(
|
|
&priv->spi->dev,
|
|
"Unexpected msdu_handle on data confirm, Expected %d, got %d\n",
|
|
priv->nextmsduhandle,
|
|
msduhandle
|
|
);
|
|
return -EIO;
|
|
}
|
|
|
|
priv->async_tx_pending = false;
|
|
priv->nextmsduhandle++;
|
|
|
|
if (status) {
|
|
dev_err(
|
|
&priv->spi->dev,
|
|
"Link transmission unsuccessful, status = %d\n",
|
|
status
|
|
);
|
|
if (status != MAC_TRANSACTION_OVERFLOW) {
|
|
ieee802154_wake_queue(priv->hw);
|
|
return 0;
|
|
}
|
|
}
|
|
ieee802154_xmit_complete(priv->hw, priv->tx_skb, true);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* ca8210_skb_rx() - Contructs a properly framed socket buffer from a received
|
|
* MCPS_DATA_indication
|
|
* @hw: ieee802154_hw that MCPS_DATA_indication was received by
|
|
* @len: length of MCPS_DATA_indication
|
|
* @data_ind: Octet array of MCPS_DATA_indication
|
|
*
|
|
* Called by the spi driver whenever a SAP command is received, this function
|
|
* will ascertain whether the command is of interest to the network driver and
|
|
* take necessary action.
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_skb_rx(
|
|
struct ieee802154_hw *hw,
|
|
size_t len,
|
|
u8 *data_ind
|
|
)
|
|
{
|
|
struct ieee802154_hdr hdr;
|
|
int msdulen;
|
|
int hlen;
|
|
u8 mpdulinkquality = data_ind[23];
|
|
struct sk_buff *skb;
|
|
struct ca8210_priv *priv = hw->priv;
|
|
|
|
/* Allocate mtu size buffer for every rx packet */
|
|
skb = dev_alloc_skb(IEEE802154_MTU + sizeof(hdr));
|
|
if (!skb)
|
|
return -ENOMEM;
|
|
|
|
skb_reserve(skb, sizeof(hdr));
|
|
|
|
msdulen = data_ind[22]; /* msdu_length */
|
|
if (msdulen > IEEE802154_MTU) {
|
|
dev_err(
|
|
&priv->spi->dev,
|
|
"received erroneously large msdu length!\n"
|
|
);
|
|
kfree_skb(skb);
|
|
return -EMSGSIZE;
|
|
}
|
|
dev_dbg(&priv->spi->dev, "skb buffer length = %d\n", msdulen);
|
|
|
|
if (priv->promiscuous)
|
|
goto copy_payload;
|
|
|
|
/* Populate hdr */
|
|
hdr.sec.level = data_ind[29 + msdulen];
|
|
dev_dbg(&priv->spi->dev, "security level: %#03x\n", hdr.sec.level);
|
|
if (hdr.sec.level > 0) {
|
|
hdr.sec.key_id_mode = data_ind[30 + msdulen];
|
|
memcpy(&hdr.sec.extended_src, &data_ind[31 + msdulen], 8);
|
|
hdr.sec.key_id = data_ind[39 + msdulen];
|
|
}
|
|
hdr.source.mode = data_ind[0];
|
|
dev_dbg(&priv->spi->dev, "srcAddrMode: %#03x\n", hdr.source.mode);
|
|
hdr.source.pan_id = *(u16 *)&data_ind[1];
|
|
dev_dbg(&priv->spi->dev, "srcPanId: %#06x\n", hdr.source.pan_id);
|
|
memcpy(&hdr.source.extended_addr, &data_ind[3], 8);
|
|
hdr.dest.mode = data_ind[11];
|
|
dev_dbg(&priv->spi->dev, "dstAddrMode: %#03x\n", hdr.dest.mode);
|
|
hdr.dest.pan_id = *(u16 *)&data_ind[12];
|
|
dev_dbg(&priv->spi->dev, "dstPanId: %#06x\n", hdr.dest.pan_id);
|
|
memcpy(&hdr.dest.extended_addr, &data_ind[14], 8);
|
|
|
|
/* Fill in FC implicitly */
|
|
hdr.fc.type = 1; /* Data frame */
|
|
if (hdr.sec.level)
|
|
hdr.fc.security_enabled = 1;
|
|
else
|
|
hdr.fc.security_enabled = 0;
|
|
if (data_ind[1] != data_ind[12] || data_ind[2] != data_ind[13])
|
|
hdr.fc.intra_pan = 1;
|
|
else
|
|
hdr.fc.intra_pan = 0;
|
|
hdr.fc.dest_addr_mode = hdr.dest.mode;
|
|
hdr.fc.source_addr_mode = hdr.source.mode;
|
|
|
|
/* Add hdr to front of buffer */
|
|
hlen = ieee802154_hdr_push(skb, &hdr);
|
|
|
|
if (hlen < 0) {
|
|
dev_crit(&priv->spi->dev, "failed to push mac hdr onto skb!\n");
|
|
kfree_skb(skb);
|
|
return hlen;
|
|
}
|
|
|
|
skb_reset_mac_header(skb);
|
|
skb->mac_len = hlen;
|
|
|
|
copy_payload:
|
|
/* Add <msdulen> bytes of space to the back of the buffer */
|
|
/* Copy msdu to skb */
|
|
skb_put_data(skb, &data_ind[29], msdulen);
|
|
|
|
ieee802154_rx_irqsafe(hw, skb, mpdulinkquality);
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* ca8210_net_rx() - Acts upon received SAP commands relevant to the network
|
|
* driver
|
|
* @hw: ieee802154_hw that command was received by
|
|
* @command: Octet array of received command
|
|
* @len: length of the received command
|
|
*
|
|
* Called by the spi driver whenever a SAP command is received, this function
|
|
* will ascertain whether the command is of interest to the network driver and
|
|
* take necessary action.
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_net_rx(struct ieee802154_hw *hw, u8 *command, size_t len)
|
|
{
|
|
struct ca8210_priv *priv = hw->priv;
|
|
unsigned long flags;
|
|
u8 status;
|
|
|
|
dev_dbg(&priv->spi->dev, "%s: CmdID = %d\n", __func__, command[0]);
|
|
|
|
if (command[0] == SPI_MCPS_DATA_INDICATION) {
|
|
/* Received data */
|
|
spin_lock_irqsave(&priv->lock, flags);
|
|
if (command[26] == priv->last_dsn) {
|
|
dev_dbg(
|
|
&priv->spi->dev,
|
|
"DSN %d resend received, ignoring...\n",
|
|
command[26]
|
|
);
|
|
spin_unlock_irqrestore(&priv->lock, flags);
|
|
return 0;
|
|
}
|
|
priv->last_dsn = command[26];
|
|
spin_unlock_irqrestore(&priv->lock, flags);
|
|
return ca8210_skb_rx(hw, len - 2, command + 2);
|
|
} else if (command[0] == SPI_MCPS_DATA_CONFIRM) {
|
|
status = command[3];
|
|
if (priv->async_tx_pending) {
|
|
return ca8210_async_xmit_complete(
|
|
hw,
|
|
command[2],
|
|
status
|
|
);
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* ca8210_skb_tx() - Transmits a given socket buffer using the ca8210
|
|
* @skb: Socket buffer to transmit
|
|
* @msduhandle: Data identifier to pass to the 802.15.4 MAC
|
|
* @priv: Pointer to private data section of target ca8210
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_skb_tx(
|
|
struct sk_buff *skb,
|
|
u8 msduhandle,
|
|
struct ca8210_priv *priv
|
|
)
|
|
{
|
|
int status;
|
|
struct ieee802154_hdr header = { };
|
|
struct secspec secspec;
|
|
unsigned int mac_len;
|
|
|
|
dev_dbg(&priv->spi->dev, "%s called\n", __func__);
|
|
|
|
/* Get addressing info from skb - ieee802154 layer creates a full
|
|
* packet
|
|
*/
|
|
mac_len = ieee802154_hdr_peek_addrs(skb, &header);
|
|
|
|
secspec.security_level = header.sec.level;
|
|
secspec.key_id_mode = header.sec.key_id_mode;
|
|
if (secspec.key_id_mode == 2)
|
|
memcpy(secspec.key_source, &header.sec.short_src, 4);
|
|
else if (secspec.key_id_mode == 3)
|
|
memcpy(secspec.key_source, &header.sec.extended_src, 8);
|
|
secspec.key_index = header.sec.key_id;
|
|
|
|
/* Pass to Cascoda API */
|
|
status = mcps_data_request(
|
|
header.source.mode,
|
|
header.dest.mode,
|
|
header.dest.pan_id,
|
|
(union macaddr *)&header.dest.extended_addr,
|
|
skb->len - mac_len,
|
|
&skb->data[mac_len],
|
|
msduhandle,
|
|
header.fc.ack_request,
|
|
&secspec,
|
|
priv->spi
|
|
);
|
|
return link_to_linux_err(status);
|
|
}
|
|
|
|
/**
|
|
* ca8210_start() - Starts the network driver
|
|
* @hw: ieee802154_hw of ca8210 being started
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_start(struct ieee802154_hw *hw)
|
|
{
|
|
int status;
|
|
u8 rx_on_when_idle;
|
|
u8 lqi_threshold = 0;
|
|
struct ca8210_priv *priv = hw->priv;
|
|
|
|
priv->last_dsn = -1;
|
|
/* Turn receiver on when idle for now just to test rx */
|
|
rx_on_when_idle = 1;
|
|
status = mlme_set_request_sync(
|
|
MAC_RX_ON_WHEN_IDLE,
|
|
0,
|
|
1,
|
|
&rx_on_when_idle,
|
|
priv->spi
|
|
);
|
|
if (status) {
|
|
dev_crit(
|
|
&priv->spi->dev,
|
|
"Setting rx_on_when_idle failed, status = %d\n",
|
|
status
|
|
);
|
|
return link_to_linux_err(status);
|
|
}
|
|
status = hwme_set_request_sync(
|
|
HWME_LQILIMIT,
|
|
1,
|
|
&lqi_threshold,
|
|
priv->spi
|
|
);
|
|
if (status) {
|
|
dev_crit(
|
|
&priv->spi->dev,
|
|
"Setting lqilimit failed, status = %d\n",
|
|
status
|
|
);
|
|
return link_to_linux_err(status);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* ca8210_stop() - Stops the network driver
|
|
* @hw: ieee802154_hw of ca8210 being stopped
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static void ca8210_stop(struct ieee802154_hw *hw)
|
|
{
|
|
}
|
|
|
|
/**
|
|
* ca8210_xmit_async() - Asynchronously transmits a given socket buffer using
|
|
* the ca8210
|
|
* @hw: ieee802154_hw of ca8210 to transmit from
|
|
* @skb: Socket buffer to transmit
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_xmit_async(struct ieee802154_hw *hw, struct sk_buff *skb)
|
|
{
|
|
struct ca8210_priv *priv = hw->priv;
|
|
int status;
|
|
|
|
dev_dbg(&priv->spi->dev, "calling %s\n", __func__);
|
|
|
|
priv->tx_skb = skb;
|
|
priv->async_tx_pending = true;
|
|
status = ca8210_skb_tx(skb, priv->nextmsduhandle, priv);
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* ca8210_get_ed() - Returns the measured energy on the current channel at this
|
|
* instant in time
|
|
* @hw: ieee802154_hw of target ca8210
|
|
* @level: Measured Energy Detect level
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_get_ed(struct ieee802154_hw *hw, u8 *level)
|
|
{
|
|
u8 lenvar;
|
|
struct ca8210_priv *priv = hw->priv;
|
|
|
|
return link_to_linux_err(
|
|
hwme_get_request_sync(HWME_EDVALUE, &lenvar, level, priv->spi)
|
|
);
|
|
}
|
|
|
|
/**
|
|
* ca8210_set_channel() - Sets the current operating 802.15.4 channel of the
|
|
* ca8210
|
|
* @hw: ieee802154_hw of target ca8210
|
|
* @page: Channel page to set
|
|
* @channel: Channel number to set
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_set_channel(
|
|
struct ieee802154_hw *hw,
|
|
u8 page,
|
|
u8 channel
|
|
)
|
|
{
|
|
u8 status;
|
|
struct ca8210_priv *priv = hw->priv;
|
|
|
|
status = mlme_set_request_sync(
|
|
PHY_CURRENT_CHANNEL,
|
|
0,
|
|
1,
|
|
&channel,
|
|
priv->spi
|
|
);
|
|
if (status) {
|
|
dev_err(
|
|
&priv->spi->dev,
|
|
"error setting channel, MLME-SET.confirm status = %d\n",
|
|
status
|
|
);
|
|
}
|
|
return link_to_linux_err(status);
|
|
}
|
|
|
|
/**
|
|
* ca8210_set_hw_addr_filt() - Sets the address filtering parameters of the
|
|
* ca8210
|
|
* @hw: ieee802154_hw of target ca8210
|
|
* @filt: Filtering parameters
|
|
* @changed: Bitmap representing which parameters to change
|
|
*
|
|
* Effectively just sets the actual addressing information identifying this node
|
|
* as all filtering is performed by the ca8210 as detailed in the IEEE 802.15.4
|
|
* 2006 specification.
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_set_hw_addr_filt(
|
|
struct ieee802154_hw *hw,
|
|
struct ieee802154_hw_addr_filt *filt,
|
|
unsigned long changed
|
|
)
|
|
{
|
|
u8 status = 0;
|
|
struct ca8210_priv *priv = hw->priv;
|
|
|
|
if (changed & IEEE802154_AFILT_PANID_CHANGED) {
|
|
status = mlme_set_request_sync(
|
|
MAC_PAN_ID,
|
|
0,
|
|
2,
|
|
&filt->pan_id, priv->spi
|
|
);
|
|
if (status) {
|
|
dev_err(
|
|
&priv->spi->dev,
|
|
"error setting pan id, MLME-SET.confirm status = %d",
|
|
status
|
|
);
|
|
return link_to_linux_err(status);
|
|
}
|
|
}
|
|
if (changed & IEEE802154_AFILT_SADDR_CHANGED) {
|
|
status = mlme_set_request_sync(
|
|
MAC_SHORT_ADDRESS,
|
|
0,
|
|
2,
|
|
&filt->short_addr, priv->spi
|
|
);
|
|
if (status) {
|
|
dev_err(
|
|
&priv->spi->dev,
|
|
"error setting short address, MLME-SET.confirm status = %d",
|
|
status
|
|
);
|
|
return link_to_linux_err(status);
|
|
}
|
|
}
|
|
if (changed & IEEE802154_AFILT_IEEEADDR_CHANGED) {
|
|
status = mlme_set_request_sync(
|
|
NS_IEEE_ADDRESS,
|
|
0,
|
|
8,
|
|
&filt->ieee_addr,
|
|
priv->spi
|
|
);
|
|
if (status) {
|
|
dev_err(
|
|
&priv->spi->dev,
|
|
"error setting ieee address, MLME-SET.confirm status = %d",
|
|
status
|
|
);
|
|
return link_to_linux_err(status);
|
|
}
|
|
}
|
|
/* TODO: Should use MLME_START to set coord bit? */
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* ca8210_set_tx_power() - Sets the transmit power of the ca8210
|
|
* @hw: ieee802154_hw of target ca8210
|
|
* @mbm: Transmit power in mBm (dBm*100)
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_set_tx_power(struct ieee802154_hw *hw, s32 mbm)
|
|
{
|
|
struct ca8210_priv *priv = hw->priv;
|
|
|
|
mbm /= 100;
|
|
return link_to_linux_err(
|
|
mlme_set_request_sync(PHY_TRANSMIT_POWER, 0, 1, &mbm, priv->spi)
|
|
);
|
|
}
|
|
|
|
/**
|
|
* ca8210_set_cca_mode() - Sets the clear channel assessment mode of the ca8210
|
|
* @hw: ieee802154_hw of target ca8210
|
|
* @cca: CCA mode to set
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_set_cca_mode(
|
|
struct ieee802154_hw *hw,
|
|
const struct wpan_phy_cca *cca
|
|
)
|
|
{
|
|
u8 status;
|
|
u8 cca_mode;
|
|
struct ca8210_priv *priv = hw->priv;
|
|
|
|
cca_mode = cca->mode & 3;
|
|
if (cca_mode == 3 && cca->opt == NL802154_CCA_OPT_ENERGY_CARRIER_OR) {
|
|
/* cca_mode 0 == CS OR ED, 3 == CS AND ED */
|
|
cca_mode = 0;
|
|
}
|
|
status = mlme_set_request_sync(
|
|
PHY_CCA_MODE,
|
|
0,
|
|
1,
|
|
&cca_mode,
|
|
priv->spi
|
|
);
|
|
if (status) {
|
|
dev_err(
|
|
&priv->spi->dev,
|
|
"error setting cca mode, MLME-SET.confirm status = %d",
|
|
status
|
|
);
|
|
}
|
|
return link_to_linux_err(status);
|
|
}
|
|
|
|
/**
|
|
* ca8210_set_cca_ed_level() - Sets the CCA ED level of the ca8210
|
|
* @hw: ieee802154_hw of target ca8210
|
|
* @level: ED level to set (in mbm)
|
|
*
|
|
* Sets the minimum threshold of measured energy above which the ca8210 will
|
|
* back off and retry a transmission.
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_set_cca_ed_level(struct ieee802154_hw *hw, s32 level)
|
|
{
|
|
u8 status;
|
|
u8 ed_threshold = (level / 100) * 2 + 256;
|
|
struct ca8210_priv *priv = hw->priv;
|
|
|
|
status = hwme_set_request_sync(
|
|
HWME_EDTHRESHOLD,
|
|
1,
|
|
&ed_threshold,
|
|
priv->spi
|
|
);
|
|
if (status) {
|
|
dev_err(
|
|
&priv->spi->dev,
|
|
"error setting ed threshold, HWME-SET.confirm status = %d",
|
|
status
|
|
);
|
|
}
|
|
return link_to_linux_err(status);
|
|
}
|
|
|
|
/**
|
|
* ca8210_set_csma_params() - Sets the CSMA parameters of the ca8210
|
|
* @hw: ieee802154_hw of target ca8210
|
|
* @min_be: Minimum backoff exponent when backing off a transmission
|
|
* @max_be: Maximum backoff exponent when backing off a transmission
|
|
* @retries: Number of times to retry after backing off
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_set_csma_params(
|
|
struct ieee802154_hw *hw,
|
|
u8 min_be,
|
|
u8 max_be,
|
|
u8 retries
|
|
)
|
|
{
|
|
u8 status;
|
|
struct ca8210_priv *priv = hw->priv;
|
|
|
|
status = mlme_set_request_sync(MAC_MIN_BE, 0, 1, &min_be, priv->spi);
|
|
if (status) {
|
|
dev_err(
|
|
&priv->spi->dev,
|
|
"error setting min be, MLME-SET.confirm status = %d",
|
|
status
|
|
);
|
|
return link_to_linux_err(status);
|
|
}
|
|
status = mlme_set_request_sync(MAC_MAX_BE, 0, 1, &max_be, priv->spi);
|
|
if (status) {
|
|
dev_err(
|
|
&priv->spi->dev,
|
|
"error setting max be, MLME-SET.confirm status = %d",
|
|
status
|
|
);
|
|
return link_to_linux_err(status);
|
|
}
|
|
status = mlme_set_request_sync(
|
|
MAC_MAX_CSMA_BACKOFFS,
|
|
0,
|
|
1,
|
|
&retries,
|
|
priv->spi
|
|
);
|
|
if (status) {
|
|
dev_err(
|
|
&priv->spi->dev,
|
|
"error setting max csma backoffs, MLME-SET.confirm status = %d",
|
|
status
|
|
);
|
|
}
|
|
return link_to_linux_err(status);
|
|
}
|
|
|
|
/**
|
|
* ca8210_set_frame_retries() - Sets the maximum frame retries of the ca8210
|
|
* @hw: ieee802154_hw of target ca8210
|
|
* @retries: Number of retries
|
|
*
|
|
* Sets the number of times to retry a transmission if no acknowledgment was
|
|
* was received from the other end when one was requested.
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_set_frame_retries(struct ieee802154_hw *hw, s8 retries)
|
|
{
|
|
u8 status;
|
|
struct ca8210_priv *priv = hw->priv;
|
|
|
|
status = mlme_set_request_sync(
|
|
MAC_MAX_FRAME_RETRIES,
|
|
0,
|
|
1,
|
|
&retries,
|
|
priv->spi
|
|
);
|
|
if (status) {
|
|
dev_err(
|
|
&priv->spi->dev,
|
|
"error setting frame retries, MLME-SET.confirm status = %d",
|
|
status
|
|
);
|
|
}
|
|
return link_to_linux_err(status);
|
|
}
|
|
|
|
static int ca8210_set_promiscuous_mode(struct ieee802154_hw *hw, const bool on)
|
|
{
|
|
u8 status;
|
|
struct ca8210_priv *priv = hw->priv;
|
|
|
|
status = mlme_set_request_sync(
|
|
MAC_PROMISCUOUS_MODE,
|
|
0,
|
|
1,
|
|
(const void *)&on,
|
|
priv->spi
|
|
);
|
|
if (status) {
|
|
dev_err(
|
|
&priv->spi->dev,
|
|
"error setting promiscuous mode, MLME-SET.confirm status = %d",
|
|
status
|
|
);
|
|
} else {
|
|
priv->promiscuous = on;
|
|
}
|
|
return link_to_linux_err(status);
|
|
}
|
|
|
|
static const struct ieee802154_ops ca8210_phy_ops = {
|
|
.start = ca8210_start,
|
|
.stop = ca8210_stop,
|
|
.xmit_async = ca8210_xmit_async,
|
|
.ed = ca8210_get_ed,
|
|
.set_channel = ca8210_set_channel,
|
|
.set_hw_addr_filt = ca8210_set_hw_addr_filt,
|
|
.set_txpower = ca8210_set_tx_power,
|
|
.set_cca_mode = ca8210_set_cca_mode,
|
|
.set_cca_ed_level = ca8210_set_cca_ed_level,
|
|
.set_csma_params = ca8210_set_csma_params,
|
|
.set_frame_retries = ca8210_set_frame_retries,
|
|
.set_promiscuous_mode = ca8210_set_promiscuous_mode
|
|
};
|
|
|
|
/* Test/EVBME Interface */
|
|
|
|
/**
|
|
* ca8210_test_int_open() - Opens the test interface to the userspace
|
|
* @inodp: inode representation of file interface
|
|
* @filp: file interface
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_test_int_open(struct inode *inodp, struct file *filp)
|
|
{
|
|
struct ca8210_priv *priv = inodp->i_private;
|
|
|
|
filp->private_data = priv;
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* ca8210_test_check_upstream() - Checks a command received from the upstream
|
|
* testing interface for required action
|
|
* @buf: Buffer containing command to check
|
|
* @device_ref: Nondescript pointer to target device
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_test_check_upstream(u8 *buf, void *device_ref)
|
|
{
|
|
int ret;
|
|
u8 response[CA8210_SPI_BUF_SIZE];
|
|
|
|
if (buf[0] == SPI_MLME_SET_REQUEST) {
|
|
ret = tdme_checkpibattribute(buf[2], buf[4], buf + 5);
|
|
if (ret) {
|
|
response[0] = SPI_MLME_SET_CONFIRM;
|
|
response[1] = 3;
|
|
response[2] = MAC_INVALID_PARAMETER;
|
|
response[3] = buf[2];
|
|
response[4] = buf[3];
|
|
if (cascoda_api_upstream)
|
|
cascoda_api_upstream(response, 5, device_ref);
|
|
return ret;
|
|
}
|
|
}
|
|
if (buf[0] == SPI_MLME_ASSOCIATE_REQUEST) {
|
|
return tdme_channelinit(buf[2], device_ref);
|
|
} else if (buf[0] == SPI_MLME_START_REQUEST) {
|
|
return tdme_channelinit(buf[4], device_ref);
|
|
} else if (
|
|
(buf[0] == SPI_MLME_SET_REQUEST) &&
|
|
(buf[2] == PHY_CURRENT_CHANNEL)
|
|
) {
|
|
return tdme_channelinit(buf[5], device_ref);
|
|
} else if (
|
|
(buf[0] == SPI_TDME_SET_REQUEST) &&
|
|
(buf[2] == TDME_CHANNEL)
|
|
) {
|
|
return tdme_channelinit(buf[4], device_ref);
|
|
} else if (
|
|
(CA8210_MAC_WORKAROUNDS) &&
|
|
(buf[0] == SPI_MLME_RESET_REQUEST) &&
|
|
(buf[2] == 1)
|
|
) {
|
|
/* reset COORD Bit for Channel Filtering as Coordinator */
|
|
return tdme_setsfr_request_sync(
|
|
0,
|
|
CA8210_SFR_MACCON,
|
|
0,
|
|
device_ref
|
|
);
|
|
}
|
|
return 0;
|
|
} /* End of EVBMECheckSerialCommand() */
|
|
|
|
/**
|
|
* ca8210_test_int_user_write() - Called by a process in userspace to send a
|
|
* message to the ca8210 drivers
|
|
* @filp: file interface
|
|
* @in_buf: Buffer containing message to write
|
|
* @len: length of message
|
|
* @off: file offset
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static ssize_t ca8210_test_int_user_write(
|
|
struct file *filp,
|
|
const char __user *in_buf,
|
|
size_t len,
|
|
loff_t *off
|
|
)
|
|
{
|
|
int ret;
|
|
struct ca8210_priv *priv = filp->private_data;
|
|
u8 command[CA8210_SPI_BUF_SIZE];
|
|
|
|
if (len > CA8210_SPI_BUF_SIZE) {
|
|
dev_warn(
|
|
&priv->spi->dev,
|
|
"userspace requested erroneously long write (%zu)\n",
|
|
len
|
|
);
|
|
return -EMSGSIZE;
|
|
}
|
|
|
|
ret = copy_from_user(command, in_buf, len);
|
|
if (ret) {
|
|
dev_err(
|
|
&priv->spi->dev,
|
|
"%d bytes could not be copied from userspace\n",
|
|
ret
|
|
);
|
|
return -EIO;
|
|
}
|
|
|
|
ret = ca8210_test_check_upstream(command, priv->spi);
|
|
if (ret == 0) {
|
|
ret = ca8210_spi_exchange(
|
|
command,
|
|
command[1] + 2,
|
|
NULL,
|
|
priv->spi
|
|
);
|
|
if (ret < 0) {
|
|
/* effectively 0 bytes were written successfully */
|
|
dev_err(
|
|
&priv->spi->dev,
|
|
"spi exchange failed\n"
|
|
);
|
|
return ret;
|
|
}
|
|
if (command[0] & SPI_SYN)
|
|
priv->sync_down++;
|
|
}
|
|
|
|
return len;
|
|
}
|
|
|
|
/**
|
|
* ca8210_test_int_user_read() - Called by a process in userspace to read a
|
|
* message from the ca8210 drivers
|
|
* @filp: file interface
|
|
* @buf: Buffer to write message to
|
|
* @len: length of message to read (ignored)
|
|
* @offp: file offset
|
|
*
|
|
* If the O_NONBLOCK flag was set when opening the file then this function will
|
|
* not block, i.e. it will return if the fifo is empty. Otherwise the function
|
|
* will block, i.e. wait until new data arrives.
|
|
*
|
|
* Return: number of bytes read
|
|
*/
|
|
static ssize_t ca8210_test_int_user_read(
|
|
struct file *filp,
|
|
char __user *buf,
|
|
size_t len,
|
|
loff_t *offp
|
|
)
|
|
{
|
|
int i, cmdlen;
|
|
struct ca8210_priv *priv = filp->private_data;
|
|
unsigned char *fifo_buffer;
|
|
unsigned long bytes_not_copied;
|
|
|
|
if (filp->f_flags & O_NONBLOCK) {
|
|
/* Non-blocking mode */
|
|
if (kfifo_is_empty(&priv->test.up_fifo))
|
|
return 0;
|
|
} else {
|
|
/* Blocking mode */
|
|
wait_event_interruptible(
|
|
priv->test.readq,
|
|
!kfifo_is_empty(&priv->test.up_fifo)
|
|
);
|
|
}
|
|
|
|
if (kfifo_out(&priv->test.up_fifo, &fifo_buffer, 4) != 4) {
|
|
dev_err(
|
|
&priv->spi->dev,
|
|
"test_interface: Wrong number of elements popped from upstream fifo\n"
|
|
);
|
|
return 0;
|
|
}
|
|
cmdlen = fifo_buffer[1];
|
|
bytes_not_copied = cmdlen + 2;
|
|
|
|
bytes_not_copied = copy_to_user(buf, fifo_buffer, bytes_not_copied);
|
|
if (bytes_not_copied > 0) {
|
|
dev_err(
|
|
&priv->spi->dev,
|
|
"%lu bytes could not be copied to user space!\n",
|
|
bytes_not_copied
|
|
);
|
|
}
|
|
|
|
dev_dbg(&priv->spi->dev, "test_interface: Cmd len = %d\n", cmdlen);
|
|
|
|
dev_dbg(&priv->spi->dev, "test_interface: Read\n");
|
|
for (i = 0; i < cmdlen + 2; i++)
|
|
dev_dbg(&priv->spi->dev, "%#03x\n", fifo_buffer[i]);
|
|
|
|
kfree(fifo_buffer);
|
|
|
|
return cmdlen + 2;
|
|
}
|
|
|
|
/**
|
|
* ca8210_test_int_ioctl() - Called by a process in userspace to enact an
|
|
* arbitrary action
|
|
* @filp: file interface
|
|
* @ioctl_num: which action to enact
|
|
* @ioctl_param: arbitrary parameter for the action
|
|
*
|
|
* Return: status
|
|
*/
|
|
static long ca8210_test_int_ioctl(
|
|
struct file *filp,
|
|
unsigned int ioctl_num,
|
|
unsigned long ioctl_param
|
|
)
|
|
{
|
|
struct ca8210_priv *priv = filp->private_data;
|
|
|
|
switch (ioctl_num) {
|
|
case CA8210_IOCTL_HARD_RESET:
|
|
ca8210_reset_send(priv->spi, ioctl_param);
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* ca8210_test_int_poll() - Called by a process in userspace to determine which
|
|
* actions are currently possible for the file
|
|
* @filp: file interface
|
|
* @ptable: poll table
|
|
*
|
|
* Return: set of poll return flags
|
|
*/
|
|
static __poll_t ca8210_test_int_poll(
|
|
struct file *filp,
|
|
struct poll_table_struct *ptable
|
|
)
|
|
{
|
|
__poll_t return_flags = 0;
|
|
struct ca8210_priv *priv = filp->private_data;
|
|
|
|
poll_wait(filp, &priv->test.readq, ptable);
|
|
if (!kfifo_is_empty(&priv->test.up_fifo))
|
|
return_flags |= (EPOLLIN | EPOLLRDNORM);
|
|
if (wait_event_interruptible(
|
|
priv->test.readq,
|
|
!kfifo_is_empty(&priv->test.up_fifo))) {
|
|
return EPOLLERR;
|
|
}
|
|
return return_flags;
|
|
}
|
|
|
|
static const struct file_operations test_int_fops = {
|
|
.read = ca8210_test_int_user_read,
|
|
.write = ca8210_test_int_user_write,
|
|
.open = ca8210_test_int_open,
|
|
.release = NULL,
|
|
.unlocked_ioctl = ca8210_test_int_ioctl,
|
|
.poll = ca8210_test_int_poll
|
|
};
|
|
|
|
/* Init/Deinit */
|
|
|
|
/**
|
|
* ca8210_get_platform_data() - Populate a ca8210_platform_data object
|
|
* @spi_device: Pointer to ca8210 spi device object to get data for
|
|
* @pdata: Pointer to ca8210_platform_data object to populate
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_get_platform_data(
|
|
struct spi_device *spi_device,
|
|
struct ca8210_platform_data *pdata
|
|
)
|
|
{
|
|
int ret = 0;
|
|
|
|
if (!spi_device->dev.of_node)
|
|
return -EINVAL;
|
|
|
|
pdata->extclockenable = of_property_read_bool(
|
|
spi_device->dev.of_node,
|
|
"extclock-enable"
|
|
);
|
|
if (pdata->extclockenable) {
|
|
ret = of_property_read_u32(
|
|
spi_device->dev.of_node,
|
|
"extclock-freq",
|
|
&pdata->extclockfreq
|
|
);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = of_property_read_u32(
|
|
spi_device->dev.of_node,
|
|
"extclock-gpio",
|
|
&pdata->extclockgpio
|
|
);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* ca8210_config_extern_clk() - Configure the external clock provided by the
|
|
* ca8210
|
|
* @pdata: Pointer to ca8210_platform_data containing clock parameters
|
|
* @spi: Pointer to target ca8210 spi device
|
|
* @on: True to turn the clock on, false to turn off
|
|
*
|
|
* The external clock is configured with a frequency and output pin taken from
|
|
* the platform data.
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_config_extern_clk(
|
|
struct ca8210_platform_data *pdata,
|
|
struct spi_device *spi,
|
|
bool on
|
|
)
|
|
{
|
|
u8 clkparam[2];
|
|
|
|
if (on) {
|
|
dev_info(&spi->dev, "Switching external clock on\n");
|
|
switch (pdata->extclockfreq) {
|
|
case SIXTEEN_MHZ:
|
|
clkparam[0] = 1;
|
|
break;
|
|
case EIGHT_MHZ:
|
|
clkparam[0] = 2;
|
|
break;
|
|
case FOUR_MHZ:
|
|
clkparam[0] = 3;
|
|
break;
|
|
case TWO_MHZ:
|
|
clkparam[0] = 4;
|
|
break;
|
|
case ONE_MHZ:
|
|
clkparam[0] = 5;
|
|
break;
|
|
default:
|
|
dev_crit(&spi->dev, "Invalid extclock-freq\n");
|
|
return -EINVAL;
|
|
}
|
|
clkparam[1] = pdata->extclockgpio;
|
|
} else {
|
|
dev_info(&spi->dev, "Switching external clock off\n");
|
|
clkparam[0] = 0; /* off */
|
|
clkparam[1] = 0;
|
|
}
|
|
return link_to_linux_err(
|
|
hwme_set_request_sync(HWME_SYSCLKOUT, 2, clkparam, spi)
|
|
);
|
|
}
|
|
|
|
/**
|
|
* ca8210_register_ext_clock() - Register ca8210's external clock with kernel
|
|
* @spi: Pointer to target ca8210 spi device
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_register_ext_clock(struct spi_device *spi)
|
|
{
|
|
struct device_node *np = spi->dev.of_node;
|
|
struct ca8210_priv *priv = spi_get_drvdata(spi);
|
|
struct ca8210_platform_data *pdata = spi->dev.platform_data;
|
|
int ret = 0;
|
|
|
|
if (!np)
|
|
return -EFAULT;
|
|
|
|
priv->clk = clk_register_fixed_rate(
|
|
&spi->dev,
|
|
np->name,
|
|
NULL,
|
|
0,
|
|
pdata->extclockfreq
|
|
);
|
|
|
|
if (IS_ERR(priv->clk)) {
|
|
dev_crit(&spi->dev, "Failed to register external clk\n");
|
|
return PTR_ERR(priv->clk);
|
|
}
|
|
ret = of_clk_add_provider(np, of_clk_src_simple_get, priv->clk);
|
|
if (ret) {
|
|
clk_unregister(priv->clk);
|
|
dev_crit(
|
|
&spi->dev,
|
|
"Failed to register external clock as clock provider\n"
|
|
);
|
|
} else {
|
|
dev_info(&spi->dev, "External clock set as clock provider\n");
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* ca8210_unregister_ext_clock() - Unregister ca8210's external clock with
|
|
* kernel
|
|
* @spi: Pointer to target ca8210 spi device
|
|
*/
|
|
static void ca8210_unregister_ext_clock(struct spi_device *spi)
|
|
{
|
|
struct ca8210_priv *priv = spi_get_drvdata(spi);
|
|
|
|
if (!priv->clk)
|
|
return
|
|
|
|
of_clk_del_provider(spi->dev.of_node);
|
|
clk_unregister(priv->clk);
|
|
dev_info(&spi->dev, "External clock unregistered\n");
|
|
}
|
|
|
|
/**
|
|
* ca8210_reset_init() - Initialise the reset input to the ca8210
|
|
* @spi: Pointer to target ca8210 spi device
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_reset_init(struct spi_device *spi)
|
|
{
|
|
int ret;
|
|
struct ca8210_platform_data *pdata = spi->dev.platform_data;
|
|
|
|
pdata->gpio_reset = of_get_named_gpio(
|
|
spi->dev.of_node,
|
|
"reset-gpio",
|
|
0
|
|
);
|
|
|
|
ret = gpio_direction_output(pdata->gpio_reset, 1);
|
|
if (ret < 0) {
|
|
dev_crit(
|
|
&spi->dev,
|
|
"Reset GPIO %d did not set to output mode\n",
|
|
pdata->gpio_reset
|
|
);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* ca8210_interrupt_init() - Initialise the irq output from the ca8210
|
|
* @spi: Pointer to target ca8210 spi device
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_interrupt_init(struct spi_device *spi)
|
|
{
|
|
int ret;
|
|
struct ca8210_platform_data *pdata = spi->dev.platform_data;
|
|
|
|
pdata->gpio_irq = of_get_named_gpio(
|
|
spi->dev.of_node,
|
|
"irq-gpio",
|
|
0
|
|
);
|
|
|
|
pdata->irq_id = gpio_to_irq(pdata->gpio_irq);
|
|
if (pdata->irq_id < 0) {
|
|
dev_crit(
|
|
&spi->dev,
|
|
"Could not get irq for gpio pin %d\n",
|
|
pdata->gpio_irq
|
|
);
|
|
gpio_free(pdata->gpio_irq);
|
|
return pdata->irq_id;
|
|
}
|
|
|
|
ret = request_irq(
|
|
pdata->irq_id,
|
|
ca8210_interrupt_handler,
|
|
IRQF_TRIGGER_FALLING,
|
|
"ca8210-irq",
|
|
spi_get_drvdata(spi)
|
|
);
|
|
if (ret) {
|
|
dev_crit(&spi->dev, "request_irq %d failed\n", pdata->irq_id);
|
|
gpio_unexport(pdata->gpio_irq);
|
|
gpio_free(pdata->gpio_irq);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* ca8210_dev_com_init() - Initialise the spi communication component
|
|
* @priv: Pointer to private data structure
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_dev_com_init(struct ca8210_priv *priv)
|
|
{
|
|
priv->mlme_workqueue = alloc_ordered_workqueue(
|
|
"MLME work queue",
|
|
WQ_UNBOUND
|
|
);
|
|
if (!priv->mlme_workqueue) {
|
|
dev_crit(&priv->spi->dev, "alloc of mlme_workqueue failed!\n");
|
|
return -ENOMEM;
|
|
}
|
|
|
|
priv->irq_workqueue = alloc_ordered_workqueue(
|
|
"ca8210 irq worker",
|
|
WQ_UNBOUND
|
|
);
|
|
if (!priv->irq_workqueue) {
|
|
dev_crit(&priv->spi->dev, "alloc of irq_workqueue failed!\n");
|
|
return -ENOMEM;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* ca8210_dev_com_clear() - Deinitialise the spi communication component
|
|
* @priv: Pointer to private data structure
|
|
*/
|
|
static void ca8210_dev_com_clear(struct ca8210_priv *priv)
|
|
{
|
|
flush_workqueue(priv->mlme_workqueue);
|
|
destroy_workqueue(priv->mlme_workqueue);
|
|
flush_workqueue(priv->irq_workqueue);
|
|
destroy_workqueue(priv->irq_workqueue);
|
|
}
|
|
|
|
#define CA8210_MAX_TX_POWERS (9)
|
|
static const s32 ca8210_tx_powers[CA8210_MAX_TX_POWERS] = {
|
|
800, 700, 600, 500, 400, 300, 200, 100, 0
|
|
};
|
|
|
|
#define CA8210_MAX_ED_LEVELS (21)
|
|
static const s32 ca8210_ed_levels[CA8210_MAX_ED_LEVELS] = {
|
|
-10300, -10250, -10200, -10150, -10100, -10050, -10000, -9950, -9900,
|
|
-9850, -9800, -9750, -9700, -9650, -9600, -9550, -9500, -9450, -9400,
|
|
-9350, -9300
|
|
};
|
|
|
|
/**
|
|
* ca8210_hw_setup() - Populate the ieee802154_hw phy attributes with the
|
|
* ca8210's defaults
|
|
* @ca8210_hw: Pointer to ieee802154_hw to populate
|
|
*/
|
|
static void ca8210_hw_setup(struct ieee802154_hw *ca8210_hw)
|
|
{
|
|
/* Support channels 11-26 */
|
|
ca8210_hw->phy->supported.channels[0] = CA8210_VALID_CHANNELS;
|
|
ca8210_hw->phy->supported.tx_powers_size = CA8210_MAX_TX_POWERS;
|
|
ca8210_hw->phy->supported.tx_powers = ca8210_tx_powers;
|
|
ca8210_hw->phy->supported.cca_ed_levels_size = CA8210_MAX_ED_LEVELS;
|
|
ca8210_hw->phy->supported.cca_ed_levels = ca8210_ed_levels;
|
|
ca8210_hw->phy->current_channel = 18;
|
|
ca8210_hw->phy->current_page = 0;
|
|
ca8210_hw->phy->transmit_power = 800;
|
|
ca8210_hw->phy->cca.mode = NL802154_CCA_ENERGY_CARRIER;
|
|
ca8210_hw->phy->cca.opt = NL802154_CCA_OPT_ENERGY_CARRIER_AND;
|
|
ca8210_hw->phy->cca_ed_level = -9800;
|
|
ca8210_hw->phy->symbol_duration = 16;
|
|
ca8210_hw->phy->lifs_period = 40;
|
|
ca8210_hw->phy->sifs_period = 12;
|
|
ca8210_hw->flags =
|
|
IEEE802154_HW_AFILT |
|
|
IEEE802154_HW_OMIT_CKSUM |
|
|
IEEE802154_HW_FRAME_RETRIES |
|
|
IEEE802154_HW_PROMISCUOUS |
|
|
IEEE802154_HW_CSMA_PARAMS;
|
|
ca8210_hw->phy->flags =
|
|
WPAN_PHY_FLAG_TXPOWER |
|
|
WPAN_PHY_FLAG_CCA_ED_LEVEL |
|
|
WPAN_PHY_FLAG_CCA_MODE;
|
|
}
|
|
|
|
/**
|
|
* ca8210_test_interface_init() - Initialise the test file interface
|
|
* @priv: Pointer to private data structure
|
|
*
|
|
* Provided as an alternative to the standard linux network interface, the test
|
|
* interface exposes a file in the filesystem (ca8210_test) that allows
|
|
* 802.15.4 SAP Commands and Cascoda EVBME commands to be sent directly to
|
|
* the stack.
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_test_interface_init(struct ca8210_priv *priv)
|
|
{
|
|
struct ca8210_test *test = &priv->test;
|
|
char node_name[32];
|
|
|
|
snprintf(
|
|
node_name,
|
|
sizeof(node_name),
|
|
"ca8210@%d_%d",
|
|
priv->spi->master->bus_num,
|
|
priv->spi->chip_select
|
|
);
|
|
|
|
test->ca8210_dfs_spi_int = debugfs_create_file(
|
|
node_name,
|
|
0600, /* S_IRUSR | S_IWUSR */
|
|
NULL,
|
|
priv,
|
|
&test_int_fops
|
|
);
|
|
if (IS_ERR(test->ca8210_dfs_spi_int)) {
|
|
dev_err(
|
|
&priv->spi->dev,
|
|
"Error %ld when creating debugfs node\n",
|
|
PTR_ERR(test->ca8210_dfs_spi_int)
|
|
);
|
|
return PTR_ERR(test->ca8210_dfs_spi_int);
|
|
}
|
|
debugfs_create_symlink("ca8210", NULL, node_name);
|
|
init_waitqueue_head(&test->readq);
|
|
return kfifo_alloc(
|
|
&test->up_fifo,
|
|
CA8210_TEST_INT_FIFO_SIZE,
|
|
GFP_KERNEL
|
|
);
|
|
}
|
|
|
|
/**
|
|
* ca8210_test_interface_clear() - Deinitialise the test file interface
|
|
* @priv: Pointer to private data structure
|
|
*/
|
|
static void ca8210_test_interface_clear(struct ca8210_priv *priv)
|
|
{
|
|
struct ca8210_test *test = &priv->test;
|
|
|
|
if (!IS_ERR(test->ca8210_dfs_spi_int))
|
|
debugfs_remove(test->ca8210_dfs_spi_int);
|
|
kfifo_free(&test->up_fifo);
|
|
dev_info(&priv->spi->dev, "Test interface removed\n");
|
|
}
|
|
|
|
/**
|
|
* ca8210_remove() - Shut down a ca8210 upon being disconnected
|
|
* @priv: Pointer to private data structure
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_remove(struct spi_device *spi_device)
|
|
{
|
|
struct ca8210_priv *priv;
|
|
struct ca8210_platform_data *pdata;
|
|
|
|
dev_info(&spi_device->dev, "Removing ca8210\n");
|
|
|
|
pdata = spi_device->dev.platform_data;
|
|
if (pdata) {
|
|
if (pdata->extclockenable) {
|
|
ca8210_unregister_ext_clock(spi_device);
|
|
ca8210_config_extern_clk(pdata, spi_device, 0);
|
|
}
|
|
free_irq(pdata->irq_id, spi_device->dev.driver_data);
|
|
kfree(pdata);
|
|
spi_device->dev.platform_data = NULL;
|
|
}
|
|
/* get spi_device private data */
|
|
priv = spi_get_drvdata(spi_device);
|
|
if (priv) {
|
|
dev_info(
|
|
&spi_device->dev,
|
|
"sync_down = %d, sync_up = %d\n",
|
|
priv->sync_down,
|
|
priv->sync_up
|
|
);
|
|
ca8210_dev_com_clear(spi_device->dev.driver_data);
|
|
if (priv->hw) {
|
|
if (priv->hw_registered)
|
|
ieee802154_unregister_hw(priv->hw);
|
|
ieee802154_free_hw(priv->hw);
|
|
priv->hw = NULL;
|
|
dev_info(
|
|
&spi_device->dev,
|
|
"Unregistered & freed ieee802154_hw.\n"
|
|
);
|
|
}
|
|
if (IS_ENABLED(CONFIG_IEEE802154_CA8210_DEBUGFS))
|
|
ca8210_test_interface_clear(priv);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* ca8210_probe() - Set up a connected ca8210 upon being detected by the system
|
|
* @priv: Pointer to private data structure
|
|
*
|
|
* Return: 0 or linux error code
|
|
*/
|
|
static int ca8210_probe(struct spi_device *spi_device)
|
|
{
|
|
struct ca8210_priv *priv;
|
|
struct ieee802154_hw *hw;
|
|
struct ca8210_platform_data *pdata;
|
|
int ret;
|
|
|
|
dev_info(&spi_device->dev, "Inserting ca8210\n");
|
|
|
|
/* allocate ieee802154_hw and private data */
|
|
hw = ieee802154_alloc_hw(sizeof(struct ca8210_priv), &ca8210_phy_ops);
|
|
if (!hw) {
|
|
dev_crit(&spi_device->dev, "ieee802154_alloc_hw failed\n");
|
|
ret = -ENOMEM;
|
|
goto error;
|
|
}
|
|
|
|
priv = hw->priv;
|
|
priv->hw = hw;
|
|
priv->spi = spi_device;
|
|
hw->parent = &spi_device->dev;
|
|
spin_lock_init(&priv->lock);
|
|
priv->async_tx_pending = false;
|
|
priv->hw_registered = false;
|
|
priv->sync_up = 0;
|
|
priv->sync_down = 0;
|
|
priv->promiscuous = false;
|
|
priv->retries = 0;
|
|
init_completion(&priv->ca8210_is_awake);
|
|
init_completion(&priv->spi_transfer_complete);
|
|
init_completion(&priv->sync_exchange_complete);
|
|
spi_set_drvdata(priv->spi, priv);
|
|
if (IS_ENABLED(CONFIG_IEEE802154_CA8210_DEBUGFS)) {
|
|
cascoda_api_upstream = ca8210_test_int_driver_write;
|
|
ca8210_test_interface_init(priv);
|
|
} else {
|
|
cascoda_api_upstream = NULL;
|
|
}
|
|
ca8210_hw_setup(hw);
|
|
ieee802154_random_extended_addr(&hw->phy->perm_extended_addr);
|
|
|
|
pdata = kmalloc(sizeof(*pdata), GFP_KERNEL);
|
|
if (!pdata) {
|
|
ret = -ENOMEM;
|
|
goto error;
|
|
}
|
|
|
|
ret = ca8210_get_platform_data(priv->spi, pdata);
|
|
if (ret) {
|
|
dev_crit(&spi_device->dev, "ca8210_get_platform_data failed\n");
|
|
goto error;
|
|
}
|
|
priv->spi->dev.platform_data = pdata;
|
|
|
|
ret = ca8210_dev_com_init(priv);
|
|
if (ret) {
|
|
dev_crit(&spi_device->dev, "ca8210_dev_com_init failed\n");
|
|
goto error;
|
|
}
|
|
ret = ca8210_reset_init(priv->spi);
|
|
if (ret) {
|
|
dev_crit(&spi_device->dev, "ca8210_reset_init failed\n");
|
|
goto error;
|
|
}
|
|
|
|
ret = ca8210_interrupt_init(priv->spi);
|
|
if (ret) {
|
|
dev_crit(&spi_device->dev, "ca8210_interrupt_init failed\n");
|
|
goto error;
|
|
}
|
|
|
|
msleep(100);
|
|
|
|
ca8210_reset_send(priv->spi, 1);
|
|
|
|
ret = tdme_chipinit(priv->spi);
|
|
if (ret) {
|
|
dev_crit(&spi_device->dev, "tdme_chipinit failed\n");
|
|
goto error;
|
|
}
|
|
|
|
if (pdata->extclockenable) {
|
|
ret = ca8210_config_extern_clk(pdata, priv->spi, 1);
|
|
if (ret) {
|
|
dev_crit(
|
|
&spi_device->dev,
|
|
"ca8210_config_extern_clk failed\n"
|
|
);
|
|
goto error;
|
|
}
|
|
ret = ca8210_register_ext_clock(priv->spi);
|
|
if (ret) {
|
|
dev_crit(
|
|
&spi_device->dev,
|
|
"ca8210_register_ext_clock failed\n"
|
|
);
|
|
goto error;
|
|
}
|
|
}
|
|
|
|
ret = ieee802154_register_hw(hw);
|
|
if (ret) {
|
|
dev_crit(&spi_device->dev, "ieee802154_register_hw failed\n");
|
|
goto error;
|
|
}
|
|
priv->hw_registered = true;
|
|
|
|
return 0;
|
|
error:
|
|
msleep(100); /* wait for pending spi transfers to complete */
|
|
ca8210_remove(spi_device);
|
|
return link_to_linux_err(ret);
|
|
}
|
|
|
|
static const struct of_device_id ca8210_of_ids[] = {
|
|
{.compatible = "cascoda,ca8210", },
|
|
{},
|
|
};
|
|
MODULE_DEVICE_TABLE(of, ca8210_of_ids);
|
|
|
|
static struct spi_driver ca8210_spi_driver = {
|
|
.driver = {
|
|
.name = DRIVER_NAME,
|
|
.owner = THIS_MODULE,
|
|
.of_match_table = of_match_ptr(ca8210_of_ids),
|
|
},
|
|
.probe = ca8210_probe,
|
|
.remove = ca8210_remove
|
|
};
|
|
|
|
module_spi_driver(ca8210_spi_driver);
|
|
|
|
MODULE_AUTHOR("Harry Morris <h.morris@cascoda.com>");
|
|
MODULE_DESCRIPTION("CA-8210 SoftMAC driver");
|
|
MODULE_LICENSE("Dual BSD/GPL");
|
|
MODULE_VERSION("1.0");
|