285 lines
8.6 KiB
C
285 lines
8.6 KiB
C
/****************************************************************************
|
|
* net/sixlowpan/sixlowpan_framer.c
|
|
*
|
|
* 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 <stdbool.h>
|
|
#include <string.h>
|
|
#include <assert.h>
|
|
#include <errno.h>
|
|
#include <debug.h>
|
|
|
|
#include "nuttx/net/net.h"
|
|
#include "nuttx/net/radiodev.h"
|
|
#include "nuttx/wireless/ieee802154/ieee802154_mac.h"
|
|
|
|
#include "sixlowpan/sixlowpan_internal.h"
|
|
|
|
#ifdef CONFIG_NET_6LOWPAN
|
|
|
|
#ifdef CONFIG_WIRELESS_IEEE802154
|
|
/****************************************************************************
|
|
* Public Functions
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Name: sixlowpan_anyaddrnull
|
|
*
|
|
* Description:
|
|
* If the destination address is all zero in the MAC header buf, then it is
|
|
* broadcast on the 802.15.4 network.
|
|
*
|
|
* Input Parameters:
|
|
* addr - The address to check
|
|
* addrlen - The length of the address in bytes
|
|
*
|
|
* Returned Value:
|
|
* True if the address is all zero.
|
|
*
|
|
****************************************************************************/
|
|
|
|
static bool sixlowpan_anyaddrnull(FAR const uint8_t *addr, uint8_t addrlen)
|
|
{
|
|
while (addrlen-- > 0)
|
|
{
|
|
if (addr[addrlen] != 0x00)
|
|
{
|
|
return false;
|
|
}
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: sixlowpan_saddrnull
|
|
*
|
|
* Description:
|
|
* If the destination address is all zero in the MAC header buf, then it is
|
|
* broadcast on the 802.15.4 network.
|
|
*
|
|
* Input Parameters:
|
|
* eaddr - The short address to check
|
|
*
|
|
* Returned Value:
|
|
* The address length associated with the address mode.
|
|
*
|
|
****************************************************************************/
|
|
|
|
static inline bool sixlowpan_saddrnull(FAR const uint8_t *saddr)
|
|
{
|
|
return sixlowpan_anyaddrnull(saddr, NET_6LOWPAN_SADDRSIZE);
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: sixlowpan_eaddrnull
|
|
*
|
|
* Description:
|
|
* If the destination address is all zero in the MAC header buf, then it is
|
|
* broadcast on the 802.15.4 network.
|
|
*
|
|
* Input Parameters:
|
|
* eaddr - The extended address to check
|
|
*
|
|
* Returned Value:
|
|
* The address length associated with the address mode.
|
|
*
|
|
****************************************************************************/
|
|
|
|
static inline bool sixlowpan_eaddrnull(FAR const uint8_t *eaddr)
|
|
{
|
|
return sixlowpan_anyaddrnull(eaddr, NET_6LOWPAN_EADDRSIZE);
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Public Functions
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Name: sixlowpan_meta_data
|
|
*
|
|
* Description:
|
|
* Based on the collected attributes and addresses, construct the MAC meta
|
|
* data structure that we need to interface with the IEEE802.15.4 MAC.
|
|
*
|
|
* Input Parameters:
|
|
* radio - Radio network driver state instance.
|
|
* pktmeta - Meta-data specific to the current outgoing frame
|
|
* meta - Location to return the corresponding meta data.
|
|
*
|
|
* Returned Value:
|
|
* Ok is returned on success; Otherwise a negated errno value is returned.
|
|
*
|
|
* Assumptions:
|
|
* Called with the network locked.
|
|
*
|
|
****************************************************************************/
|
|
|
|
int sixlowpan_meta_data(FAR struct radio_driver_s *radio,
|
|
FAR const struct ieee802_txmetadata_s *pktmeta,
|
|
FAR struct ieee802154_frame_meta_s *meta)
|
|
{
|
|
bool rcvrnull;
|
|
|
|
/* Initialize all settings to all zero */
|
|
|
|
memset(meta, 0, sizeof(struct ieee802154_frame_meta_s));
|
|
|
|
/* Source address mode */
|
|
|
|
meta->srcmode = pktmeta->sextended != 0 ?
|
|
IEEE802154_ADDRMODE_EXTENDED :
|
|
IEEE802154_ADDRMODE_SHORT;
|
|
|
|
/* Check for a broadcast destination address (all zero) */
|
|
|
|
if (pktmeta->dextended != 0)
|
|
{
|
|
/* Extended destination address mode */
|
|
|
|
rcvrnull = sixlowpan_eaddrnull(pktmeta->dest.nm_addr);
|
|
}
|
|
else
|
|
{
|
|
/* Short destination address mode */
|
|
|
|
rcvrnull = sixlowpan_saddrnull(pktmeta->dest.nm_addr);
|
|
}
|
|
|
|
if (!rcvrnull)
|
|
{
|
|
meta->flags.ackreq = TRUE;
|
|
}
|
|
|
|
/* Destination address */
|
|
|
|
/* If the output address is NULL, then it is broadcast on the 802.15.4
|
|
* network.
|
|
*/
|
|
|
|
if (rcvrnull)
|
|
{
|
|
/* Broadcast requires short address mode. */
|
|
|
|
meta->destaddr.mode = IEEE802154_ADDRMODE_SHORT;
|
|
meta->destaddr.saddr[0] = 0xff;
|
|
meta->destaddr.saddr[1] = 0xff;
|
|
}
|
|
else if (pktmeta->dextended != 0)
|
|
{
|
|
/* Extended destination address mode */
|
|
|
|
meta->destaddr.mode = IEEE802154_ADDRMODE_EXTENDED;
|
|
sixlowpan_eaddrcopy(&meta->destaddr.eaddr, pktmeta->dest.nm_addr);
|
|
}
|
|
else
|
|
{
|
|
/* Short destination address mode */
|
|
|
|
meta->destaddr.mode = IEEE802154_ADDRMODE_SHORT;
|
|
|
|
/* 802.15.4 layer expects address in Little-Endian byte order */
|
|
|
|
meta->destaddr.saddr[0] = pktmeta->dest.nm_addr[1];
|
|
meta->destaddr.saddr[1] = pktmeta->dest.nm_addr[0];
|
|
}
|
|
|
|
/* 802.15.4 layer expects address in Little-Endian byte order */
|
|
|
|
meta->destaddr.panid[0] = pktmeta->dpanid[1];
|
|
meta->destaddr.panid[1] = pktmeta->dpanid[0];
|
|
|
|
/* Handle associated with MSDU. Will increment once per packet, not
|
|
* necessarily per frame: The same MSDU handle will be used for each
|
|
* fragment of a disassembled packet.
|
|
*/
|
|
|
|
meta->handle = radio->r_msdu_handle++;
|
|
|
|
#ifdef CONFIG_IEEE802154_SECURITY
|
|
# warning CONFIG_IEEE802154_SECURITY not yet supported
|
|
#endif
|
|
|
|
#ifdef CONFIG_IEEE802154_UWB
|
|
# warning CONFIG_IEEE802154_UWB not yet supported
|
|
#endif
|
|
|
|
/* Ranging left zero */
|
|
|
|
return OK;
|
|
}
|
|
#endif
|
|
|
|
/****************************************************************************
|
|
* Name: sixlowpan_frame_hdrlen
|
|
*
|
|
* Description:
|
|
* This function is before the first frame has been sent in order to
|
|
* determine what the size of the IEEE802.15.4 header will be. No frame
|
|
* buffer is required to make this determination.
|
|
*
|
|
* Input Parameters:
|
|
* radio - A reference IEEE802.15.4 MAC network device structure.
|
|
* meta - Meta data that describes the MAC header
|
|
*
|
|
* Returned Value:
|
|
* The frame header length is returned on success; otherwise, a negated
|
|
* errno value is return on failure.
|
|
*
|
|
****************************************************************************/
|
|
|
|
int sixlowpan_frame_hdrlen(FAR struct radio_driver_s *radio,
|
|
FAR const void *meta)
|
|
{
|
|
return radio->r_get_mhrlen(radio, meta);
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: sixlowpan_frame_submit
|
|
*
|
|
* Description:
|
|
* This function is called after eiether (1) the IEEE802.15.4 MAC driver
|
|
* polls for TX data or (2) after the IEEE802.15.4 MAC driver provides a
|
|
* new incoming frame and the network responds with an outgoing packet. It
|
|
* submits any new outgoing frame to the MAC.
|
|
*
|
|
* Input Parameters:
|
|
* radio - A reference to a radio network device instance.
|
|
* meta - Meta data that describes the MAC header
|
|
* frame - The IOB containing the frame to be submitted.
|
|
*
|
|
* Returned Value:
|
|
* Zero (OK) is returned on success; otherwise, a negated errno value is
|
|
* return on any failure.
|
|
*
|
|
****************************************************************************/
|
|
|
|
int sixlowpan_frame_submit(FAR struct radio_driver_s *radio,
|
|
FAR const void *meta, FAR struct iob_s *frame)
|
|
{
|
|
return radio->r_req_data(radio, meta, frame);
|
|
}
|
|
|
|
#endif /* CONFIG_NET_6LOWPAN */
|