598386ef90
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: 91e985a877c9ff8cbab9
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: 89e9d426e92fc0fbcf7e
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: 87b616414a6bd744c4b3
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: 90a7666655f4e46b0da7
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: 623d54a7f72319ea53a9
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: 52c3ddfae6d88dc9b2e5
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.
421 lines
12 KiB
C
421 lines
12 KiB
C
/******************************************************************************
|
||
* drivers/wireless/spirit/spirit_pktmbus.c
|
||
* Configuration and management of SPIRIT MBUS 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 <assert.h>
|
||
|
||
#include "spirit_pktmbus.h"
|
||
#include "spirit_radio.h"
|
||
#include "spirit_spi.h"
|
||
|
||
/******************************************************************************
|
||
* Public Functions
|
||
******************************************************************************/
|
||
|
||
/******************************************************************************
|
||
* Name: spirit_pktmbus_initialize
|
||
*
|
||
* Description:
|
||
* Initializes the SPIRIT MBUS packet according to the specified parameters
|
||
* in the struct spirit_pktmbus_init_s structure.
|
||
*
|
||
* Input Parameters:
|
||
* spirit - Reference to a Spirit library state structure instance
|
||
* mbusinit - Pointer to a struct spirit_pktmbus_init_s structure that
|
||
* contains the configuration information for the specified
|
||
* SPIRIT MBUS PACKET FORMAT.
|
||
*
|
||
* Returned Value:
|
||
* Zero (OK) on success; a negated errno value on failure.
|
||
*
|
||
******************************************************************************/
|
||
|
||
int spirit_pktmbus_initialize(FAR struct spirit_library_s *spirit,
|
||
FAR const struct spirit_pktmbus_init_s *mbusinit)
|
||
{
|
||
uint8_t regval[3];
|
||
|
||
/* Check the parameters */
|
||
|
||
DEBUGASSERT(IS_MBUS_SUBMODE(mbusinit->submode));
|
||
|
||
/* Packet format config */
|
||
|
||
spirit_pktmbus_set_format(spirit);
|
||
spirit_pktcommon_enable_crcfilter(spirit, S_DISABLE);
|
||
spirit_radio_enable_csblanking(spirit, S_ENABLE);
|
||
|
||
/* Preamble, postamble and submode config */
|
||
|
||
regval[0] = mbusinit->preamblen;
|
||
regval[1] = mbusinit->postamblen;
|
||
regval[2] = (uint8_t) mbusinit->submode;
|
||
|
||
/* Writes the new values on the MBUS_PRMBL registers */
|
||
|
||
return spirit_reg_write(spirit, MBUS_PRMBL_BASE, regval, 3);
|
||
}
|
||
|
||
/******************************************************************************
|
||
* Name: spirit_pktmbus_get_setup
|
||
*
|
||
* Description:
|
||
* Returns the SPIRIT MBUS packet structure according to the specified
|
||
* parameters in the registers.
|
||
*
|
||
* Input Parameters:
|
||
* spirit - Reference to a Spirit library state structure instance
|
||
* mbusinit - MBUS packet init structure.
|
||
*
|
||
* Returned Value:
|
||
* Zero (OK) on success; a negated errno value on failure.
|
||
*
|
||
******************************************************************************/
|
||
|
||
int spirit_pktmbus_get_setup(FAR struct spirit_library_s *spirit,
|
||
FAR struct spirit_pktmbus_init_s *mbusinit)
|
||
{
|
||
uint8_t regval[3];
|
||
int ret;
|
||
|
||
/* Reads the MBUS regs value */
|
||
|
||
ret = spirit_reg_read(spirit, MBUS_PRMBL_BASE, regval, 3);
|
||
if (ret >= 0)
|
||
{
|
||
/* Fit the structure */
|
||
|
||
mbusinit->preamblen = regval[0];
|
||
mbusinit->postamblen = regval[1];
|
||
mbusinit->submode = (enum spirit_mbus_submode_e) (regval[2] & 0x0E);
|
||
}
|
||
|
||
return ret;
|
||
}
|
||
|
||
/******************************************************************************
|
||
* Name: spirit_pktmbus_set_format
|
||
*
|
||
* Description:
|
||
* Configures the MBUS packet format as the one used by SPIRIT.
|
||
*
|
||
* Input Parameters:
|
||
* None.
|
||
*
|
||
* Returned Value:
|
||
* Zero (OK) on success; a negated errno value on failure.
|
||
*
|
||
******************************************************************************/
|
||
|
||
int spirit_pktmbus_set_format(FAR struct spirit_library_s *spirit)
|
||
{
|
||
uint8_t regval;
|
||
int ret;
|
||
|
||
/* Reads the PCKTCTRL3 register value */
|
||
|
||
ret = spirit_reg_read(spirit, PCKTCTRL3_BASE, ®val, 1);
|
||
if (ret < 0)
|
||
{
|
||
return ret;
|
||
}
|
||
|
||
/* Sets format bits. Also set to 0 the direct RX mode bits */
|
||
|
||
regval &= 0x0F;
|
||
regval |= ((uint8_t) PCKTCTRL3_PCKT_FRMT_MBUS);
|
||
|
||
/* Writes value on the PCKTCTRL3 register */
|
||
|
||
ret = spirit_reg_write(spirit, PCKTCTRL3_BASE, ®val, 1);
|
||
if (ret < 0)
|
||
{
|
||
return ret;
|
||
}
|
||
|
||
/* Reads the PCKTCTRL1 register value */
|
||
|
||
ret = spirit_reg_read(spirit, PCKTCTRL1_BASE, ®val, 1);
|
||
if (ret < 0)
|
||
{
|
||
return ret;
|
||
}
|
||
|
||
/* Build the new value. Set to 0 the direct TX mode bits */
|
||
|
||
regval &= 0xf3;
|
||
|
||
/* Writes the value on the PCKTCTRL1 register */
|
||
|
||
ret = spirit_reg_write(spirit, PCKTCTRL1_BASE, ®val, 1);
|
||
if (ret < 0)
|
||
{
|
||
return ret;
|
||
}
|
||
|
||
/* Reads the PROTOCOL1 register */
|
||
|
||
ret = spirit_reg_read(spirit, PROTOCOL1_BASE, ®val, 1);
|
||
if (ret < 0)
|
||
{
|
||
return ret;
|
||
}
|
||
|
||
/* Mask a reserved bit */
|
||
|
||
regval &= ~0x20;
|
||
|
||
/* Writes the value on the PROTOCOL1 register */
|
||
|
||
return spirit_reg_write(spirit, PROTOCOL1_BASE, ®val, 1);
|
||
}
|
||
|
||
/******************************************************************************
|
||
* Name: spirit_pktmbus_set_preamble
|
||
*
|
||
* Description:
|
||
* Sets how many chip sequence <20>01<30> shall be added in the preamble respect
|
||
* to the minimum value as defined according to the specified sub-mode.
|
||
*
|
||
* Input Parameters:
|
||
* spirit - Reference to a Spirit library state structure instance
|
||
* preamble - The number of chip sequence.
|
||
*
|
||
* Returned Value:
|
||
* Zero (OK) on success; a negated errno value on failure.
|
||
*
|
||
******************************************************************************/
|
||
|
||
int spirit_pktmbus_set_preamble(FAR struct spirit_library_s *spirit,
|
||
uint8_t preamble)
|
||
{
|
||
/* Modifies the MBUS_PRMBL register value */
|
||
|
||
return spirit_reg_write(spirit, MBUS_PRMBL_BASE, &preamble, 1);
|
||
}
|
||
|
||
/******************************************************************************
|
||
* Name: spirit_pktmbus_get_preamble
|
||
*
|
||
* Description:
|
||
* Returns how many chip sequence "01" are added in the preamble respect to
|
||
* the minimum value as defined according to the specified sub-mode.
|
||
*
|
||
* Input Parameters:
|
||
* spirit - Reference to a Spirit library state structure instance
|
||
*
|
||
* Returned Value:
|
||
* Preable in number of "01" chip sequences.
|
||
*
|
||
******************************************************************************/
|
||
|
||
uint8_t spirit_pktmbus_get_preamble(FAR struct spirit_library_s *spirit)
|
||
{
|
||
uint8_t regval;
|
||
|
||
/* Modifies the MBUS_PRMBL register value */
|
||
|
||
(void)spirit_reg_read(spirit, MBUS_PRMBL_BASE, ®val, 1);
|
||
|
||
/* Return value */
|
||
|
||
return regval;
|
||
}
|
||
|
||
/******************************************************************************
|
||
* Name: spirit_pktmbus_set_postamble
|
||
*
|
||
* Description:
|
||
* Sets how many chip sequence <20>01<30> will be used in postamble
|
||
*
|
||
* Input Parameters:
|
||
* spirit - Reference to a Spirit library state structure instance
|
||
* postamble - The number of chip sequence.
|
||
*
|
||
* Returned Value:
|
||
* Zero (OK) on success; a negated errno value on failure.
|
||
*
|
||
******************************************************************************/
|
||
|
||
int spirit_pktmbus_set_postamble(FAR struct spirit_library_s *spirit,
|
||
uint8_t postamble)
|
||
{
|
||
/* Modifies the MBUS_PSTMBL register value */
|
||
|
||
return spirit_reg_write(spirit, MBUS_PSTMBL_BASE, &postamble, 1);
|
||
}
|
||
|
||
/******************************************************************************
|
||
* Name:
|
||
*
|
||
* Description:
|
||
* Returns how many chip sequence "01" are used in the postamble
|
||
*
|
||
* Input Parameters:
|
||
* spirit - Reference to a Spirit library state structure instance
|
||
*
|
||
* Returned Value:
|
||
* Postamble in number of "01" chip sequences.
|
||
*
|
||
******************************************************************************/
|
||
|
||
uint8_t spirit_pktmbus_get_postamble(FAR struct spirit_library_s *spirit)
|
||
{
|
||
uint8_t regval;
|
||
|
||
/* Reads the MBUS_PSTMBL register */
|
||
|
||
(void)spirit_reg_read(spirit, MBUS_PSTMBL_BASE, ®val, 1);
|
||
|
||
/* Returns value */
|
||
|
||
return regval;
|
||
}
|
||
|
||
/******************************************************************************
|
||
* Name:
|
||
*
|
||
* Description:
|
||
* Sets the MBUS submode used.
|
||
*
|
||
* Input Parameters:
|
||
* spirit - Reference to a Spirit library state structure instance
|
||
* submode - The submode used.
|
||
*
|
||
* Returned Value:
|
||
* Zero (OK) on success; a negated errno value on failure.
|
||
*
|
||
******************************************************************************/
|
||
|
||
int spirit_pktmbus_set_submode(FAR struct spirit_library_s *spirit,
|
||
enum spirit_mbus_submode_e submode)
|
||
{
|
||
/* Modifies the MBUS_CTRL register value */
|
||
|
||
return spirit_reg_write(spirit, MBUS_CTRL_BASE, (FAR uint8_t *)submode, 1);
|
||
}
|
||
|
||
/******************************************************************************
|
||
* Name: spirit_pktmbus_get_submode
|
||
*
|
||
* Description:
|
||
* Returns the MBUS submode used.
|
||
*
|
||
* Input Parameters:
|
||
* spirit - Reference to a Spirit library state structure instance
|
||
*
|
||
* Returned Value:
|
||
* MBUS submode.
|
||
*
|
||
******************************************************************************/
|
||
|
||
enum spirit_mbus_submode_e
|
||
spirit_pktmbus_get_submode(FAR struct spirit_library_s *spirit)
|
||
{
|
||
uint8_t regval;
|
||
|
||
/* Reads the MBUS_CTRL register value */
|
||
|
||
(void)spirit_reg_read(spirit, MBUS_CTRL_BASE, ®val, 1);
|
||
|
||
/* Returns value */
|
||
|
||
return (enum spirit_mbus_submode_e) regval;
|
||
}
|
||
|
||
/******************************************************************************
|
||
* Name: spirit_pktmbus_set_payloadlen
|
||
*
|
||
* Description:
|
||
* Sets the payload length for SPIRIT MBUS packets.
|
||
*
|
||
* 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_pktmbus_set_payloadlen(FAR struct spirit_library_s *spirit,
|
||
uint16_t payloadlen)
|
||
{
|
||
uint8_t regval[2];
|
||
|
||
/* Computes PCKTLEN0 value from payloadlen */
|
||
|
||
regval[1] = BUILD_PCKTLEN0(payloadlen);
|
||
|
||
/* Computes PCKTLEN1 value from payloadlen */
|
||
|
||
regval[0] = BUILD_PCKTLEN1(payloadlen);
|
||
|
||
/* Writes data on the PCKTLEN1/0 register */
|
||
|
||
return spirit_reg_write(spirit, PCKTLEN1_BASE, regval, 2);
|
||
}
|
||
|
||
/******************************************************************************
|
||
* Name: spirit_pktmbus_get_payloadlen
|
||
*
|
||
* Description:
|
||
* Returns the payload length for SPIRIT MBUS packets.
|
||
*
|
||
* Input Parameters:
|
||
* spirit - Reference to a Spirit library state structure instance
|
||
*
|
||
* Returned Value:
|
||
* Payload length in bytes.
|
||
*
|
||
******************************************************************************/
|
||
|
||
uint16_t spirit_pktmbus_get_payloadlen(FAR struct spirit_library_s *spirit)
|
||
{
|
||
uint8_t regval[2];
|
||
|
||
/* Reads the packet length registers */
|
||
|
||
(void)spirit_reg_read(spirit, PCKTLEN1_BASE, regval, 2);
|
||
|
||
/* Returns the packet length */
|
||
|
||
return ((((uint16_t)regval[0]) << 8) + (uint16_t)regval[1]);
|
||
}
|