📄 macinit.c
字号:
* Function : MAC_Tx_isr
* Description : Interrupt Service Routine for MAC Tx
*/
void MAC_Tx_isr(void)
{
sFrameDescriptor *pTxFDptr;
U32 *pFrameDataPtr ;
U32 Status ;
U32 CTxPtr ;
CTxPtr = BDMATXPTR ;
while ( gCTxFDPtr != CTxPtr ) {
pTxFDptr = (sFrameDescriptor *) gCTxFDPtr;
// Check CPU ownership
// if Owner is BDMA then break
pFrameDataPtr = (U32 *)&pTxFDptr->FrameDataPtr;
if ( (*pFrameDataPtr & fOwnership_BDMA) ) break ;
Status = (pTxFDptr->StatusAndFrameLength >> 16) & 0xffff;
if (Status & Comp) {
gsMacTxStatus.MacTxGood++ ;
//put_byte('T');
}
else
{
//put_byte('E');
// Save Error status
// Check each status, because, error can duplicated
if (Status & Under) gsMacTxStatus.UnderErr++ ;
if (Status & ExColl) gsMacTxStatus.ExCollErr++ ;
if (Status & Defer) gsMacTxStatus.TxDefferedErr++ ;
if (Status & Paused) gsMacTxStatus.sPaused++ ;
if (Status & Defer) gsMacTxStatus.DeferErr++ ;
if (Status & NCarr) gsMacTxStatus.NCarrErr++ ;
if (Status & SQErr) gsMacTxStatus.sSQE++ ;
if (Status & LateColl) gsMacTxStatus.LateCollErr++ ;
if (Status & TxPar) gsMacTxStatus.TxParErr++ ;
if (Status & TxHalted) gsMacTxStatus.sTxHalted++ ;
// Set MAC/BDMA Tx control register for next use.
MacDebugStatus() ;
ReadyMacTx() ;
} // end if
// Clear Framedata pointer already used.
pTxFDptr->StatusAndFrameLength = (U32)0x0;
gCTxFDPtr = (U32)pTxFDptr->NextFrameDescriptor ;
} // end while loop
MacTxDoneFlagForLoopBackCheck = 1 ;
}
/*
* Function : MAC_Rx_isr
* Description : Interrupt Service Routine for MAC Rx
* Not Used
*/
void MAC_Rx_isr(void)
{
//Print("ISR MAC RX");
put_byte('M');
}
/*
* Function : BDMA_Tx_isr
* Description : Interrupt Service Routine for BDMA Tx
* Not Used
*/
void BDMA_Tx_isr(void) { }
/*
* Function : BDMA_Rx_isr
* Description : Interrupt Service Routine for BDMA Rx
* Ethenet Frame is received in BDMA_Rx_isr
*/
void BDMA_Rx_isr(void)
{
sFrameDescriptor *pRxFDptr ;
U32 RxStatus, FrameLength ;
U32 CRxPtr;
U32 sBdmaStat ;
U8 *pFrameData ;
#if KS32C5000_BUG_FETCH
U32 FstData,FstDataSave,*FstFrameData ;
#endif
// Step 1. Get current frame descriptor and status
CRxPtr = BDMARXPTR ;
sBdmaStat = BDMASTAT ;
// Step 2. Clear BDMA status register bit by write 1
BDMASTAT |= S_BRxRDF ;
gsBdmaRxStatus.BdmaRxCnt++ ;
do {
// Step 3. Check Null List Interrupt
if ( BDMASTAT & S_BRxNL ) {
BDMASTAT |= S_BRxNL ;
gsBdmaRxStatus.BRxNLErr++ ;
MacInitialize() ;
break ;
}
// Step 4. Get Rx Frame Descriptor
pRxFDptr = (sFrameDescriptor *)gCRxFDPtr ;
RxStatus = (pRxFDptr->StatusAndFrameLength >> 16) & 0xffff;
// Step 5. If Rx frame is good, then process received frame
if((RxStatus & Good)&&!(RxStatus & OvMax)) {
FrameLength = pRxFDptr->StatusAndFrameLength & 0xffff ;
pFrameData = (U8 *)pRxFDptr->FrameDataPtr ;
gsBdmaRxStatus.BdmaRxGood++ ;
//if ( !(gsBdmaRxStatus.BdmaRxGood%10000) )
//Print("<R%d:%d>", tm0.tm_sec,gsBdmaRxStatus.BdmaRxGood) ;
//Print("<FrameLength %d :%d>\r", FrameLength, gsBdmaRxStatus.BdmaRxGood) ;
/*if((FrameLength==77)|(FrameLength==78)|(FrameLength==79)| \
(FrameLength==141)|(FrameLength==142)|(FrameLength==143)| \
(FrameLength==205)|(FrameLength==206)|(FrameLength==207)| \
(FrameLength==269)|(FrameLength==270)|(FrameLength==271))*/
//Print("<FrameLength %d :%d RxStat %x>\r", FrameLength, gsBdmaRxStatus.BdmaRxGood, RxStatus) ;
#if KS32C5000_BUG_FETCH
FstFrameData = (U32 *)pRxFDptr->FrameDataPtr ;
FstDataSave = *FstFrameData ;
FstData = ( (FstDataSave<<24) & 0xFF000000 ) |\
( (FstDataSave<<8) & 0x00FF0000 ) |\
( (FstDataSave>>24) & 0x000000FF ) |\
( (FstDataSave>>8) & 0x0000FF00 ) ;
if (gPreviousStatusField == FstData)
pFrameData = pFrameData + 4 ;
#endif
// Step 6. Get received frame to memory buffer
GetRxFrameData(pFrameData, FrameLength, RxStatus) ;
} else {
//put_byte('q');
// Step 7. If Rx frame has error, then process error frame
gErrorPacketCnt++ ;
// Save Error status
// Check each status, because, error can duplicated
if (RxStatus & OvMax) {
gsMacRxStatus.OvMaxSize++ ;
//put_byte('M');
Print("\r\r OverSize error\r");
}
if (RxStatus & CtlRcv) gsMacRxStatus.sCtlRecd++ ;
if (RxStatus & Rx10Stat) gsMacRxStatus.sRx10Stat++ ;
if (RxStatus & AlignErr) gsMacRxStatus.AllgnErr++ ;
if (RxStatus & CRCErr) gsMacRxStatus.sCRCErr++ ;
if (RxStatus & Overflow) gsMacRxStatus.OverflowErr++ ;
if (RxStatus & LongErr) gsMacRxStatus.sLongErr++ ;
if (RxStatus & RxPar) gsMacRxStatus.RxParErr++ ;
if (RxStatus & RxHalted) gsMacRxStatus.sRxHalted++ ;
}
// Step 8. Change ownership to BDMA for next use
(pRxFDptr->FrameDataPtr) |= fOwnership_BDMA;
// Save Current Status and Frame Length field, and clear
#if KS32C5000_BUG_FETCH
gPreviousStatusField = pRxFDptr->StatusAndFrameLength ;
#endif
//pRxFDptr->StatusAndFrameLength = (U32)0x0;
// Step 9. Get Next Frame Descriptor pointer to process
gCRxFDPtr = (U32)(pRxFDptr->NextFrameDescriptor) ;
} while (CRxPtr != gCRxFDPtr);
// Step 10. Check Notowner status
if ( sBdmaStat & S_BRxNO ) {
BDMASTAT |= S_BRxNO ;
gsBdmaRxStatus.BRxNOErr++ ;
ReadyMacRx() ;
}
BdmaRxDoneFlagForLoopBackCheck = 1 ; // only used for loopback test
}
/*
* Function : SendPacket
* Description : Send ethernet frame function
* Input : frame data pointer, frame length
* Output : transmit ok(1) or error(0)
*/
int SendPacket(U8 *Data,int Size)
{
sFrameDescriptor *psTxFD;
U32 *pFrameDataPtr ;
U8 *pFrameData ;
int FrameLength ;
// 1. Get Tx frame descriptor & data pointer
psTxFD = (sFrameDescriptor *)gWTxFDPtr ;
pFrameData = (U8 *)psTxFD->FrameDataPtr ;
pFrameDataPtr = (U32 *)&psTxFD->FrameDataPtr;
FrameLength = Size + sizeof(etheader) ;
// 2. Check BDMA ownership
if ( (*pFrameDataPtr & fOwnership_BDMA) ) return 0 ;
// 3. Prepare Tx Frame data to Frame buffer
memcpy ((U8 *)pFrameData,(U8 *)Data,FrameLength);
// 4. Set TX Frame flag & Length Field
#ifdef LITTLE
psTxFD->Reserved = (PaddingMode | CRCMode | SourceAddrIncrement | \
LittleEndian | WidgetAlign00 | MACTxIntEn);
#else
psTxFD->Reserved = (Padding| CRCMode | FrameDataPtrInc | \
BigEndian | WA00 | MACTxIntEn);
#endif
psTxFD->StatusAndFrameLength = (U32)(FrameLength & 0xffff);
// 5. Cheange ownership to BDMA
psTxFD->FrameDataPtr |= fOwnership_BDMA;
// 6. Enable MAC and BDMA Tx control register
MacTxGo();
// 7. Change the Tx frame descriptor for next use
gWTxFDPtr = (U32)(psTxFD->NextFrameDescriptor);
return 1 ;
}
/*
* Function : ControlFrameTransfer
* Description : Transfer Control Frame Data to another Host
*/
void ControlFrameTransfer(void)
{
char TransferPacket ;
gBdmaTxCon |= BTxCPIE ;
ReadyMacTx() ;
do
{
Print("\r $$ Select Transmit(T) or Quit(Q) ? ") ;
TransferPacket = get_byte() ;
if ( (TransferPacket == 'T') || (TransferPacket == 't') )
{
// Step 1. set destination address to CAM #0
// Step 2. set source address to CAM #1
// CAM #0 : 0000f0110000 (Destin Addr)
// CAM #1 : 11f000000000 (Source Addr)
VPint(CAM_BaseAddr) = 0x0000f011 ;
VPint(CAM_BaseAddr + 0x4) = 0x000011f0 ;
VPint(CAM_BaseAddr + 0x8) = 0x00000000 ;
// Step 3. set length or type field, opcode, and operand to CAM #18
// CAM #18 : Opcode & Operand
// CAM #18 : Pause Count Value
VPint(CAM_BaseAddr + 0x6c) = 0x88080001 ;
// Step 4. set to zero preceed CAM #18
// CAM #19 - #20 : Filled with Zero
VPint(CAM_BaseAddr + 0x70) = 0x12340000 ;
VPint(CAM_BaseAddr + 0x74) = 0x00000000 ;
VPint(CAM_BaseAddr + 0x78) = 0x00000000 ;
VPint(CAM_BaseAddr + 0x7c) = 0x00000000 ;
// Step 5. Enable CAM location
// CAM Enable
CAMEN = 0x1c0003 ;
// Step 6. Enable transmit control frame by
// set SendPause bit in MACTXCON
MACTXCON |= SdPause | TxEn ;
// Step 7. Wait control frame finished
while ( (BDMASTAT & S_BTxCCP) ) ;
}
} while ( (TransferPacket != 'Q') && (TransferPacket != 'q') ) ;
}
/*
* Function : MacDebugStatus
* Description : View MAC status, and other
*/
void MacDebugStatus(void)
{
sFrameDescriptor *pRxFDptr, *pTxFDptr ;
U32 *pFDPtr ;
pRxFDptr = (sFrameDescriptor *) gCRxFDPtr ;
pFDPtr = (U32 *)pRxFDptr ;
Print("\n\n\r $$ MAC Rx Frame : Good ( %d ), Error ( %d ) ",\
gsBdmaRxStatus.BdmaRxGood, gErrorPacketCnt);
Print("\r --------------------------------------") ;
Print("\r - Current Frame Descriptor Pointer : %08x", pFDPtr ) ;
Print("\r Frame Data Ptr : %08x", *pFDPtr++ ) ;
Print("\r Reserved Field : %08x", *pFDPtr++ ) ;
Print("\r Status and Frame Length : %08x", *pFDPtr++ ) ;
Print("\r Next Frame Descriptor : %08x", *pFDPtr ) ;
Print("\r --------------------------------------") ;
Print("\r - BDMARXPTR : %08x", BDMARXPTR ) ;
Print(" - BDMASTAT : %08x", BDMASTAT ) ;
Print("\r - BDMARXCON : %08x", BDMARXCON ) ;
Print(" - BDMARXLSZ : %08x", BDMARXLSZ ) ;
Print("\r - CAM Base : %08x", CAM_BASE ) ;
Print(" - BDMARXBUF : %08x", BDMARXBUF ) ;
Print("\r - MACCON : %08x", MACCON ) ;
Print(" - CAMCON : %08x", CAMCON ) ;
Print("\r - MACRXCON : %08x", MACRXCON ) ;
Print(" - MACRXSTAT : %08x", MACRXSTAT ) ;
Print("\r --------------------------------------") ;
pTxFDptr = (sFrameDescriptor *) gCTxFDPtr ;
pFDPtr = (U32 *)pTxFDptr ;
Print("\n\r $$ MAC Tx Frame : Good ( %d )",gsMacTxStatus.MacTxGood) ;
Print("\r --------------------------------------") ;
Print("\r - Current Frame Descriptor Pointer : %08x", pFDPtr ) ;
Print("\r Frame Data Ptr : %08x", *pFDPtr++ ) ;
Print("\r Reserved Field : %08x", *pFDPtr++ ) ;
Print("\r Status and Frame Length : %08x", *pFDPtr++ ) ;
Print("\r Next Frame Descriptor : %08x", *pFDPtr ) ;
Print("\r --------------------------------------") ;
Print("\r - BDMATXPTR : %08x", BDMATXPTR ) ;
Print(" - BDMATXCON : %08x", BDMATXCON ) ;
Print("\r - BDMATXBUF : %08x", BDMATXBUF ) ;
Print(" - MACTXCON : %08x", MACTXCON ) ;
Print("\r - MACTXSTAT : %08x", MACTXSTAT ) ;
Print("\r --------------------------------------") ;
Print("\r - EMISSCNT : %08x", EMISSCNT ) ;
Print(" - EPZCNT : %08x\n\r", EPZCNT ) ;
}
/*
* Function : BdmaRxForSingleIsr
* Description : BDMA Rx Interrupt Service Routine for Single Receive
*/
void BdmaRxForSingleIsr(void)
{
sFrameDescriptor *pRxFDptr ;
U32 RxStatus, FrameLength ;
U32 CRxPtr;
U32 sBdmaStat ;
U8 *pFrameData ;
#if KS32C5000_BUG_FETCH
U32 FstData,FstDataSave,*FstFrameData ;
#endif
// Step 1. Get current frame descriptor and status
CRxPtr = BDMARXPTR ;
sBdmaStat = BDMASTAT ;
// Step 2. Clear BDMA status register bit by write 1
BDMASTAT |= S_BRxRDF ;
gsBdmaRxStatus.BdmaRxCnt++ ;
do {
// Step 3. Check Null List Interrupt
if ( BDMASTAT & S_BRxNL ) {
BDMASTAT |= S_BRxNL ;
gsBdmaRxStatus.BRxNLErr++ ;
MacInitialize() ;
break ;
}
// Step 4. Get Rx Frame Descriptor
pRxFDptr = (sFrameDescriptor *)gCRxFDPtr ;
RxStatus = (pRxFDptr->StatusAndFrameLength >> 16) & 0xffff;
// Step 5. If Rx frame is good, then process received frame
if(RxStatus & Good) {
FrameLength = pRxFDptr->StatusAndFrameLength & 0xffff ;
pFrameData = (U8 *)pRxFDptr->FrameDataPtr ;
gsBdmaRxStatus.BdmaRxGood++ ;
if ( !(gsBdmaRxStatus.BdmaRxGood%10000) )
Print("<R%d>", gsBdmaRxStatus.BdmaRxGood) ;
#if KS32C5000_BUG_FETCH
FstFrameData = (U32 *)pRxFDptr->FrameDataPtr ;
FstDataSave = *FstFrameData ;
FstData = ( (FstDataSave<<24) & 0xFF000000 ) |\
( (FstDataSave<<8) & 0x00FF0000 ) |\
( (FstDataSave>>24) & 0x000000FF ) |\
( (FstDataSave>>8) & 0x0000FF00 ) ;
if (gPreviousStatusField == FstData)
pFrameData = pFrameData + 4 ;
#endif
// Step 6. Get received frame to memory buffer
Print("\n ->> %d'th Received Frame ",gsBdmaRxStatus.BdmaRxGood) ;
PrintRxFrame(pFrameData,FrameLength) ;
} else {
// Step 7. If Rx frame has error, then process error frame
gErrorPacketCnt++ ;
// Save Error status
// Check each status, because, error can duplicated
if (RxStatus & OvMax) gsMacRxStatus.OvMaxSize++ ;
if (RxStatus & CtlRcv) gsMacRxStatus.sCtlRecd++ ;
if (RxStatus & Rx10Stat) gsMacRxStatus.sRx10Stat++ ;
if (RxStatus & AlignErr) gsMacRxStatus.AllgnErr++ ;
if (RxStatus & CRCErr) gsMacRxStatus.sCRCErr++ ;
if (RxStatus & Overflow) gsMacRxStatus.OverflowErr++ ;
if (RxStatus & LongErr) gsMacRxStatus.sLongErr++ ;
if (RxStatus & RxPar) gsMacRxStatus.RxParErr++ ;
if (RxStatus & RxHalted) gsMacRxStatus.sRxHalted++ ;
}
// Step 8. Change ownership to BDMA for next use
(pRxFDptr->FrameDataPtr) |= fOwnership_BDMA;
// Save Current Status and Frame Length field, and clear
#if KS32C5000_BUG_FETCH
gPreviousStatusField = pRxFDptr->StatusAndFrameLength ;
#endif
pRxFDptr->StatusAndFrameLength = (U32)0x0;
// Step 9. Get Next Frame Descriptor pointer to process
gCRxFDPtr = (U32)(pRxFDptr->NextFrameDescriptor) ;
} while (CRxPtr != gCRxFDPtr);
// Step 10. Check Notowner status
if ( sBdmaStat & S_BRxNO ) {
BDMASTAT |= S_BRxNO ;
gsBdmaRxStatus.BRxNOErr++ ;
ReadyMacRx() ;
}
}
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -