我必须更改网络驱动程序(在实时操作系统上)以嗅探 PTP 帧(它是具有特殊数据字段的 UDP 帧)并更改一些数据。我需要更新网络驱动程序(R8168)中的数据。这样做我也必须在发送帧之前修改 CRC 字段。我找了一些例子,但没有一个有效。我想这在使用 htons 或 ntohs 的行中有问题:我不知道我是否必须使用网络字节顺序或主机字节顺序。
unsigned int calc_checksum( unsigned char *pcBuf, unsigned short usLength, unsigned int uiSum )
{
unsigned short i, usTmp ;
/* Checksum all the pairs of bytes first... */
for ( i = 0; i < (usLength & ~1U); i += 2 )
{
usTmp = *((unsigned short *)(pcBuf + i)) ;
uiSum += (unsigned short)ntohs( usTmp ) ;
if ( uiSum > 0xFFFF )
uiSum -= 0xFFFF ;
}
/*
* If there's a single byte left over, checksum it, too.
* Network byte order is big-endian, so the remaining byte is
* the high byte.
*/
if ( i < usLength )
{
uiSum += pcBuf[i] << 8 ;
if ( uiSum > 0xFFFF )
uiSum -= 0xFFFF ;
}
/*.*/
return uiSum ;
}
/* Recalculate UPD checksum */
usTmp = sizeof(TUdpHeader) + sizeof(TPTPSyncData) ;
uiSum = calc_checksum( (unsigned char *)(&pPTPFrame->udpHeader.sport),
sizeof(TUdpHeader) + sizeof(TPTPSyncData),
calc_checksum( (unsigned char *)(&pPTPFrame->ipHeader.saddr),
2 * sizeof(unsigned int), IP_UDP + htons( usTmp ) ) ) ;
// Return the one's complement of sum
usTmp = (~uiSum) & 0xFFFF ;
pPTPFrame->udpHeader.checksum = htons( usTmp ) ;
笔记:
- pPTPFrame 是指向全帧的指针(EthHeader + IpHeader +
UdpHeader + Data) - IP_UDP = 17
- TPTPSyncData 是数据结构
非常感谢。伊曼纽尔。