diff options
Diffstat (limited to 'lcmodule/source/cnh1605205_ldr_network_layer/source/a2_header.c')
| -rw-r--r-- | lcmodule/source/cnh1605205_ldr_network_layer/source/a2_header.c | 201 |
1 files changed, 201 insertions, 0 deletions
diff --git a/lcmodule/source/cnh1605205_ldr_network_layer/source/a2_header.c b/lcmodule/source/cnh1605205_ldr_network_layer/source/a2_header.c new file mode 100644 index 0000000..7b7631b --- /dev/null +++ b/lcmodule/source/cnh1605205_ldr_network_layer/source/a2_header.c @@ -0,0 +1,201 @@ +/******************************************************************************* + * Copyright (C) ST-Ericsson SA 2011 + * License terms: 3-clause BSD license + ******************************************************************************/ +/** + * @addtogroup ldr_communication_serv + * @{ + * @addtogroup a2_family + * @{ + * @addtogroup ldr_header + * @{ + */ + +/******************************************************************************* + * Includes + ******************************************************************************/ +#include "c_system.h" +#include <string.h> +#include "t_basicdefinitions.h" +#include "r_a2_header.h" +#include "r_serialization.h" + +/******************************************************************************* + * Declaration of file local functions + ******************************************************************************/ +static uint8 A2_FindHeaderPattern(const uint8 *const HeaderData_p, uint32 *StartInBuffer_p); + + +/******************************************************************************* + * Definition of internal functions + ******************************************************************************/ + +/* + * Deserialize the header stored in network format to a structure. + * + * @param [out] Header_p Pointer to the header structure where the + * header data should be placed. + * @param [in] Data_p Pointer to the buffer with received header. + * + * @return none. + */ +void A2_DeserializeHeader(A2_Header_t *Header_p, void *Data_p) +{ + void *Iter_p = Data_p; + + Header_p->HeaderPattern = get_uint8(&Iter_p); + Header_p->Protocol = get_uint8(&Iter_p); + + if (PROTO_A2_ACK == Header_p->Protocol) { + Header_p->SourceAddress = get_uint8(&Iter_p); + Header_p->DestinationAddress = get_uint8(&Iter_p); + Header_p->SequenceNumber = get_uint8(&Iter_p); + Header_p->Reserved[0] = get_uint8(&Iter_p); + Header_p->Reserved[1] = get_uint8(&Iter_p); + Header_p->Reserved[2] = get_uint8(&Iter_p); + Header_p->DataLength = 0; + } else { + Header_p->SourceAddress = get_uint8(&Iter_p); + Header_p->DestinationAddress = get_uint8(&Iter_p); + Header_p->SequenceNumber = get_uint8(&Iter_p); + Header_p->Reserved[0] = get_uint8(&Iter_p); + Header_p->Reserved[1] = get_uint8(&Iter_p); + Header_p->Reserved[2] = get_uint8(&Iter_p); + Header_p->DataLength = get_uint32_le(&Iter_p); + } +} + +/* + * Serialize the header structure to network format. + * + * The data buffer must be of at least size HEADER_LENGTH. + * + * @param [out] Data_p Pointer to the buffer where the + * serialized header should be placed. + * @param [in] Header_p Pointer to the source header structure. + * + * @return none. + */ +void A2_SerializeHeader(void *Data_p, const A2_Header_t *Header_p) +{ + void *Iter_p = Data_p; + + if (PROTO_A2_ACK == Header_p->Protocol) { + put_uint8(&Iter_p, A2_HEADER_PATTERN); + put_uint8(&Iter_p, PROTO_A2_ACK); + put_uint8(&Iter_p, Header_p->SourceAddress); + put_uint8(&Iter_p, Header_p->DestinationAddress); + put_uint8(&Iter_p, Header_p->SequenceNumber); + put_uint8(&Iter_p, Header_p->Reserved[0]); + put_uint8(&Iter_p, Header_p->Reserved[1]); + put_uint8(&Iter_p, Header_p->Reserved[2]); + put_uint16_le(&Iter_p, 0); + } else { + put_uint8(&Iter_p, A2_HEADER_PATTERN); + put_uint8(&Iter_p, PROTO_A2); + put_uint8(&Iter_p, Header_p->SourceAddress); + put_uint8(&Iter_p, Header_p->DestinationAddress); + put_uint8(&Iter_p, Header_p->SequenceNumber); + put_uint8(&Iter_p, Header_p->Reserved[0]); + put_uint8(&Iter_p, Header_p->Reserved[1]); + put_uint8(&Iter_p, Header_p->Reserved[2]); + put_uint32_le(&Iter_p, Header_p->DataLength); + } +} + + +/* + * Get packet length in bytes given the information in Header_p. + * + * @param [in] Header_p Pointer to the header structure. + * + * @return The length of the packet in bytes. + */ +uint32 A2_GetPacketLength(const A2_Header_t *Header_p) +{ + return A2_HEADER_LENGTH + Header_p->DataLength; +} + + +/* + * Determines whether the first HEADER_LENGTH bytes of Data_p contains a + * valid header. + * + * @param [in] Data_p Pointer to the header candidate. + * + * @retval TRUE If header is valid. + * @retval FALSE If header is not valid. + */ +boolean A2_IsValidHeader(const void *Data_p) +{ + uint8 *Temp_p = (uint8 *)Data_p; + + if (A2_HEADER_PATTERN != *Temp_p) { + return FALSE; + } + + if ((PROTO_A2 != *(Temp_p + 1)) && (PROTO_A2_ACK != *(Temp_p + 1)) && (PROTO_CTRL_MSG != *(Temp_p + 1))) { + return FALSE; + } + + return TRUE; +} + +/* + * Checks if new header is received. + * + * @param [in] In_p Pointer to the structure with receiver information. + * + * @retval TRUE If header is received. + * @retval FALSE If header is not received. + */ +boolean A2_IsReceivedHeader(A2_Inbound_t *In_p) +{ + uint32 StartHeaderInBuffer = 0; + uint8 *TmpPointer_p = NULL; + uint8 Res = 0; + + Res = A2_FindHeaderPattern(In_p->Scratch, &StartHeaderInBuffer); + + if (A2_HEADER_PATTERN_MATCH == Res) { + /* Check start point of header in received data */ + if (StartHeaderInBuffer == 0) { + return TRUE; + } else { + In_p->ReqData = StartHeaderInBuffer; + TmpPointer_p = (uint8 *)((uint32)In_p->Target_p + StartHeaderInBuffer); + memcpy(In_p->Target_p, (uint8 *)TmpPointer_p, A2_HEADER_LENGTH - StartHeaderInBuffer); + In_p->ReqBuffOffset = A2_HEADER_LENGTH - StartHeaderInBuffer; + } + } else { + /* setup for receiving new packet */ + In_p->State = A2_RECEIVE_ERROR; + } + + return FALSE; +} + +static uint8 A2_FindHeaderPattern(const uint8 *const HeaderData_p, uint32 *StartInBuffer_p) +{ + uint8 Res = NO_A2_HEADER_PATTERN; + uint32 Offset = 0; + + do { + Res = NO_A2_HEADER_PATTERN; + + if ((*((uint8 *)HeaderData_p + Offset) == A2_HEADER_PATTERN)) { + Res = A2_HEADER_PATTERN_MATCH; + break; + } + + Offset++; + } while (Offset < (A2_HEADER_LENGTH - 1)); + + *StartInBuffer_p = Offset; + + return Res; +} + +/** @} */ +/** @} */ +/** @} */ |