金牌会员
 
- 积分
- 1124
- 威望
- 611
- 贡献
- 317
- 兑换币
- 356
- 注册时间
- 2014-5-20
- 在线时间
- 98 小时
- 毕业学校
- 山东理工大学
|
ushort CRC_CHECK(u8 *Buf, u8 CRC_CNT)
{
ushort CRC_Temp= 0xffff;
u8 i,j;
for (i=0;i<CRC_CNT; i++)
{
CRC_Temp ^= Buf[i];
for (j=0;j<8;j++)
{
if (CRC_Temp & 0x01)
{
CRC_Temp = (CRC_Temp >>1 ) ^ 0xa001;
}
else
{
CRC_Temp = CRC_Temp >> 1;
}
}
}
return(CRC_Temp);
}
void OutPut_Data(void)//坑爹的协议 弄得我卡了几天
{
s16 temp[4] = {0};
u16 temp1[4] = {0};
u8 databuf[10] = {0};
u8 i;
ushort CRC16 = 0;
for(i=0;i<4;i++)
{
temp[i] = (s16)Data[i];
temp1[i] = (u16)temp[i];
}
for(i=0;i<4;i++)
{
databuf[i*2] = (s8)(temp1[i]%256);
databuf[i*2+1] = (s8)(temp1[i]/256);
}
CRC16 = CRC_CHECK(databuf,8);
databuf[8] = CRC16%256;
databuf[9] = CRC16/256;
for(i=0;i<10;i++)
{
uart_putchar(UART0,databuf[i]);
}
}
是这个协议不? |
|