cs8900dbg.c

支持三星原产的S3C2413开发板

	USHORT *bp;
	USHORT	data;

														/* Discard RxStatus		*/
	data   = IOREAD(IO_RX_TX_DATA_0);
												/* Read the frame's length.		*/
	length = IOREAD(IO_RX_TX_DATA_0);

	if (length > dwLength) length = 0;

	bp    = (USHORT *)pbData;

	rlen = length;

	while (rlen)
	{
		data = IOREAD(IO_RX_TX_DATA_0);

		if (rlen == 1)
		{
			*((BYTE *)bp) = (BYTE)data;
			rlen--;
		}
		else
		{
			*bp++ = data;
			rlen -= 2;
		}
	}

	return length;
}


static USHORT 
TransmitPkt(BYTE *pbData, USHORT slen)
{
	USHORT * bp;
	USHORT   data;
	DWORD	 i;

	/* Send Command */
	IOWRITE(IO_TX_CMD, TX_CMD_START_ALL | TX_CMD_LOW_BITS);
	IOWRITE(IO_TX_LENGTH, slen);

	/* Wait			*/
	for (i = 0; i < MAX_COUNT; i++)
	{
		data = READ_REG2(PKTPG_BUS_ST);
		if (data & BUS_ST_RDY_4_TX_NOW) break;
	} 

	if (i >= MAX_COUNT) return 1;

	bp = (USHORT *)pbData;

	while (slen)
	{
		IOWRITE(IO_RX_TX_DATA_0, *bp++);
		slen--;

		if (slen) slen--;
	}

	return 0;
}

/*::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::*/
/*::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::*/

BOOL
CS8900DBG_Init(BYTE *iobase, ULONG membase, USHORT MacAddr[3])
{
	BOOL r = FALSE;

	bIsPacket         = FALSE;
	dwEthernetIOBase  = (DWORD)iobase;
	dwEthernetMemBase = membase;
	RETAILMSG(1, (TEXT("CS8900: IOBase=%x, MEMBase=%x\n\r"), dwEthernetIOBase, dwEthernetMemBase));
	
	RETAILMSG(1, (TEXT("CS8900: MAC Address: %x:%x:%x:%x:%x:%x\r\n"),
				MacAddr[0] & 0x00FF, MacAddr[0] >> 8,
				MacAddr[1] & 0x00FF, MacAddr[1] >> 8,
				MacAddr[2] & 0x00FF, MacAddr[2] >> 8));
    do
	{
		if (!Reset())			break;
		if (!Probe())			break;
		if (!Init(MacAddr))		break;

		r = TRUE;
	} while (0);
	return r;
}

/*::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::*/
/*::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::*/

DWORD
CS8900DBG_GetPendingInts(void)
{
	USHORT event;
    RX_CTL   RxCTL;
	BOOL   r = FALSE;

	event		= IOREAD(IO_ISQ);			
	RxCTL.All   = READ_REG2(PKTPG_RX_CTL);

	if ( ((event & ISQ_REG_NUM)	== REG_NUM_RX_EVENT ) &&
		 (event & RX_EVENT_RX_OK) &&
		 ((event & RX_EVENT_HASHED) || (event & RX_EVENT_IND_ADDR) || (event & RX_EVENT_BROADCAST))) 
	{
		r = bIsPacket = TRUE;
	}
	else
		bIsPacket = FALSE;

	return(r ? INTR_TYPE_RX : 0);
}

/*::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::*/
/*::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::*/
// TODO - the LAF hash process can yield the same index value for different MAC addresses.
// As such, we should do a second level check in this routine.
UINT16
CS8900DBG_GetFrame(BYTE *pbData, UINT16 *pwLength)
{
    UINT16 r = 0;
	
	if (!bIsPacket) 
		CS8900DBG_GetPendingInts();

	if (bIsPacket) 
	{
		bIsPacket = FALSE;
		r = RcvPkt(pbData, *pwLength);

		if (pwLength)
		{
			// Remove the length of the CRC value.
			//
			*pwLength = r;
		}
	}

	return r;
}

/*::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::*/
/*::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::*/
UINT16 
CS8900DBG_SendFrame( BYTE *pbData, DWORD dwLength ) 
{
	return 
		TransmitPkt(pbData, (UINT16)dwLength);
}

/*::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::*/
/*::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::::*/
BOOL
CS8900DBG_ReInit(DWORD iobase, DWORD membase)
{
	bIsPacket = FALSE;

	dwEthernetIOBase  = iobase;
	dwEthernetMemBase = membase;

	RETAILMSG(1, (TEXT("Resetting dwEthernetIOBase=%x\n"), dwEthernetIOBase));
	RETAILMSG(1, (TEXT("Resetting dwEthernetMemBase=%x\n"), dwEthernetMemBase));
	return TRUE;
}

/*
    @func   void | CS8900DBG_CurrentPacketFilter | Sets a receive packet h/w filter.
    @rdesc  N/A.
    @comm    
    @xref   
*/
void CS8900DBG_CurrentPacketFilter(DWORD dwFilter)
{
    RX_CTL   RxCTL;
	LINE_CTL LineCTL;
		
	// Clear RxON to disable frame receive.
	//
	LineCTL.All = READ_REG2(PKTPG_LINE_CTL);
	LineCTL.Bits.SerRxON = 0;
	WRITE_REG2(PKTPG_LINE_CTL, LineCTL.All);

	RxCTL.All   = READ_REG2(PKTPG_RX_CTL);

	// Reset all packet filter bits to defaults.
	//
	RxCTL.Bits.MulticastA	= 0;
	RxCTL.Bits.PromiscuousA = 0;
	RxCTL.Bits.BroadcastA	= 1;	// Always accept broadcast messages.
	RxCTL.Bits.IndividualA	= 1;	// Always accept packets with a direct address.
	RxCTL.Bits.IAHashA		= 0;	// We don't support multiple directed addresses.


	// What kind of filtering do we want to apply?
	//
	// NOTE: the filter provided might be 0, but since this EDBG driver is used for KITL, we don't want
	// to stifle the KITL connection, so broadcast and directed packets should always be accepted.
	//
	if (dwFilter & PACKET_TYPE_ALL_MULTICAST)
	{	// Accept *all* multicast packets.
		WRITE_REG2((PKTPG_LOGICAL_ADDR_FILTER + 0), 0xFFFF);
		WRITE_REG2((PKTPG_LOGICAL_ADDR_FILTER + 2), 0xFFFF);
		WRITE_REG2((PKTPG_LOGICAL_ADDR_FILTER + 4), 0xFFFF);
		WRITE_REG2((PKTPG_LOGICAL_ADDR_FILTER + 6), 0xFFFF);

		RxCTL.Bits.MulticastA = 1;
	}

	if (dwFilter & PACKET_TYPE_MULTICAST)
	{	// Accept multicast packets.
		RxCTL.Bits.MulticastA = 1;
	}
 
#if 0	// Promiscuous mode is causing random hangs - it's not strictly needed.
	if (dwFilter & PACKET_TYPE_PROMISCUOUS)
	{	// Accept anything.
		RxCTL.Bits.PromiscuousA = 1;
	}
#endif

    EdbgOutputDebugString("CS8900: Set receive packet filter [Filter=0x%x, RxCTL=0x%x].\r\n", dwFilter, RxCTL.All);

	WRITE_REG2(PKTPG_RX_CTL, RxCTL.All);

	// Set RxON to disable frame receive.
	//
	LineCTL.Bits.SerRxON = 1;
	WRITE_REG2(PKTPG_LINE_CTL, LineCTL.All);

}	// CS8900DBG_CurrentPacketFilter().


/*
    @func   BOOL | CS8900DBG_MulticastList | Sets a multicast address filter list.
    @rdesc  TRUE = Success, FALSE = Failure.
    @comm    
    @xref   
*/
BOOL CS8900DBG_MulticastList(PUCHAR pucMulticastAddresses, DWORD dwNumAddresses)
{
	BYTE nCount;
	BYTE nIndex;
	LINE_CTL LineCTL;
	USHORT LAF[4];	// Logical address filter (hash index).

	// Clear RxON to disable frame receive.
	//
	LineCTL.All = READ_REG2(PKTPG_LINE_CTL);
	LineCTL.Bits.SerRxON = 0;
	WRITE_REG2(PKTPG_LINE_CTL, LineCTL.All);

	memset(LAF, 0, (4 * sizeof(USHORT)));

	// Compute the logical address filter value.
	//
	for (nCount = 0 ; nCount < dwNumAddresses ; nCount++)
	{
        EdbgOutputDebugString("CS8900: Multicast[%d of %d]  = %x-%x-%x-%x-%x-%x\r\n",
                             (nCount + 1),
							 dwNumAddresses,
                             pucMulticastAddresses[6*nCount + 0],
                             pucMulticastAddresses[6*nCount + 1],
                             pucMulticastAddresses[6*nCount + 2],
                             pucMulticastAddresses[6*nCount + 3],
                             pucMulticastAddresses[6*nCount + 4],
                             pucMulticastAddresses[6*nCount + 5]);

		nIndex = CalculateHashIndex(&pucMulticastAddresses[6*nCount]);
        LAF[nIndex/16]  |=  1 << (nIndex%16);
	}

	EdbgOutputDebugString("CS8900: Logical Address Filter = %x.%x.%x.%x.\r\n", LAF[3], LAF[2], LAF[1], LAF[0]);

	// Write the logical address filter value.
	//
	WRITE_REG2((PKTPG_LOGICAL_ADDR_FILTER + 0), LAF[0]);
	WRITE_REG2((PKTPG_LOGICAL_ADDR_FILTER + 2), LAF[1]);
	WRITE_REG2((PKTPG_LOGICAL_ADDR_FILTER + 4), LAF[2]);
	WRITE_REG2((PKTPG_LOGICAL_ADDR_FILTER + 6), LAF[3]);

	// Set RxON to disable frame receive.
	//
	LineCTL.Bits.SerRxON = 1;
	WRITE_REG2(PKTPG_LINE_CTL, LineCTL.All);

    return(TRUE);

}	// CS8900_MulticastList().