366 lines
12 KiB
C
366 lines
12 KiB
C
/****************************************************************************
|
|
* wireless/ieee802154/mac802154_data.c
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*
|
|
* Licensed to the Apache Software Foundation (ASF) under one or more
|
|
* contributor license agreements. See the NOTICE file distributed with
|
|
* this work for additional information regarding copyright ownership. The
|
|
* ASF licenses this file to you under the Apache License, Version 2.0 (the
|
|
* "License"); you may not use this file except in compliance with the
|
|
* License. You may obtain a copy of the License at
|
|
*
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
*
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
* distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
|
|
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
|
|
* License for the specific language governing permissions and limitations
|
|
* under the License.
|
|
*
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Included Files
|
|
****************************************************************************/
|
|
|
|
#include <nuttx/config.h>
|
|
|
|
#include <stdlib.h>
|
|
#include <assert.h>
|
|
#include <errno.h>
|
|
#include <debug.h>
|
|
#include <string.h>
|
|
|
|
#include <nuttx/mm/iob.h>
|
|
|
|
#include "mac802154.h"
|
|
#include "mac802154_internal.h"
|
|
#include "mac802154_data.h"
|
|
|
|
#include <nuttx/wireless/ieee802154/ieee802154_mac.h>
|
|
|
|
/****************************************************************************
|
|
* Public Functions
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Name: mac802154_req_data
|
|
*
|
|
* Description:
|
|
* The MCPS-DATA.request primitive requests the transfer of a data SPDU
|
|
* (i.e., MSDU) from a local SSCS entity to a single peer SSCS entity.
|
|
* Confirmation is returned via the
|
|
* struct mac802154_maccb_s->conf_data callback.
|
|
*
|
|
****************************************************************************/
|
|
|
|
int mac802154_req_data(MACHANDLE mac,
|
|
FAR const struct ieee802154_frame_meta_s *meta,
|
|
FAR struct iob_s *frame)
|
|
{
|
|
FAR struct ieee802154_privmac_s *priv =
|
|
(FAR struct ieee802154_privmac_s *)mac;
|
|
FAR struct ieee802154_txdesc_s *txdesc;
|
|
uint16_t *frame_ctrl;
|
|
uint8_t mhr_len = 3;
|
|
int ret;
|
|
|
|
wlinfo("Accepting outbound frame io_len=%u io_offset=%u\n",
|
|
frame->io_len, frame->io_offset);
|
|
|
|
/* Check the required frame size */
|
|
|
|
if (frame->io_len > IEEE802154_MAX_PHY_PACKET_SIZE)
|
|
{
|
|
return -E2BIG;
|
|
}
|
|
|
|
/* Cast the first two bytes of the IOB to a uint16_t frame control field */
|
|
|
|
frame_ctrl = (FAR uint16_t *)&frame->io_data[0];
|
|
|
|
/* Ensure we start with a clear frame control field */
|
|
|
|
*frame_ctrl = 0;
|
|
|
|
/* Set the frame type to Data */
|
|
|
|
*frame_ctrl |= IEEE802154_FRAME_DATA << IEEE802154_FRAMECTRL_SHIFT_FTYPE;
|
|
|
|
/* If the msduLength is greater than aMaxMACSafePayloadSize, the MAC
|
|
* sublayer will set the Frame Version to one. [1] pg. 118.
|
|
*/
|
|
|
|
if ((frame->io_len - frame->io_offset) >
|
|
IEEE802154_MAX_SAFE_MAC_PAYLOAD_SIZE)
|
|
{
|
|
*frame_ctrl |= (1 << IEEE802154_FRAMECTRL_SHIFT_VERSION);
|
|
}
|
|
|
|
/* If the TXOptions parameter specifies that an acknowledged transmission
|
|
* is required, the AR field will be set appropriately, as described in
|
|
* 5.1.6.4 [1] pg. 118.
|
|
*/
|
|
|
|
*frame_ctrl |= (meta->flags.ackreq << IEEE802154_FRAMECTRL_SHIFT_ACKREQ);
|
|
|
|
/* If the destination address is present, copy the PAN ID and one of the
|
|
* addresses, depending on mode, into the MHR.
|
|
*/
|
|
|
|
if (meta->destaddr.mode != IEEE802154_ADDRMODE_NONE)
|
|
{
|
|
IEEE802154_PANIDCOPY(&frame->io_data[mhr_len], meta->destaddr.panid);
|
|
mhr_len += IEEE802154_PANIDSIZE;
|
|
|
|
if (meta->destaddr.mode == IEEE802154_ADDRMODE_SHORT)
|
|
{
|
|
IEEE802154_SADDRCOPY(&frame->io_data[mhr_len],
|
|
meta->destaddr.saddr);
|
|
mhr_len += IEEE802154_SADDRSIZE;
|
|
}
|
|
else if (meta->destaddr.mode == IEEE802154_ADDRMODE_EXTENDED)
|
|
{
|
|
int index;
|
|
|
|
/* The IEEE 802.15.4 Standard is confusing with regards to
|
|
* byte-order for * extended address. More research discovers
|
|
* that the extended address should be sent in reverse-canonical
|
|
* form.
|
|
*/
|
|
|
|
for (index = IEEE802154_EADDRSIZE - 1; index >= 0; index--)
|
|
{
|
|
frame->io_data[mhr_len++] = meta->destaddr.eaddr[index];
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Set the destination addr mode inside the frame control field */
|
|
|
|
*frame_ctrl |= (meta->destaddr.mode << IEEE802154_FRAMECTRL_SHIFT_DADDR);
|
|
|
|
/* From this point on, we need exclusive access to the privmac struct */
|
|
|
|
ret = nxmutex_lock(&priv->lock);
|
|
if (ret < 0)
|
|
{
|
|
/* Should only fail if interrupted by a signal */
|
|
|
|
wlwarn("WARNING: nxmutex_lock failed: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
/* If both destination and source addressing information is present, the
|
|
* MAC sublayer shall compare the destination and source PAN identifiers.
|
|
* [1] pg. 41.
|
|
*/
|
|
|
|
if (meta->srcmode != IEEE802154_ADDRMODE_NONE &&
|
|
meta->destaddr.mode != IEEE802154_ADDRMODE_NONE)
|
|
{
|
|
/* If the PAN identifiers are identical, the PAN ID Compression field
|
|
* shall be set to one, and the source PAN identifier shall be omitted
|
|
* from the transmitted frame. [1] pg. 41.
|
|
*/
|
|
|
|
if (IEEE802154_PANIDCMP(meta->destaddr.panid, priv->addr.panid))
|
|
{
|
|
*frame_ctrl |= IEEE802154_FRAMECTRL_PANIDCOMP;
|
|
}
|
|
}
|
|
|
|
if (meta->srcmode != IEEE802154_ADDRMODE_NONE)
|
|
{
|
|
/* If the destination address is not included, or if PAN ID Compression
|
|
* is off, we need to include the Source PAN ID.
|
|
*/
|
|
|
|
if ((meta->destaddr.mode == IEEE802154_ADDRMODE_NONE) ||
|
|
(!(*frame_ctrl & IEEE802154_FRAMECTRL_PANIDCOMP)))
|
|
{
|
|
IEEE802154_PANIDCOPY(&frame->io_data[mhr_len], priv->addr.panid);
|
|
mhr_len += IEEE802154_PANIDSIZE;
|
|
}
|
|
|
|
if (meta->srcmode == IEEE802154_ADDRMODE_SHORT)
|
|
{
|
|
IEEE802154_SADDRCOPY(&frame->io_data[mhr_len], priv->addr.saddr);
|
|
mhr_len += IEEE802154_SADDRSIZE;
|
|
}
|
|
else if (meta->srcmode == IEEE802154_ADDRMODE_EXTENDED)
|
|
{
|
|
int index;
|
|
|
|
/* The IEEE 802.15.4 Standard is confusing with regards to
|
|
* byte-order for * extended address. More research discovers
|
|
* that the extended address should be sent in reverse-canonical
|
|
* form.
|
|
*/
|
|
|
|
for (index = IEEE802154_EADDRSIZE - 1; index >= 0; index--)
|
|
{
|
|
frame->io_data[mhr_len++] = priv->addr.eaddr[index];
|
|
}
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* If this device is not the PAN coordinator, it shouldn't be sending
|
|
* frames with a source address mode of NONE
|
|
*/
|
|
|
|
if (priv->devmode != IEEE802154_DEVMODE_PANCOORD)
|
|
{
|
|
ret = -EINVAL;
|
|
goto errout_with_lock;
|
|
}
|
|
}
|
|
|
|
/* Set the source addr mode inside the frame control field */
|
|
|
|
*frame_ctrl |= (meta->srcmode << IEEE802154_FRAMECTRL_SHIFT_SADDR);
|
|
|
|
/* Each time a data or a MAC command frame is generated, the MAC sublayer
|
|
* shall copy the value of macDSN into the Sequence Number field of the MHR
|
|
* of the outgoing frame and then increment it by one. [1] pg. 40.
|
|
*/
|
|
|
|
frame->io_data[2] = priv->dsn++;
|
|
|
|
/* The MAC header we just created must never have exceeded where the app
|
|
* data starts. This should never happen since the offset should have
|
|
* been set via the same logic to calculate the header length as the logic
|
|
* here that created the header
|
|
*/
|
|
|
|
wlinfo("mhr_len=%u\n", mhr_len);
|
|
DEBUGASSERT(mhr_len == frame->io_offset);
|
|
|
|
/* Allocate the txdesc, waiting if necessary, allow interruptions */
|
|
|
|
ret = mac802154_txdesc_alloc(priv, &txdesc);
|
|
if (ret < 0)
|
|
{
|
|
/* Should only fail if interrupted by a signal while re-acquiring
|
|
* lock. So the lock is not held if a failure is returned.
|
|
*/
|
|
|
|
wlwarn("WARNING: mac802154_txdesc_alloc failed: %d\n", ret);
|
|
goto errout_with_lock;
|
|
}
|
|
|
|
/* Set the offset to 0 to include the header ( we do not want to
|
|
* modify the frame until AFTER the last place that -EINTR could
|
|
* be returned and could generate a retry. Subsequent error returns
|
|
* are fatal and no retry should occur.
|
|
*/
|
|
|
|
frame->io_offset = 0;
|
|
|
|
/* Then initialize the TX descriptor */
|
|
|
|
txdesc->conf->handle = meta->handle;
|
|
txdesc->frame = frame;
|
|
txdesc->frametype = IEEE802154_FRAME_DATA;
|
|
txdesc->ackreq = meta->flags.ackreq;
|
|
|
|
/* If the TxOptions parameter specifies that a GTS transmission is
|
|
* required, the MAC sublayer will determine whether it has a valid GTS as
|
|
* described 5.1.7.3. If a valid GTS could not be found, the MAC sublayer
|
|
* will discard the MSDU. If a valid GTS was found, the MAC sublayer will
|
|
* defer, if necessary, until the GTS. If the TxOptions parameter specifies
|
|
* that a GTS transmission is not required, the MAC sublayer will transmit
|
|
* the MSDU using either slotted CSMA-CA in the CAP for a beacon-enabled
|
|
* PAN or unslotted CSMA-CA for a nonbeacon-enabled PAN. Specifying a GTS
|
|
* transmission in the TxOptions parameter overrides an indirect
|
|
* transmission request. [1] pg. 118.
|
|
*/
|
|
|
|
if (meta->flags.usegts)
|
|
{
|
|
/* TODO:
|
|
* Support GTS transmission. This should just change where we link
|
|
* the transaction. Instead of going in the CSMA transaction list, it
|
|
* should be linked to the GTS' transaction list. We'll need to check
|
|
* if the GTS is valid, and then find the GTS, before linking.
|
|
* Note, we also don't have to try and kick-off any transmission here.
|
|
*/
|
|
|
|
ret = -ENOTSUP;
|
|
goto errout_with_txdesc;
|
|
}
|
|
else
|
|
{
|
|
/* If the TxOptions parameter specifies that an indirect transmission
|
|
* is required and this primitive is received by the MAC sublayer of a
|
|
* coordinator, the data frame is sent using indirect transmission, as
|
|
* described in 5.1.5 and 5.1.6.3. [1]
|
|
*/
|
|
|
|
if (meta->flags.indirect)
|
|
{
|
|
/* If the TxOptions parameter specifies that an indirect
|
|
* transmission is required and if the device receiving this
|
|
* primitive is not a coordinator, the destination address is not
|
|
* present, or the TxOptions parameter also specifies a
|
|
* GTS transmission, the indirect transmission option will be
|
|
* ignored. [1]
|
|
*
|
|
* NOTE: We don't just ignore the parameter. Instead, we throw an
|
|
* error, since this really shouldn't be happening.
|
|
*/
|
|
|
|
if (priv->devmode >= IEEE802154_DEVMODE_COORD &&
|
|
meta->destaddr.mode != IEEE802154_ADDRMODE_NONE)
|
|
{
|
|
/* Copy in a reference to the destination address to assist in
|
|
* searching when data is requested.
|
|
*/
|
|
|
|
memcpy(&txdesc->destaddr, &meta->destaddr,
|
|
sizeof(struct ieee802154_addr_s));
|
|
mac802154_setupindirect(priv, txdesc);
|
|
nxmutex_unlock(&priv->lock);
|
|
}
|
|
else
|
|
{
|
|
ret = -EINVAL;
|
|
goto errout_with_txdesc;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* Link the transaction into the CSMA transaction list */
|
|
|
|
sq_addlast((FAR sq_entry_t *)txdesc, &priv->csma_queue);
|
|
|
|
/* We no longer need to have the MAC layer locked. */
|
|
|
|
nxmutex_unlock(&priv->lock);
|
|
|
|
/* Notify the radio driver that there is data available */
|
|
|
|
priv->radio->txnotify(priv->radio, false);
|
|
}
|
|
}
|
|
|
|
return OK;
|
|
|
|
errout_with_txdesc:
|
|
|
|
/* Free TX the descriptor, but preserve the IOB. */
|
|
|
|
txdesc->frame = NULL;
|
|
mac802154_txdesc_free(priv, txdesc);
|
|
|
|
errout_with_lock:
|
|
nxmutex_unlock(&priv->lock);
|
|
return ret;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Internal MAC Functions
|
|
****************************************************************************/
|