初始提交
This commit is contained in:
71
app/smart_grid/protocol/proto_acm.c
Normal file
71
app/smart_grid/protocol/proto_acm.c
Normal file
@@ -0,0 +1,71 @@
|
||||
/****************************************************************************
|
||||
|
||||
Copyright(c) 2019 by Aerospace C.Power (Chongqing) Microelectronics. ALL RIGHTS RESERVED.
|
||||
|
||||
This Information is proprietary to Aerospace C.Power (Chongqing) Microelectronics and MAY NOT
|
||||
be copied by any method or incorporated into another program without
|
||||
the express written consent of Aerospace C.Power. This Information or any portion
|
||||
thereof remains the property of Aerospace C.Power. The Information contained herein
|
||||
is believed to be accurate and Aerospace C.Power assumes no responsibility or
|
||||
liability for its use in any way and conveys no license or title under
|
||||
any patent or copyright and makes no representation or warranty that this
|
||||
Information is free from patent or copyright infringement.
|
||||
|
||||
****************************************************************************/
|
||||
|
||||
/* iot common header files */
|
||||
#include "os_types_api.h"
|
||||
|
||||
/* iot common header files */
|
||||
#include "iot_crc_api.h"
|
||||
#include "iot_io_api.h"
|
||||
|
||||
/* smart grid internal header files */
|
||||
#include "iot_sg_fr.h"
|
||||
#include "proto_acm.h"
|
||||
|
||||
#if (IOT_SMART_GRID_CCO_ACM_ENABLE)
|
||||
|
||||
void proto_acm_check_frame_handler(uint8_t *buffer, uint32_t buffer_len,
|
||||
bool_t *is_frame)
|
||||
{
|
||||
uint16_t frame_len;
|
||||
uint16_t fcs, fcs_offset;
|
||||
uint16_t frame_min_len;
|
||||
|
||||
frame_min_len = sizeof(proto_acm_hdr_t) + sizeof(proto_acm_tail_t);
|
||||
|
||||
if (buffer_len < frame_min_len) {
|
||||
*is_frame = false;
|
||||
return;
|
||||
}
|
||||
|
||||
if (buffer[0] != PROTO_ACM_SOF_BYTE
|
||||
|| buffer[buffer_len - 1] != PROTO_ACM_EOF_BYTE) {
|
||||
*is_frame = false;
|
||||
return;
|
||||
}
|
||||
|
||||
frame_len = (uint16_t)buffer[2];
|
||||
frame_len = (frame_len << 8) | (uint16_t)buffer[1];
|
||||
frame_len += frame_min_len;
|
||||
|
||||
if (frame_len != buffer_len) {
|
||||
*is_frame = false;
|
||||
return;
|
||||
}
|
||||
|
||||
fcs_offset = (uint16_t)(buffer_len - sizeof(proto_acm_tail_t));
|
||||
fcs = (uint16_t)buffer[fcs_offset + 1];
|
||||
fcs = (fcs << 8) | (uint16_t)buffer[fcs_offset];
|
||||
if (fcs != iot_getcrc16(&buffer[PROTO_ACM_SOF_BYTE_LEN],
|
||||
buffer_len - PROTO_ACM_SOF_BYTE_LEN - sizeof(proto_acm_tail_t),
|
||||
IOT_CRC16_TYPE_X25)) {
|
||||
/* checksum failure */
|
||||
*is_frame = false;
|
||||
return;
|
||||
}
|
||||
*is_frame = true;
|
||||
}
|
||||
|
||||
#endif /* IOT_SMART_GRID_CCO_ACM_ENABLE */
|
||||
Reference in New Issue
Block a user