71 lines
		
	
	
		
			2.2 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			71 lines
		
	
	
		
			2.2 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/****************************************************************************
 | 
						|
 | 
						|
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 */ |