nes-proj/arch/cpu/cc13xx-cc26xx/dev/rf-prop-mode.c

725 lines
22 KiB
C
Raw Normal View History

2018-02-08 10:45:47 +00:00
/*
2018-02-15 11:48:02 +00:00
* Copyright (c) 2018, Texas Instruments Incorporated - http://www.ti.com/
2018-02-08 10:45:47 +00:00
* All rights reserved.
*
* 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 HOLDER 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.
*/
/*---------------------------------------------------------------------------*/
/**
* \addtogroup rf-core-prop
* @{
*
* \file
* Implementation of the CC13xx prop mode NETSTACK_RADIO driver
*/
/*---------------------------------------------------------------------------*/
#include "contiki.h"
#include "net/packetbuf.h"
#include "net/netstack.h"
#include "sys/energest.h"
#include "sys/clock.h"
#include "sys/rtimer.h"
#include "sys/cc.h"
2018-02-09 11:50:55 +00:00
#include "dev/watchdog.h"
2018-02-08 10:45:47 +00:00
/*---------------------------------------------------------------------------*/
/* RF Core Mailbox API */
#include <ti/devices/DeviceFamily.h>
#include DeviceFamily_constructPath(driverlib/rf_mailbox.h)
#include DeviceFamily_constructPath(driverlib/rf_common_cmd.h)
#include DeviceFamily_constructPath(driverlib/rf_data_entry.h)
#include DeviceFamily_constructPath(driverlib/rf_prop_cmd.h)
#include DeviceFamily_constructPath(driverlib/rf_prop_mailbox.h)
2018-02-08 10:45:47 +00:00
#include <ti/drivers/rf/RF.h>
2018-02-15 11:48:02 +00:00
/*---------------------------------------------------------------------------*/
/* Platform RF dev */
#include "dot-15-4g.h"
2018-07-09 18:13:01 +00:00
#include "rf-core.h"
2018-07-12 08:44:14 +00:00
#include "rf-data-queue.h"
2018-07-09 18:13:01 +00:00
#include "netstack-settings.h"
2018-07-13 12:34:08 +00:00
#include RF_CORE_PROP_RF_SETTINGS
2018-02-08 10:45:47 +00:00
/*---------------------------------------------------------------------------*/
#include <stdint.h>
#include <string.h>
#include <stdio.h>
#include <stdbool.h>
2018-02-09 11:50:55 +00:00
#include <assert.h>
2018-02-08 10:45:47 +00:00
/*---------------------------------------------------------------------------*/
2018-07-12 08:44:14 +00:00
/* Log configuration */
#include "sys/log.h"
#define LOG_MODULE "RF Prop Mode"
#define LOG_LEVEL LOG_LEVEL_NONE
/*---------------------------------------------------------------------------*/
#ifdef NDEBUG
2018-06-15 14:37:51 +00:00
# define PRINTF(...)
2018-02-08 10:45:47 +00:00
#else
2018-06-15 14:37:51 +00:00
# define PRINTF(...) printf(__VA_ARGS__)
#endif
/*---------------------------------------------------------------------------*/
/* Configuration for default Prop channel */
#ifdef PROP_MODE_CONF_CHANNEL
# define PROP_MODE_CHANNEL PROP_MODE_CONF_CHANNEL
#else
# define PROP_MODE_CHANNEL RF_CHANNEL
2018-02-08 10:45:47 +00:00
#endif
/*---------------------------------------------------------------------------*/
/* Data whitener. 1: Whitener, 0: No whitener */
#ifdef PROP_MODE_CONF_DW
2018-06-15 14:37:51 +00:00
# define PROP_MODE_DW PROP_MODE_CONF_DW
2018-02-08 10:45:47 +00:00
#else
2018-06-15 14:37:51 +00:00
# define PROP_MODE_DW 0
2018-02-08 10:45:47 +00:00
#endif
#ifdef PROP_MODE_CONF_USE_CRC16
2018-06-15 14:37:51 +00:00
# define PROP_MODE_USE_CRC16 PROP_MODE_CONF_USE_CRC16
2018-02-08 10:45:47 +00:00
#else
2018-06-15 14:37:51 +00:00
# define PROP_MODE_USE_CRC16 0
2018-02-08 10:45:47 +00:00
#endif
/*---------------------------------------------------------------------------*/
2018-06-19 12:55:18 +00:00
/* Used for checking result of CCA_REQ command */
#define CCA_STATE_IDLE 0
#define CCA_STATE_BUSY 1
#define CCA_STATE_INVALID 2
2018-02-08 10:45:47 +00:00
/* Used as an error return value for get_cca_info */
#define RF_GET_CCA_INFO_ERROR 0xFF
#ifdef PROP_MODE_CONF_RSSI_THRESHOLD
2018-06-15 14:37:51 +00:00
# define PROP_MODE_RSSI_THRESHOLD PROP_MODE_CONF_RSSI_THRESHOLD
2018-02-08 10:45:47 +00:00
#else
2018-06-15 14:37:51 +00:00
# define PROP_MODE_RSSI_THRESHOLD 0xA6
2018-02-08 10:45:47 +00:00
#endif
/*---------------------------------------------------------------------------*/
/* Defines and variables related to the .15.4g PHY HDR */
#define DOT_4G_MAX_FRAME_LEN 2047
#define DOT_4G_PHR_LEN 2
/* PHY HDR bits */
#define DOT_4G_PHR_CRC16 0x10
#define DOT_4G_PHR_DW 0x08
#if PROP_MODE_USE_CRC16
/* CRC16 */
2018-06-15 14:37:51 +00:00
# define DOT_4G_PHR_CRC_BIT DOT_4G_PHR_CRC16
# define CRC_LEN 2
2018-02-08 10:45:47 +00:00
#else
/* CRC32 */
2018-06-15 14:37:51 +00:00
# define DOT_4G_PHR_CRC_BIT 0
# define CRC_LEN 4
#endif /* PROP_MODE_USE_CRC16 */
2018-02-08 10:45:47 +00:00
#if PROP_MODE_DW
2018-06-15 14:37:51 +00:00
# define DOT_4G_PHR_DW_BIT DOT_4G_PHR_DW
2018-02-08 10:45:47 +00:00
#else
2018-06-15 14:37:51 +00:00
#define DOT_4G_PHR_DW_BIT 0
2018-02-08 10:45:47 +00:00
#endif
/*---------------------------------------------------------------------------*/
/* How long to wait for the RF to enter RX in rf_cmd_ieee_rx */
2018-07-09 18:13:01 +00:00
#define TIMEOUT_ENTER_RX_WAIT (RTIMER_SECOND >> 10)
/* How long to wait for the rx read entry to become ready */
#define TIMEOUT_DATA_ENTRY_BUSY (RTIMER_SECOND / 250)
2018-02-08 10:45:47 +00:00
/*---------------------------------------------------------------------------*/
/* Configuration for TX power table */
#ifdef PROP_MODE_CONF_TX_POWER_TABLE
2018-06-15 14:37:51 +00:00
# define TX_POWER_TABLE PROP_MODE_CONF_TX_POWER_TABLE
2018-02-08 10:45:47 +00:00
#else
# define TX_POWER_TABLE rf_prop_tx_power_table
2018-02-08 10:45:47 +00:00
#endif
/*---------------------------------------------------------------------------*/
/* TX power table convenience macros */
2018-06-19 12:55:18 +00:00
#define TX_POWER_TABLE_SIZE ((sizeof(TX_POWER_TABLE) / sizeof(TX_POWER_TABLE[0])) - 1)
2018-02-08 10:45:47 +00:00
2018-06-19 12:55:18 +00:00
#define TX_POWER_MIN (TX_POWER_TABLE[0].power)
#define TX_POWER_MAX (TX_POWER_TABLE[TX_POWER_TABLE_SIZE - 1].power)
2018-02-08 10:45:47 +00:00
2018-06-19 12:55:18 +00:00
#define TX_POWER_IN_RANGE(dbm) ((TX_POWER_MIN <= (dbm)) && ((dbm) <= TX_POWER_MAX))
2018-02-08 10:45:47 +00:00
/*---------------------------------------------------------------------------*/
2018-06-15 14:37:51 +00:00
/* TX buf configuration */
#define TX_BUF_HDR_LEN 2
#define TX_BUF_PAYLOAD_LEN 180
#define TX_BUF_SIZE (TX_BUF_HDR_LEN + TX_BUF_PAYLOAD_LEN)
2018-02-08 10:45:47 +00:00
/*---------------------------------------------------------------------------*/
2018-06-19 12:55:18 +00:00
/* Size of the Length field in Data Entry, two bytes in this case */
typedef uint16_t lensz_t;
2018-06-19 12:55:18 +00:00
#define FRAME_OFFSET sizeof(lensz_t)
#define FRAME_SHAVE 2 /* RSSI (1) + Status (1) */
2018-06-15 14:37:51 +00:00
/*---------------------------------------------------------------------------*/
#define MAC_RADIO_RECEIVER_SENSITIVITY_DBM -110
#define MAC_RADIO_RECEIVER_SATURATION_DBM 10
#define MAC_SPEC_ED_MIN_DBM_ABOVE_RECEIVER_SENSITIVITY 10
#define MAC_SPEC_ED_MAX 0xFF
2018-02-08 10:45:47 +00:00
2018-06-15 14:37:51 +00:00
#define ED_RF_POWER_MIN_DBM (MAC_RADIO_RECEIVER_SENSITIVITY_DBM + MAC_SPEC_ED_MIN_DBM_ABOVE_RECEIVER_SENSITIVITY)
#define ED_RF_POWER_MAX_DBM MAC_RADIO_RECEIVER_SATURATION_DBM
/*---------------------------------------------------------------------------*/
2018-06-19 12:55:18 +00:00
/* RF Core typedefs */
typedef rfc_propRxOutput_t rx_output_t;
2018-06-15 14:37:51 +00:00
typedef struct {
/* Outgoing frame buffer */
uint8_t tx_buf[TX_BUF_SIZE] CC_ALIGN(4);
2018-02-08 10:45:47 +00:00
2018-06-15 14:37:51 +00:00
/* RX Statistics struct */
2018-06-19 12:55:18 +00:00
rx_output_t rx_stats;
2018-02-08 10:45:47 +00:00
2018-06-15 14:37:51 +00:00
/* RSSI Threshold */
int8_t rssi_threshold;
2018-07-09 18:13:01 +00:00
uint16_t channel;
2018-06-15 14:37:51 +00:00
/* Indicates RF is supposed to be on or off */
uint8_t rf_is_on;
2018-02-08 10:45:47 +00:00
2018-06-15 14:37:51 +00:00
/* RF driver */
RF_Handle rf_handle;
} prop_radio_t;
static prop_radio_t prop_radio;
2018-02-08 10:45:47 +00:00
/*---------------------------------------------------------------------------*/
2018-06-15 14:37:51 +00:00
#define cmd_radio_setup (*(volatile rfc_CMD_PROP_RADIO_DIV_SETUP_t *)&rf_cmd_prop_radio_div_setup)
#define cmd_fs (*(volatile rfc_CMD_FS_t *) &rf_cmd_prop_fs)
#define cmd_tx (*(volatile rfc_CMD_PROP_TX_ADV_t *) &rf_cmd_prop_tx_adv)
#define cmd_rx (*(volatile rfc_CMD_PROP_RX_ADV_t *) &rf_cmd_prop_rx_adv)
/*---------------------------------------------------------------------------*/
2018-07-09 18:13:01 +00:00
static inline bool tx_is_active(void) { return cmd_tx.status == ACTIVE; }
static inline bool rx_is_active(void) { return cmd_rx.status == ACTIVE; }
2018-02-09 08:13:12 +00:00
/*---------------------------------------------------------------------------*/
2018-06-15 14:37:51 +00:00
static int on(void);
static int off(void);
2018-02-09 11:50:55 +00:00
/*---------------------------------------------------------------------------*/
static void
2018-07-09 18:13:01 +00:00
init_rf_params(void)
2018-02-09 11:50:55 +00:00
{
2018-07-12 08:44:14 +00:00
data_queue_t *data_queue = data_queue_init(sizeof(lensz_t));
2018-07-09 18:13:01 +00:00
cmd_rx.maxPktLen = DOT_4G_MAX_FRAME_LEN - cmd_rx.lenOffset;
2018-07-12 08:44:14 +00:00
cmd_rx.pQueue = data_queue;
2018-07-09 18:13:01 +00:00
cmd_rx.pOutput = (uint8_t *)&prop_radio.rx_stats;
2018-02-09 11:50:55 +00:00
}
/*---------------------------------------------------------------------------*/
2018-07-09 18:13:01 +00:00
static int8_t
2018-02-08 10:45:47 +00:00
get_rssi(void)
{
2018-07-09 18:13:01 +00:00
rf_result_t res;
const bool rx_is_idle = !rx_is_active();
2018-02-09 08:13:12 +00:00
2018-07-09 18:13:01 +00:00
if (rx_is_idle) {
2018-07-12 08:44:14 +00:00
res = netstack_sched_rx();
2018-07-09 18:13:01 +00:00
if (res != RF_RESULT_OK) {
return RF_GET_RSSI_ERROR_VAL;
}
2018-06-15 14:37:51 +00:00
}
2018-02-09 08:13:12 +00:00
2018-07-09 18:13:01 +00:00
const rtimer_clock_t t0 = RTIMER_NOW();
while ((cmd_rx.status != ACTIVE) &&
RTIMER_CLOCK_LT(RTIMER_NOW(), t0 + TIMEOUT_ENTER_RX_WAIT));
2018-06-15 14:37:51 +00:00
int8_t rssi = RF_GET_RSSI_ERROR_VAL;
2018-07-09 18:13:01 +00:00
if (rx_is_active()) {
2018-06-15 14:37:51 +00:00
rssi = RF_getRssi(prop_radio.rf_handle);
}
2018-02-09 08:13:12 +00:00
2018-07-09 18:13:01 +00:00
if (rx_is_idle) {
netstack_stop_rx();
2018-06-15 14:37:51 +00:00
}
2018-02-09 08:13:12 +00:00
2018-06-15 14:37:51 +00:00
return rssi;
2018-02-08 10:45:47 +00:00
}
/*---------------------------------------------------------------------------*/
static uint8_t
get_channel(void)
{
2018-06-15 14:37:51 +00:00
uint32_t freq_khz = cmd_fs.frequency * 1000;
2018-02-09 08:13:12 +00:00
/*
* For some channels, fractFreq * 1000 / 65536 will return 324.99xx.
* Casting the result to uint32_t will truncate decimals resulting in the
* function returning channel - 1 instead of channel. Thus, we do a quick
* positive integer round up.
*/
2018-06-15 14:37:51 +00:00
freq_khz += (((cmd_fs.fractFreq * 1000) + 65535) / 65536);
2018-02-09 08:13:12 +00:00
2018-07-13 12:34:08 +00:00
return (uint8_t)((freq_khz - DOT_15_4G_CHAN0_FREQ) / DOT_15_4G_FREQ_SPACING);
2018-02-08 10:45:47 +00:00
}
/*---------------------------------------------------------------------------*/
2018-07-09 18:13:01 +00:00
static rf_result_t
set_channel(uint16_t channel)
2018-02-08 10:45:47 +00:00
{
2018-07-09 18:13:01 +00:00
rf_result_t res;
2018-02-08 10:45:47 +00:00
2018-07-13 12:34:08 +00:00
if (!DOT_15_4_G_CHAN_IN_RANGE(channel)) {
2018-07-09 18:13:01 +00:00
PRINTF("set_channel: illegal channel %d, defaults to %d\n",
2018-07-13 12:34:08 +00:00
(int)channel, DOT_15_4G_CHAN_MAX);
channel = DOT_15_4G_CHAN_MAX;
2018-06-15 14:37:51 +00:00
}
2018-07-09 18:13:01 +00:00
if (channel == prop_radio.channel) {
/* We are already calibrated to this channel */
return RF_RESULT_OK;
2018-06-15 14:37:51 +00:00
}
2018-02-09 08:13:12 +00:00
2018-07-13 12:34:08 +00:00
const uint32_t new_freq = DOT_15_4_G_FREQ(channel);
2018-07-09 18:13:01 +00:00
const uint16_t freq = (uint16_t)(new_freq / 1000);
const uint16_t frac = (uint16_t)(((new_freq - (freq * 1000)) * 0x10000) / 1000);
2018-06-19 12:55:18 +00:00
2018-07-09 18:13:01 +00:00
PRINTF("set_channel: %u = 0x%04x.0x%04x (%lu)\n",
(int)channel, freq, frac, new_freq);
2018-02-08 10:45:47 +00:00
2018-07-09 18:13:01 +00:00
cmd_fs.frequency = freq;
cmd_fs.fractFreq = frac;
res = netstack_sched_fs();
if (res != RF_RESULT_OK) {
return res;
}
prop_radio.channel = channel;
return RF_RESULT_OK;
2018-06-19 12:55:18 +00:00
}
/*---------------------------------------------------------------------------*/
2018-06-15 14:37:51 +00:00
static uint8_t
calculate_lqi(int8_t rssi)
{
/* Note : Currently the LQI value is simply the energy detect measurement.
* A more accurate value could be derived by using the correlation
* value along with the RSSI value. */
rssi = CLAMP(rssi, ED_RF_POWER_MIN_DBM, ED_RF_POWER_MAX_DBM);
/* Create energy detect measurement by normalizing and scaling RF power level.
* Note : The division operation below is designed for maximum accuracy and
* best granularity. This is done by grouping the math operations to
* compute the entire numerator before doing any division. */
return (MAC_SPEC_ED_MAX * (rssi - ED_RF_POWER_MIN_DBM)) / (ED_RF_POWER_MAX_DBM - ED_RF_POWER_MIN_DBM);
}
/*---------------------------------------------------------------------------*/
2018-02-08 10:45:47 +00:00
static int
prepare(const void *payload, unsigned short payload_len)
{
2018-07-09 18:13:01 +00:00
const size_t len = MIN((size_t)payload_len,
(size_t)TX_BUF_PAYLOAD_LEN);
2018-02-08 10:45:47 +00:00
2018-06-15 14:37:51 +00:00
memcpy(prop_radio.tx_buf + TX_BUF_HDR_LEN, payload, len);
return 0;
2018-02-08 10:45:47 +00:00
}
/*---------------------------------------------------------------------------*/
static int
transmit(unsigned short transmit_len)
{
2018-07-09 18:13:01 +00:00
rf_result_t res;
2018-06-15 14:37:51 +00:00
2018-07-09 18:13:01 +00:00
if (tx_is_active()) {
2018-06-15 14:37:51 +00:00
PRINTF("transmit: not allowed while transmitting\n");
return RADIO_TX_ERR;
}
2018-06-15 14:37:51 +00:00
/* Length in .15.4g PHY HDR. Includes the CRC but not the HDR itself */
2018-07-09 18:13:01 +00:00
const uint16_t total_length = transmit_len + CRC_LEN;
/*
* Prepare the .15.4g PHY header
* MS=0, Length MSBits=0, DW and CRC configurable
* Total length = transmit_len (payload) + CRC length
*
* The Radio will flip the bits around, so tx_buf[0] must have the length
2018-07-09 18:13:01 +00:00
* LSBs (PHR[15:8] and tx_buf[1] will have PHR[7:0]
*/
2018-07-12 08:44:14 +00:00
prop_radio.tx_buf[0] = ((total_length >> 0) & 0xFF);
prop_radio.tx_buf[1] = ((total_length >> 8) & 0xFF) + DOT_4G_PHR_DW_BIT + DOT_4G_PHR_CRC_BIT;
2018-02-09 11:50:55 +00:00
/* pktLen: Total number of bytes in the TX buffer, including the header if
* one exists, but not including the CRC (which is not present in the buffer) */
2018-06-15 14:37:51 +00:00
cmd_tx.pktLen = transmit_len + DOT_4G_PHR_LEN;
cmd_tx.pPkt = prop_radio.tx_buf;
2018-07-12 08:44:14 +00:00
res = netstack_sched_prop_tx();
2018-02-08 10:45:47 +00:00
2018-07-09 18:13:01 +00:00
return (res == RF_RESULT_OK)
? RADIO_TX_OK
: RADIO_TX_ERR;
2018-02-08 10:45:47 +00:00
}
/*---------------------------------------------------------------------------*/
static int
send(const void *payload, unsigned short payload_len)
{
2018-06-15 14:37:51 +00:00
prepare(payload, payload_len);
return transmit(payload_len);
2018-02-08 10:45:47 +00:00
}
/*---------------------------------------------------------------------------*/
static int
2018-06-15 14:37:51 +00:00
read(void *buf, unsigned short buf_len)
2018-02-08 10:45:47 +00:00
{
2018-07-12 08:44:14 +00:00
volatile data_entry_t *data_entry = data_queue_current_entry();
2018-02-08 10:45:47 +00:00
const rtimer_clock_t t0 = RTIMER_NOW();
2018-07-12 08:44:14 +00:00
/* Only wait if the Radio is accessing the entry */
while ((data_entry->status == DATA_ENTRY_BUSY) &&
RTIMER_CLOCK_LT(RTIMER_NOW(), t0 + TIMEOUT_DATA_ENTRY_BUSY));
if (data_entry->status != DATA_ENTRY_FINISHED) {
2018-06-19 12:55:18 +00:00
/* No available data */
2018-06-15 14:37:51 +00:00
return 0;
}
2018-07-12 08:44:14 +00:00
/*
* First 2 bytes in the data entry are the length.
* Data frame is on the following format:
* Length (2) + Payload (N) + RSSI (1) + Status (1)
* Data frame DOES NOT contain the following:
* no Header/PHY bytes
* no appended Received CRC bytes
* no Timestamp bytes
* +---------+---------+--------+--------+
* | 2 bytes | N bytes | 1 byte | 1 byte |
* +---------+---------+--------+--------+
* | Length | Payload | RSSI | Status |
* +---------+---------+--------+--------+
* Length bytes equal total length of entire frame excluding itself,
2018-07-12 08:44:14 +00:00
* Length = N + RSSI (1) + Status (1)
* = N + 2
2018-07-12 08:44:14 +00:00
* N = Length - 2
*/
uint8_t *const frame_ptr = (uint8_t*)&data_entry->data;
const lensz_t frame_len = *(lensz_t*)frame_ptr;
/* Sanity check that Frame is at least Frame Shave bytes long */
if (frame_len < FRAME_SHAVE) {
PRINTF("read: frame too short len=%d\n", frame_len);
2018-07-12 08:44:14 +00:00
data_queue_release_entry();
return 0;
}
2018-06-15 14:37:51 +00:00
const uint8_t *payload_ptr = frame_ptr + sizeof(lensz_t);
const unsigned short payload_len = (unsigned short)(frame_len - FRAME_SHAVE);
2018-06-15 14:37:51 +00:00
/* Sanity check that Payload fits in Buffer */
if (payload_len > buf_len) {
PRINTF("read: payload too large for buffer len=%d buf_len=%d\n", payload_len, buf_len);
2018-07-12 08:44:14 +00:00
data_queue_release_entry();
return 0;
2018-06-15 14:37:51 +00:00
}
memcpy(buf, payload_ptr, payload_len);
2018-06-15 14:37:51 +00:00
/* RSSI stored after payload */
const int8_t rssi = (int8_t)payload_ptr[payload_len];
/* LQI calculated from RSSI */
const uint8_t lqi = calculate_lqi(rssi);
packetbuf_set_attr(PACKETBUF_ATTR_RSSI, (packetbuf_attr_t)rssi);
packetbuf_set_attr(PACKETBUF_ATTR_LINK_QUALITY, (packetbuf_attr_t)lqi);
2018-07-12 08:44:14 +00:00
data_queue_release_entry();
return (int)payload_len;
2018-02-08 10:45:47 +00:00
}
/*---------------------------------------------------------------------------*/
2018-07-09 18:13:01 +00:00
static uint8_t
cca_request(void)
2018-02-08 10:45:47 +00:00
{
2018-07-09 18:13:01 +00:00
const int8_t rssi = get_rssi();
2018-02-08 10:45:47 +00:00
2018-07-09 18:13:01 +00:00
if (rssi == RF_GET_RSSI_ERROR_VAL) {
return CCA_STATE_INVALID;
2018-06-15 14:37:51 +00:00
}
2018-02-08 10:45:47 +00:00
2018-07-09 18:13:01 +00:00
return (rssi < prop_radio.rssi_threshold)
? CCA_STATE_IDLE
: CCA_STATE_BUSY;
}
/*---------------------------------------------------------------------------*/
static int
channel_clear(void)
{
if (tx_is_active()) {
PRINTF("channel_clear: called while in TX\n");
return 0;
2018-06-15 14:37:51 +00:00
}
2018-02-08 10:45:47 +00:00
2018-07-09 18:13:01 +00:00
const uint8_t cca_state = cca_request();
2018-06-15 14:37:51 +00:00
2018-07-09 18:13:01 +00:00
/* Channel is clear if CCA state is IDLE */
return (cca_state == CCA_STATE_IDLE);
2018-02-08 10:45:47 +00:00
}
/*---------------------------------------------------------------------------*/
static int
receiving_packet(void)
{
2018-07-09 18:13:01 +00:00
if (!rx_is_active()) {
return 0;
2018-06-15 14:37:51 +00:00
}
2018-02-08 10:45:47 +00:00
2018-07-09 18:13:01 +00:00
const uint8_t cca_state = cca_request();
2018-02-08 10:45:47 +00:00
2018-07-09 18:13:01 +00:00
return (cca_state == CCA_STATE_BUSY);
2018-02-08 10:45:47 +00:00
}
/*---------------------------------------------------------------------------*/
static int
pending_packet(void)
{
2018-07-12 08:44:14 +00:00
const data_entry_t *const read_entry = data_queue_current_entry();
2018-06-19 12:55:18 +00:00
volatile const data_entry_t *curr_entry = read_entry;
2018-02-08 10:45:47 +00:00
2018-06-19 12:55:18 +00:00
int num_pending = 0;
2018-02-08 10:45:47 +00:00
2018-06-15 14:37:51 +00:00
/* Go through RX Circular buffer and check their status */
do {
2018-06-19 12:55:18 +00:00
const uint8_t status = curr_entry->status;
2018-06-15 14:37:51 +00:00
if ((status == DATA_ENTRY_FINISHED) ||
(status == DATA_ENTRY_BUSY)) {
2018-06-19 12:55:18 +00:00
num_pending += 1;
2018-06-15 14:37:51 +00:00
}
2018-06-19 12:55:18 +00:00
/* Stop when we have looped the circular buffer */
curr_entry = (data_entry_t *)curr_entry->pNextEntry;
} while (curr_entry != read_entry);
2018-06-15 14:37:51 +00:00
2018-06-19 12:55:18 +00:00
if (num_pending > 0) {
2018-07-09 18:13:01 +00:00
process_poll(&rf_core_process);
2018-06-15 14:37:51 +00:00
}
2018-02-08 10:45:47 +00:00
2018-06-15 14:37:51 +00:00
/* If we didn't find an entry at status finished, no frames are pending */
2018-06-19 12:55:18 +00:00
return num_pending;
2018-02-08 10:45:47 +00:00
}
/*---------------------------------------------------------------------------*/
static int
2018-06-15 14:37:51 +00:00
on(void)
2018-02-08 10:45:47 +00:00
{
2018-07-09 18:13:01 +00:00
rf_result_t res;
2018-06-15 14:37:51 +00:00
if (prop_radio.rf_is_on) {
PRINTF("on: Radio already on\n");
2018-07-09 18:13:01 +00:00
return RF_RESULT_OK;
2018-06-15 14:37:51 +00:00
}
2018-07-12 08:44:14 +00:00
data_queue_reset();
2018-06-15 14:37:51 +00:00
2018-07-12 08:44:14 +00:00
res = netstack_sched_rx();
2018-06-15 14:37:51 +00:00
2018-07-09 18:13:01 +00:00
if (res != RF_RESULT_OK) {
return RF_RESULT_ERROR;
2018-06-15 14:37:51 +00:00
}
prop_radio.rf_is_on = true;
2018-07-09 18:13:01 +00:00
return RF_RESULT_OK;
2018-02-08 10:45:47 +00:00
}
/*---------------------------------------------------------------------------*/
static int
2018-06-15 14:37:51 +00:00
off(void)
2018-02-08 10:45:47 +00:00
{
2018-06-15 14:37:51 +00:00
if (!prop_radio.rf_is_on) {
PRINTF("off: Radio already off\n");
2018-07-09 18:13:01 +00:00
return RF_RESULT_OK;
2018-06-15 14:37:51 +00:00
}
2018-02-08 10:45:47 +00:00
2018-07-09 18:13:01 +00:00
rf_yield();
2018-02-08 10:45:47 +00:00
2018-06-15 14:37:51 +00:00
prop_radio.rf_is_on = false;
2018-07-09 18:13:01 +00:00
return RF_RESULT_OK;
2018-02-08 10:45:47 +00:00
}
/*---------------------------------------------------------------------------*/
static radio_result_t
get_value(radio_param_t param, radio_value_t *value)
{
2018-07-09 18:13:01 +00:00
rf_result_t res;
if (!value) {
2018-02-08 10:45:47 +00:00
return RADIO_RESULT_INVALID_VALUE;
}
switch (param) {
2018-02-08 10:45:47 +00:00
case RADIO_PARAM_POWER_MODE:
/* On / off */
2018-06-15 14:37:51 +00:00
*value = (prop_radio.rf_is_on)
? RADIO_POWER_MODE_ON
: RADIO_POWER_MODE_OFF;
2018-02-08 10:45:47 +00:00
return RADIO_RESULT_OK;
2018-02-08 10:45:47 +00:00
case RADIO_PARAM_CHANNEL:
*value = (radio_value_t)get_channel();
return RADIO_RESULT_OK;
2018-02-08 10:45:47 +00:00
case RADIO_PARAM_TXPOWER:
2018-07-09 18:13:01 +00:00
res = rf_get_tx_power(prop_radio.rf_handle, TX_POWER_TABLE, (int8_t*)&value);
return ((res == RF_RESULT_OK) &&
(*value != RF_TxPowerTable_INVALID_DBM))
? RADIO_RESULT_OK
: RADIO_RESULT_ERROR;
2018-02-08 10:45:47 +00:00
case RADIO_PARAM_CCA_THRESHOLD:
2018-06-15 14:37:51 +00:00
*value = prop_radio.rssi_threshold;
2018-02-08 10:45:47 +00:00
return RADIO_RESULT_OK;
2018-02-08 10:45:47 +00:00
case RADIO_PARAM_RSSI:
*value = get_rssi();
2018-06-15 14:37:51 +00:00
return (*value == RF_GET_RSSI_ERROR_VAL)
? RADIO_RESULT_ERROR
: RADIO_RESULT_OK;
2018-02-08 10:45:47 +00:00
case RADIO_CONST_CHANNEL_MIN:
2018-07-13 12:34:08 +00:00
*value = DOT_15_4G_CHAN_MIN;
2018-02-08 10:45:47 +00:00
return RADIO_RESULT_OK;
2018-02-08 10:45:47 +00:00
case RADIO_CONST_CHANNEL_MAX:
2018-07-13 12:34:08 +00:00
*value = DOT_15_4G_CHAN_MAX;
2018-02-08 10:45:47 +00:00
return RADIO_RESULT_OK;
2018-02-08 10:45:47 +00:00
case RADIO_CONST_TXPOWER_MIN:
*value = (radio_value_t)TX_POWER_MIN;
2018-02-08 10:45:47 +00:00
return RADIO_RESULT_OK;
2018-02-08 10:45:47 +00:00
case RADIO_CONST_TXPOWER_MAX:
*value = (radio_value_t)TX_POWER_MAX;
2018-02-08 10:45:47 +00:00
return RADIO_RESULT_OK;
2018-02-08 10:45:47 +00:00
default:
return RADIO_RESULT_NOT_SUPPORTED;
}
}
/*---------------------------------------------------------------------------*/
static radio_result_t
set_value(radio_param_t param, radio_value_t value)
{
2018-07-09 18:13:01 +00:00
rf_result_t res;
2018-02-08 10:45:47 +00:00
switch(param) {
case RADIO_PARAM_POWER_MODE:
2018-07-09 18:13:01 +00:00
2018-02-08 10:45:47 +00:00
if(value == RADIO_POWER_MODE_ON) {
2018-07-09 18:13:01 +00:00
return (on() == RF_RESULT_OK)
? RADIO_RESULT_OK
: RADIO_RESULT_ERROR;
} else if(value == RADIO_POWER_MODE_OFF) {
2018-06-15 14:37:51 +00:00
off();
2018-02-08 10:45:47 +00:00
return RADIO_RESULT_OK;
}
2018-07-09 18:13:01 +00:00
2018-02-08 10:45:47 +00:00
return RADIO_RESULT_INVALID_VALUE;
2018-02-08 10:45:47 +00:00
case RADIO_PARAM_CHANNEL:
2018-07-09 18:13:01 +00:00
res = set_channel((uint16_t)value);
return (res == RF_RESULT_OK)
? RADIO_RESULT_OK
: RADIO_RESULT_ERROR;
2018-02-08 10:45:47 +00:00
case RADIO_PARAM_TXPOWER:
2018-07-09 18:13:01 +00:00
if (!TX_POWER_IN_RANGE((int8_t)value)) {
return RADIO_RESULT_INVALID_VALUE;
}
res = rf_set_tx_power(prop_radio.rf_handle, TX_POWER_TABLE, (int8_t)value);
return (res == RF_RESULT_OK)
? RADIO_RESULT_OK
: RADIO_RESULT_ERROR;
2018-02-08 10:45:47 +00:00
case RADIO_PARAM_RX_MODE:
return RADIO_RESULT_OK;
2018-02-08 10:45:47 +00:00
case RADIO_PARAM_CCA_THRESHOLD:
2018-06-15 14:37:51 +00:00
prop_radio.rssi_threshold = (int8_t)value;
2018-02-09 11:50:55 +00:00
return RADIO_RESULT_OK;
2018-02-08 10:45:47 +00:00
default:
return RADIO_RESULT_NOT_SUPPORTED;
}
}
/*---------------------------------------------------------------------------*/
static radio_result_t
get_object(radio_param_t param, void *dest, size_t size)
{
return RADIO_RESULT_NOT_SUPPORTED;
2018-02-08 10:45:47 +00:00
}
/*---------------------------------------------------------------------------*/
static radio_result_t
set_object(radio_param_t param, const void *src, size_t size)
{
return RADIO_RESULT_NOT_SUPPORTED;
2018-02-08 10:45:47 +00:00
}
/*---------------------------------------------------------------------------*/
2018-02-09 11:50:55 +00:00
static int
2018-06-15 14:37:51 +00:00
init(void)
2018-02-09 11:50:55 +00:00
{
2018-06-19 12:55:18 +00:00
if (prop_radio.rf_handle) {
PRINTF("init: Radio already initialized\n");
2018-07-09 18:13:01 +00:00
return RF_RESULT_OK;
2018-06-19 12:55:18 +00:00
}
2018-07-09 18:13:01 +00:00
/* RX is off */
prop_radio.rf_is_on = false;
2018-06-15 14:37:51 +00:00
/* Set configured RSSI threshold */
prop_radio.rssi_threshold = PROP_MODE_RSSI_THRESHOLD;
2018-07-09 18:13:01 +00:00
init_rf_params();
2018-06-15 14:37:51 +00:00
/* Init RF params and specify non-default params */
RF_Params rf_params;
RF_Params_init(&rf_params);
2018-06-19 12:55:18 +00:00
rf_params.nInactivityTimeout = 2000; /* 2 ms */
2018-06-15 14:37:51 +00:00
/* Open RF Driver */
2018-07-09 18:13:01 +00:00
prop_radio.rf_handle = netstack_open(&rf_params);
2018-06-15 14:37:51 +00:00
if (prop_radio.rf_handle == NULL) {
2018-06-19 12:55:18 +00:00
PRINTF("init: unable to open RF driver\n");
2018-07-09 18:13:01 +00:00
return RF_RESULT_ERROR;
2018-06-15 14:37:51 +00:00
}
2018-02-09 11:50:55 +00:00
2018-06-15 14:37:51 +00:00
set_channel(PROP_MODE_CHANNEL);
2018-02-09 11:50:55 +00:00
2018-06-15 14:37:51 +00:00
ENERGEST_ON(ENERGEST_TYPE_LISTEN);
2018-02-09 11:50:55 +00:00
2018-06-15 14:37:51 +00:00
/* Start RF process */
2018-07-09 18:13:01 +00:00
process_start(&rf_core_process, NULL);
2018-02-09 11:50:55 +00:00
2018-07-09 18:13:01 +00:00
return RF_RESULT_OK;
2018-02-09 11:50:55 +00:00
}
/*---------------------------------------------------------------------------*/
2018-02-08 10:45:47 +00:00
const struct radio_driver prop_mode_driver = {
2018-06-15 14:37:51 +00:00
init,
2018-02-08 10:45:47 +00:00
prepare,
transmit,
send,
2018-06-15 14:37:51 +00:00
read,
2018-02-08 10:45:47 +00:00
channel_clear,
receiving_packet,
pending_packet,
2018-06-15 14:37:51 +00:00
on,
off,
2018-02-08 10:45:47 +00:00
get_value,
set_value,
get_object,
set_object,
};
/*---------------------------------------------------------------------------*/
/**
* @}
*/