2017-02-06 12:42:34 +01:00
|
|
|
/* ieee802154_nrf5.c - nRF5 802.15.4 driver */
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Copyright (c) 2017 Nordic Semiconductor ASA
|
|
|
|
*
|
|
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
|
|
*/
|
|
|
|
|
2018-09-03 17:28:47 +03:00
|
|
|
#define LOG_MODULE_NAME ieee802154_nrf5
|
2019-05-10 18:00:03 -03:00
|
|
|
#if defined(CONFIG_IEEE802154_DRIVER_LOG_LEVEL)
|
2018-11-09 16:30:56 +02:00
|
|
|
#define LOG_LEVEL CONFIG_IEEE802154_DRIVER_LOG_LEVEL
|
2019-05-10 18:00:03 -03:00
|
|
|
#else
|
|
|
|
#define LOG_LEVEL LOG_LEVEL_NONE
|
|
|
|
#endif
|
2018-09-03 17:28:47 +03:00
|
|
|
|
|
|
|
#include <logging/log.h>
|
|
|
|
LOG_MODULE_REGISTER(LOG_MODULE_NAME);
|
2017-02-06 12:42:34 +01:00
|
|
|
|
|
|
|
#include <errno.h>
|
|
|
|
|
|
|
|
#include <kernel.h>
|
|
|
|
#include <arch/cpu.h>
|
2020-03-19 18:32:37 +01:00
|
|
|
#include <debug/stack.h>
|
2017-02-06 12:42:34 +01:00
|
|
|
|
2018-10-31 12:44:45 -05:00
|
|
|
#include <soc.h>
|
2017-02-06 12:42:34 +01:00
|
|
|
#include <device.h>
|
|
|
|
#include <init.h>
|
2020-03-18 13:36:35 +02:00
|
|
|
#include <debug/stack.h>
|
2017-02-06 12:42:34 +01:00
|
|
|
#include <net/net_if.h>
|
2017-04-03 17:14:35 +02:00
|
|
|
#include <net/net_pkt.h>
|
2017-02-06 12:42:34 +01:00
|
|
|
|
2018-01-15 11:39:54 +01:00
|
|
|
#if defined(CONFIG_NET_L2_OPENTHREAD)
|
|
|
|
#include <net/openthread.h>
|
|
|
|
#endif
|
|
|
|
|
2019-06-26 10:33:41 -04:00
|
|
|
#include <sys/byteorder.h>
|
2017-02-06 12:42:34 +01:00
|
|
|
#include <string.h>
|
2017-10-13 15:45:02 -07:00
|
|
|
#include <random/rand32.h>
|
2017-02-06 12:42:34 +01:00
|
|
|
|
|
|
|
#include <net/ieee802154_radio.h>
|
|
|
|
|
|
|
|
#include "ieee802154_nrf5.h"
|
2019-01-17 14:12:27 +01:00
|
|
|
#include "nrf_802154.h"
|
2017-02-06 12:42:34 +01:00
|
|
|
|
2021-04-23 13:51:00 +02:00
|
|
|
#if defined(CONFIG_NRF_802154_SER_HOST)
|
2020-11-13 16:39:45 +01:00
|
|
|
#include "nrf_802154_serialization_error.h"
|
|
|
|
#endif
|
|
|
|
|
2017-02-06 12:42:34 +01:00
|
|
|
struct nrf5_802154_config {
|
2020-04-30 20:33:38 +02:00
|
|
|
void (*irq_config_func)(const struct device *dev);
|
2017-02-06 12:42:34 +01:00
|
|
|
};
|
|
|
|
|
|
|
|
static struct nrf5_802154_data nrf5_data;
|
|
|
|
|
2020-03-20 11:39:21 +01:00
|
|
|
#define ACK_REQUEST_BYTE 1
|
|
|
|
#define ACK_REQUEST_BIT (1 << 5)
|
|
|
|
#define FRAME_PENDING_BYTE 1
|
|
|
|
#define FRAME_PENDING_BIT (1 << 4)
|
2020-09-28 12:01:30 +02:00
|
|
|
#define TXTIME_OFFSET_US (5 * USEC_PER_MSEC)
|
2020-03-20 11:39:21 +01:00
|
|
|
|
2021-02-11 09:09:52 +01:00
|
|
|
#if defined(CONFIG_IEEE802154_NRF5_UICR_EUI64_ENABLE)
|
|
|
|
#if defined(CONFIG_SOC_NRF5340_CPUAPP)
|
|
|
|
#define EUI64_ADDR (NRF_UICR->OTP)
|
|
|
|
#else
|
|
|
|
#define EUI64_ADDR (NRF_UICR->CUSTOMER)
|
|
|
|
#endif /* CONFIG_SOC_NRF5340_CPUAPP */
|
|
|
|
#else
|
2020-11-13 16:39:45 +01:00
|
|
|
#if defined(CONFIG_SOC_NRF5340_CPUAPP) || defined(CONFIG_SOC_NRF5340_CPUNET)
|
|
|
|
#define EUI64_ADDR (NRF_FICR->INFO.DEVICEID)
|
|
|
|
#else
|
|
|
|
#define EUI64_ADDR (NRF_FICR->DEVICEID)
|
2021-02-11 09:09:52 +01:00
|
|
|
#endif /* CONFIG_SOC_NRF5340_CPUAPP || CONFIG_SOC_NRF5340_CPUNET */
|
|
|
|
#endif /* CONFIG_IEEE802154_NRF5_UICR_EUI64_ENABLE */
|
|
|
|
|
|
|
|
#if defined(CONFIG_IEEE802154_NRF5_UICR_EUI64_ENABLE)
|
|
|
|
#define EUI64_ADDR_HIGH CONFIG_IEEE802154_NRF5_UICR_EUI64_REG
|
|
|
|
#define EUI64_ADDR_LOW (CONFIG_IEEE802154_NRF5_UICR_EUI64_REG + 1)
|
|
|
|
#else
|
|
|
|
#define EUI64_ADDR_HIGH 0
|
|
|
|
#define EUI64_ADDR_LOW 1
|
|
|
|
#endif /* CONFIG_IEEE802154_NRF5_UICR_EUI64_ENABLE */
|
2020-11-13 16:39:45 +01:00
|
|
|
|
2017-02-06 12:42:34 +01:00
|
|
|
/* Convenience defines for RADIO */
|
|
|
|
#define NRF5_802154_DATA(dev) \
|
2020-05-28 21:23:02 +02:00
|
|
|
((struct nrf5_802154_data * const)(dev)->data)
|
2017-02-06 12:42:34 +01:00
|
|
|
|
|
|
|
#define NRF5_802154_CFG(dev) \
|
2020-05-28 20:44:16 +02:00
|
|
|
((const struct nrf5_802154_config * const)(dev)->config)
|
2017-02-06 12:42:34 +01:00
|
|
|
|
2020-07-28 12:36:26 +02:00
|
|
|
#if CONFIG_IEEE802154_VENDOR_OUI_ENABLE
|
|
|
|
#define IEEE802154_NRF5_VENDOR_OUI CONFIG_IEEE802154_VENDOR_OUI
|
|
|
|
#else
|
|
|
|
#define IEEE802154_NRF5_VENDOR_OUI (uint32_t)0xF4CE36
|
|
|
|
#endif
|
|
|
|
|
2020-05-27 11:26:57 -05:00
|
|
|
static void nrf5_get_eui64(uint8_t *mac)
|
2017-02-06 12:42:34 +01:00
|
|
|
{
|
2020-07-28 12:36:26 +02:00
|
|
|
uint64_t factoryAddress;
|
|
|
|
uint32_t index = 0;
|
|
|
|
|
2021-02-11 09:09:52 +01:00
|
|
|
#if !defined(CONFIG_IEEE802154_NRF5_UICR_EUI64_ENABLE)
|
2020-07-28 12:36:26 +02:00
|
|
|
/* Set the MAC Address Block Larger (MA-L) formerly called OUI. */
|
|
|
|
mac[index++] = (IEEE802154_NRF5_VENDOR_OUI >> 16) & 0xff;
|
|
|
|
mac[index++] = (IEEE802154_NRF5_VENDOR_OUI >> 8) & 0xff;
|
|
|
|
mac[index++] = IEEE802154_NRF5_VENDOR_OUI & 0xff;
|
2021-02-11 09:09:52 +01:00
|
|
|
#endif
|
2020-07-28 12:36:26 +02:00
|
|
|
|
2020-11-16 10:50:44 +01:00
|
|
|
#if defined(CONFIG_SOC_NRF5340_CPUAPP) && \
|
|
|
|
defined(CONFIG_TRUSTED_EXECUTION_NONSECURE)
|
|
|
|
#error Accessing EUI64 on the non-secure mode is not supported at the moment
|
|
|
|
#else
|
2020-07-28 12:36:26 +02:00
|
|
|
/* Use device identifier assigned during the production. */
|
2021-02-11 09:09:52 +01:00
|
|
|
factoryAddress = (uint64_t)EUI64_ADDR[EUI64_ADDR_HIGH] << 32;
|
|
|
|
factoryAddress |= EUI64_ADDR[EUI64_ADDR_LOW];
|
2020-11-16 10:50:44 +01:00
|
|
|
#endif
|
2020-07-28 12:36:26 +02:00
|
|
|
memcpy(mac + index, &factoryAddress, sizeof(factoryAddress) - index);
|
2017-02-06 12:42:34 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
static void nrf5_rx_thread(void *arg1, void *arg2, void *arg3)
|
|
|
|
{
|
2020-07-08 11:31:38 +02:00
|
|
|
struct nrf5_802154_data *nrf5_radio = (struct nrf5_802154_data *)arg1;
|
2017-04-05 08:37:44 +02:00
|
|
|
struct net_pkt *pkt;
|
2019-01-17 14:12:27 +01:00
|
|
|
struct nrf5_802154_rx_frame *rx_frame;
|
2020-05-27 11:26:57 -05:00
|
|
|
uint8_t pkt_len;
|
2017-02-06 12:42:34 +01:00
|
|
|
|
|
|
|
ARG_UNUSED(arg2);
|
|
|
|
ARG_UNUSED(arg3);
|
|
|
|
|
|
|
|
while (1) {
|
2017-04-05 08:37:44 +02:00
|
|
|
pkt = NULL;
|
2019-01-17 14:12:27 +01:00
|
|
|
rx_frame = NULL;
|
2017-02-06 12:42:34 +01:00
|
|
|
|
2018-09-03 17:28:47 +03:00
|
|
|
LOG_DBG("Waiting for frame");
|
2019-01-17 14:12:27 +01:00
|
|
|
|
|
|
|
rx_frame = k_fifo_get(&nrf5_radio->rx_fifo, K_FOREVER);
|
|
|
|
|
|
|
|
__ASSERT_NO_MSG(rx_frame->psdu);
|
2017-02-06 12:42:34 +01:00
|
|
|
|
2017-02-22 11:25:39 +01:00
|
|
|
/* rx_mpdu contains length, psdu, fcs|lqi
|
|
|
|
* The last 2 bytes contain LQI or FCS, depending if
|
|
|
|
* automatic CRC handling is enabled or not, respectively.
|
2017-02-06 12:42:34 +01:00
|
|
|
*/
|
2018-01-15 11:39:54 +01:00
|
|
|
if (IS_ENABLED(CONFIG_IEEE802154_RAW_MODE) ||
|
|
|
|
IS_ENABLED(CONFIG_NET_L2_OPENTHREAD)) {
|
2019-01-17 14:12:27 +01:00
|
|
|
pkt_len = rx_frame->psdu[0];
|
2017-11-16 11:11:51 +01:00
|
|
|
} else {
|
2019-01-17 14:12:27 +01:00
|
|
|
pkt_len = rx_frame->psdu[0] - NRF5_FCS_LENGTH;
|
2017-11-16 11:11:51 +01:00
|
|
|
}
|
2017-02-06 12:42:34 +01:00
|
|
|
|
2019-02-20 12:08:00 +01:00
|
|
|
__ASSERT_NO_MSG(pkt_len <= CONFIG_NET_BUF_DATA_SIZE);
|
|
|
|
|
|
|
|
LOG_DBG("Frame received");
|
|
|
|
|
2021-01-22 09:35:33 +01:00
|
|
|
/* Block the RX thread until net_pkt is available, so that we
|
|
|
|
* don't drop already ACKed frame in case of temporary net_pkt
|
|
|
|
* scarcity. The nRF 802154 radio driver will accumulate any
|
|
|
|
* incoming frames until it runs out of internal buffers (and
|
|
|
|
* thus stops acknowledging consecutive frames).
|
|
|
|
*/
|
2021-01-21 15:11:42 +01:00
|
|
|
pkt = net_pkt_rx_alloc_with_buffer(nrf5_radio->iface, pkt_len,
|
2021-01-22 09:35:33 +01:00
|
|
|
AF_UNSPEC, 0, K_FOREVER);
|
2019-01-17 14:12:27 +01:00
|
|
|
|
2019-02-20 10:01:57 +01:00
|
|
|
if (net_pkt_write(pkt, rx_frame->psdu + 1, pkt_len)) {
|
2019-02-20 12:08:00 +01:00
|
|
|
goto drop;
|
|
|
|
}
|
2017-02-06 12:42:34 +01:00
|
|
|
|
2019-01-17 14:12:27 +01:00
|
|
|
net_pkt_set_ieee802154_lqi(pkt, rx_frame->lqi);
|
|
|
|
net_pkt_set_ieee802154_rssi(pkt, rx_frame->rssi);
|
2020-03-20 11:39:21 +01:00
|
|
|
net_pkt_set_ieee802154_ack_fpb(pkt, rx_frame->ack_fpb);
|
2017-02-06 12:42:34 +01:00
|
|
|
|
2020-04-03 09:38:15 +02:00
|
|
|
#if defined(CONFIG_NET_PKT_TIMESTAMP)
|
|
|
|
struct net_ptp_time timestamp = {
|
|
|
|
.second = rx_frame->time / USEC_PER_SEC,
|
|
|
|
.nanosecond =
|
|
|
|
(rx_frame->time % USEC_PER_SEC) * NSEC_PER_USEC
|
|
|
|
};
|
|
|
|
|
|
|
|
net_pkt_set_timestamp(pkt, ×tamp);
|
|
|
|
#endif
|
|
|
|
|
2018-09-03 17:28:47 +03:00
|
|
|
LOG_DBG("Caught a packet (%u) (LQI: %u)",
|
2019-01-17 14:12:27 +01:00
|
|
|
pkt_len, rx_frame->lqi);
|
2017-02-06 12:42:34 +01:00
|
|
|
|
2017-04-05 08:37:44 +02:00
|
|
|
if (net_recv_data(nrf5_radio->iface, pkt) < 0) {
|
2019-01-17 14:12:27 +01:00
|
|
|
LOG_ERR("Packet dropped by NET stack");
|
|
|
|
goto drop;
|
2017-02-06 12:42:34 +01:00
|
|
|
}
|
|
|
|
|
2019-01-17 14:12:27 +01:00
|
|
|
nrf_802154_buffer_free_raw(rx_frame->psdu);
|
|
|
|
rx_frame->psdu = NULL;
|
|
|
|
|
2019-05-10 18:00:03 -03:00
|
|
|
if (LOG_LEVEL >= LOG_LEVEL_DBG) {
|
2020-03-12 14:18:42 -07:00
|
|
|
log_stack_usage(&nrf5_radio->rx_thread);
|
2018-12-18 12:29:02 +01:00
|
|
|
}
|
|
|
|
|
2017-02-06 12:42:34 +01:00
|
|
|
continue;
|
|
|
|
|
2019-01-17 14:12:27 +01:00
|
|
|
drop:
|
|
|
|
nrf_802154_buffer_free_raw(rx_frame->psdu);
|
|
|
|
rx_frame->psdu = NULL;
|
|
|
|
|
2021-03-05 12:01:51 +01:00
|
|
|
net_pkt_unref(pkt);
|
2017-02-06 12:42:34 +01:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2021-01-25 16:33:17 +01:00
|
|
|
static void nrf5_get_capabilities_at_boot(void)
|
|
|
|
{
|
|
|
|
nrf_802154_capabilities_t caps = nrf_802154_capabilities_get();
|
|
|
|
|
|
|
|
nrf5_data.capabilities =
|
|
|
|
IEEE802154_HW_FCS |
|
|
|
|
IEEE802154_HW_PROMISC |
|
|
|
|
IEEE802154_HW_FILTER |
|
|
|
|
((caps & NRF_802154_CAPABILITY_CSMA) ? IEEE802154_HW_CSMA : 0UL) |
|
|
|
|
IEEE802154_HW_2_4_GHZ |
|
|
|
|
IEEE802154_HW_TX_RX_ACK |
|
|
|
|
IEEE802154_HW_ENERGY_SCAN |
|
|
|
|
((caps & NRF_802154_CAPABILITY_DELAYED_TX) ? IEEE802154_HW_TXTIME : 0UL) |
|
|
|
|
IEEE802154_HW_SLEEP_TO_TX;
|
|
|
|
}
|
|
|
|
|
2017-02-06 12:42:34 +01:00
|
|
|
/* Radio device API */
|
|
|
|
|
2020-04-30 20:33:38 +02:00
|
|
|
static enum ieee802154_hw_caps nrf5_get_capabilities(const struct device *dev)
|
2017-09-04 15:24:36 +02:00
|
|
|
{
|
2021-01-25 16:33:17 +01:00
|
|
|
return nrf5_data.capabilities;
|
2017-09-04 15:24:36 +02:00
|
|
|
}
|
|
|
|
|
2020-04-30 20:33:38 +02:00
|
|
|
static int nrf5_cca(const struct device *dev)
|
2017-02-06 12:42:34 +01:00
|
|
|
{
|
|
|
|
struct nrf5_802154_data *nrf5_radio = NRF5_802154_DATA(dev);
|
|
|
|
|
2019-01-17 14:12:27 +01:00
|
|
|
if (!nrf_802154_cca()) {
|
|
|
|
LOG_DBG("CCA failed");
|
2017-02-06 12:42:34 +01:00
|
|
|
return -EBUSY;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* The nRF driver guarantees that a callback will be called once
|
2019-01-17 14:12:27 +01:00
|
|
|
* the CCA function is done, thus unlocking the semaphore.
|
2017-02-06 12:42:34 +01:00
|
|
|
*/
|
|
|
|
k_sem_take(&nrf5_radio->cca_wait, K_FOREVER);
|
|
|
|
|
2019-01-17 14:12:27 +01:00
|
|
|
LOG_DBG("Channel free? %d", nrf5_radio->channel_free);
|
2017-02-06 12:42:34 +01:00
|
|
|
|
2019-01-17 14:12:27 +01:00
|
|
|
return nrf5_radio->channel_free ? 0 : -EBUSY;
|
2017-02-06 12:42:34 +01:00
|
|
|
}
|
|
|
|
|
2020-04-30 20:33:38 +02:00
|
|
|
static int nrf5_set_channel(const struct device *dev, uint16_t channel)
|
2017-02-06 12:42:34 +01:00
|
|
|
{
|
2019-01-17 14:12:27 +01:00
|
|
|
ARG_UNUSED(dev);
|
2017-02-06 12:42:34 +01:00
|
|
|
|
2018-09-03 17:28:47 +03:00
|
|
|
LOG_DBG("%u", channel);
|
2017-02-06 12:42:34 +01:00
|
|
|
|
|
|
|
if (channel < 11 || channel > 26) {
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
2019-01-17 14:12:27 +01:00
|
|
|
nrf_802154_channel_set(channel);
|
2017-02-06 12:42:34 +01:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2020-04-30 20:33:38 +02:00
|
|
|
static int nrf5_energy_scan_start(const struct device *dev,
|
2020-05-27 11:26:57 -05:00
|
|
|
uint16_t duration,
|
2020-02-25 11:17:45 +01:00
|
|
|
energy_scan_done_cb_t done_cb)
|
|
|
|
{
|
|
|
|
int err = 0;
|
|
|
|
|
|
|
|
ARG_UNUSED(dev);
|
|
|
|
|
|
|
|
if (nrf5_data.energy_scan_done == NULL) {
|
|
|
|
nrf5_data.energy_scan_done = done_cb;
|
|
|
|
|
|
|
|
if (nrf_802154_energy_detection(duration * 1000) == false) {
|
|
|
|
nrf5_data.energy_scan_done = NULL;
|
|
|
|
err = -EPERM;
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
err = -EALREADY;
|
|
|
|
}
|
|
|
|
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2020-04-30 20:33:38 +02:00
|
|
|
static int nrf5_set_pan_id(const struct device *dev, uint16_t pan_id)
|
2017-02-06 12:42:34 +01:00
|
|
|
{
|
2020-05-27 11:26:57 -05:00
|
|
|
uint8_t pan_id_le[2];
|
2017-02-06 12:42:34 +01:00
|
|
|
|
|
|
|
ARG_UNUSED(dev);
|
|
|
|
|
|
|
|
sys_put_le16(pan_id, pan_id_le);
|
2019-01-17 14:12:27 +01:00
|
|
|
nrf_802154_pan_id_set(pan_id_le);
|
2017-02-06 12:42:34 +01:00
|
|
|
|
2018-09-03 17:28:47 +03:00
|
|
|
LOG_DBG("0x%x", pan_id);
|
2019-01-17 14:12:27 +01:00
|
|
|
|
2017-02-06 12:42:34 +01:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2020-04-30 20:33:38 +02:00
|
|
|
static int nrf5_set_short_addr(const struct device *dev, uint16_t short_addr)
|
2017-02-06 12:42:34 +01:00
|
|
|
{
|
2020-05-27 11:26:57 -05:00
|
|
|
uint8_t short_addr_le[2];
|
2017-02-06 12:42:34 +01:00
|
|
|
|
|
|
|
ARG_UNUSED(dev);
|
|
|
|
|
|
|
|
sys_put_le16(short_addr, short_addr_le);
|
2019-01-17 14:12:27 +01:00
|
|
|
nrf_802154_short_address_set(short_addr_le);
|
2017-02-06 12:42:34 +01:00
|
|
|
|
2018-09-03 17:28:47 +03:00
|
|
|
LOG_DBG("0x%x", short_addr);
|
2019-01-17 14:12:27 +01:00
|
|
|
|
2017-02-06 12:42:34 +01:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2020-04-30 20:33:38 +02:00
|
|
|
static int nrf5_set_ieee_addr(const struct device *dev,
|
|
|
|
const uint8_t *ieee_addr)
|
2017-02-06 12:42:34 +01:00
|
|
|
{
|
|
|
|
ARG_UNUSED(dev);
|
|
|
|
|
2018-09-03 17:28:47 +03:00
|
|
|
LOG_DBG("IEEE address %02x:%02x:%02x:%02x:%02x:%02x:%02x:%02x",
|
2017-02-06 12:42:34 +01:00
|
|
|
ieee_addr[7], ieee_addr[6], ieee_addr[5], ieee_addr[4],
|
|
|
|
ieee_addr[3], ieee_addr[2], ieee_addr[1], ieee_addr[0]);
|
|
|
|
|
2019-01-17 14:12:27 +01:00
|
|
|
nrf_802154_extended_address_set(ieee_addr);
|
2017-02-06 12:42:34 +01:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2020-04-30 20:33:38 +02:00
|
|
|
static int nrf5_filter(const struct device *dev, bool set,
|
2018-03-19 09:53:29 +01:00
|
|
|
enum ieee802154_filter_type type,
|
|
|
|
const struct ieee802154_filter *filter)
|
2017-09-05 14:09:15 +02:00
|
|
|
{
|
2018-09-03 17:28:47 +03:00
|
|
|
LOG_DBG("Applying filter %u", type);
|
2017-09-05 14:09:15 +02:00
|
|
|
|
2018-03-19 09:53:29 +01:00
|
|
|
if (!set) {
|
|
|
|
return -ENOTSUP;
|
|
|
|
}
|
|
|
|
|
2017-09-05 14:09:15 +02:00
|
|
|
if (type == IEEE802154_FILTER_TYPE_IEEE_ADDR) {
|
|
|
|
return nrf5_set_ieee_addr(dev, filter->ieee_addr);
|
|
|
|
} else if (type == IEEE802154_FILTER_TYPE_SHORT_ADDR) {
|
|
|
|
return nrf5_set_short_addr(dev, filter->short_addr);
|
|
|
|
} else if (type == IEEE802154_FILTER_TYPE_PAN_ID) {
|
|
|
|
return nrf5_set_pan_id(dev, filter->pan_id);
|
|
|
|
}
|
|
|
|
|
2018-03-19 09:53:29 +01:00
|
|
|
return -ENOTSUP;
|
2017-09-05 14:09:15 +02:00
|
|
|
}
|
|
|
|
|
2020-04-30 20:33:38 +02:00
|
|
|
static int nrf5_set_txpower(const struct device *dev, int16_t dbm)
|
2017-02-06 12:42:34 +01:00
|
|
|
{
|
2019-01-17 14:12:27 +01:00
|
|
|
ARG_UNUSED(dev);
|
2017-02-06 12:42:34 +01:00
|
|
|
|
2018-09-03 17:28:47 +03:00
|
|
|
LOG_DBG("%d", dbm);
|
2019-01-17 14:12:27 +01:00
|
|
|
|
|
|
|
nrf_802154_tx_power_set(dbm);
|
2017-02-06 12:42:34 +01:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2019-04-11 13:29:25 +02:00
|
|
|
static int handle_ack(struct nrf5_802154_data *nrf5_radio)
|
|
|
|
{
|
2020-05-27 11:26:57 -05:00
|
|
|
uint8_t ack_len = nrf5_radio->ack_frame.psdu[0] - NRF5_FCS_LENGTH;
|
2019-04-11 13:29:25 +02:00
|
|
|
struct net_pkt *ack_pkt;
|
|
|
|
int err = 0;
|
|
|
|
|
|
|
|
ack_pkt = net_pkt_alloc_with_buffer(nrf5_radio->iface, ack_len,
|
|
|
|
AF_UNSPEC, 0, K_NO_WAIT);
|
|
|
|
if (!ack_pkt) {
|
|
|
|
LOG_ERR("No free packet available.");
|
|
|
|
err = -ENOMEM;
|
|
|
|
goto free_nrf_ack;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Upper layers expect the frame to start at the MAC header, skip the
|
|
|
|
* PHY header (1 byte).
|
|
|
|
*/
|
|
|
|
if (net_pkt_write(ack_pkt, nrf5_radio->ack_frame.psdu + 1,
|
|
|
|
ack_len) < 0) {
|
|
|
|
LOG_ERR("Failed to write to a packet.");
|
|
|
|
err = -ENOMEM;
|
|
|
|
goto free_net_ack;
|
|
|
|
}
|
|
|
|
|
|
|
|
net_pkt_set_ieee802154_lqi(ack_pkt, nrf5_radio->ack_frame.lqi);
|
|
|
|
net_pkt_set_ieee802154_rssi(ack_pkt, nrf5_radio->ack_frame.rssi);
|
|
|
|
|
|
|
|
net_pkt_cursor_init(ack_pkt);
|
|
|
|
|
|
|
|
if (ieee802154_radio_handle_ack(nrf5_radio->iface, ack_pkt) != NET_OK) {
|
|
|
|
LOG_INF("ACK packet not handled - releasing.");
|
|
|
|
}
|
|
|
|
|
|
|
|
free_net_ack:
|
|
|
|
net_pkt_unref(ack_pkt);
|
|
|
|
|
|
|
|
free_nrf_ack:
|
|
|
|
nrf_802154_buffer_free_raw(nrf5_radio->ack_frame.psdu);
|
|
|
|
nrf5_radio->ack_frame.psdu = NULL;
|
|
|
|
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
|
2020-04-30 20:33:38 +02:00
|
|
|
static void nrf5_tx_started(const struct device *dev,
|
2020-02-28 15:48:57 +01:00
|
|
|
struct net_pkt *pkt,
|
|
|
|
struct net_buf *frag)
|
|
|
|
{
|
|
|
|
ARG_UNUSED(pkt);
|
|
|
|
|
|
|
|
if (nrf5_data.event_handler) {
|
|
|
|
nrf5_data.event_handler(dev, IEEE802154_EVENT_TX_STARTED,
|
|
|
|
(void *)frag);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2021-01-25 16:21:48 +01:00
|
|
|
/* This function cannot be used in the serialized version yet. */
|
|
|
|
#if defined(CONFIG_NET_PKT_TXTIME) && !defined(CONFIG_NRF_802154_SER_HOST)
|
2020-09-28 12:01:30 +02:00
|
|
|
static bool nrf5_tx_at(struct net_pkt *pkt, bool cca)
|
|
|
|
{
|
|
|
|
uint32_t tx_at = net_pkt_txtime(pkt) / NSEC_PER_USEC;
|
|
|
|
bool ret;
|
|
|
|
|
|
|
|
ret = nrf_802154_transmit_raw_at(nrf5_data.tx_psdu,
|
|
|
|
cca,
|
|
|
|
tx_at - TXTIME_OFFSET_US,
|
|
|
|
TXTIME_OFFSET_US,
|
|
|
|
nrf_802154_channel_get());
|
|
|
|
if (nrf5_data.event_handler) {
|
|
|
|
LOG_WRN("TX_STARTED event will be triggered without delay");
|
|
|
|
}
|
|
|
|
return ret;
|
|
|
|
}
|
2021-01-25 16:21:48 +01:00
|
|
|
#endif /* CONFIG_NET_PKT_TXTIME */
|
2020-09-28 12:01:30 +02:00
|
|
|
|
2020-04-30 20:33:38 +02:00
|
|
|
static int nrf5_tx(const struct device *dev,
|
net: ieee802154_radio: Allow to specify TX mode
Even though radio driver can report in its capabilities that it does
support CSMA CA, there's no way in the driver to select how the frame
should be transmitted (with CSMA or without). As layers above radio
driver (Thread, Zigbee) can expect that both TX modes are available, we
need to extend the API to allow either of these modes.
This commits extends the API `tx` function with an extra parameter,
`ieee802154_tx_mode`, which informs the driver how the packet should be
transmitted. Currently, the following modes are specified:
* direct (regular tx, no cca, just how it worked so far),
* CCA before transmission,
* CSMA CA before transmission,
* delayed TX,
* delayed TX with CCA
Assume that radios that reported CSMA CA capability transmit in CSMA CA
mode by default, all others will support direct mode.
Signed-off-by: Robert Lubos <robert.lubos@nordicsemi.no>
2020-02-28 13:57:49 +01:00
|
|
|
enum ieee802154_tx_mode mode,
|
2017-04-05 08:37:44 +02:00
|
|
|
struct net_pkt *pkt,
|
2017-02-06 12:42:34 +01:00
|
|
|
struct net_buf *frag)
|
|
|
|
{
|
|
|
|
struct nrf5_802154_data *nrf5_radio = NRF5_802154_DATA(dev);
|
2020-05-27 11:26:57 -05:00
|
|
|
uint8_t payload_len = frag->len;
|
|
|
|
uint8_t *payload = frag->data;
|
2020-03-13 09:21:55 +01:00
|
|
|
bool ret = true;
|
net: ieee802154_radio: Allow to specify TX mode
Even though radio driver can report in its capabilities that it does
support CSMA CA, there's no way in the driver to select how the frame
should be transmitted (with CSMA or without). As layers above radio
driver (Thread, Zigbee) can expect that both TX modes are available, we
need to extend the API to allow either of these modes.
This commits extends the API `tx` function with an extra parameter,
`ieee802154_tx_mode`, which informs the driver how the packet should be
transmitted. Currently, the following modes are specified:
* direct (regular tx, no cca, just how it worked so far),
* CCA before transmission,
* CSMA CA before transmission,
* delayed TX,
* delayed TX with CCA
Assume that radios that reported CSMA CA capability transmit in CSMA CA
mode by default, all others will support direct mode.
Signed-off-by: Robert Lubos <robert.lubos@nordicsemi.no>
2020-02-28 13:57:49 +01:00
|
|
|
|
2018-09-03 17:28:47 +03:00
|
|
|
LOG_DBG("%p (%u)", payload, payload_len);
|
2017-02-06 12:42:34 +01:00
|
|
|
|
|
|
|
nrf5_radio->tx_psdu[0] = payload_len + NRF5_FCS_LENGTH;
|
|
|
|
memcpy(nrf5_radio->tx_psdu + 1, payload, payload_len);
|
|
|
|
|
2017-09-29 14:22:26 +02:00
|
|
|
/* Reset semaphore in case ACK was received after timeout */
|
|
|
|
k_sem_reset(&nrf5_radio->tx_wait);
|
|
|
|
|
2020-03-13 09:21:55 +01:00
|
|
|
switch (mode) {
|
|
|
|
case IEEE802154_TX_MODE_DIRECT:
|
|
|
|
ret = nrf_802154_transmit_raw(nrf5_radio->tx_psdu, false);
|
|
|
|
break;
|
|
|
|
case IEEE802154_TX_MODE_CCA:
|
|
|
|
ret = nrf_802154_transmit_raw(nrf5_radio->tx_psdu, true);
|
|
|
|
break;
|
|
|
|
case IEEE802154_TX_MODE_CSMA_CA:
|
|
|
|
nrf_802154_transmit_csma_ca_raw(nrf5_radio->tx_psdu);
|
|
|
|
break;
|
2021-01-25 16:21:48 +01:00
|
|
|
/* This function cannot be used in the serialized version yet. */
|
|
|
|
#if defined(CONFIG_NET_PKT_TXTIME) && !defined(CONFIG_NRF_802154_SER_HOST)
|
2020-03-13 09:21:55 +01:00
|
|
|
case IEEE802154_TX_MODE_TXTIME:
|
|
|
|
case IEEE802154_TX_MODE_TXTIME_CCA:
|
2020-09-28 12:01:30 +02:00
|
|
|
__ASSERT_NO_MSG(pkt);
|
|
|
|
ret = nrf5_tx_at(pkt,
|
|
|
|
mode == IEEE802154_TX_MODE_TXTIME_CCA);
|
|
|
|
break;
|
2021-01-25 16:21:48 +01:00
|
|
|
#endif /* CONFIG_NET_PKT_TXTIME */
|
2020-03-13 09:21:55 +01:00
|
|
|
default:
|
|
|
|
NET_ERR("TX mode %d not supported", mode);
|
|
|
|
return -ENOTSUP;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (!ret) {
|
2018-09-03 17:28:47 +03:00
|
|
|
LOG_ERR("Cannot send frame");
|
2017-02-06 12:42:34 +01:00
|
|
|
return -EIO;
|
|
|
|
}
|
|
|
|
|
2020-02-28 15:48:57 +01:00
|
|
|
nrf5_tx_started(dev, pkt, frag);
|
|
|
|
|
2018-09-03 17:28:47 +03:00
|
|
|
LOG_DBG("Sending frame (ch:%d, txpower:%d)",
|
2019-01-17 14:12:27 +01:00
|
|
|
nrf_802154_channel_get(), nrf_802154_tx_power_get());
|
2017-02-06 12:42:34 +01:00
|
|
|
|
2020-04-03 13:04:11 +02:00
|
|
|
/* Wait for the callback from the radio driver. */
|
|
|
|
k_sem_take(&nrf5_radio->tx_wait, K_FOREVER);
|
2017-02-06 12:42:34 +01:00
|
|
|
|
2019-01-17 14:12:27 +01:00
|
|
|
LOG_DBG("Result: %d", nrf5_data.tx_result);
|
|
|
|
|
2020-09-17 14:28:22 +02:00
|
|
|
switch (nrf5_radio->tx_result) {
|
|
|
|
case NRF_802154_TX_ERROR_NONE:
|
2019-04-11 13:29:25 +02:00
|
|
|
if (nrf5_radio->ack_frame.psdu == NULL) {
|
|
|
|
/* No ACK was requested. */
|
|
|
|
return 0;
|
2019-01-17 14:12:27 +01:00
|
|
|
}
|
2019-04-11 13:29:25 +02:00
|
|
|
/* Handle ACK packet. */
|
|
|
|
return handle_ack(nrf5_radio);
|
2020-09-17 14:28:22 +02:00
|
|
|
case NRF_802154_TX_ERROR_NO_MEM:
|
|
|
|
return -ENOBUFS;
|
|
|
|
case NRF_802154_TX_ERROR_BUSY_CHANNEL:
|
|
|
|
return -EBUSY;
|
|
|
|
case NRF_802154_TX_ERROR_INVALID_ACK:
|
|
|
|
case NRF_802154_TX_ERROR_NO_ACK:
|
|
|
|
return -ENOMSG;
|
|
|
|
case NRF_802154_TX_ERROR_ABORTED:
|
|
|
|
case NRF_802154_TX_ERROR_TIMESLOT_DENIED:
|
|
|
|
case NRF_802154_TX_ERROR_TIMESLOT_ENDED:
|
|
|
|
return -EIO;
|
2019-01-17 14:12:27 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
return -EIO;
|
2017-02-06 12:42:34 +01:00
|
|
|
}
|
|
|
|
|
2021-04-23 13:51:00 +02:00
|
|
|
static uint64_t nrf5_get_time(const struct device *dev)
|
|
|
|
{
|
|
|
|
ARG_UNUSED(dev);
|
|
|
|
|
|
|
|
return nrf_802154_time_get();
|
|
|
|
}
|
|
|
|
|
2020-04-30 20:33:38 +02:00
|
|
|
static int nrf5_start(const struct device *dev)
|
2017-02-06 12:42:34 +01:00
|
|
|
{
|
2019-01-17 14:12:27 +01:00
|
|
|
ARG_UNUSED(dev);
|
|
|
|
|
|
|
|
if (!nrf_802154_receive()) {
|
|
|
|
LOG_ERR("Failed to enter receive state");
|
|
|
|
return -EIO;
|
|
|
|
}
|
2017-02-06 12:42:34 +01:00
|
|
|
|
2018-09-03 17:28:47 +03:00
|
|
|
LOG_DBG("nRF5 802154 radio started (channel: %d)",
|
2019-01-17 14:12:27 +01:00
|
|
|
nrf_802154_channel_get());
|
2017-02-06 12:42:34 +01:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2020-04-30 20:33:38 +02:00
|
|
|
static int nrf5_stop(const struct device *dev)
|
2017-02-06 12:42:34 +01:00
|
|
|
{
|
|
|
|
ARG_UNUSED(dev);
|
|
|
|
|
2019-01-17 14:12:27 +01:00
|
|
|
if (!nrf_802154_sleep()) {
|
2018-09-03 17:28:47 +03:00
|
|
|
LOG_ERR("Error while stopping radio");
|
2017-02-06 12:42:34 +01:00
|
|
|
return -EIO;
|
|
|
|
}
|
|
|
|
|
2018-09-03 17:28:47 +03:00
|
|
|
LOG_DBG("nRF5 802154 radio stopped");
|
2017-02-06 12:42:34 +01:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2021-02-24 09:34:50 +01:00
|
|
|
#if !IS_ENABLED(CONFIG_IEEE802154_NRF5_EXT_IRQ_MGMT)
|
2017-02-06 12:42:34 +01:00
|
|
|
static void nrf5_radio_irq(void *arg)
|
|
|
|
{
|
|
|
|
ARG_UNUSED(arg);
|
|
|
|
|
2019-01-17 14:12:27 +01:00
|
|
|
nrf_802154_radio_irq_handler();
|
2017-02-06 12:42:34 +01:00
|
|
|
}
|
2020-06-01 12:08:03 +02:00
|
|
|
#endif
|
2017-02-06 12:42:34 +01:00
|
|
|
|
2020-04-30 20:33:38 +02:00
|
|
|
static void nrf5_irq_config(const struct device *dev)
|
2017-02-06 12:42:34 +01:00
|
|
|
{
|
|
|
|
ARG_UNUSED(dev);
|
|
|
|
|
2021-02-24 09:34:50 +01:00
|
|
|
#if !IS_ENABLED(CONFIG_IEEE802154_NRF5_EXT_IRQ_MGMT)
|
2019-09-20 14:13:45 +02:00
|
|
|
IRQ_CONNECT(RADIO_IRQn, NRF_802154_IRQ_PRIORITY,
|
2019-01-17 14:12:27 +01:00
|
|
|
nrf5_radio_irq, NULL, 0);
|
2019-09-20 14:13:45 +02:00
|
|
|
irq_enable(RADIO_IRQn);
|
2020-06-01 12:08:03 +02:00
|
|
|
#endif
|
2017-02-06 12:42:34 +01:00
|
|
|
}
|
|
|
|
|
2020-04-30 20:33:38 +02:00
|
|
|
static int nrf5_init(const struct device *dev)
|
2017-02-06 12:42:34 +01:00
|
|
|
{
|
|
|
|
const struct nrf5_802154_config *nrf5_radio_cfg = NRF5_802154_CFG(dev);
|
|
|
|
struct nrf5_802154_data *nrf5_radio = NRF5_802154_DATA(dev);
|
|
|
|
|
2019-01-17 14:12:27 +01:00
|
|
|
k_fifo_init(&nrf5_radio->rx_fifo);
|
2017-02-06 12:42:34 +01:00
|
|
|
k_sem_init(&nrf5_radio->tx_wait, 0, 1);
|
|
|
|
k_sem_init(&nrf5_radio->cca_wait, 0, 1);
|
|
|
|
|
2019-01-17 14:12:27 +01:00
|
|
|
nrf_802154_init();
|
2017-02-06 12:42:34 +01:00
|
|
|
|
2021-02-24 10:55:12 +01:00
|
|
|
nrf5_get_capabilities_at_boot();
|
|
|
|
|
2017-02-06 12:42:34 +01:00
|
|
|
nrf5_radio_cfg->irq_config_func(dev);
|
|
|
|
|
2017-05-09 12:15:00 -07:00
|
|
|
k_thread_create(&nrf5_radio->rx_thread, nrf5_radio->rx_stack,
|
|
|
|
CONFIG_IEEE802154_NRF5_RX_STACK_SIZE,
|
2020-07-08 11:31:38 +02:00
|
|
|
nrf5_rx_thread, nrf5_radio, NULL, NULL,
|
2019-09-19 07:16:34 -05:00
|
|
|
K_PRIO_COOP(2), 0, K_NO_WAIT);
|
2017-02-06 12:42:34 +01:00
|
|
|
|
2020-05-26 10:48:53 +02:00
|
|
|
k_thread_name_set(&nrf5_radio->rx_thread, "nrf5_rx");
|
2019-01-17 14:12:27 +01:00
|
|
|
|
2018-09-03 17:28:47 +03:00
|
|
|
LOG_INF("nRF5 802154 radio initialized");
|
2017-02-06 12:42:34 +01:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void nrf5_iface_init(struct net_if *iface)
|
|
|
|
{
|
2020-04-30 20:33:38 +02:00
|
|
|
const struct device *dev = net_if_get_device(iface);
|
2017-02-06 12:42:34 +01:00
|
|
|
struct nrf5_802154_data *nrf5_radio = NRF5_802154_DATA(dev);
|
|
|
|
|
|
|
|
nrf5_get_eui64(nrf5_radio->mac);
|
2019-01-17 14:12:27 +01:00
|
|
|
net_if_set_link_addr(iface, nrf5_radio->mac, sizeof(nrf5_radio->mac),
|
2017-02-23 13:47:44 +01:00
|
|
|
NET_LINK_IEEE802154);
|
2017-02-06 12:42:34 +01:00
|
|
|
|
|
|
|
nrf5_radio->iface = iface;
|
2019-01-17 14:12:27 +01:00
|
|
|
|
2017-02-06 12:42:34 +01:00
|
|
|
ieee802154_init(iface);
|
|
|
|
}
|
|
|
|
|
2020-04-30 20:33:38 +02:00
|
|
|
static int nrf5_configure(const struct device *dev,
|
|
|
|
enum ieee802154_config_type type,
|
2020-03-31 15:38:41 +02:00
|
|
|
const struct ieee802154_config *config)
|
2019-04-16 14:52:59 +02:00
|
|
|
{
|
|
|
|
ARG_UNUSED(dev);
|
|
|
|
|
|
|
|
switch (type) {
|
|
|
|
case IEEE802154_CONFIG_AUTO_ACK_FPB:
|
2020-03-31 15:38:41 +02:00
|
|
|
if (config->auto_ack_fpb.enabled) {
|
|
|
|
switch (config->auto_ack_fpb.mode) {
|
|
|
|
case IEEE802154_FPB_ADDR_MATCH_THREAD:
|
|
|
|
nrf_802154_src_addr_matching_method_set(
|
|
|
|
NRF_802154_SRC_ADDR_MATCH_THREAD);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case IEEE802154_FPB_ADDR_MATCH_ZIGBEE:
|
|
|
|
nrf_802154_src_addr_matching_method_set(
|
|
|
|
NRF_802154_SRC_ADDR_MATCH_ZIGBEE);
|
|
|
|
break;
|
|
|
|
|
|
|
|
default:
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2019-04-16 14:52:59 +02:00
|
|
|
nrf_802154_auto_pending_bit_set(config->auto_ack_fpb.enabled);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case IEEE802154_CONFIG_ACK_FPB:
|
|
|
|
if (config->ack_fpb.enabled) {
|
|
|
|
if (!nrf_802154_pending_bit_for_addr_set(
|
|
|
|
config->ack_fpb.addr,
|
|
|
|
config->ack_fpb.extended)) {
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (config->ack_fpb.addr != NULL) {
|
|
|
|
if (!nrf_802154_pending_bit_for_addr_clear(
|
|
|
|
config->ack_fpb.addr,
|
|
|
|
config->ack_fpb.extended)) {
|
|
|
|
return -ENOENT;
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
nrf_802154_pending_bit_for_addr_reset(
|
|
|
|
config->ack_fpb.extended);
|
|
|
|
}
|
|
|
|
|
|
|
|
break;
|
|
|
|
|
2020-03-19 14:47:22 +01:00
|
|
|
case IEEE802154_CONFIG_PAN_COORDINATOR:
|
|
|
|
nrf_802154_pan_coord_set(config->pan_coordinator);
|
|
|
|
break;
|
|
|
|
|
2020-03-19 13:12:36 +01:00
|
|
|
case IEEE802154_CONFIG_PROMISCUOUS:
|
|
|
|
nrf_802154_promiscuous_set(config->promiscuous);
|
|
|
|
break;
|
|
|
|
|
2020-02-28 15:48:57 +01:00
|
|
|
case IEEE802154_CONFIG_EVENT_HANDLER:
|
|
|
|
nrf5_data.event_handler = config->event_handler;
|
|
|
|
|
2019-04-16 14:52:59 +02:00
|
|
|
default:
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2017-02-06 12:42:34 +01:00
|
|
|
/* nRF5 radio driver callbacks */
|
|
|
|
|
2020-04-03 09:38:15 +02:00
|
|
|
void nrf_802154_received_timestamp_raw(uint8_t *data, int8_t power, uint8_t lqi,
|
|
|
|
uint32_t time)
|
2017-02-06 12:42:34 +01:00
|
|
|
{
|
2020-05-27 11:26:57 -05:00
|
|
|
for (uint32_t i = 0; i < ARRAY_SIZE(nrf5_data.rx_frames); i++) {
|
2019-01-17 14:12:27 +01:00
|
|
|
if (nrf5_data.rx_frames[i].psdu != NULL) {
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
|
|
|
|
nrf5_data.rx_frames[i].psdu = data;
|
2020-04-03 09:38:15 +02:00
|
|
|
nrf5_data.rx_frames[i].time = time;
|
2019-01-17 14:12:27 +01:00
|
|
|
nrf5_data.rx_frames[i].rssi = power;
|
|
|
|
nrf5_data.rx_frames[i].lqi = lqi;
|
|
|
|
|
2020-03-20 11:39:21 +01:00
|
|
|
if (data[ACK_REQUEST_BYTE] & ACK_REQUEST_BIT) {
|
|
|
|
nrf5_data.rx_frames[i].ack_fpb =
|
|
|
|
nrf5_data.last_frame_ack_fpb;
|
|
|
|
} else {
|
|
|
|
nrf5_data.rx_frames[i].ack_fpb = false;
|
|
|
|
}
|
|
|
|
|
|
|
|
nrf5_data.last_frame_ack_fpb = false;
|
|
|
|
|
2019-01-17 14:12:27 +01:00
|
|
|
k_fifo_put(&nrf5_data.rx_fifo, &nrf5_data.rx_frames[i]);
|
|
|
|
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
|
|
|
__ASSERT(false, "Not enough rx frames allocated for 15.4 driver");
|
|
|
|
}
|
2017-02-06 12:42:34 +01:00
|
|
|
|
2019-01-17 14:12:27 +01:00
|
|
|
void nrf_802154_receive_failed(nrf_802154_rx_error_t error)
|
|
|
|
{
|
2020-10-15 12:20:28 +02:00
|
|
|
enum ieee802154_rx_fail_reason reason;
|
|
|
|
|
|
|
|
switch (error) {
|
|
|
|
case NRF_802154_RX_ERROR_INVALID_FRAME:
|
|
|
|
case NRF_802154_RX_ERROR_DELAYED_TIMEOUT:
|
|
|
|
reason = IEEE802154_RX_FAIL_NOT_RECEIVED;
|
|
|
|
break;
|
|
|
|
|
|
|
|
case NRF_802154_RX_ERROR_INVALID_FCS:
|
|
|
|
reason = IEEE802154_RX_FAIL_INVALID_FCS;
|
|
|
|
break;
|
|
|
|
|
|
|
|
case NRF_802154_RX_ERROR_INVALID_DEST_ADDR:
|
|
|
|
reason = IEEE802154_RX_FAIL_ADDR_FILTERED;
|
|
|
|
break;
|
|
|
|
|
|
|
|
default:
|
|
|
|
reason = IEEE802154_RX_FAIL_OTHER;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
2020-03-20 11:39:21 +01:00
|
|
|
nrf5_data.last_frame_ack_fpb = false;
|
2020-10-15 12:20:28 +02:00
|
|
|
if (nrf5_data.event_handler) {
|
|
|
|
nrf5_data.event_handler(net_if_get_device(nrf5_data.iface),
|
|
|
|
IEEE802154_EVENT_RX_FAILED,
|
|
|
|
(void *)&reason);
|
|
|
|
}
|
2020-03-20 11:39:21 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
void nrf_802154_tx_ack_started(const uint8_t *data)
|
|
|
|
{
|
|
|
|
nrf5_data.last_frame_ack_fpb =
|
|
|
|
data[FRAME_PENDING_BYTE] & FRAME_PENDING_BIT;
|
2017-02-06 12:42:34 +01:00
|
|
|
}
|
|
|
|
|
2019-01-17 14:12:27 +01:00
|
|
|
void nrf_802154_transmitted_raw(const uint8_t *frame, uint8_t *ack,
|
|
|
|
int8_t power, uint8_t lqi)
|
2017-02-06 12:42:34 +01:00
|
|
|
{
|
2019-01-17 14:12:27 +01:00
|
|
|
ARG_UNUSED(frame);
|
|
|
|
ARG_UNUSED(power);
|
|
|
|
ARG_UNUSED(lqi);
|
|
|
|
|
|
|
|
nrf5_data.tx_result = NRF_802154_TX_ERROR_NONE;
|
2019-04-11 13:29:25 +02:00
|
|
|
nrf5_data.ack_frame.psdu = ack;
|
|
|
|
nrf5_data.ack_frame.rssi = power;
|
|
|
|
nrf5_data.ack_frame.lqi = lqi;
|
2017-02-06 12:42:34 +01:00
|
|
|
|
|
|
|
k_sem_give(&nrf5_data.tx_wait);
|
|
|
|
}
|
|
|
|
|
2019-01-17 14:12:27 +01:00
|
|
|
void nrf_802154_transmit_failed(const uint8_t *frame,
|
|
|
|
nrf_802154_tx_error_t error)
|
2017-02-06 12:42:34 +01:00
|
|
|
{
|
2019-01-17 14:12:27 +01:00
|
|
|
ARG_UNUSED(frame);
|
|
|
|
|
|
|
|
nrf5_data.tx_result = error;
|
|
|
|
|
2017-02-06 12:42:34 +01:00
|
|
|
k_sem_give(&nrf5_data.tx_wait);
|
|
|
|
}
|
|
|
|
|
2019-01-17 14:12:27 +01:00
|
|
|
void nrf_802154_cca_done(bool channel_free)
|
2017-02-06 12:42:34 +01:00
|
|
|
{
|
2019-01-17 14:12:27 +01:00
|
|
|
nrf5_data.channel_free = channel_free;
|
|
|
|
|
|
|
|
k_sem_give(&nrf5_data.cca_wait);
|
|
|
|
}
|
|
|
|
|
|
|
|
void nrf_802154_cca_failed(nrf_802154_cca_error_t error)
|
|
|
|
{
|
|
|
|
ARG_UNUSED(error);
|
|
|
|
|
|
|
|
nrf5_data.channel_free = false;
|
|
|
|
|
2017-02-06 12:42:34 +01:00
|
|
|
k_sem_give(&nrf5_data.cca_wait);
|
|
|
|
}
|
|
|
|
|
2020-02-25 11:17:45 +01:00
|
|
|
void nrf_802154_energy_detected(uint8_t result)
|
|
|
|
{
|
|
|
|
if (nrf5_data.energy_scan_done != NULL) {
|
2020-05-27 11:26:57 -05:00
|
|
|
int16_t dbm;
|
2020-02-25 11:17:45 +01:00
|
|
|
energy_scan_done_cb_t callback = nrf5_data.energy_scan_done;
|
|
|
|
|
|
|
|
nrf5_data.energy_scan_done = NULL;
|
|
|
|
dbm = nrf_802154_dbm_from_energy_level_calculate(result);
|
|
|
|
callback(net_if_get_device(nrf5_data.iface), dbm);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void nrf_802154_energy_detection_failed(nrf_802154_ed_error_t error)
|
|
|
|
{
|
|
|
|
if (nrf5_data.energy_scan_done != NULL) {
|
|
|
|
energy_scan_done_cb_t callback = nrf5_data.energy_scan_done;
|
|
|
|
|
|
|
|
nrf5_data.energy_scan_done = NULL;
|
|
|
|
callback(net_if_get_device(nrf5_data.iface), SHRT_MAX);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2021-04-23 13:51:00 +02:00
|
|
|
#if defined(CONFIG_NRF_802154_SER_HOST)
|
2020-11-13 16:39:45 +01:00
|
|
|
void nrf_802154_serialization_error(const nrf_802154_ser_err_data_t *p_err)
|
|
|
|
{
|
|
|
|
__ASSERT(false, "802.15.4 serialization error");
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2017-02-06 12:42:34 +01:00
|
|
|
static const struct nrf5_802154_config nrf5_radio_cfg = {
|
2019-04-25 15:10:10 +02:00
|
|
|
.irq_config_func = nrf5_irq_config,
|
2017-02-06 12:42:34 +01:00
|
|
|
};
|
|
|
|
|
|
|
|
static struct ieee802154_radio_api nrf5_radio_api = {
|
|
|
|
.iface_api.init = nrf5_iface_init,
|
|
|
|
|
2017-09-04 15:24:36 +02:00
|
|
|
.get_capabilities = nrf5_get_capabilities,
|
2017-02-06 12:42:34 +01:00
|
|
|
.cca = nrf5_cca,
|
|
|
|
.set_channel = nrf5_set_channel,
|
2018-03-19 09:53:29 +01:00
|
|
|
.filter = nrf5_filter,
|
2017-02-06 12:42:34 +01:00
|
|
|
.set_txpower = nrf5_set_txpower,
|
|
|
|
.start = nrf5_start,
|
|
|
|
.stop = nrf5_stop,
|
|
|
|
.tx = nrf5_tx,
|
2020-02-25 11:17:45 +01:00
|
|
|
.ed_scan = nrf5_energy_scan_start,
|
2021-04-23 13:51:00 +02:00
|
|
|
.get_time = nrf5_get_time,
|
2019-04-16 14:52:59 +02:00
|
|
|
.configure = nrf5_configure,
|
2017-02-06 12:42:34 +01:00
|
|
|
};
|
|
|
|
|
2018-01-15 11:39:54 +01:00
|
|
|
#if defined(CONFIG_NET_L2_IEEE802154)
|
|
|
|
#define L2 IEEE802154_L2
|
|
|
|
#define L2_CTX_TYPE NET_L2_GET_CTX_TYPE(IEEE802154_L2)
|
|
|
|
#define MTU 125
|
|
|
|
#elif defined(CONFIG_NET_L2_OPENTHREAD)
|
|
|
|
#define L2 OPENTHREAD_L2
|
|
|
|
#define L2_CTX_TYPE NET_L2_GET_CTX_TYPE(OPENTHREAD_L2)
|
|
|
|
#define MTU 1280
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#if defined(CONFIG_NET_L2_IEEE802154) || defined(CONFIG_NET_L2_OPENTHREAD)
|
2017-02-06 12:42:34 +01:00
|
|
|
NET_DEVICE_INIT(nrf5_154_radio, CONFIG_IEEE802154_NRF5_DRV_NAME,
|
2021-04-28 11:05:54 +02:00
|
|
|
nrf5_init, NULL, &nrf5_data, &nrf5_radio_cfg,
|
2017-02-06 12:42:34 +01:00
|
|
|
CONFIG_IEEE802154_NRF5_INIT_PRIO,
|
2018-01-15 11:39:54 +01:00
|
|
|
&nrf5_radio_api, L2,
|
|
|
|
L2_CTX_TYPE, MTU);
|
|
|
|
#else
|
2020-12-18 08:47:49 -06:00
|
|
|
DEVICE_DEFINE(nrf5_154_radio, CONFIG_IEEE802154_NRF5_DRV_NAME,
|
2021-04-28 11:05:54 +02:00
|
|
|
nrf5_init, NULL, &nrf5_data, &nrf5_radio_cfg,
|
2020-12-18 08:47:49 -06:00
|
|
|
POST_KERNEL, CONFIG_IEEE802154_NRF5_INIT_PRIO,
|
|
|
|
&nrf5_radio_api);
|
2017-03-06 16:20:19 +01:00
|
|
|
#endif
|