#include"basetype.h"
#include"common.h"

UINT16 EthernetLib_EncodeEthernetHeader(IN UINT8* pucSrcMac, IN UINT8* pucDstMac,
	IN UINT16 usNextProtocol, OUT UINT8* pucBuffer)
{
	UINT8* pucPointer = pucBuffer;

	memcpy(pucPointer, pucDstMac, MAC_BYTE);
	pucPointer += MAC_BYTE;
	memcpy(pucPointer, pucSrcMac, MAC_BYTE);
	pucPointer += MAC_BYTE;

	//	*(UINT16*)pucPointer = usNextProtocol;

	*pucPointer = (UINT8)((usNextProtocol & 0xFF00) >> 8);
	pucPointer++;
	*pucPointer = usNextProtocol & 0xFF;

	return 14;
}

/*
* description: 解封装报文里面的以太头部分
*
* input:
*	pucBuffer						报文
*	usPacketLen						报文长度
* output：
*	ETHERNET_S* pstEthernetHeader	报文的以太头部分
* return：							NULL
* tip：								IN是空宏，表示改参数是输入
*/
VOID EthernetLib_DecodeEthernetHeader(IN UINT8* pucBuffer, UINT16 usPacketLen, ETHERNET_S* pstEthernetHeader)
{

	if (usPacketLen < 14)
	{
		printf("Ethernet header message length error\n");
		exit(-1);
	}
	UINT8* pucPointer = pucBuffer;
	memcpy(pstEthernetHeader->aucDst, pucPointer, MAC_BYTE);
	pucPointer += MAC_BYTE;

	memcpy(pstEthernetHeader->aucSrc, pucPointer, MAC_BYTE);
	pucPointer += MAC_BYTE;

	pstEthernetHeader->usNextProtocol = ((UINT16)(*pucPointer) << 8);
	pucPointer++;
	pstEthernetHeader->usNextProtocol += (UINT16)(*pucPointer);
	pucPointer++;

	return;
}

VOID EthernetLib_DecodeEthernetVlanHeader(IN UINT8* pucBuffer, UINT16 usPacketLen, ETHERNET_VLAN_S* pstEthernetHeader)
{
	if (usPacketLen < 18)
	{
		printf("Ethernet header message length error\n");
		exit(-1);
	}

	UINT8* pucPointer = pucBuffer;
	memcpy(pstEthernetHeader->aucDst, pucPointer, MAC_BYTE);
	pucPointer += MAC_BYTE;

	memcpy(pstEthernetHeader->aucSrc, pucPointer, MAC_BYTE);
	pucPointer += MAC_BYTE;

	memcpy((VOID*)&pstEthernetHeader->usEtype, pucPointer, VLAN_ETYPE);
	pucPointer += VLAN_ETYPE;

	memcpy((VOID*)&pstEthernetHeader->usVlanTag, pucPointer, VLAN_ID);
	pucPointer += VLAN_ID;

	pstEthernetHeader->usNextProtocol = ((UINT16)(*pucPointer) << 8);
	pucPointer++;
	pstEthernetHeader->usNextProtocol += (UINT16)(*pucPointer);
	pucPointer++;
	return;
}