s3c2510eth.c

S3c2510下的VXWORKS的BSP源代码（包括了以太网、串口、USB等等驱动）

          (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;
}

/*******************************************************************************