nuttx/drivers/wireless/spirit/lib/spirit_pktstack.c
Gregory Nutt 47791442a0 Squashed commit of the following:
commit 3fcf84a9a2673e1e1466ce5b114d7b73c257e515
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Fri Jul 28 12:00:31 2017 -0600

    Spirit: Brings in the last of the PktCommon interfaces.

commit d26ebd901ba4ba84910e99b4e728b98c30fa4c0b
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Fri Jul 28 09:54:52 2017 -0600

    Spirit: Add a few more PktCommon interfaces.

commit b5cb8041d50233a4abb8fb4d1dcef5428ae2c2b2
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Fri Jul 28 09:33:31 2017 -0600

    libc/termios:  Remember block comments before empty file sections.

commit 0fcab2c1c8c74442d40bd5e8c6af50a34f8a5821
Author: Sebastien Lorquet <sebastien@lorquet.fr>
Date:   Fri Jul 28 09:31:00 2017 -0600

    tcdrain implementation based on a new term ioctl

commit 797d4adf7d41068c671f0217d369b797b269de1a
Author: Stefan Kolb <Stefan.Kolb@avat.de>
Date:   Fri Jul 28 09:19:04 2017 -0600

    We discovered a problem with the samv7 mcan driver which results, under some circumstances, in a very high CPU load.

    The problem occurs, and is easily reproducible, if the device is connected to a CAN network with a wrongly configured CAN speed (baud rate). In our tests we set the CAN speed of the device to 1000000 and the speed of the other CAN nodes to 500000. The device is restarted and sends a CANopen “bootup message” to the CAN network. This results in huge amount of errors messages on the CAN bus, probably because of the CAN feature for acknowledging error messages. The error messages can’t be read by the device because of the misconfigured CAN speed, instead the CAN chip reports lots of errors, which are reported to the application which uses the CAN driver (CONFIG_CAN_ERRORS is enabled).

    The CAN errors are reported from the CAN chip via interrupts and thus the interrupt load is very high in this scenario. To fix the problem the driver now disables each RX error interrupt after it is occurred. The RX error interrupts are turned back on if at least one CAN message is received successfully.

commit e298f48e96d9e34017dcab8e4d87032862ae9322
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Fri Jul 28 09:06:26 2017 -0600

    Spirit:  Bring in PktStack interfaces.

commit 4a0f00a7058312dcf6ac392689b9f69112f613ec
Merge: 855cf97130 b458934ac4
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Thu Jul 27 18:05:02 2017 -0600

    Merge remote-tracking branch 'origin/master' into spirit

commit 855cf9713052a851a1daeb3842db2edd6ff6f658
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Thu Jul 27 18:03:56 2017 -0600

    Spirit Network Driver:  Add some hooks that will eventually support address filtering.

commit 3b3fb24ea86cf8233b034871d5c550f47ab852e6
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Thu Jul 27 17:13:21 2017 -0600

    Spirit: Add a PktStack header file.

commit 705e8fff6a21264ab751fb34c107cb109430ac89
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Thu Jul 27 15:00:03 2017 -0600

    Spirit:  Bring in last of timer interfaces.

commit f8984b2f82e165f5bba132d6b099222d1beb1fbd
Merge: cb79778a30 f287cc25d6
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Thu Jul 27 11:57:01 2017 -0600

    Merge remote-tracking branch 'origin/master' into spirit

commit cb79778a3044ae97a1cc615dfa24099144f04bd0
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Thu Jul 27 11:46:31 2017 -0600

    Spirit:  Bring in last of QI interfaces.

commit 0245b330a33aa73531b82ae261b1312be9922e0f
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Thu Jul 27 10:14:34 2017 -0600

    Spirit:  Add general interfaces.

commit 121845a8f229ec2c88e5721da5512135f6624ee5
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Thu Jul 27 09:41:23 2017 -0600

    Spirit:  Bring in last of GPIO interfaces.

commit 279bfcc92bcd0cfa48c0ed7862fa2b75fbee99b8
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Wed Jul 26 17:09:19 2017 -0600

    Spirit: Add some missing configuration options: Add register -level debug options.

commit 4be89324a5908e35afc70373c279f4d05f62b48f
Merge: 66e87f9bb3 598386ef90
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Wed Jul 26 15:36:20 2017 -0600

    Merge remote-tracking branch 'origin/master' into spirit

commit 66e87f9bb3ef75fddf25400bc08475c5e6ad4c30
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Wed Jul 26 15:19:56 2017 -0600

    Spirit:  Brings in last of PktBasic logic.

commit 8b4c89d6a103003fa04363e2c2ae7b9ee390bf49
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Wed Jul 26 11:55:50 2017 -0600

    Spirit:  Bring in AES and MBUS logic.

commit d00022d39ab0ce839de29386949481e5c24feff3
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Wed Jul 26 09:22:03 2017 -0600

    Spirit:  Bring in remainder of calibration interfaces.

commit 40b4b2f902e04293f8940551a97a9a24a48988dd
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Wed Jul 26 08:44:32 2017 -0600

    Spirit:  Bring in DirectRF interfaces.

commit 7c109608e1a2989f3edbc2fd939a2d225fff382a
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Wed Jul 26 07:46:19 2017 -0600

    Spirit: Add CSMA support.

commit 0f88896595d162c4ac6138e7b1af2fc35c865b3d
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Tue Jul 25 18:57:43 2017 -0600

    Spirit:  Add some initial TX logic to network driver.

commit 4dc7058dfcdcf40980578680b7e1a4206dea4ea2
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Tue Jul 25 17:02:11 2017 -0600

    Spirit: Completes ports of spirit_management.* files

commit c904eef51d929e041b87d0c8aff6fa3c2f895341
Merge: 91e985a877 c9ff8cbab9
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Tue Jul 25 15:15:04 2017 -0600

    Merge remote-tracking branch 'origin/master' into spirit

commit 91e985a87729017a66d19276c4d47681064f95ea
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Tue Jul 25 15:13:54 2017 -0600

    Spirit:  Add a few more functions that will soon be needed for packet transmission.

commit b5981d29983907c2194fbc26af4b72ad532bee78
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Tue Jul 25 13:30:07 2017 -0600

    Spirit:  Finish off some initialization issues; Started some interrupt handling logic.

commit c21073e0bc2870b3d9ba40bdfdfd5151ce4f5890
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Tue Jul 25 09:35:52 2017 -0600

    Spirit:  Completes very basic radio initialization for network driver

commit 1b544334361c54f46bcf0ba313c125932e8dafc6
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Tue Jul 25 07:58:30 2017 -0600

    Spirit: Add more radio initialization logic... getting closer.

commit 45d1047db60843c57d394ec910c63e7c127671e0
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Mon Jul 24 19:15:33 2017 -0600

    Spirit: add some CSMA initialization logic

commit bcf55c71336d48947fe19bb09a799169852301c2
Merge: 89e9d426e9 2fc0fbcf7e
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Mon Jul 24 16:47:11 2017 -0600

    Merge remote-tracking branch 'origin/master' into spirit

commit 89e9d426e91c056e659fccf5e5c4392618f8f777
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Mon Jul 24 16:44:19 2017 -0600

    Update some comments

commit 9c5d8a5833350006ed389e898b11c8c8a20e5f4f
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Mon Jul 24 16:15:54 2017 -0600

    Spirit:  Rename drivers/wireless/spirit/src to lib.  Move Spirit network driver out of IEEE802.15.4 into drivers/wireless/spirit/drivers

commit cabc0ec9e6eb558dcb715ab17264383aa0105e7a
Merge: 87b616414a 6bd744c4b3
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Mon Jul 24 15:38:40 2017 -0600

    Merge remote-tracking branch 'origin/master' into spirit

commit 87b616414a79c01a71acea78f8258e05325c1996
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Mon Jul 24 15:37:27 2017 -0600

    Spirit radio driver is mutating into a standalone network driver.

commit 507798233868a661ae8adad3e3aa117075a7a146
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Mon Jul 24 13:32:08 2017 -0600

    Spirit: More radio initialization logic

commit 33af25704ce9ca83d576300d153cfe31cc6d2576
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Mon Jul 24 12:19:14 2017 -0600

    Spirit:  Beginning of radio initialization logic

commit 97b20014c016e55952a8f9d8f4ae29e2cc555b23
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Mon Jul 24 09:42:06 2017 -0600

    Spirit: More initialization logic.

commit 295d8e27824c0417fccea2344b30bb5c93ffbabe
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Sun Jul 23 15:39:53 2017 -0600

    Spirit:  Add header file containing enumeration of commands.

commit 8a2d9dd8eb9cc70cbcdd1b913fc9022b9c9ec8da
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Sun Jul 23 11:33:50 2017 -0600

    Spirit:  Add GPIO initialization logic

commit 8b6d80c44f92024c45a6ba63ba1af3fdafe94dc3
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Sun Jul 23 10:07:25 2017 -0600

    Spirit:  Add interrupt control logic.

commit 423f846fe5c914f92a4bfea4d9d1fa33de1c77a5
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Sat Jul 22 19:06:52 2017 -0600

    Spirit: Yet a little more radio initialization logic.

commit 5895b979823e51ddde5ad52e6de66a8ad662e883
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Sat Jul 22 15:36:05 2017 -0600

    Spirit: A little more radio initialization logic.

commit 86311ab30aad386203c181c792847dd1d37f9a02
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Sat Jul 22 13:02:32 2017 -0600

    Spirit: A miniscule amount of radio initialization logic.

commit ad55e89d5ee12ea1eeea95fcd38ff3da0db4416a
Merge: 90a7666655 f4e46b0da7
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Sat Jul 22 10:56:30 2017 -0600

    Merge remote-tracking branch 'origin/master' into spirit

commit 90a766665534b05da0157dbc383cb06a98c86a79
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Sat Jul 22 10:52:52 2017 -0600

    Spirit1:  A few fixes for a clean build of initial configuration (not much there yet)

commit bbbf04c223230a52a7705a2161128265cfbaa480
Merge: 623d54a7f7 2319ea53a9
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Sat Jul 22 09:53:57 2017 -0600

    Merge remote-tracking branch 'origin/master' into spirit

commit 623d54a7f719e9032099f88f38203efee4b80722
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Sat Jul 22 09:43:52 2017 -0600

    b-l475e-iot01a: Add a configuration for testing sprit radio.

commit d309d73d9f4665f9d870eb03531f450043d9389d
Merge: 52c3ddfae6 d88dc9b2e5
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Sat Jul 22 09:02:06 2017 -0600

    Merge remote-tracking branch 'origin/master' into spirit

commit 52c3ddfae6802e111c2b5cf1207baf21a61dd00b
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Sat Jul 22 08:33:04 2017 -0600

    Spirit:  Add register definition header file.

commit 8d842ab5e8f9ca653b42f9ee88dc279f06b4fa98
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Fri Jul 21 17:27:03 2017 -0600

    b-l475e-iot01a: Add initial, unverified support for the SPSRGF/Spirit1 module.

commit 73d902a1048616fb9c2dd2147cabcd8ee78e19ac
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Fri Jul 21 15:49:43 2017 -0600

    Spirit: Fixes to get skeleton IEEE 802.15.4 driver build.

commit ebc5a8387bb94f0cc3827533795f3e4a33207e67
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Fri Jul 21 15:16:29 2017 -0600

    Spirit1:  Add framework for IEEE 802.15.4 driver.  Does not yet build.

commit 52e195a7ae14ddb18bdd56258f4877381d2501ca
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Fri Jul 21 14:02:42 2017 -0600

    Spirit:  A little more SPI logic.

commit 90048d0c5b8a5af4d81a15d99535c84ed38d8ae9
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Fri Jul 21 11:19:06 2017 -0600

    Spirit: Build directories setup.  Some initial files added, mostly just to verify build.

commit 8273a381ac1f6bb081b292b5e73226185e9e634c
Author: Gregory Nutt <gnutt@nuttx.org>
Date:   Fri Jul 21 08:34:04 2017 -0600

    USB composite:  Remove references to CDC/ACM and USB MSC from composite logic.  They are no longer coupled.
2017-07-28 12:01:05 -06:00

922 lines
26 KiB
C

/******************************************************************************
* drivers/wireless/spirit/spirit_pktstack.c
* Configuration and management of SPIRIT STack packets.
*
* Copyright(c) 2015 STMicroelectronics
* Author: VMA division - AMS
* Version 3.2.2 08-July-2015
*
* Adapted for NuttX by:
* Author: Gregory Nutt <gnutt@nuttx.org>
*
* 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 STMicroelectronics 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.
*
******************************************************************************/
/******************************************************************************
* Included Files
******************************************************************************/
#include <sys/types.h>
#include <assert.h>
#include "spirit_spi.h"
#include "spirit_pktcommon.h"
#include "spirit_pktstack.h"
/******************************************************************************
* Public Functions
******************************************************************************/
/******************************************************************************
* Name: spirit_pktstack_initialize
*
* Description:
* Initializes the SPIRIT STack packet according to the specified parameters
* in the struct spirit_pktstack_init_s.
*
* Input Parameters:
* spirit - Reference to a Spirit library state structure instance
* pktstack - STack packet init structure.
*
* Returned Value:
* Zero (OK) on success; a negated errno value on failure.
*
******************************************************************************/
int spirit_pktstack_initialize(FAR struct spirit_library_s *spirit,
FAR const struct spirit_pktstack_init_s *pktstack)
{
uint8_t regval[4];
uint8_t pktlenwidth;
int ret;
int i;
/* Check the parameters */
DEBUGASSERT(IS_PKT_PREAMBLE_LENGTH(pktstack->premblen));
DEBUGASSERT(IS_PKT_SYNC_LENGTH(pktstack->synclen));
DEBUGASSERT(IS_PKT_CRC_MODE(pktstack->crcmode));
DEBUGASSERT(IS_PKT_LENGTH_WIDTH_BITS(pktstack->pktlenwidth));
DEBUGASSERT(IS_PKT_CRC_MODE(pktstack->fixvarlen));
DEBUGASSERT(IS_SPIRIT_FUNCTIONAL_STATE(pktstack->fec));
DEBUGASSERT(IS_SPIRIT_FUNCTIONAL_STATE(pktstack->datawhite));
DEBUGASSERT(IS_PKT_CONTROL_LENGTH(pktstack->ctrllen));
/* Read the PROTOCOL1 register */
ret = spirit_reg_read(spirit, PROTOCOL1_BASE, &regval[0], 1);
if (ret < 0)
{
return ret;
}
/* Mask a reserved bit */
regval[0] &= ~0x20;
/* Always (!) set the automatic packet filtering */
regval[0] |= PROTOCOL1_AUTO_PCKT_FLT_MASK;
/* Write the value to register */
ret = spirit_reg_write(spirit, PROTOCOL1_BASE, &regval[0], 1);
if (ret < 0)
{
return ret;
}
/* Read the PCKT_FLT_OPTIONS register */
ret = spirit_reg_read(spirit, PCKT_FLT_OPTIONS_BASE, &regval[0], 1);
if (ret < 0)
{
return ret;
}
/* Always reset the control and source filtering */
regval[0] &= ~(PCKT_FLT_OPTIONS_SOURCE_FILTERING_MASK |
PCKT_FLT_OPTIONS_CONTROL_FILTERING_MASK);
/* Write the value to register */
ret = spirit_reg_write(spirit, PCKT_FLT_OPTIONS_BASE, &regval[0], 1);
if (ret < 0)
{
return ret;
}
/* Address and control length setting: source and destination address are
* always present so ADDRESS_LENGTH=2 */
regval[0] = 0x10 | (uint8_t)pktstack->ctrllen;
/* Packet format and width length setting */
pktlenwidth = pktstack->pktlenwidth;
if (pktlenwidth == 0)
{
pktlenwidth = 1;
}
regval[1] = (uint8_t)PCKTCTRL3_PCKT_FRMT_STACK | (uint8_t)(pktlenwidth - 1);
/* Preamble, sync and fixed or variable length setting */
regval[2] = ((uint8_t)pktstack->premblen) | ((uint8_t)pktstack->synclen) |
((uint8_t)pktstack->fixvarlen);
/* CRC length, whitening and FEC setting */
regval[3] = (uint8_t) pktstack->crcmode;
if (pktstack->datawhite == S_ENABLE)
{
regval[3] |= PCKTCTRL1_WHIT_MASK;
}
if (pktstack->fec == S_ENABLE)
{
regval[3] |= PCKTCTRL1_FEC_MASK;
}
/* Write registers */
ret = spirit_reg_write(spirit, PCKTCTRL4_BASE, regval, 4);
if (ret < 0)
{
return ret;
}
/* Sync words setting */
for (i = 0; i < 4; i++)
{
if (i < 3 - (pktstack->synclen >> 1))
{
regval[i] = 0;
}
else
{
regval[i] = (uint8_t) (pktstack->syncwords >> (8 * i));
}
}
/* Enables or disables the CRC check */
if (pktstack->crcmode == PKT_NO_CRC)
{
ret = spirit_pktcommon_enable_crcfilter(spirit, S_DISABLE);
}
else
{
ret = spirit_pktcommon_enable_crcfilter(spirit, S_ENABLE);
}
if (ret < 0)
{
return ret;
}
/* Write registers */
return spirit_reg_write(spirit, SYNC4_BASE, regval, 4);
}
/******************************************************************************
* Name: spirit_pktstack_get_setup
* Description:
* Returns the SPIRIT STack packet structure according to the specified
* parameters in the registers.
*
* Input Parameters:
* spirit - Reference to a Spirit library state structure instance
* pktstack - STack packet init structure.
*
* Returned Value:
* Zero (OK) on success; a negated errno value on failure.
*
******************************************************************************/
int spirit_pktstack_get_setup(FAR struct spirit_library_s *spirit,
FAR struct spirit_pktstack_init_s *pktstack)
{
uint8_t regval[10];
int ret;
int i;
/* Read registers */
ret = spirit_reg_read(spirit, PCKTCTRL4_BASE, regval, 10);
if (ret >= 0)
{
/* Length width */
pktstack->pktlenwidth = (regval[1] & 0x0f) + 1;
/* Control length */
pktstack->ctrllen = regval[0] & 0x07;
/* CRC mode */
pktstack->crcmode = regval[3] & 0xe0;
/* Whitening */
pktstack->datawhite = (regval[3] >> 4) & 0x01;
/* FEC */
pktstack->fec = regval[3] & 0x01;
/* FIX or VAR bit */
pktstack->fixvarlen = regval[2] & 0x01;
/* Preamble length */
pktstack->premblen = regval[2] & 0xf8;
/* Sync length */
pktstack->synclen = regval[2] & 0x06;
/* sync Words */
pktstack->syncwords = 0;
for (i = 0; i < 4; i++)
{
if (i > 2 - (pktstack->synclen >> 1))
{
pktstack->syncwords |= regval[i + 6] << (8 * i);
}
}
}
return OK;
}
/******************************************************************************
* Name: spirit_pktstack_address_initialize
*
* Description:
* Initializes the SPIRIT STack packet addresses according to the specified
* parameters in the PktStackAddresses struct.
*
* Input Parameters:
* spirit - Reference to a Spirit library state structure instance
* addrinit - STack packet addresses init structure.
*
* Returned Value:
* Zero (OK) on success; a negated errno value on failure.
*
******************************************************************************/
int spirit_pktstack_address_initialize(FAR struct spirit_library_s *spirit,
FAR const struct spirit_pktstack_address_s *addrinit)
{
uint8_t regval[3];
int ret;
/* Check the parameters */
DEBUGASSERT(IS_SPIRIT_FUNCTIONAL_STATE(addrinit->destfilter));
DEBUGASSERT(IS_SPIRIT_FUNCTIONAL_STATE(addrinit->mcastfilter));
DEBUGASSERT(IS_SPIRIT_FUNCTIONAL_STATE(addrinit->bcastfilter));
/* Read the filtering options ragister */
ret = spirit_reg_read(spirit, PCKT_FLT_OPTIONS_BASE, &regval[0], 1);
if (ret >= 0)
{
/* Enables or disables filtering on my address */
if (addrinit->destfilter == S_ENABLE)
{
regval[0] |= PCKT_FLT_OPTIONS_DEST_VS_TX_ADDR_MASK;
}
else
{
regval[0] &= ~PCKT_FLT_OPTIONS_DEST_VS_TX_ADDR_MASK;
}
/* Enables or disables filtering on multicast address */
if (addrinit->mcastfilter == S_ENABLE)
{
regval[0] |= PCKT_FLT_OPTIONS_DEST_VS_MULTICAST_ADDR_MASK;
}
else
{
regval[0] &= ~PCKT_FLT_OPTIONS_DEST_VS_MULTICAST_ADDR_MASK;
}
/* Enables or disables filtering on broadcast address */
if (addrinit->bcastfilter == S_ENABLE)
{
regval[0] |= PCKT_FLT_OPTIONS_DEST_VS_BROADCAST_ADDR_MASK;
}
else
{
regval[0] &= ~PCKT_FLT_OPTIONS_DEST_VS_BROADCAST_ADDR_MASK;
}
/* Write values to the register */
ret = spirit_reg_write(spirit, PCKT_FLT_OPTIONS_BASE, &regval[0], 1);
if (ret >= 0)
{
/* Fill array with the addresses passed in the structure */
regval[0] = addrinit->bcastaddr;
regval[1] = addrinit->mcastaddr;
regval[2] = addrinit->srcaddr;
/* Write them to the addresses registers */
ret = spirit_reg_write(spirit, PCKT_FLT_GOALS_BROADCAST_BASE, regval, 3);
}
}
return ret;
}
/******************************************************************************
* Name: spirit_pktstack_get_addrsetup
*
* Description:
* Returns the SPIRIT STack packet addresses structure according to the
* specified parameters in the registers.
*
* Input Parameters:
* spirit - Reference to a Spirit library state structure instance
* addrinit - STack packet addresses init structure.
*
* Returned Value:
* Zero (OK) on success; a negated errno value on failure.
*
******************************************************************************/
int spirit_pktstack_get_addrsetup(FAR struct spirit_library_s *spirit,
FAR struct spirit_pktstack_address_s *addrinit)
{
uint8_t regval[3];
int ret;
/* Read values from the PCKT_FLT_GOALS registers */
ret = spirit_reg_read(spirit, PCKT_FLT_GOALS_BROADCAST_BASE, regval, 3);
if (ret >= 0)
{
/* Fit the structure with the read addresses */
addrinit->bcastaddr = regval[0];
addrinit->mcastaddr = regval[1];
addrinit->srcaddr = regval[2];
ret = spirit_reg_read(spirit, PCKT_FLT_OPTIONS_BASE, &regval[0], 1);
if (ret >= 0)
{
/* Fit the structure with the read filtering bits */
addrinit->bcastfilter =
(enum spirit_functional_state_e)((regval[0] >> 1) & 0x01);
addrinit->mcastfilter =
(enum spirit_functional_state_e)((regval[0] >> 2) & 0x01);
addrinit->destfilter =
(enum spirit_functional_state_e)((regval[0] >> 3) & 0x01);
}
}
return ret;
}
/******************************************************************************
* Name: spirit_pktstack_llp_initialize
*
* Description:
* Initializes the SPIRIT STack packet LLP options according to the specified
* parameters in the struct spirit_pktstack_llp_s struct.
*
* Input Parameters:
* spirit - Reference to a Spirit library state structure instance
* llpinit - STack packet LLP init structure.
*
* Returned Value:
* Zero (OK) on success; a negated errno value on failure.
*
******************************************************************************/
int spirit_pktstack_llp_initialize(FAR struct spirit_library_s *spirit,
FAR const struct spirit_pktstack_llp_s *llpinit)
{
uint8_t regval[2];
int ret;
/* Check the parameters */
DEBUGASSERT(IS_SPIRIT_FUNCTIONAL_STATE(llpinit->piggyback));
DEBUGASSERT(IS_SPIRIT_FUNCTIONAL_STATE(llpinit->autoack));
DEBUGASSERT(IS_PKT_MAXRETX(llpinit->maxretx));
/* Check if piggybacking is enabled and autoack is disabled */
DEBUGASSERT(!(llpinit->piggyback == S_ENABLE &&
llpinit->autoack == S_DISABLE));
/* Piggybacking mechanism setting from the PROTOCOL1 register */
ret = spirit_reg_read(spirit, PROTOCOL1_BASE, regval, 2);
if (ret >= 0)
{
if (llpinit->piggyback == S_ENABLE)
{
regval[0] |= PROTOCOL1_PIGGYBACKING_MASK;
}
else
{
regval[0] &= ~PROTOCOL1_PIGGYBACKING_MASK;
}
/* RX and TX autoack mechanisms setting from the PROTOCOL0 register */
if (llpinit->autoack == S_ENABLE)
{
regval[1] |= PROTOCOL0_AUTO_ACK_MASK;
}
else
{
regval[1] &= ~PROTOCOL0_AUTO_ACK_MASK;
}
/* Max number of retransmission setting */
regval[1] &= ~PROTOCOL0_NMAX_RETX_MASK;
regval[1] |= llpinit->maxretx;
/* Write registers */
ret = spirit_reg_write(spirit, PROTOCOL1_BASE, regval, 2);
}
return ret;
}
/******************************************************************************
* Name: spirit_pktstack_get_llpsetup
*
* Description:
* Returns the SPIRIT STack packet LLP options according to the specified
* values in the registers.
*
* Input Parameters:
* spirit - Reference to a Spirit library state structure instance
* llpinit - STack packet LLP structure.
*
* Returned Value:
* Zero (OK) on success; a negated errno value on failure.
*
******************************************************************************/
int spirit_pktstack_get_llpsetup(FAR struct spirit_library_s *spirit,
FAR struct spirit_pktstack_llp_s *llpinit)
{
uint8_t regval[2];
int ret;
/* Piggybacking mechanism setting from the PROTOCOL1 register */
ret = spirit_reg_read(spirit, PROTOCOL1_BASE, regval, 2);
if (ret >= 0)
{
/* Fit the structure with the read values */
llpinit->piggyback = (regval[0] >> 6) & 0x01;
llpinit->autoack = (regval[1] >> 2) & 0x01;
llpinit->maxretx = regval[1] & PROTOCOL0_NMAX_RETX_MASK;
}
return ret;
}
/******************************************************************************
* Name: spirit_pktstack_set_format
*
* Description:
* Configures the Stack packet format for SPIRIT.
*
* Input Parameters:
* spirit - Reference to a Spirit library state structure instance
*
* Returned Value:
* Zero (OK) on success; a negated errno value on failure.
*
******************************************************************************/
int spirit_pktstack_set_format(FAR struct spirit_library_s *spirit)
{
uint8_t regval;
int ret;
/* Read the PCKTCTRL3 register value */
ret = spirit_reg_read(spirit, PCKTCTRL3_BASE, &regval, 1);
if (ret < 0)
{
return ret;
}
/* Build value to be written. Also set to 0 the direct RX mode bits */
regval &= 0x0f;
regval |= ((uint8_t) PCKTCTRL3_PCKT_FRMT_STACK);
/* Write the value to the PCKTCTRL3 register. */
ret = spirit_reg_write(spirit, PCKTCTRL3_BASE, &regval, 1);
if (ret < 0)
{
return ret;
}
/* Read the PCKTCTRL1 register value */
ret = spirit_reg_read(spirit, PCKTCTRL1_BASE, &regval, 1);
if (ret < 0)
{
return ret;
}
/* Build the new value. Set to 0 the direct TX mode bits */
regval &= 0xf3;
/* Write the PCKTCTRL1 value to register */
ret = spirit_reg_write(spirit, PCKTCTRL1_BASE, &regval, 1);
if (ret < 0)
{
return ret;
}
/* Read the PROTOCOL1 register */
ret = spirit_reg_read(spirit, PROTOCOL1_BASE, &regval, 1);
if (ret < 0)
{
return ret;
}
/* Mask a reserved bit */
regval &= ~0x20;
/* Write the value to the PROTOCOL1 register */
return spirit_reg_write(spirit, PROTOCOL1_BASE, &regval, 1);
}
/******************************************************************************
* Name: spirit_pktstack_enable_addrlen
*
* Description:
* Sets the address length for SPIRIT STack packets (always 2).
*
* Input Parameters:
* spirit - Reference to a Spirit library state structure instance
*
* Returned Value:
* Zero (OK) on success; a negated errno value on failure.
*
******************************************************************************/
int spirit_pktstack_enable_addrlen(FAR struct spirit_library_s *spirit)
{
uint8_t regval;
int ret;
/* Read the PCKTCTRL4 register value */
ret = spirit_reg_read(spirit, PCKTCTRL4_BASE, &regval, 1);
if (ret >= 0)
{
/* Build the new value */
regval &= ~PCKTCTRL4_ADDRESS_LEN_MASK;
regval |= ((uint8_t) 0x10);
/* Write the value to the PCKTCTRL4 register */
ret = spirit_reg_write(spirit, PCKTCTRL4_BASE, &regval, 1);
}
return ret;
}
/******************************************************************************
* Name: spirit_pktstack_set_payloadlen
*
* Description:
* Sets the payload length for SPIRIT STack packets. Since the packet length
* depends from the address (always 2 for this packet format) and the
* control field size, this function reads the control length register
* content in order to determine the correct packet length to be written.
*
* Input Parameters:
* spirit - Reference to a Spirit library state structure instance
* payloadlen - Payload length in bytes.
*
* Returned Value:
* Zero (OK) on success; a negated errno value on failure.
*
******************************************************************************/
int spirit_pktstack_set_payloadlen(FAR struct spirit_library_s *spirit,
uint16_t payloadlen)
{
uint8_t regval[2];
/* Computes the oversize (address + control) size */
uint16_t oversize = 2 + (uint16_t)spirit_pktcommon_get_controllen(spirit);
/* Computes PCKTLEN0 value from lPayloadLength */
regval[1] = BUILD_PCKTLEN0(payloadlen + oversize);
/* Computes PCKTLEN1 value from lPayloadLength */
regval[0] = BUILD_PCKTLEN1(payloadlen + oversize);
/* Write the value to the PCKTLENx registers */
return spirit_reg_write(spirit, PCKTLEN1_BASE, regval, 2);
}
/******************************************************************************
* Name: spirit_pktstack_get_payloadlen
*
* Description:
* Returns the payload length for SPIRIT STack packets. Since the packet
* length depends from the address and the control field size, this function
* reads the correspondent registers in order to determine the correct
* payload length to be returned.
*
* Input Parameters:
* None.
*
* Returned Value:
* Payload length.
*
******************************************************************************/
uint16_t spirit_pktstack_get_payloadlen(FAR struct spirit_library_s *spirit)
{
uint8_t regval[2];
uint16_t oversize;
/* Computes the oversize (address + control) size */
oversize = 2 + (uint16_t)spirit_pktcommon_get_controllen(spirit);
/* Read the PCKTLEN1 registers value */
(void)spirit_reg_read(spirit, PCKTLEN1_BASE, regval, 2);
/* Rebuild and return the payload length value */
return ((((uint16_t) regval[1]) << 8) + (uint16_t) regval[0] - oversize);
}
/******************************************************************************
* Name: spirit_pktstack_set_varlen
*
* Description:
* Computes and sets the variable payload length for SPIRIT STack packets.
*
* Input Parameters:
* spirit - Reference to a Spirit library state structure instance
* payloadlen - Payload length in bytes.
* ctrllen - Control length in bytes.
*
* Returned Value:
* Zero (OK) on success; a negated errno value on failure.
*
******************************************************************************/
int spirit_pktstack_set_varlen(FAR struct spirit_library_s *spirit,
uint16_t payloadlen,
enum pkt_ctrllen_e ctrllen)
{
uint32_t pktlen;
uint8_t regval;
int ret;
int i;
/* packet length = payload length + address length (2) + control length */
pktlen = payloadlen + 2 + ctrllen;
/* Computes the number of bits */
for (i = 0; i < 16; i++)
{
if (pktlen == 0)
{
break;
}
pktlen >>= 1;
}
if (i == 0)
{
i = 1;
}
/* Read the PCKTCTRL3 register value */
ret = spirit_reg_read(spirit, PCKTCTRL3_BASE, &regval, 1);
if (ret >= 0)
{
/* Build the register value */
regval &= ~PCKTCTRL3_LEN_WID_MASK;
regval |= (uint8_t)(i - 1);
/* Write the PCKTCTRL3 register value */
ret = spirit_reg_write(spirit, PCKTCTRL3_BASE, &regval, 1);
}
return ret;
}
/******************************************************************************
* Name: spirit_pkstack_set_rxsource_addrmask
*
* Description:
* Rx packet source mask. Used to mask the address of the accepted packets.
* If 0 -> no filtering.
*
* Input Parameters:
* spirit - Reference to a Spirit library state structure instance
* mask - Rx source mask.
*
* Returned Value:
* Zero (OK) on success; a negated errno value on failure.
*
******************************************************************************/
int spirit_pkstack_set_rxsource_addrmask(FAR struct spirit_library_s *spirit,
uint8_t mask)
{
/* Write value to the register PCKT_FLT_GOALS_SOURCE_MASK */
return spirit_reg_write(spirit, PCKT_FLT_GOALS_SOURCE_MASK_BASE, &mask, 1);
}
/******************************************************************************
* Name: spirit_pktstack_get_rxsource_addrmask
*
* Description:
* Returns the Rx packet source mask. Used to mask the address of the
* accepted packets. If 0 -> no filtering.
*
* Input Parameters:
* spirit - Reference to a Spirit library state structure instance
*
* Returned Value:
* Rx source mask.
*
******************************************************************************/
uint8_t spirit_pktstack_get_rxsource_addrmask(FAR struct spirit_library_s *spirit)
{
uint8_t regval;
/* Write value to the PCKT_FLT_GOALS_SOURCE_MASK register */
(void)spirit_reg_read(spirit, PCKT_FLT_GOALS_SOURCE_MASK_BASE, &regval, 1);
/* Return the read value */
return regval;
}
/******************************************************************************
* Name: spirit_pkstack_get_rxpktlen
*
* Description:
* Returns the packet length field of the received packet.
*
* Input Parameters:
* spirit - Reference to a Spirit library state structure instance
*
* Returned Value:
* Packet length.
*
******************************************************************************/
uint16_t spirit_pkstack_get_rxpktlen(FAR struct spirit_library_s *spirit)
{
uint8_t regval[2];
uint16_t pktlen;
/* Read the RX_PCKT_LENx registers value */
(void)spirit_reg_read(spirit, RX_PCKT_LEN1_BASE, regval, 2);
/* Rebuild and return the the length field */
pktlen = ((((uint16_t) regval[0]) << 8) + (uint16_t) regval[1]);
/* Computes the oversize (address + control) size */
pktlen -= 2 + (uint16_t)spirit_pktcommon_get_controllen(spirit);
return pktlen;
}
/******************************************************************************
* Name: spirit_pkstack_enable_rxsource_addrfilter
*
* Description:
* If enabled RX packet is accepted only if the masked source address field
* matches the masked source address field reference (SOURCE_MASK &
* SOURCE_FIELD_REF == SOURCE_MASK & RX_SOURCE_FIELD).
*
* NOTE: This filtering control is enabled by default but the source
* address mask is by default set to 0. As a matter of fact the user has
* to enable the source filtering bit after the packet initialization
* because the packet initialiazation routine disables it.
*
* Input Parameters:
* spirit - Reference to a Spirit library state structure instance
* newstate - New state for Source address filtering enable bit.
* This parameter can be S_ENABLE or S_DISABLE.
*
* Returned Value:
* Zero (OK) on success; a negated errno value on failure.
*
******************************************************************************/
int spirit_pkstack_enable_rxsource_addrfilter(FAR struct spirit_library_s *spirit,
enum spirit_functional_state_e newstate)
{
uint8_t regval;
int ret;
/* Check the parameters */
DEBUGASSERT(IS_SPIRIT_FUNCTIONAL_STATE(newstate));
/* Modify the register value: set or reset the source bit filtering */
ret = spirit_reg_read(spirit, PCKT_FLT_OPTIONS_BASE, &regval, 1);
if (ret >= 0)
{
/* Set or reset the SOURCE ADDRESS filtering enabling bit */
if (newstate == S_ENABLE)
{
regval |= PCKT_FLT_OPTIONS_SOURCE_FILTERING_MASK;
}
else
{
regval &= ~PCKT_FLT_OPTIONS_SOURCE_FILTERING_MASK;
}
/* Write the new value to the PCKT_FLT_OPTIONS register */
ret = spirit_reg_write(spirit, PCKT_FLT_OPTIONS_BASE, &regval, 1);
}
return ret;
}