229 lines
5.7 KiB
C
229 lines
5.7 KiB
C
/**************************************************************************!
|
||
* 技术讨论：QQ群 123763203
|
||
* 官网 ：www.navota.com
|
||
*
|
||
* @file crc.c
|
||
* @brief 冗余校验模块（CRC)函数库
|
||
* @author Navota
|
||
* @date 2018-3-1
|
||
****************************************************************************/
|
||
#include "common.h"
|
||
#include "crc.h"
|
||
|
||
/*****************************************************************************//*!
|
||
*
|
||
* @brief 初始化CRC
|
||
*
|
||
* @param[in] pConfig 指向CRC配置结构体.
|
||
*
|
||
* @return none
|
||
*
|
||
*****************************************************************************/
|
||
void CRC_Init(CRC_ConfigType *pConfig)
|
||
{
|
||
uint32_t u32Sc ;
|
||
|
||
u32Sc = 0;
|
||
|
||
SIM->SCGC |= SIM_SCGC_CRC_MASK; //使能CRC控制模块时钟
|
||
|
||
u32Sc |= ((pConfig->bWidth & 0x01)<<24); //CRC模式选择
|
||
u32Sc |= CRC_CTRL_TOTR(pConfig->bTransposeReadType & 0x03); //设置数据读取的转置类型
|
||
u32Sc |= CRC_CTRL_TOT(pConfig->bTransposeWriteType & 0x03); //设置数据写入的转置类型
|
||
|
||
if (pConfig->bFinalXOR)
|
||
{
|
||
u32Sc |= CRC_CTRL_FXOR_MASK; //对CRC数据寄存的读取值进行异或操作
|
||
}
|
||
|
||
CRC0->CTRL = u32Sc;
|
||
|
||
if ( pConfig->bWidth )
|
||
{
|
||
CRC0->GPOLY = pConfig->u32PolyData; //写入32位多项式
|
||
}
|
||
else
|
||
{
|
||
CRC0->GPOLY_ACCESS16BIT.GPOLYL = pConfig->u32PolyData; /*!< 仅允许写16位多项式*/
|
||
}
|
||
|
||
}
|
||
|
||
|
||
/*****************************************************************************//*!
|
||
*
|
||
* @brief 16位模式下CRC计算函数.
|
||
*
|
||
* @param[in] seed 种子值
|
||
* @param[in] msg 指向数据数组
|
||
* @param[in] sizeBytes 数据大小
|
||
*
|
||
* @return data_out convertion result
|
||
*
|
||
*****************************************************************************/
|
||
uint32_t CRC_Cal16(uint32_t seed, uint8_t *msg, uint32_t sizeBytes)
|
||
{
|
||
uint32_t ctrl_reg,data_out,data_in;
|
||
uint8_t *pCRCBytes;
|
||
uint32_t sizeWords;
|
||
uint32_t i,j;
|
||
|
||
/* 设置WaS=1，写入种子值 */
|
||
ctrl_reg = CRC0->CTRL;
|
||
CRC0->CTRL = ctrl_reg | CRC_CTRL_WAS_MASK;
|
||
CRC0->ACCESS16BIT.DATAL = seed;
|
||
|
||
/* Set WaS=0，准备写入数据*/
|
||
CRC0->CTRL = ctrl_reg & 0xFD000000;
|
||
|
||
/*等待计算完成*/
|
||
sizeWords = sizeBytes>>1;
|
||
j = 0;
|
||
for(i=0;i<sizeWords;i++){
|
||
data_in = (msg[j] << 8) | (msg[j+1]); /*将数据写入CRC数据寄存器，以16位方式写入*/
|
||
j += 2;
|
||
CRC0->ACCESS16BIT.DATAL =data_in;
|
||
}
|
||
if (j<sizeBytes)
|
||
{
|
||
pCRCBytes = (uint8_t*)&CRC0->ACCESS8BIT.DATALL; /*以8位的方式写入剩余的数据*/
|
||
*pCRCBytes++ = msg[j];
|
||
}
|
||
if ((CRC0->CTRL& CRC_CTRL_TOTR_MASK)>1) //Modify
|
||
{
|
||
data_out=CRC0->ACCESS16BIT.DATAH; //读出字节转置后16位计算结果
|
||
}
|
||
else
|
||
{
|
||
data_out=CRC0->ACCESS16BIT.DATAL; //读出16位计算结果
|
||
}
|
||
|
||
return(data_out);
|
||
}
|
||
|
||
|
||
/*****************************************************************************//*!
|
||
*
|
||
* @brief 32位模式下CRC计算.
|
||
*
|
||
* @param[in] seed
|
||
* @param[in] msg 指向数据数组
|
||
* @param[in] sizeBytes 数据大小
|
||
*
|
||
* @return data_out convertion result
|
||
*
|
||
*****************************************************************************/
|
||
uint32_t CRC_Cal32(uint32_t seed, uint8_t *msg, uint32_t sizeBytes)
|
||
{
|
||
uint32_t ctrl_reg,data_out,data_in;
|
||
uint32_t sizeDwords;
|
||
uint8_t *pCRCBytes;
|
||
uint32_t i,j;
|
||
|
||
/* 设置WaS=1，写入种子值 */
|
||
ctrl_reg = CRC0->CTRL;
|
||
CRC0->CTRL = ctrl_reg | 0x02000000;
|
||
CRC0->DATA = seed;
|
||
|
||
/* Set WaS=0，准备写入数据*/
|
||
CRC0->CTRL = ctrl_reg & 0xFD000000;
|
||
|
||
/*等待数据计算完成*/
|
||
sizeDwords = sizeBytes>>2;
|
||
j = 0;
|
||
for(i=0;i<sizeDwords;i++)
|
||
{
|
||
data_in = ((msg[j] << 24) | (msg[j+1] << 16) | (msg[j+2] << 8) | msg[j+3]); /*将数据写入CRC数据寄存器，以32方式写入*/
|
||
j += 4;
|
||
CRC0->DATA = data_in;
|
||
}
|
||
if (j<sizeBytes)
|
||
{
|
||
pCRCBytes = (uint8_t*)&CRC0->ACCESS8BIT.DATALL; /*以8位的方式写入剩余的数据*/
|
||
|
||
#if defined(BYTE_ENABLES_1_2_4_8)
|
||
|
||
/*只写单个字节*/
|
||
for(;j<sizeBytes;j++)
|
||
{
|
||
*pCRCBytes++ = msg[j];
|
||
}
|
||
#elif defined(BYTE_ENABLES_3_6_C)
|
||
|
||
/*写入两个字节*/
|
||
data_in = 0;
|
||
i = 0;
|
||
for(;j<sizeBytes;j++)
|
||
{
|
||
data_in = (data_in <<8) | msg[j];
|
||
i++;
|
||
if (i==2)
|
||
{
|
||
i = 0;
|
||
CRC0->ACCESS16BIT.DATAL = data_in;
|
||
}
|
||
}
|
||
if (i==1)
|
||
{
|
||
CRC0->ACCESS8BIT.DATALL = data_in; /*!< 写入最后一个字节 */
|
||
}
|
||
#elif defined(BYTE_ENABLES_7_E)
|
||
/*!< 写入三个字节*/
|
||
data_in = 0;
|
||
i = 0;
|
||
for(;j<sizeBytes;j++)
|
||
{
|
||
data_in = (data_in <<8) | msg[j];
|
||
i++;
|
||
if (i==3)
|
||
{
|
||
i = 0;
|
||
/*写入第一个字符*/
|
||
CRC0->ACCESS8BIT.DATAHL = (data_in>>16) & 0xff; /*!< 写入高字的低字节 */
|
||
/*写入最后两个字节*/
|
||
CRC0->ACCESS16BIT.DATAL = data_in & 0x00ffff; /*!< 写入低字 */
|
||
}
|
||
}
|
||
if ( i == 2)
|
||
{
|
||
CRC0->ACCESS16BIT.DATAL = (data_in); /*!< 写最后两个字节 */
|
||
}
|
||
else if (i == 1)
|
||
{
|
||
CRC0->ACCESS8BIT.DATALL = data_in; /*!< 写最后一个字节 */
|
||
}
|
||
#else /*!< 只写低字节 */
|
||
for(;j<sizeBytes;j++)
|
||
{
|
||
*pCRCBytes = msg[j];
|
||
}
|
||
#endif
|
||
}
|
||
data_out=CRC0->DATA;
|
||
|
||
return(data_out); //读出32位计算结果
|
||
}
|
||
|
||
|
||
/*****************************************************************************//*!
|
||
*
|
||
* @brief 复位CRC模块
|
||
*
|
||
* @param none
|
||
*
|
||
* @return none
|
||
*
|
||
*****************************************************************************/
|
||
void CRC_DeInit(void)
|
||
{
|
||
CRC0->CTRL = 0x3000000; /*!<设置CRC位32位模式*/
|
||
CRC0->DATA = 0xFFFFFFFF;/*!< 写32位种子值到CRC数据寄存器*/
|
||
while(!(CRC0->DATA == 0xFFFFFFFF));
|
||
CRC0->GPOLY = 0x00001021;
|
||
CRC0->CTRL = 0; /*!<CRC控制寄存器清零*/
|
||
SIM->SCGC &= ~SIM_SCGC_CRC_MASK;
|
||
}
|
||
|
||
|
||
|