?? s3c2510eth.c
字號:
(regAddr << S3C2510_STACON_PHYREGADDR_SHIFT) | /* PHY Register Address */
S3C2510_STACON_PHYWRITE | /* Write */
S3C2510_STACON_PHYBUSY; /* Start Operation */
*S3C2510_STACON(unit) = val;
/* Wait until complete operation. */
while (1)
{
val = *S3C2510_STACON(unit);
if (!(val & S3C2510_STACON_PHYBUSY)) /* End Operation */
{
break;
}
if (--timeout == 0)
{
printf("s3c2510Eth%d Error: MII write timeout\n", unit);
return ERROR;
}
}
/* Wait for reflection time. */
NSDELAY(200);
return OK;
}
/*******************************************************************************
*
* s3c2510EthInitBD - initialize buffer descriptor
*
* RETURNS : N/A
*/
void s3c2510EthInitBD(
ETH_DRV_CTRL *pDrvCtrl /* pointer to driver structure */
)
{
int unit = pDrvCtrl->unit;
PETHRBD pRbd;
PETHTBD pTbd;
UINT32 pBuf;
int i;
#ifdef DEBUG_TRACE
printf("s3c2510Eth%d InitBD\n", unit);
#endif /* DEBUG_TRACE */
/* Initialize RBD. */
pDrvCtrl->rbdBase = BD_BASE_ETH + BD_SIZE_ETH * unit; /* defined in smdk2510.h */
pDrvCtrl->rbdIndex = 0;
pRbd = (PETHRBD)pDrvCtrl->rbdBase;
pBuf = FB_BASE_ETH + FB_SIZE_ETH * unit; /* defined in smdk2510.h */
#ifdef DEBUG_TRACE
printf(" rbdBase(0x%08X), rbBase(0x%08X)\n", (UINT32)pRbd, pBuf);
#endif /* DEBUG_TRACE */
for (i=0; i<NUM_RBD_ETH; i++)
{
pRbd->pBuf = pBuf + SIZE_ETH_FB_HDR;
pRbd->status = S3C2510_ETH_RBD_O;
pRbd->length = 0;
pRbd++;
pBuf += SIZE_FB; /* defined in smdk2510.h */
}
/* Reserve cluster buffer for the RBD. */
if (pDrvCtrl->pClPool)
{
for (i=0; i<NUM_RBD_ETH; i++)
{
netClusterGet(pDrvCtrl->endObj.pNetPool, pDrvCtrl->pClPool);
}
}
/* Initialize TBD. */
pDrvCtrl->tbdBase = pDrvCtrl->rbdBase + RBD_SIZE_ETH; /* defined in smdk2510.h */
pDrvCtrl->tbdIndex = 0;
pDrvCtrl->tbdFree = 0;
pTbd = (PETHTBD)pDrvCtrl->tbdBase;
pBuf = FB_BASE_ETH + FB_SIZE_ETH * unit + RFB_SIZE_ETH; /* defined in smdk2510.h */
#ifdef DEBUG_TRACE
printf(" tbdBase(0x%08X), tbBase(0x%08X)\n", (UINT32)pTbd, pBuf);
#endif /* DEBUG_TRACE */
for (i=0; i<NUM_TBD_ETH; i++)
{
pTbd->pBuf = pBuf + SIZE_ETH_FB_HDR;
pTbd->status = 0;
pTbd->length = 0;
pTbd++;
pBuf += SIZE_FB; /* defined in smdk2510.h */
}
}
/*******************************************************************************
*
* s3c2510EthAddrSet - set mac address
*
* RETURNS: OK, or ERROR.
*/
STATUS s3c2510EthAddrSet(
ETH_DRV_CTRL *pDrvCtrl /* pointer to driver structure */
)
{
int unit = pDrvCtrl->unit;
UCHAR *pCam;
#ifdef DEBUG_TRACE
printf("s3c2510Eth%d AddrSet\n", unit);
#endif /* DEBUG_TRACE */
pCam = (UCHAR *)S3C2510_CAM(unit);
bcopy(pDrvCtrl->IFADDR.phyAddress, pCam, SIZE_ETH_ADDR);
return OK;
}
/*******************************************************************************
*
* s3c2510EthFlagsSet - set device flags
*
* RETURNS: OK, or ERROR.
*/
STATUS s3c2510EthFlagsSet(
ETH_DRV_CTRL *pDrvCtrl /* pointer to driver structure */
)
{
int unit = pDrvCtrl->unit;
long flags;
#ifdef DEBUG_TRACE
printf("s3c2510Eth%d FlagsSet, %08X\n", unit, (UINT32)pDrvCtrl->endObj.flags);
#endif /* DEBUG_TRACE */
flags = END_FLAGS_GET(&pDrvCtrl->endObj);
if (flags & IFF_UP)
{
/* Config down. */
END_FLAGS_CLR(&pDrvCtrl->endObj, IFF_UP | IFF_RUNNING);
}
if (flags & IFF_PROMISC)
{
*S3C2510_CAMCON(unit) &= ~S3C2510_CAMCON_COMPEN; /* Compare Disable */
}
else
{
*S3C2510_CAMCON(unit) |= S3C2510_CAMCON_COMPEN; /* Compare Enable */
}
if (flags & (IFF_MULTICAST | IFF_ALLMULTI))
{
*S3C2510_CAMCON(unit) |= S3C2510_CAMCON_GROUP; /* Group Accept Enable */
}
else
{
*S3C2510_CAMCON(unit) &= ~S3C2510_CAMCON_GROUP; /* Group Accept Disable */
}
if (flags & IFF_BROADCAST)
{
*S3C2510_CAMCON(unit) |= S3C2510_CAMCON_BROAD; /* Broadcast Disable */
}
else
{
*S3C2510_CAMCON(unit) &= ~S3C2510_CAMCON_BROAD; /* Broadcast Disable */
}
if (flags & IFF_UP)
{
/* Config up. */
END_FLAGS_SET(&pDrvCtrl->endObj, IFF_UP | IFF_RUNNING);
}
return OK;
}
/*******************************************************************************
*
* s3c2510EthLoopSet - set loop mode
*
* RETURNS: OK, or ERROR.
*/
void s3c2510EthLoopSet(
ETH_DRV_CTRL *pDrvCtrl, /* pointer to driver structure */
int mode /* loopback mode */
)
{
int unit = pDrvCtrl->unit;
#ifdef DEBUG_TRACE
printf("s3c2510Eth%d LoopSet", unit);
#endif /* DEBUG_TRACE */
/* Disable all type of loopback. */
*S3C2510_MACCON(unit) &= ~(S3C2510_MACCON_LOOP10 | S3C2510_MACCON_LOOPBACK);
if ((mode != LOOP_L1) && (pDrvCtrl->PHYREGS.phyCtrl & MII_CR_LOOPBACK))
{
pDrvCtrl->PHYREGS.phyCtrl &= ~MII_CR_LOOPBACK;
s3c2510EthMiiWrite(pDrvCtrl, pDrvCtrl->phyInfo.phyAddr, MII_CTRL_REG, pDrvCtrl->PHYREGS.phyCtrl);
s3c2510EthAnRestart(pDrvCtrl);
}
switch (mode)
{
case LOOP_L2:
if (*S3C2510_MACCON(unit) & S3C2510_MACCON_LINK10)
{
*S3C2510_MACCON(unit) |= S3C2510_MACCON_LOOP10;
}
else
{
*S3C2510_MACCON(unit) |= S3C2510_MACCON_LOOPBACK;
}
break;
case LOOP_L1:
pDrvCtrl->PHYREGS.phyCtrl |= MII_CR_LOOPBACK;
s3c2510EthMiiWrite(pDrvCtrl, pDrvCtrl->phyInfo.phyAddr, MII_CTRL_REG, pDrvCtrl->PHYREGS.phyCtrl);
break;
}
}
/*******************************************************************************
*
* s3c2510EthMCastAdd - add multicast address
*
* RETURNS: OK, or ERROR.
*/
STATUS s3c2510EthMCastAdd(
ETH_DRV_CTRL *pDrvCtrl, /* pointer to driver structure */
UCHAR *pAddr /* pointer to the multicast address */
)
{
int unit = pDrvCtrl->unit;
UCHAR *pCam;
int i;
#ifdef DEBUG_TRACE
printf("s3c2510Eth%d MCastAdd\n", unit);
#endif /* DEBUG_TRACE */
/* Get CAM table. */
pCam = (UCHAR *)S3C2510_CAM(unit);
/* Start from second entry. First entry is reserved for our MAC address. */
for (i=1, pCam+=SIZE_ETH_ADDR; i<S3C2510_CAMEN_MAX; i++)
{
if (!(*S3C2510_CAMEN(unit) & (1 << i)))
{
#ifdef DEBUG_TRACE
printf(" Add CAM entry %d\n", i);
#endif /* DEBUG_TRACE */
bcopy(pAddr, pCam, SIZE_ETH_ADDR);
*S3C2510_CAMEN(unit) |= (1 << i);
return OK;
}
}
printf("s3c2510Eth%d Error: No CAM entry\n", unit);
return ERROR;
}
/*******************************************************************************
*
* s3c2510EthMCastDel - remove multicast address
*
* RETURNS: OK, or ERROR.
*/
STATUS s3c2510EthMCastDel(
ETH_DRV_CTRL *pDrvCtrl, /* pointer to driver structure */
UCHAR *pAddr /* pointer to the multicast address */
)
{
int unit = pDrvCtrl->unit;
UCHAR *pCam;
int i;
#ifdef DEBUG_TRACE
printf("s3c2510Eth%d McastDel\n", unit);
#endif /* DEBUG_TRACE */
pCam = (UCHAR *)S3C2510_CAM(unit);
for (i=1; i<S3C2510_CAMEN_MAX; i++)
{
if (*S3C2510_CAMEN(unit) & (1 << i))
{
if ((pCam[0] == pAddr[0]) &&
(pCam[1] == pAddr[1]) &&
(pCam[2] == pAddr[2]) &&
(pCam[3] == pAddr[3]) &&
(pCam[4] == pAddr[4]) &&
(pCam[5] == pAddr[5]))
{
#ifdef DEBUG_TRACE
printf(" Delete CAM entry %d\n", i);
#endif /* DEBUG_TRACE */
*S3C2510_CAMEN(unit) &= ~(1 << i);
return OK;
}
}
pCam += SIZE_ETH_ADDR;
}
printf("s3c2510Eth%d Error: Cannot find CAM entry\n", unit);
return ERROR;
}
/*******************************************************************************
*
* s3c2510EthStart - start S3C2510 Ethernet controller
*
* RETURNS: OK, or ERROR.
*/
STATUS s3c2510EthStart(
ETH_DRV_CTRL *pDrvCtrl /* pointer to driver structure */
)
{
int unit = pDrvCtrl->unit;
#ifdef DEBUG_TRACE
printf("s3c2510Eth%d Start\n", unit);
#endif /* DEBUG_TRACE */
/* Set device flags. */
s3c2510EthFlagsSet(pDrvCtrl);
/* Enable MAC Rx/Tx. */
*S3C2510_MRXCON(unit) |= S3C2510_MRXCON_EN; /* Receive Enable */
*S3C2510_MTXCON(unit) |= S3C2510_MTXCON_EN; /* Transmission Enable */
/* Enable BDMA Rx. */
*S3C2510_BRXCON(unit) |= S3C2510_BRXCON_EN; /* BDMA Rx Block Enable */
/* Enable interrupt. */
intEnable(pDrvCtrl->intLvlRx);
intEnable(pDrvCtrl->intLvlTx);
return OK;
}
/*******************************************************************************
*
* s3c2510EthStop - stop S3C2510 Ethernet controller
*
* RETURNS: OK, or ERROR.
*/
STATUS s3c2510EthStop(
ETH_DRV_CTRL *pDrvCtrl /* pointer to driver structure */
)
{
int unit = pDrvCtrl->unit;
#ifdef DEBUG_TRACE
printf("s3c2510Eth%d Stop\n", unit);
#endif /* DEBUG_TRACE */
/* Disable BDMA Rx/TX. */
*S3C2510_BRXCON(unit) &= ~S3C2510_BRXCON_EN; /* BDMA Rx Block Disable */
*S3C2510_BTXCON(unit) &= ~S3C2510_BTXCON_EN; /* BDMA Tx Block Disable */
/* Disable MAC Rx/Tx. */
*S3C2510_MRXCON(unit) &= ~S3C2510_MRXCON_EN; /* Receive Disable */
*S3C2510_MTXCON(unit) &= ~S3C2510_MTXCON_EN; /* Transmission Disable */
/* Disable interrupt. */
intDisable(pDrvCtrl->intLvlRx);
intDisable(pDrvCtrl->intLvlTx);
return OK;
}
/*******************************************************************************
*
* s3c2510EthPlllStart - start polling mode
*
* RETURNS: OK, or ERROR.
*/
STATUS s3c2510EthPollStart(
ETH_DRV_CTRL *pDrvCtrl /* pointer to driver structure */
)
{
int unit = pDrvCtrl->unit;
#ifdef DEBUG_TRACE
printf("s3c2510Eth%d PollStart\n", unit);
#endif /* DEBUG_TRACE */
/* Disable interrupt. */
intDisable(pDrvCtrl->intLvlRx);
intDisable(pDrvCtrl->intLvlTx);
*S3C2510_BMRXINTEN(unit) &= ~S3C2510_BMRXINTEN_BDONEIE; /* BDMA Rx Done Interrupt Disable */
*S3C2510_BMTXINTEN(unit) &= ~S3C2510_BMTXINTEN_MCOMPIE; /* MAC Tx Completion Interrupt Disable */
pDrvCtrl->bPolling = TRUE;
return OK;
}
/*******************************************************************************
?? 快捷鍵說明
復(fù)制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -