void avb1722_set_buffer_vlan(int vlan,
unsigned char Buf0[])
{
unsigned char *Buf = &Buf0[2];
AVB_Frame_t *pEtherHdr = (AVB_Frame_t *) &(Buf[0]);
SET_AVBTP_VID(pEtherHdr, vlan);
return;
}
/** This configure AVB Talker buffer for a given stream configuration.
* It updates the static portion of Ehternet/AVB transport layer headers.
*/
void AVB1722_Talker_bufInit(unsigned char Buf0[],
avb1722_Talker_StreamConfig_t *pStreamConfig,
int vlanid)
{
int i;
unsigned char *Buf = &Buf0[2];
AVB_Frame_t *pEtherHdr = (AVB_Frame_t *) &(Buf[0]);
AVB_DataHeader_t *p1722Hdr = (AVB_DataHeader_t *) &(Buf[AVB_ETHERNET_HDR_SIZE]);
AVB_AVB1722_CIP_Header_t *p61883Hdr = (AVB_AVB1722_CIP_Header_t *) &(Buf[AVB_ETHERNET_HDR_SIZE + AVB_TP_HDR_SIZE]);
// clear all the bytes in header.
memset( (void *) Buf, 0, (AVB_ETHERNET_HDR_SIZE + AVB_TP_HDR_SIZE + AVB_CIP_HDR_SIZE));
//--------------------------------------------------------------------------
// 1. Initialaise the ethernet layer.
// copy both Src/Dest MAC address
for (i = 0; i < MAC_ADRS_BYTE_COUNT; i++) {
pEtherHdr->DA[i] = pStreamConfig->destMACAdrs[i];
pEtherHdr->SA[i] = pStreamConfig->srcMACAdrs[i];
}
SET_AVBTP_TPID(pEtherHdr, AVB_TPID);
SET_AVBTP_PCP(pEtherHdr, AVB_DEFAULT_PCP);
SET_AVBTP_CFI(pEtherHdr, AVB_DEFAULT_CFI);
SET_AVBTP_VID(pEtherHdr, vlanid);
SET_AVBTP_ETYPE(pEtherHdr, AVB_1722_ETHERTYPE);
//--------------------------------------------------------------------------
// 2. Initialaise the AVB TP layer.
// NOTE: Since the data structure is cleared before we only set the requird bits.
SET_AVBTP_SV(p1722Hdr, 1); // set stream ID to valid.
SET_AVBTP_STREAM_ID0(p1722Hdr, pStreamConfig->streamId[0]);
SET_AVBTP_STREAM_ID1(p1722Hdr, pStreamConfig->streamId[1]);
//--------------------------------------------------------------------------
// 3. Initialaise the 61883 CIP protocol specific part
SET_AVB1722_CIP_TAG(p1722Hdr, AVB1722_DEFAULT_TAG);
SET_AVB1722_CIP_CHANNEL(p1722Hdr, AVB1722_DEFAULT_CHANNEL);
SET_AVB1722_CIP_TCODE(p1722Hdr, AVB1722_DEFAULT_TCODE);
SET_AVB1722_CIP_SY(p1722Hdr, AVB1722_DEFAULT_SY);
SET_AVB1722_CIP_EOH1(p61883Hdr, AVB1722_DEFAULT_EOH1);
SET_AVB1722_CIP_SID(p61883Hdr, AVB1722_DEFAULT_SID);
SET_AVB1722_CIP_DBS(p61883Hdr, 6);
SET_AVB1722_CIP_FN(p61883Hdr, 3);
SET_AVB1722_CIP_QPC(p61883Hdr, 0);
SET_AVB1722_CIP_SPH(p61883Hdr, 1);
SET_AVB1722_CIP_DBC(p61883Hdr, AVB1722_DEFAULT_DBC);
SET_AVB1722_CIP_EOH2(p61883Hdr, AVB1722_DEFAULT_EOH2);
SET_AVB1722_CIP_FMT(p61883Hdr, 0x20);
SET_AVB1722_CIP_FDF(p61883Hdr, 0x80);
SET_AVB1722_CIP_SYT(p61883Hdr, AVB1722_DEFAULT_SYT);
}
