Vergil Cola / Mbed OS MQTTGateway2

Fork of my original MQTTGateway

Dependencies:   mbed-http

easy-connect/stm-spirit1-rf-driver/source/libs/spirit1/SPIRIT1_Library/Src/SPIRIT_PktBasic.c@0:a1734fe1ec4b, 2017-04-08 (annotated)

Committer:
vpcola
Date:
Sat Apr 08 14:43:14 2017 +0000
Revision:
0:a1734fe1ec4b
Initial commit

Who changed what in which revision?

UserRevisionLine numberNew contents of line
vpcola 0:a1734fe1ec4b 1 /**
vpcola 0:a1734fe1ec4b 2 ******************************************************************************
vpcola 0:a1734fe1ec4b 3 * @file SPIRIT_PktBasic.c
vpcola 0:a1734fe1ec4b 4 * @author VMA division - AMS
vpcola 0:a1734fe1ec4b 5 * @version 3.2.2
vpcola 0:a1734fe1ec4b 6 * @date 08-July-2015
vpcola 0:a1734fe1ec4b 7 * @brief Configuration and management of SPIRIT Basic packets.
vpcola 0:a1734fe1ec4b 8 * @details
vpcola 0:a1734fe1ec4b 9 *
vpcola 0:a1734fe1ec4b 10 * @attention
vpcola 0:a1734fe1ec4b 11 *
vpcola 0:a1734fe1ec4b 12 * <h2><center>&copy; COPYRIGHT(c) 2015 STMicroelectronics</center></h2>
vpcola 0:a1734fe1ec4b 13 *
vpcola 0:a1734fe1ec4b 14 * Redistribution and use in source and binary forms, with or without modification,
vpcola 0:a1734fe1ec4b 15 * are permitted provided that the following conditions are met:
vpcola 0:a1734fe1ec4b 16 * 1. Redistributions of source code must retain the above copyright notice,
vpcola 0:a1734fe1ec4b 17 * this list of conditions and the following disclaimer.
vpcola 0:a1734fe1ec4b 18 * 2. Redistributions in binary form must reproduce the above copyright notice,
vpcola 0:a1734fe1ec4b 19 * this list of conditions and the following disclaimer in the documentation
vpcola 0:a1734fe1ec4b 20 * and/or other materials provided with the distribution.
vpcola 0:a1734fe1ec4b 21 * 3. Neither the name of STMicroelectronics nor the names of its contributors
vpcola 0:a1734fe1ec4b 22 * may be used to endorse or promote products derived from this software
vpcola 0:a1734fe1ec4b 23 * without specific prior written permission.
vpcola 0:a1734fe1ec4b 24 *
vpcola 0:a1734fe1ec4b 25 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
vpcola 0:a1734fe1ec4b 26 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
vpcola 0:a1734fe1ec4b 27 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
vpcola 0:a1734fe1ec4b 28 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
vpcola 0:a1734fe1ec4b 29 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
vpcola 0:a1734fe1ec4b 30 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
vpcola 0:a1734fe1ec4b 31 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
vpcola 0:a1734fe1ec4b 32 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
vpcola 0:a1734fe1ec4b 33 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
vpcola 0:a1734fe1ec4b 34 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
vpcola 0:a1734fe1ec4b 35 *
vpcola 0:a1734fe1ec4b 36 ******************************************************************************
vpcola 0:a1734fe1ec4b 37 */
vpcola 0:a1734fe1ec4b 38
vpcola 0:a1734fe1ec4b 39 /* Includes ------------------------------------------------------------------*/
vpcola 0:a1734fe1ec4b 40 #include "SPIRIT_PktBasic.h"
vpcola 0:a1734fe1ec4b 41 #include "MCU_Interface.h"
vpcola 0:a1734fe1ec4b 42
vpcola 0:a1734fe1ec4b 43
vpcola 0:a1734fe1ec4b 44 /**
vpcola 0:a1734fe1ec4b 45 * @addtogroup SPIRIT_Libraries
vpcola 0:a1734fe1ec4b 46 * @{
vpcola 0:a1734fe1ec4b 47 */
vpcola 0:a1734fe1ec4b 48
vpcola 0:a1734fe1ec4b 49
vpcola 0:a1734fe1ec4b 50 /**
vpcola 0:a1734fe1ec4b 51 * @addtogroup SPIRIT_PktBasic
vpcola 0:a1734fe1ec4b 52 * @{
vpcola 0:a1734fe1ec4b 53 */
vpcola 0:a1734fe1ec4b 54
vpcola 0:a1734fe1ec4b 55
vpcola 0:a1734fe1ec4b 56 /**
vpcola 0:a1734fe1ec4b 57 * @defgroup PktBasic_Private_TypesDefinitions Pkt Basic Private Types Definitions
vpcola 0:a1734fe1ec4b 58 * @{
vpcola 0:a1734fe1ec4b 59 */
vpcola 0:a1734fe1ec4b 60
vpcola 0:a1734fe1ec4b 61 /**
vpcola 0:a1734fe1ec4b 62 *@}
vpcola 0:a1734fe1ec4b 63 */
vpcola 0:a1734fe1ec4b 64
vpcola 0:a1734fe1ec4b 65
vpcola 0:a1734fe1ec4b 66 /**
vpcola 0:a1734fe1ec4b 67 * @defgroup PktBasic_Private_Defines Pkt Basic Private Defines
vpcola 0:a1734fe1ec4b 68 * @{
vpcola 0:a1734fe1ec4b 69 */
vpcola 0:a1734fe1ec4b 70
vpcola 0:a1734fe1ec4b 71 /**
vpcola 0:a1734fe1ec4b 72 *@}
vpcola 0:a1734fe1ec4b 73 */
vpcola 0:a1734fe1ec4b 74
vpcola 0:a1734fe1ec4b 75
vpcola 0:a1734fe1ec4b 76 /**
vpcola 0:a1734fe1ec4b 77 * @defgroup PktBasic_Private_Macros Pkt Basic Private Macros
vpcola 0:a1734fe1ec4b 78 * @{
vpcola 0:a1734fe1ec4b 79 */
vpcola 0:a1734fe1ec4b 80
vpcola 0:a1734fe1ec4b 81 /**
vpcola 0:a1734fe1ec4b 82 *@}
vpcola 0:a1734fe1ec4b 83 */
vpcola 0:a1734fe1ec4b 84
vpcola 0:a1734fe1ec4b 85
vpcola 0:a1734fe1ec4b 86 /**
vpcola 0:a1734fe1ec4b 87 * @defgroup PktBasic_Private_Variables Pkt Basic Private Variables
vpcola 0:a1734fe1ec4b 88 * @{
vpcola 0:a1734fe1ec4b 89 */
vpcola 0:a1734fe1ec4b 90
vpcola 0:a1734fe1ec4b 91 /**
vpcola 0:a1734fe1ec4b 92 *@}
vpcola 0:a1734fe1ec4b 93 */
vpcola 0:a1734fe1ec4b 94
vpcola 0:a1734fe1ec4b 95
vpcola 0:a1734fe1ec4b 96
vpcola 0:a1734fe1ec4b 97 /**
vpcola 0:a1734fe1ec4b 98 * @defgroup PktBasic_Private_FunctionPrototypes Pkt Basic Private Function Prototypes
vpcola 0:a1734fe1ec4b 99 * @{
vpcola 0:a1734fe1ec4b 100 */
vpcola 0:a1734fe1ec4b 101
vpcola 0:a1734fe1ec4b 102 /**
vpcola 0:a1734fe1ec4b 103 *@}
vpcola 0:a1734fe1ec4b 104 */
vpcola 0:a1734fe1ec4b 105
vpcola 0:a1734fe1ec4b 106
vpcola 0:a1734fe1ec4b 107 /**
vpcola 0:a1734fe1ec4b 108 * @defgroup PktBasic_Private_Functions Pkt Basic Private Functions
vpcola 0:a1734fe1ec4b 109 * @{
vpcola 0:a1734fe1ec4b 110 */
vpcola 0:a1734fe1ec4b 111
vpcola 0:a1734fe1ec4b 112 /**
vpcola 0:a1734fe1ec4b 113 * @brief Initializes the SPIRIT Basic packet according to the specified parameters in the PktBasicInit struct.
vpcola 0:a1734fe1ec4b 114 * Notice that this function sets the autofiltering option on CRC if it is set to any value different from BASIC_NO_CRC.
vpcola 0:a1734fe1ec4b 115 * @param pxPktBasicInit Basic packet init structure.
vpcola 0:a1734fe1ec4b 116 * This parameter is a pointer to @ref PktBasicInit.
vpcola 0:a1734fe1ec4b 117 * @retval None.
vpcola 0:a1734fe1ec4b 118 */
vpcola 0:a1734fe1ec4b 119 void SpiritPktBasicInit(PktBasicInit* pxPktBasicInit)
vpcola 0:a1734fe1ec4b 120 {
vpcola 0:a1734fe1ec4b 121 uint8_t tempRegValue[4], i;
vpcola 0:a1734fe1ec4b 122
vpcola 0:a1734fe1ec4b 123 /* Check the parameters */
vpcola 0:a1734fe1ec4b 124 s_assert_param(IS_BASIC_PREAMBLE_LENGTH(pxPktBasicInit->xPreambleLength));
vpcola 0:a1734fe1ec4b 125 s_assert_param(IS_BASIC_SYNC_LENGTH(pxPktBasicInit->xSyncLength));
vpcola 0:a1734fe1ec4b 126 s_assert_param(IS_BASIC_CRC_MODE(pxPktBasicInit->xCrcMode));
vpcola 0:a1734fe1ec4b 127 s_assert_param(IS_BASIC_LENGTH_WIDTH_BITS(pxPktBasicInit->cPktLengthWidth));
vpcola 0:a1734fe1ec4b 128 s_assert_param(IS_BASIC_FIX_VAR_LENGTH(pxPktBasicInit->xFixVarLength));
vpcola 0:a1734fe1ec4b 129 s_assert_param(IS_SPIRIT_FUNCTIONAL_STATE(pxPktBasicInit->xAddressField));
vpcola 0:a1734fe1ec4b 130 s_assert_param(IS_SPIRIT_FUNCTIONAL_STATE(pxPktBasicInit->xFec));
vpcola 0:a1734fe1ec4b 131 s_assert_param(IS_SPIRIT_FUNCTIONAL_STATE(pxPktBasicInit->xDataWhitening));
vpcola 0:a1734fe1ec4b 132 s_assert_param(IS_BASIC_CONTROL_LENGTH(pxPktBasicInit->xControlLength));
vpcola 0:a1734fe1ec4b 133
vpcola 0:a1734fe1ec4b 134 /* Reads the PROTOCOL1 register */
vpcola 0:a1734fe1ec4b 135 g_xStatus = SpiritSpiReadRegisters(PROTOCOL1_BASE, 1, &tempRegValue[0]);
vpcola 0:a1734fe1ec4b 136
vpcola 0:a1734fe1ec4b 137 /* Mask a reserved bit */
vpcola 0:a1734fe1ec4b 138 tempRegValue[0] &= ~0x20;
vpcola 0:a1734fe1ec4b 139
vpcola 0:a1734fe1ec4b 140 /* Always set the automatic packet filtering */
vpcola 0:a1734fe1ec4b 141 tempRegValue[0] |= PROTOCOL1_AUTO_PCKT_FLT_MASK;
vpcola 0:a1734fe1ec4b 142
vpcola 0:a1734fe1ec4b 143 /* Writes the value on register */
vpcola 0:a1734fe1ec4b 144 g_xStatus = SpiritSpiWriteRegisters(PROTOCOL1_BASE, 1, &tempRegValue[0]);
vpcola 0:a1734fe1ec4b 145
vpcola 0:a1734fe1ec4b 146 /* Reads the PCKT_FLT_OPTIONS register */
vpcola 0:a1734fe1ec4b 147 g_xStatus = SpiritSpiReadRegisters(PCKT_FLT_OPTIONS_BASE, 1, &tempRegValue[0]);
vpcola 0:a1734fe1ec4b 148
vpcola 0:a1734fe1ec4b 149 /* Always reset the control and source filtering (also if it is not present in basic) */
vpcola 0:a1734fe1ec4b 150 tempRegValue[0] &= ~(PCKT_FLT_OPTIONS_SOURCE_FILTERING_MASK | PCKT_FLT_OPTIONS_CONTROL_FILTERING_MASK);
vpcola 0:a1734fe1ec4b 151
vpcola 0:a1734fe1ec4b 152 /* Writes the value on register */
vpcola 0:a1734fe1ec4b 153 g_xStatus = SpiritSpiWriteRegisters(PCKT_FLT_OPTIONS_BASE, 1, &tempRegValue[0]);
vpcola 0:a1734fe1ec4b 154
vpcola 0:a1734fe1ec4b 155 if(pxPktBasicInit->xAddressField == S_ENABLE)
vpcola 0:a1734fe1ec4b 156 {
vpcola 0:a1734fe1ec4b 157 tempRegValue[0]=0x08;
vpcola 0:a1734fe1ec4b 158 }
vpcola 0:a1734fe1ec4b 159 else
vpcola 0:a1734fe1ec4b 160 {
vpcola 0:a1734fe1ec4b 161 tempRegValue[0]=0x00;
vpcola 0:a1734fe1ec4b 162 }
vpcola 0:a1734fe1ec4b 163 /* Address and control length setting */
vpcola 0:a1734fe1ec4b 164 tempRegValue[0] |= ((uint8_t) pxPktBasicInit->xControlLength);
vpcola 0:a1734fe1ec4b 165
vpcola 0:a1734fe1ec4b 166 /* Packet format and width length setting */
vpcola 0:a1734fe1ec4b 167 pxPktBasicInit->cPktLengthWidth == 0 ? pxPktBasicInit->cPktLengthWidth=1 : pxPktBasicInit->cPktLengthWidth;
vpcola 0:a1734fe1ec4b 168 tempRegValue[1] = ((uint8_t) PCKTCTRL3_PCKT_FRMT_BASIC) | ((uint8_t)(pxPktBasicInit->cPktLengthWidth-1));
vpcola 0:a1734fe1ec4b 169
vpcola 0:a1734fe1ec4b 170 /* Preamble, sync and fixed or variable length setting */
vpcola 0:a1734fe1ec4b 171 tempRegValue[2] = ((uint8_t) pxPktBasicInit->xPreambleLength) | ((uint8_t) pxPktBasicInit->xSyncLength) |
vpcola 0:a1734fe1ec4b 172 ((uint8_t) pxPktBasicInit->xFixVarLength);
vpcola 0:a1734fe1ec4b 173
vpcola 0:a1734fe1ec4b 174 /* CRC length, whitening and FEC setting */
vpcola 0:a1734fe1ec4b 175 tempRegValue[3] = (uint8_t) pxPktBasicInit->xCrcMode;
vpcola 0:a1734fe1ec4b 176
vpcola 0:a1734fe1ec4b 177 if(pxPktBasicInit->xDataWhitening == S_ENABLE)
vpcola 0:a1734fe1ec4b 178 {
vpcola 0:a1734fe1ec4b 179 tempRegValue[3] |= PCKTCTRL1_WHIT_MASK;
vpcola 0:a1734fe1ec4b 180 }
vpcola 0:a1734fe1ec4b 181
vpcola 0:a1734fe1ec4b 182 if(pxPktBasicInit->xFec == S_ENABLE)
vpcola 0:a1734fe1ec4b 183 {
vpcola 0:a1734fe1ec4b 184 tempRegValue[3] |= PCKTCTRL1_FEC_MASK;
vpcola 0:a1734fe1ec4b 185 }
vpcola 0:a1734fe1ec4b 186
vpcola 0:a1734fe1ec4b 187 /* Writes registers */
vpcola 0:a1734fe1ec4b 188 SpiritSpiWriteRegisters(PCKTCTRL4_BASE, 4, tempRegValue);
vpcola 0:a1734fe1ec4b 189
vpcola 0:a1734fe1ec4b 190 /* Sync words setting */
vpcola 0:a1734fe1ec4b 191 for(i=0;i<4;i++)
vpcola 0:a1734fe1ec4b 192 {
vpcola 0:a1734fe1ec4b 193 if(i<3-(pxPktBasicInit->xSyncLength >>1))
vpcola 0:a1734fe1ec4b 194 {
vpcola 0:a1734fe1ec4b 195 tempRegValue[i]=0;
vpcola 0:a1734fe1ec4b 196 }
vpcola 0:a1734fe1ec4b 197 else
vpcola 0:a1734fe1ec4b 198 {
vpcola 0:a1734fe1ec4b 199 tempRegValue[i] = (uint8_t)(pxPktBasicInit->lSyncWords>>(8*i));
vpcola 0:a1734fe1ec4b 200 }
vpcola 0:a1734fe1ec4b 201 }
vpcola 0:a1734fe1ec4b 202
vpcola 0:a1734fe1ec4b 203 /* Sets CRC check bit */
vpcola 0:a1734fe1ec4b 204 if(pxPktBasicInit->xCrcMode == PKT_NO_CRC)
vpcola 0:a1734fe1ec4b 205 {
vpcola 0:a1734fe1ec4b 206 SpiritPktBasicFilterOnCrc(S_DISABLE);
vpcola 0:a1734fe1ec4b 207 }
vpcola 0:a1734fe1ec4b 208 else
vpcola 0:a1734fe1ec4b 209 {
vpcola 0:a1734fe1ec4b 210 SpiritPktBasicFilterOnCrc(S_ENABLE);
vpcola 0:a1734fe1ec4b 211 }
vpcola 0:a1734fe1ec4b 212
vpcola 0:a1734fe1ec4b 213
vpcola 0:a1734fe1ec4b 214 g_xStatus = SpiritSpiWriteRegisters(SYNC4_BASE, 4, tempRegValue);
vpcola 0:a1734fe1ec4b 215
vpcola 0:a1734fe1ec4b 216 }
vpcola 0:a1734fe1ec4b 217
vpcola 0:a1734fe1ec4b 218
vpcola 0:a1734fe1ec4b 219 /**
vpcola 0:a1734fe1ec4b 220 * @brief Returns the SPIRIT Basic packet structure according to the specified parameters in the registers.
vpcola 0:a1734fe1ec4b 221 * @param pxPktBasicInit Basic packet init structure.
vpcola 0:a1734fe1ec4b 222 * This parameter is a pointer to @ref PktBasicInit.
vpcola 0:a1734fe1ec4b 223 * @retval None.
vpcola 0:a1734fe1ec4b 224 */
vpcola 0:a1734fe1ec4b 225 void SpiritPktBasicGetInfo(PktBasicInit* pxPktBasicInit)
vpcola 0:a1734fe1ec4b 226 {
vpcola 0:a1734fe1ec4b 227 uint8_t tempRegValue[10];
vpcola 0:a1734fe1ec4b 228
vpcola 0:a1734fe1ec4b 229 /* Reads registers */
vpcola 0:a1734fe1ec4b 230 g_xStatus = SpiritSpiReadRegisters(PCKTCTRL4_BASE, 10, tempRegValue);
vpcola 0:a1734fe1ec4b 231
vpcola 0:a1734fe1ec4b 232 /* Length width */
vpcola 0:a1734fe1ec4b 233 pxPktBasicInit->cPktLengthWidth=(tempRegValue[1] & 0x0F)+1;
vpcola 0:a1734fe1ec4b 234
vpcola 0:a1734fe1ec4b 235 /* Address field */
vpcola 0:a1734fe1ec4b 236 pxPktBasicInit->xAddressField=(SpiritFunctionalState)((tempRegValue[0]>>3) & 0x01);
vpcola 0:a1734fe1ec4b 237
vpcola 0:a1734fe1ec4b 238 /* Control length */
vpcola 0:a1734fe1ec4b 239 pxPktBasicInit->xControlLength=(BasicControlLength)(tempRegValue[0] & 0x07);
vpcola 0:a1734fe1ec4b 240
vpcola 0:a1734fe1ec4b 241 /* CRC mode */
vpcola 0:a1734fe1ec4b 242 pxPktBasicInit->xCrcMode=(BasicCrcMode)(tempRegValue[3] & 0xE0);
vpcola 0:a1734fe1ec4b 243
vpcola 0:a1734fe1ec4b 244 /* Whitening */
vpcola 0:a1734fe1ec4b 245 pxPktBasicInit->xDataWhitening=(SpiritFunctionalState)((tempRegValue[3] >> 4) & 0x01);
vpcola 0:a1734fe1ec4b 246
vpcola 0:a1734fe1ec4b 247 /* FEC */
vpcola 0:a1734fe1ec4b 248 pxPktBasicInit->xFec=(SpiritFunctionalState)(tempRegValue[3] & 0x01);
vpcola 0:a1734fe1ec4b 249
vpcola 0:a1734fe1ec4b 250 /* FIX or VAR bit */
vpcola 0:a1734fe1ec4b 251 pxPktBasicInit->xFixVarLength=(BasicFixVarLength)(tempRegValue[2] & 0x01);
vpcola 0:a1734fe1ec4b 252
vpcola 0:a1734fe1ec4b 253 /* Preamble length */
vpcola 0:a1734fe1ec4b 254 pxPktBasicInit->xPreambleLength=(BasicPreambleLength)(tempRegValue[2] & 0xF8);
vpcola 0:a1734fe1ec4b 255
vpcola 0:a1734fe1ec4b 256 /* Sync length */
vpcola 0:a1734fe1ec4b 257 pxPktBasicInit->xSyncLength=(BasicSyncLength)(tempRegValue[2] & 0x06);
vpcola 0:a1734fe1ec4b 258
vpcola 0:a1734fe1ec4b 259 /* sync Words */
vpcola 0:a1734fe1ec4b 260 pxPktBasicInit->lSyncWords=0;
vpcola 0:a1734fe1ec4b 261 for(uint8_t i=0 ; i<4 ; i++)
vpcola 0:a1734fe1ec4b 262 {
vpcola 0:a1734fe1ec4b 263 if(i>2-(((uint8_t)pxPktBasicInit->xSyncLength) >>1))
vpcola 0:a1734fe1ec4b 264 {
vpcola 0:a1734fe1ec4b 265 pxPktBasicInit->lSyncWords |= (uint32_t)(tempRegValue[i+6])<<(8*i);
vpcola 0:a1734fe1ec4b 266 }
vpcola 0:a1734fe1ec4b 267 }
vpcola 0:a1734fe1ec4b 268
vpcola 0:a1734fe1ec4b 269 }
vpcola 0:a1734fe1ec4b 270
vpcola 0:a1734fe1ec4b 271
vpcola 0:a1734fe1ec4b 272 /**
vpcola 0:a1734fe1ec4b 273 * @brief Initializes the SPIRIT Basic packet addresses according to the specified
vpcola 0:a1734fe1ec4b 274 * parameters in the PktBasicAddressesInit struct.
vpcola 0:a1734fe1ec4b 275 * @param pxPktBasicAddresses Basic packet addresses init structure.
vpcola 0:a1734fe1ec4b 276 * This parameter is a pointer to @ref PktBasicAddresses.
vpcola 0:a1734fe1ec4b 277 * @retval None.
vpcola 0:a1734fe1ec4b 278 */
vpcola 0:a1734fe1ec4b 279 void SpiritPktBasicAddressesInit(PktBasicAddressesInit* pxPktBasicAddresses)
vpcola 0:a1734fe1ec4b 280 {
vpcola 0:a1734fe1ec4b 281 uint8_t tempRegValue[3];
vpcola 0:a1734fe1ec4b 282
vpcola 0:a1734fe1ec4b 283 /* Check the parameters */
vpcola 0:a1734fe1ec4b 284 s_assert_param(IS_SPIRIT_FUNCTIONAL_STATE(pxPktBasicAddresses->xFilterOnMyAddress));
vpcola 0:a1734fe1ec4b 285 s_assert_param(IS_SPIRIT_FUNCTIONAL_STATE(pxPktBasicAddresses->xFilterOnMulticastAddress));
vpcola 0:a1734fe1ec4b 286 s_assert_param(IS_SPIRIT_FUNCTIONAL_STATE(pxPktBasicAddresses->xFilterOnBroadcastAddress));
vpcola 0:a1734fe1ec4b 287
vpcola 0:a1734fe1ec4b 288
vpcola 0:a1734fe1ec4b 289 /* Reads the PCKT_FLT_OPTIONS ragister */
vpcola 0:a1734fe1ec4b 290 g_xStatus = SpiritSpiReadRegisters(PCKT_FLT_OPTIONS_BASE, 1, &tempRegValue[0]);
vpcola 0:a1734fe1ec4b 291
vpcola 0:a1734fe1ec4b 292 /* Enables or disables filtering on my address */
vpcola 0:a1734fe1ec4b 293 if(pxPktBasicAddresses->xFilterOnMyAddress == S_ENABLE)
vpcola 0:a1734fe1ec4b 294 {
vpcola 0:a1734fe1ec4b 295 tempRegValue[0] |= PCKT_FLT_OPTIONS_DEST_VS_TX_ADDR_MASK;
vpcola 0:a1734fe1ec4b 296 }
vpcola 0:a1734fe1ec4b 297 else
vpcola 0:a1734fe1ec4b 298 {
vpcola 0:a1734fe1ec4b 299 tempRegValue[0] &= ~PCKT_FLT_OPTIONS_DEST_VS_TX_ADDR_MASK;
vpcola 0:a1734fe1ec4b 300 }
vpcola 0:a1734fe1ec4b 301
vpcola 0:a1734fe1ec4b 302 /* Enables or disables filtering on multicast address */
vpcola 0:a1734fe1ec4b 303 if(pxPktBasicAddresses->xFilterOnMulticastAddress == S_ENABLE)
vpcola 0:a1734fe1ec4b 304 {
vpcola 0:a1734fe1ec4b 305 tempRegValue[0] |= PCKT_FLT_OPTIONS_DEST_VS_MULTICAST_ADDR_MASK;
vpcola 0:a1734fe1ec4b 306 }
vpcola 0:a1734fe1ec4b 307 else
vpcola 0:a1734fe1ec4b 308 {
vpcola 0:a1734fe1ec4b 309 tempRegValue[0] &= ~PCKT_FLT_OPTIONS_DEST_VS_MULTICAST_ADDR_MASK;
vpcola 0:a1734fe1ec4b 310 }
vpcola 0:a1734fe1ec4b 311
vpcola 0:a1734fe1ec4b 312 /* Enables or disables filtering on broadcast address */
vpcola 0:a1734fe1ec4b 313 if(pxPktBasicAddresses->xFilterOnBroadcastAddress == S_ENABLE)
vpcola 0:a1734fe1ec4b 314 {
vpcola 0:a1734fe1ec4b 315 tempRegValue[0] |= PCKT_FLT_OPTIONS_DEST_VS_BROADCAST_ADDR_MASK;
vpcola 0:a1734fe1ec4b 316 }
vpcola 0:a1734fe1ec4b 317 else
vpcola 0:a1734fe1ec4b 318 {
vpcola 0:a1734fe1ec4b 319 tempRegValue[0] &= ~PCKT_FLT_OPTIONS_DEST_VS_BROADCAST_ADDR_MASK;
vpcola 0:a1734fe1ec4b 320 }
vpcola 0:a1734fe1ec4b 321
vpcola 0:a1734fe1ec4b 322 /* Writes the new value on the PCKT_FLT_OPTIONS register */
vpcola 0:a1734fe1ec4b 323 g_xStatus = SpiritSpiWriteRegisters(PCKT_FLT_OPTIONS_BASE, 1, &tempRegValue[0]);
vpcola 0:a1734fe1ec4b 324
vpcola 0:a1734fe1ec4b 325 /* Fills the array with the addresses passed in the structure */
vpcola 0:a1734fe1ec4b 326 tempRegValue[0] = pxPktBasicAddresses->cBroadcastAddress;
vpcola 0:a1734fe1ec4b 327 tempRegValue[1] = pxPktBasicAddresses->cMulticastAddress;
vpcola 0:a1734fe1ec4b 328 tempRegValue[2] = pxPktBasicAddresses->cMyAddress;
vpcola 0:a1734fe1ec4b 329
vpcola 0:a1734fe1ec4b 330 /* Writes values on the PCKT_FLT_GOALS registers */
vpcola 0:a1734fe1ec4b 331 g_xStatus = SpiritSpiWriteRegisters(PCKT_FLT_GOALS_BROADCAST_BASE, 3, tempRegValue);
vpcola 0:a1734fe1ec4b 332
vpcola 0:a1734fe1ec4b 333
vpcola 0:a1734fe1ec4b 334 }
vpcola 0:a1734fe1ec4b 335
vpcola 0:a1734fe1ec4b 336
vpcola 0:a1734fe1ec4b 337 /**
vpcola 0:a1734fe1ec4b 338 * @brief Returns the SPIRIT Basic packet addresses structure according to the specified
vpcola 0:a1734fe1ec4b 339 * parameters in the registers.
vpcola 0:a1734fe1ec4b 340 * @param pxPktBasicAddresses Basic packet addresses init structure.
vpcola 0:a1734fe1ec4b 341 * This parameter is a pointer to @ref PktBasicAddresses.
vpcola 0:a1734fe1ec4b 342 * @retval None.
vpcola 0:a1734fe1ec4b 343 */
vpcola 0:a1734fe1ec4b 344 void SpiritPktBasicGetAddressesInfo(PktBasicAddressesInit* pxPktBasicAddresses)
vpcola 0:a1734fe1ec4b 345 {
vpcola 0:a1734fe1ec4b 346 uint8_t tempRegValue[3];
vpcola 0:a1734fe1ec4b 347
vpcola 0:a1734fe1ec4b 348 /* Reads values on the PCKT_FLT_GOALS registers */
vpcola 0:a1734fe1ec4b 349 g_xStatus = SpiritSpiReadRegisters(PCKT_FLT_GOALS_BROADCAST_BASE, 3, tempRegValue);
vpcola 0:a1734fe1ec4b 350
vpcola 0:a1734fe1ec4b 351 /* Fit the structure with the read addresses */
vpcola 0:a1734fe1ec4b 352 pxPktBasicAddresses->cBroadcastAddress = tempRegValue[0];
vpcola 0:a1734fe1ec4b 353 pxPktBasicAddresses->cMulticastAddress = tempRegValue[1];
vpcola 0:a1734fe1ec4b 354 pxPktBasicAddresses->cMyAddress = tempRegValue[2];
vpcola 0:a1734fe1ec4b 355
vpcola 0:a1734fe1ec4b 356 g_xStatus = SpiritSpiReadRegisters(PCKT_FLT_OPTIONS_BASE, 1, &tempRegValue[0]);
vpcola 0:a1734fe1ec4b 357
vpcola 0:a1734fe1ec4b 358 /* Fit the structure with the read filtering bits */
vpcola 0:a1734fe1ec4b 359 pxPktBasicAddresses->xFilterOnBroadcastAddress = (SpiritFunctionalState)((tempRegValue[0] >> 1) & 0x01);
vpcola 0:a1734fe1ec4b 360 pxPktBasicAddresses->xFilterOnMulticastAddress = (SpiritFunctionalState)((tempRegValue[0] >> 2) & 0x01);
vpcola 0:a1734fe1ec4b 361 pxPktBasicAddresses->xFilterOnMyAddress = (SpiritFunctionalState)((tempRegValue[0] >> 3) & 0x01);
vpcola 0:a1734fe1ec4b 362
vpcola 0:a1734fe1ec4b 363 }
vpcola 0:a1734fe1ec4b 364
vpcola 0:a1734fe1ec4b 365
vpcola 0:a1734fe1ec4b 366 /**
vpcola 0:a1734fe1ec4b 367 * @brief Configures the Basic packet format as packet used by SPIRIT.
vpcola 0:a1734fe1ec4b 368 * @param None.
vpcola 0:a1734fe1ec4b 369 * @retval None.
vpcola 0:a1734fe1ec4b 370 */
vpcola 0:a1734fe1ec4b 371 void SpiritPktBasicSetFormat(void)
vpcola 0:a1734fe1ec4b 372 {
vpcola 0:a1734fe1ec4b 373 uint8_t tempRegValue;
vpcola 0:a1734fe1ec4b 374
vpcola 0:a1734fe1ec4b 375 /* Reads the register value */
vpcola 0:a1734fe1ec4b 376 g_xStatus = SpiritSpiReadRegisters(PCKTCTRL3_BASE, 1, &tempRegValue);
vpcola 0:a1734fe1ec4b 377
vpcola 0:a1734fe1ec4b 378 /* Build the new value. Also set to 0 the direct RX mode bits */
vpcola 0:a1734fe1ec4b 379 tempRegValue &= 0x0F;
vpcola 0:a1734fe1ec4b 380 tempRegValue |= (uint8_t)PCKTCTRL3_PCKT_FRMT_BASIC;
vpcola 0:a1734fe1ec4b 381
vpcola 0:a1734fe1ec4b 382 /* Writes the value on the PCKTCTRL3 register */
vpcola 0:a1734fe1ec4b 383 g_xStatus = SpiritSpiWriteRegisters(PCKTCTRL3_BASE, 1, &tempRegValue);
vpcola 0:a1734fe1ec4b 384
vpcola 0:a1734fe1ec4b 385 /* Reads the PCKTCTRL1_BASE register */
vpcola 0:a1734fe1ec4b 386 g_xStatus = SpiritSpiReadRegisters(PCKTCTRL1_BASE, 1, &tempRegValue);
vpcola 0:a1734fe1ec4b 387
vpcola 0:a1734fe1ec4b 388 /* Build the new value. Set to 0 the direct TX mode bits */
vpcola 0:a1734fe1ec4b 389 tempRegValue &= 0xF3;
vpcola 0:a1734fe1ec4b 390
vpcola 0:a1734fe1ec4b 391 /* Writes the value on the PCKTCTRL1 register */
vpcola 0:a1734fe1ec4b 392 g_xStatus = SpiritSpiWriteRegisters(PCKTCTRL1_BASE, 1, &tempRegValue);
vpcola 0:a1734fe1ec4b 393
vpcola 0:a1734fe1ec4b 394 /* Reads the PROTOCOL1 register */
vpcola 0:a1734fe1ec4b 395 g_xStatus = SpiritSpiReadRegisters(PROTOCOL1_BASE, 1, &tempRegValue);
vpcola 0:a1734fe1ec4b 396
vpcola 0:a1734fe1ec4b 397 /* Mask a reserved bit */
vpcola 0:a1734fe1ec4b 398 tempRegValue &= ~0x20;
vpcola 0:a1734fe1ec4b 399
vpcola 0:a1734fe1ec4b 400 /* Writes the value on register */
vpcola 0:a1734fe1ec4b 401 g_xStatus = SpiritSpiWriteRegisters(PROTOCOL1_BASE, 1, &tempRegValue);
vpcola 0:a1734fe1ec4b 402 }
vpcola 0:a1734fe1ec4b 403
vpcola 0:a1734fe1ec4b 404
vpcola 0:a1734fe1ec4b 405 /**
vpcola 0:a1734fe1ec4b 406 * @brief Sets the address length for SPIRIT Basic packets.
vpcola 0:a1734fe1ec4b 407 * @param xAddressField length of ADDRESS in bytes.
vpcola 0:a1734fe1ec4b 408 * This parameter can be: S_ENABLE or S_DISABLE.
vpcola 0:a1734fe1ec4b 409 * @retval None.
vpcola 0:a1734fe1ec4b 410 */
vpcola 0:a1734fe1ec4b 411 void SpiritPktBasicAddressField(SpiritFunctionalState xAddressField)
vpcola 0:a1734fe1ec4b 412 {
vpcola 0:a1734fe1ec4b 413 uint8_t tempRegValue;
vpcola 0:a1734fe1ec4b 414
vpcola 0:a1734fe1ec4b 415 /* Check the parameters */
vpcola 0:a1734fe1ec4b 416 s_assert_param(IS_SPIRIT_FUNCTIONAL_STATE(xAddressField));
vpcola 0:a1734fe1ec4b 417
vpcola 0:a1734fe1ec4b 418 /* Reads the PCKTCTRL4 register value */
vpcola 0:a1734fe1ec4b 419 g_xStatus = SpiritSpiReadRegisters(PCKTCTRL4_BASE, 1, &tempRegValue);
vpcola 0:a1734fe1ec4b 420
vpcola 0:a1734fe1ec4b 421 /* Build the address length for the register */
vpcola 0:a1734fe1ec4b 422 if(xAddressField==S_ENABLE)
vpcola 0:a1734fe1ec4b 423 {
vpcola 0:a1734fe1ec4b 424 tempRegValue |= 0x08;
vpcola 0:a1734fe1ec4b 425 }
vpcola 0:a1734fe1ec4b 426 else
vpcola 0:a1734fe1ec4b 427 {
vpcola 0:a1734fe1ec4b 428 tempRegValue &= 0x07;
vpcola 0:a1734fe1ec4b 429 }
vpcola 0:a1734fe1ec4b 430
vpcola 0:a1734fe1ec4b 431 /* Writes the new value on the PCKTCTRL4 register */
vpcola 0:a1734fe1ec4b 432 g_xStatus = SpiritSpiWriteRegisters(PCKTCTRL4_BASE, 1, &tempRegValue);
vpcola 0:a1734fe1ec4b 433
vpcola 0:a1734fe1ec4b 434 }
vpcola 0:a1734fe1ec4b 435
vpcola 0:a1734fe1ec4b 436
vpcola 0:a1734fe1ec4b 437 /**
vpcola 0:a1734fe1ec4b 438 * @brief Specifies if the Address field for SPIRIT Basic packets is enabled or disabled.
vpcola 0:a1734fe1ec4b 439 * @param None.
vpcola 0:a1734fe1ec4b 440 * @retval SpiritFunctionalState Notifies if the address field is enabled or disabled.
vpcola 0:a1734fe1ec4b 441 */
vpcola 0:a1734fe1ec4b 442 SpiritFunctionalState SpiritPktBasicGetAddressField(void)
vpcola 0:a1734fe1ec4b 443 {
vpcola 0:a1734fe1ec4b 444 uint8_t tempRegValue;
vpcola 0:a1734fe1ec4b 445
vpcola 0:a1734fe1ec4b 446 /* Reads the PCKTCTRL4 register value */
vpcola 0:a1734fe1ec4b 447 g_xStatus = SpiritSpiReadRegisters(PCKTCTRL4_BASE, 1, &tempRegValue);
vpcola 0:a1734fe1ec4b 448
vpcola 0:a1734fe1ec4b 449 /* Returns the address field value */
vpcola 0:a1734fe1ec4b 450 if(tempRegValue & PCKTCTRL4_ADDRESS_LEN_MASK)
vpcola 0:a1734fe1ec4b 451 {
vpcola 0:a1734fe1ec4b 452 return S_ENABLE;
vpcola 0:a1734fe1ec4b 453 }
vpcola 0:a1734fe1ec4b 454 else
vpcola 0:a1734fe1ec4b 455 {
vpcola 0:a1734fe1ec4b 456 return S_DISABLE;
vpcola 0:a1734fe1ec4b 457 }
vpcola 0:a1734fe1ec4b 458
vpcola 0:a1734fe1ec4b 459 }
vpcola 0:a1734fe1ec4b 460
vpcola 0:a1734fe1ec4b 461
vpcola 0:a1734fe1ec4b 462 /**
vpcola 0:a1734fe1ec4b 463 * @brief Sets the payload length for SPIRIT Basic packets. Since the packet length
vpcola 0:a1734fe1ec4b 464 * depends from the address and the control field size, this
vpcola 0:a1734fe1ec4b 465 * function reads the correspondent registers in order to determine
vpcola 0:a1734fe1ec4b 466 * the correct packet length to be written.
vpcola 0:a1734fe1ec4b 467 * @param nPayloadLength payload length in bytes.
vpcola 0:a1734fe1ec4b 468 * This parameter is an uint16_t.
vpcola 0:a1734fe1ec4b 469 * @retval None.
vpcola 0:a1734fe1ec4b 470 */
vpcola 0:a1734fe1ec4b 471 void SpiritPktBasicSetPayloadLength(uint16_t nPayloadLength)
vpcola 0:a1734fe1ec4b 472 {
vpcola 0:a1734fe1ec4b 473 uint8_t tempRegValue[2];
vpcola 0:a1734fe1ec4b 474 uint16_t overSize=0;
vpcola 0:a1734fe1ec4b 475
vpcola 0:a1734fe1ec4b 476 /* Computes the oversize (address + control) size */
vpcola 0:a1734fe1ec4b 477 if(SpiritPktBasicGetAddressField())
vpcola 0:a1734fe1ec4b 478 {
vpcola 0:a1734fe1ec4b 479 overSize=1;
vpcola 0:a1734fe1ec4b 480 }
vpcola 0:a1734fe1ec4b 481 overSize += (uint16_t) SpiritPktBasicGetControlLength();
vpcola 0:a1734fe1ec4b 482
vpcola 0:a1734fe1ec4b 483 /* Computes PCKTLEN0 value from nPayloadLength */
vpcola 0:a1734fe1ec4b 484 tempRegValue[1]=BASIC_BUILD_PCKTLEN0(nPayloadLength+overSize);
vpcola 0:a1734fe1ec4b 485 /* Computes PCKTLEN1 value from nPayloadLength */
vpcola 0:a1734fe1ec4b 486 tempRegValue[0]=BASIC_BUILD_PCKTLEN1(nPayloadLength+overSize);
vpcola 0:a1734fe1ec4b 487
vpcola 0:a1734fe1ec4b 488 /* Writes data on the PCKTLEN1/0 register */
vpcola 0:a1734fe1ec4b 489 g_xStatus = SpiritSpiWriteRegisters(PCKTLEN1_BASE, 2, tempRegValue);
vpcola 0:a1734fe1ec4b 490
vpcola 0:a1734fe1ec4b 491 }
vpcola 0:a1734fe1ec4b 492
vpcola 0:a1734fe1ec4b 493
vpcola 0:a1734fe1ec4b 494 /**
vpcola 0:a1734fe1ec4b 495 * @brief Returns the payload length for SPIRIT Basic packets. Since the
vpcola 0:a1734fe1ec4b 496 * packet length depends from the address and the control
vpcola 0:a1734fe1ec4b 497 * field size, this function reads the correspondent
vpcola 0:a1734fe1ec4b 498 * registers in order to determine the correct payload length
vpcola 0:a1734fe1ec4b 499 * to be returned.
vpcola 0:a1734fe1ec4b 500 * @param None.
vpcola 0:a1734fe1ec4b 501 * @retval uint16_t Payload length in bytes.
vpcola 0:a1734fe1ec4b 502 */
vpcola 0:a1734fe1ec4b 503 uint16_t SpiritPktBasicGetPayloadLength(void)
vpcola 0:a1734fe1ec4b 504 {
vpcola 0:a1734fe1ec4b 505 uint8_t tempRegValue[2];
vpcola 0:a1734fe1ec4b 506 uint16_t overSize=0;
vpcola 0:a1734fe1ec4b 507
vpcola 0:a1734fe1ec4b 508 /* Computes the oversize (address + control) size */
vpcola 0:a1734fe1ec4b 509 if(SpiritPktBasicGetAddressField())
vpcola 0:a1734fe1ec4b 510 {
vpcola 0:a1734fe1ec4b 511 overSize=1;
vpcola 0:a1734fe1ec4b 512 }
vpcola 0:a1734fe1ec4b 513 overSize += (uint16_t) SpiritPktBasicGetControlLength();
vpcola 0:a1734fe1ec4b 514
vpcola 0:a1734fe1ec4b 515 /* Reads the packet length registers */
vpcola 0:a1734fe1ec4b 516 g_xStatus = SpiritSpiReadRegisters(PCKTLEN1_BASE, 2, tempRegValue);
vpcola 0:a1734fe1ec4b 517
vpcola 0:a1734fe1ec4b 518 /* Returns the packet length */
vpcola 0:a1734fe1ec4b 519 return ((((uint16_t)tempRegValue[0])<<8) + (uint16_t) tempRegValue[1]) - overSize;
vpcola 0:a1734fe1ec4b 520 }
vpcola 0:a1734fe1ec4b 521
vpcola 0:a1734fe1ec4b 522 /**
vpcola 0:a1734fe1ec4b 523 * @brief Returns the packet length field of the received packet.
vpcola 0:a1734fe1ec4b 524 * @param None.
vpcola 0:a1734fe1ec4b 525 * @retval uint16_t Packet length.
vpcola 0:a1734fe1ec4b 526 */
vpcola 0:a1734fe1ec4b 527 uint16_t SpiritPktBasicGetReceivedPktLength(void)
vpcola 0:a1734fe1ec4b 528 {
vpcola 0:a1734fe1ec4b 529 uint8_t tempRegValue[2];
vpcola 0:a1734fe1ec4b 530 uint16_t overSize=0;
vpcola 0:a1734fe1ec4b 531
vpcola 0:a1734fe1ec4b 532 /* Computes the oversize (address + control) size */
vpcola 0:a1734fe1ec4b 533 if(SpiritPktBasicGetAddressField())
vpcola 0:a1734fe1ec4b 534 {
vpcola 0:a1734fe1ec4b 535 overSize=1;
vpcola 0:a1734fe1ec4b 536 }
vpcola 0:a1734fe1ec4b 537 overSize += (uint16_t) SpiritPktBasicGetControlLength();
vpcola 0:a1734fe1ec4b 538
vpcola 0:a1734fe1ec4b 539 /* Reads the RX_PCKT_LENx registers value */
vpcola 0:a1734fe1ec4b 540 g_xStatus = SpiritSpiReadRegisters(RX_PCKT_LEN1_BASE, 2, tempRegValue);
vpcola 0:a1734fe1ec4b 541
vpcola 0:a1734fe1ec4b 542 /* Rebuild and return the length field */
vpcola 0:a1734fe1ec4b 543 return (((((uint16_t) tempRegValue[0]) << 8) + (uint16_t) tempRegValue[1]) - overSize);
vpcola 0:a1734fe1ec4b 544 }
vpcola 0:a1734fe1ec4b 545
vpcola 0:a1734fe1ec4b 546 /**
vpcola 0:a1734fe1ec4b 547 * @brief Computes and sets the variable payload length for SPIRIT Basic packets.
vpcola 0:a1734fe1ec4b 548 * @param nMaxPayloadLength payload length in bytes.
vpcola 0:a1734fe1ec4b 549 * This parameter is an uint16_t.
vpcola 0:a1734fe1ec4b 550 * @param xAddressField Enable or Disable Address Field.
vpcola 0:a1734fe1ec4b 551 * This parameter can be S_ENABLE or S_DISABLE.
vpcola 0:a1734fe1ec4b 552 * @param xControlLength Control length in bytes.
vpcola 0:a1734fe1ec4b 553 * This parameter can be any value of @ref BasicControlLength.
vpcola 0:a1734fe1ec4b 554 * @retval None.
vpcola 0:a1734fe1ec4b 555 */
vpcola 0:a1734fe1ec4b 556 void SpiritPktBasicSetVarLengthWidth(uint16_t nMaxPayloadLength, SpiritFunctionalState xAddressField, BasicControlLength xControlLength)
vpcola 0:a1734fe1ec4b 557 {
vpcola 0:a1734fe1ec4b 558 uint8_t tempRegValue,
vpcola 0:a1734fe1ec4b 559 addressLength,
vpcola 0:a1734fe1ec4b 560 i;
vpcola 0:a1734fe1ec4b 561 uint32_t packetLength;
vpcola 0:a1734fe1ec4b 562
vpcola 0:a1734fe1ec4b 563 /* Sets the address length according to xAddressField */
vpcola 0:a1734fe1ec4b 564 if(xAddressField == S_ENABLE)
vpcola 0:a1734fe1ec4b 565 {
vpcola 0:a1734fe1ec4b 566 addressLength=1;
vpcola 0:a1734fe1ec4b 567 }
vpcola 0:a1734fe1ec4b 568 else
vpcola 0:a1734fe1ec4b 569 {
vpcola 0:a1734fe1ec4b 570 addressLength=0;
vpcola 0:a1734fe1ec4b 571 }
vpcola 0:a1734fe1ec4b 572
vpcola 0:a1734fe1ec4b 573 /* packet length = payload length + address length + control length */
vpcola 0:a1734fe1ec4b 574 packetLength=nMaxPayloadLength+addressLength+xControlLength;
vpcola 0:a1734fe1ec4b 575
vpcola 0:a1734fe1ec4b 576 /* Computes the number of bits */
vpcola 0:a1734fe1ec4b 577 for(i=0;i<16;i++)
vpcola 0:a1734fe1ec4b 578 {
vpcola 0:a1734fe1ec4b 579 if(packetLength == 0) break;
vpcola 0:a1734fe1ec4b 580 {
vpcola 0:a1734fe1ec4b 581 packetLength >>= 1;
vpcola 0:a1734fe1ec4b 582 }
vpcola 0:a1734fe1ec4b 583 }
vpcola 0:a1734fe1ec4b 584 i==0 ? i=1 : i;
vpcola 0:a1734fe1ec4b 585
vpcola 0:a1734fe1ec4b 586 /* Reads the PCKTCTRL3 register value */
vpcola 0:a1734fe1ec4b 587 g_xStatus = SpiritSpiReadRegisters(PCKTCTRL3_BASE, 1, &tempRegValue);
vpcola 0:a1734fe1ec4b 588
vpcola 0:a1734fe1ec4b 589 /* Build value for the length width */
vpcola 0:a1734fe1ec4b 590 tempRegValue &= ~PCKTCTRL3_LEN_WID_MASK;
vpcola 0:a1734fe1ec4b 591 tempRegValue |= (uint8_t)(i-1);
vpcola 0:a1734fe1ec4b 592
vpcola 0:a1734fe1ec4b 593 /* Writes the PCKTCTRL3 register value */
vpcola 0:a1734fe1ec4b 594 g_xStatus = SpiritSpiWriteRegisters(PCKTCTRL3_BASE, 1, &tempRegValue);
vpcola 0:a1734fe1ec4b 595
vpcola 0:a1734fe1ec4b 596 }
vpcola 0:a1734fe1ec4b 597
vpcola 0:a1734fe1ec4b 598
vpcola 0:a1734fe1ec4b 599
vpcola 0:a1734fe1ec4b 600 /**
vpcola 0:a1734fe1ec4b 601 *@}
vpcola 0:a1734fe1ec4b 602 */
vpcola 0:a1734fe1ec4b 603
vpcola 0:a1734fe1ec4b 604 /**
vpcola 0:a1734fe1ec4b 605 *@}
vpcola 0:a1734fe1ec4b 606 */
vpcola 0:a1734fe1ec4b 607
vpcola 0:a1734fe1ec4b 608
vpcola 0:a1734fe1ec4b 609 /**
vpcola 0:a1734fe1ec4b 610 *@}
vpcola 0:a1734fe1ec4b 611 */
vpcola 0:a1734fe1ec4b 612
vpcola 0:a1734fe1ec4b 613
vpcola 0:a1734fe1ec4b 614
vpcola 0:a1734fe1ec4b 615 /******************* (C) COPYRIGHT 2015 STMicroelectronics *****END OF FILE****/