lpc23xx_eth_driver.c

Go to the documentation of this file.

/**
 * @file lpc23xx_eth_driver.c
 * @brief LPC2300 Ethernet MAC driver
 *
 * @section License
 *
 * SPDX-License-Identifier: GPL-2.0-or-later
 *
 * Copyright (C) 2010-2024 Oryx Embedded SARL. All rights reserved.
 *
 * This file is part of CycloneTCP Open.
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version 2
 * of the License, or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software Foundation,
 * Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
 *
 * @author Oryx Embedded SARL (www.oryx-embedded.com)
 * @version 2.4.4
 **/
 
//Switch to the appropriate trace level
#define TRACE_LEVEL NIC_TRACE_LEVEL
 
//Dependencies
#include "lpc23xx.h"
#include "core/net.h"
#include "drivers/mac/lpc23xx_eth_driver.h"
#include "debug.h"
 
//Underlying network interface
static NetInterface *nicDriverInterface;
 
//IAR EWARM compiler?
#if defined(__ICCARM__)
 
//Transmit buffer
#pragma data_alignment = 4
static uint8_t txBuffer[LPC23XX_ETH_TX_BUFFER_COUNT][LPC23XX_ETH_TX_BUFFER_SIZE];
//Receive buffer
#pragma data_alignment = 4
static uint8_t rxBuffer[LPC23XX_ETH_RX_BUFFER_COUNT][LPC23XX_ETH_RX_BUFFER_SIZE];
//Transmit descriptors
#pragma data_alignment = 4
static Lpc23xxTxDesc txDesc[LPC23XX_ETH_TX_BUFFER_COUNT];
//Transmit status array
#pragma data_alignment = 4
static Lpc23xxTxStatus txStatus[LPC23XX_ETH_TX_BUFFER_COUNT];
//Receive descriptors
#pragma data_alignment = 4
static Lpc23xxRxDesc rxDesc[LPC23XX_ETH_RX_BUFFER_COUNT];
//Receive status array
#pragma data_alignment = 8
static Lpc23xxRxStatus rxStatus[LPC23XX_ETH_RX_BUFFER_COUNT];
 
//Keil MDK-ARM or GCC compiler?
#else
 
//Transmit buffer
static uint8_t txBuffer[LPC23XX_ETH_TX_BUFFER_COUNT][LPC23XX_ETH_TX_BUFFER_SIZE]
   __attribute__((aligned(4)));
//Receive buffer
static uint8_t rxBuffer[LPC23XX_ETH_RX_BUFFER_COUNT][LPC23XX_ETH_RX_BUFFER_SIZE]
   __attribute__((aligned(4)));
//Transmit descriptors
static Lpc23xxTxDesc txDesc[LPC23XX_ETH_TX_BUFFER_COUNT]
   __attribute__((aligned(4)));
//Transmit status array
static Lpc23xxTxStatus txStatus[LPC23XX_ETH_TX_BUFFER_COUNT]
   __attribute__((aligned(4)));
//Receive descriptors
static Lpc23xxRxDesc rxDesc[LPC23XX_ETH_RX_BUFFER_COUNT]
   __attribute__((aligned(4)));
//Receive status array
static Lpc23xxRxStatus rxStatus[LPC23XX_ETH_RX_BUFFER_COUNT]
   __attribute__((aligned(8)));
 
#endif
 
 
/**
 * @brief LPC23xx Ethernet MAC driver
 **/
 
const NicDriver lpc23xxEthDriver =
{
   NIC_TYPE_ETHERNET,
   ETH_MTU,
   lpc23xxEthInit,
   lpc23xxEthTick,
   lpc23xxEthEnableIrq,
   lpc23xxEthDisableIrq,
   lpc23xxEthEventHandler,
   lpc23xxEthSendPacket,
   lpc23xxEthUpdateMacAddrFilter,
   lpc23xxEthUpdateMacConfig,
   lpc23xxEthWritePhyReg,
   lpc23xxEthReadPhyReg,
   TRUE,
   TRUE,
   TRUE,
   FALSE
};
 
 
/**
 * @brief LPC23xx Ethernet MAC initialization
 * @param[in] interface Underlying network interface
 * @return Error code
 **/
 
error_t lpc23xxEthInit(NetInterface *interface)
{
   error_t error;
 
   //Debug message
   TRACE_INFO("Initializing LPC23xx Ethernet MAC...\r\n");
 
   //Save underlying network interface
   nicDriverInterface = interface;
 
   //Power up EMAC controller
   PCONP |= PCONP_PCENET;
 
   //GPIO configuration
   lpc23xxEthInitGpio(interface);
 
   //Reset host registers, transmit datapath and receive datapath
   MAC_COMMAND = COMMAND_RX_RESET | COMMAND_TX_RESET | COMMAND_REG_RESET;
 
   //Reset EMAC controller
   MAC_MAC1 = MAC1_SOFT_RESET | MAC1_SIMULATION_RESET |
      MAC1_RESET_MCS_RX | MAC1_RESET_RX | MAC1_RESET_MCS_TX | MAC1_RESET_TX;
 
   //Initialize MAC related registers
   MAC_MAC1 = 0;
   MAC_MAC2 = MAC2_PAD_CRC_ENABLE | MAC2_CRC_ENABLE;
   MAC_IPGR = IPGR_DEFAULT_VALUE;
   MAC_CLRT = CLRT_DEFAULT_VALUE;
 
   //Select RMII mode
   MAC_COMMAND = COMMAND_RMII;
 
   //Configure MDC clock
   MAC_MCFG = MCFG_CLOCK_SELECT_DIV28;
   //Reset MII management interface
   MAC_MCFG |= MCFG_RESET_MII_MGMT;
   MAC_MCFG &= ~MCFG_RESET_MII_MGMT;
 
   //Valid Ethernet PHY or switch driver?
   if(interface->phyDriver != NULL)
   {
      //Ethernet PHY initialization
      error = interface->phyDriver->init(interface);
   }
   else if(interface->switchDriver != NULL)
   {
      //Ethernet switch initialization
      error = interface->switchDriver->init(interface);
   }
   else
   {
      //The interface is not properly configured
      error = ERROR_FAILURE;
   }
 
   //Any error to report?
   if(error)
   {
      return error;
   }
 
   //Initialize TX and RX descriptor arrays
   lpc23xxEthInitDesc(interface);
 
   //Set the MAC address of the station
   MAC_SA0 = interface->macAddr.w[2];
   MAC_SA1 = interface->macAddr.w[1];
   MAC_SA2 = interface->macAddr.w[0];
 
   //Initialize hash table
   MAC_HASHFILTERL = 0;
   MAC_HASHFILTERH = 0;
 
   //Configure the receive filter
   MAC_RXFILTERCTRL = RFC_ACCEPT_PERFECT_EN |
      RFC_ACCEPT_MULTICAST_HASH_EN | RFC_ACCEPT_BROADCAST_EN;
 
   //Program the MAXF register with the maximum frame length to be accepted
   MAC_MAXF = LPC23XX_ETH_RX_BUFFER_SIZE;
 
   //Reset EMAC interrupt flags
   MAC_INTCLEAR  = 0xFFFF;
   //Enable desired EMAC interrupts
   MAC_INTENABLE = INT_TX_DONE | INT_RX_DONE;
 
   //The interrupt request is assigned to the IRQ category
   VICIntSelect &= ~VIC_INT_ETHERNET;
   //Register interrupt handler
   VICVectAddr21 = (uint32_t) lpc23xxEthIrqHandler;
   //Configure interrupt priority
   VICVectPriority21 = LPC23XX_ETH_IRQ_PRIORITY;
 
   //Enable transmission and reception
   MAC_COMMAND |= COMMAND_TX_ENABLE | COMMAND_RX_ENABLE;
   //Allow frames to be received
   MAC_MAC1 |= MAC1_RECEIVE_ENABLE;
 
   //Accept any packets from the upper layer
   osSetEvent(&interface->nicTxEvent);
 
   //Successful initialization
   return NO_ERROR;
}
 
 
/**
 * @brief GPIO configuration
 * @param[in] interface Underlying network interface
 **/
 
__weak_func void lpc23xxEthInitGpio(NetInterface *interface)
{
//LPC2378-STK evaluation board?
#if defined(USE_LPC2378_STK)
   //Configure P1.0 (ENET_TXD0), P1.1 (ENET_TXD1), P1.4 (ENET_TX_EN), P1.8 (ENET_CRS),
   //P1.9 (ENET_RXD0), P1.10 (ENET_RXD1), P1.14 (RX_ER) and P1.15 (ENET_REF_CLK)
   PINSEL2 &= ~(PINSEL2_P1_0_MASK | PINSEL2_P1_1_MASK |
      PINSEL2_P1_4_MASK | PINSEL2_P1_8_MASK | PINSEL2_P1_9_MASK |
      PINSEL2_P1_10_MASK | PINSEL2_P1_14_MASK | PINSEL2_P1_15_MASK);
 
   PINSEL2 |= PINSEL2_P1_0_ENET_TXD0 | PINSEL2_P1_1_ENET_TXD1 |
      PINSEL2_P1_4_ENET_TX_EN | PINSEL2_P1_8_ENET_CRS | PINSEL2_P1_9_ENET_RXD0 |
      PINSEL2_P1_10_ENET_RXD1 | PINSEL2_P1_14_ENET_RX_ER | PINSEL2_P1_15_ENET_REF_CLK;
 
   //Configure P1.16 (ENET_MDC) and P1.17 (ENET_MDIO)
   PINSEL3 &= ~(PINSEL3_P1_16_MASK | PINSEL3_P1_17_MASK);
   PINSEL3 |= PINSEL3_P1_16_ENET_MDC | PINSEL3_P1_17_ENET_MDIO;
#endif
}
 
 
/**
 * @brief Initialize TX and RX descriptors
 * @param[in] interface Underlying network interface
 **/
 
void lpc23xxEthInitDesc(NetInterface *interface)
{
   uint_t i;
 
   //Initialize TX descriptors
   for(i = 0; i < LPC23XX_ETH_TX_BUFFER_COUNT; i++)
   {
      //Base address of the buffer containing transmit data
      txDesc[i].packet = (uint32_t) txBuffer[i];
      //Transmit descriptor control word
      txDesc[i].control = 0;
      //Transmit status information word
      txStatus[i].info = 0;
   }
 
   //Initialize RX descriptors
   for(i = 0; i < LPC23XX_ETH_RX_BUFFER_COUNT; i++)
   {
      //Base address of the buffer for storing receive data
      rxDesc[i].packet = (uint32_t) rxBuffer[i];
      //Receive descriptor control word
      rxDesc[i].control = RX_CTRL_INTERRUPT | (LPC23XX_ETH_RX_BUFFER_SIZE - 1);
      //Receive status information word
      rxStatus[i].info = 0;
      //Receive status HashCRC word
      rxStatus[i].hashCrc = 0;
   }
 
   //Initialize EMAC transmit descriptor registers
   MAC_TXDESCRIPTOR = (uint32_t) txDesc;
   MAC_TXSTATUS = (uint32_t) txStatus;
   MAC_TXDESCRIPTORNUM = LPC23XX_ETH_TX_BUFFER_COUNT - 1;
   MAC_TXPRODUCEINDEX = 0;
 
   //Initialize EMAC receive descriptor registers
   MAC_RXDESCRIPTOR = (uint32_t) rxDesc;
   MAC_RXSTATUS = (uint32_t) rxStatus;
   MAC_RXDESCRIPTORNUM = LPC23XX_ETH_RX_BUFFER_COUNT - 1;
   MAC_RXCONSUMEINDEX = 0;
}
 
 
/**
 * @brief LPC23xx Ethernet MAC timer handler
 *
 * This routine is periodically called by the TCP/IP stack to handle periodic
 * operations such as polling the link state
 *
 * @param[in] interface Underlying network interface
 **/
 
void lpc23xxEthTick(NetInterface *interface)
{
   //Valid Ethernet PHY or switch driver?
   if(interface->phyDriver != NULL)
   {
      //Handle periodic operations
      interface->phyDriver->tick(interface);
   }
   else if(interface->switchDriver != NULL)
   {
      //Handle periodic operations
      interface->switchDriver->tick(interface);
   }
   else
   {
      //Just for sanity
   }
}
 
 
/**
 * @brief Enable interrupts
 * @param[in] interface Underlying network interface
 **/
 
void lpc23xxEthEnableIrq(NetInterface *interface)
{
   //Enable Ethernet MAC interrupts
   VICIntEnable = VIC_INT_ETHERNET;
 
   //Valid Ethernet PHY or switch driver?
   if(interface->phyDriver != NULL)
   {
      //Enable Ethernet PHY interrupts
      interface->phyDriver->enableIrq(interface);
   }
   else if(interface->switchDriver != NULL)
   {
      //Enable Ethernet switch interrupts
      interface->switchDriver->enableIrq(interface);
   }
   else
   {
      //Just for sanity
   }
}
 
 
/**
 * @brief Disable interrupts
 * @param[in] interface Underlying network interface
 **/
 
void lpc23xxEthDisableIrq(NetInterface *interface)
{
   //Disable Ethernet MAC interrupts
   VICIntEnClr = VIC_INT_ETHERNET;
 
   //Valid Ethernet PHY or switch driver?
   if(interface->phyDriver != NULL)
   {
      //Disable Ethernet PHY interrupts
      interface->phyDriver->disableIrq(interface);
   }
   else if(interface->switchDriver != NULL)
   {
      //Disable Ethernet switch interrupts
      interface->switchDriver->disableIrq(interface);
   }
   else
   {
      //Just for sanity
   }
}
 
 
/**
 * @brief LPC23xx Ethernet MAC interrupt service routine
 **/
 
__irq void lpc23xxEthIrqHandler(void)
{
   uint_t i;
   bool_t flag;
   uint32_t status;
 
   //Interrupt service routine prologue
   osEnterIsr();
 
   //This flag will be set if a higher priority task must be woken
   flag = FALSE;
 
   //Read interrupt status register
   status = MAC_INTSTATUS;
 
   //Packet transmitted?
   if((status & INT_TX_DONE) != 0)
   {
      //Clear TxDone interrupt flag
      MAC_INTCLEAR = INT_TX_DONE;
 
      //Get the index of the next descriptor
      i = MAC_TXPRODUCEINDEX + 1;
 
      //Wrap around if necessary
      if(i >= LPC23XX_ETH_TX_BUFFER_COUNT)
      {
         i = 0;
      }
 
      //Check whether the TX buffer is available for writing
      if(i != MAC_TXCONSUMEINDEX)
      {
         //Notify the TCP/IP stack that the transmitter is ready to send
         flag |= osSetEventFromIsr(&nicDriverInterface->nicTxEvent);
      }
   }
 
   //Packet received?
   if((status & INT_RX_DONE) != 0)
   {
      //Disable RxDone interrupts
      MAC_INTENABLE &= ~INT_RX_DONE;
 
      //Set event flag
      nicDriverInterface->nicEvent = TRUE;
      //Notify the TCP/IP stack of the event
      flag |= osSetEventFromIsr(&netEvent);
   }
 
   //Interrupt service routine epilogue
   osExitIsr(flag);
}
 
 
/**
 * @brief LPC23xx Ethernet MAC event handler
 * @param[in] interface Underlying network interface
 **/
 
void lpc23xxEthEventHandler(NetInterface *interface)
{
   error_t error;
 
   //Packet received?
   if((MAC_INTSTATUS & INT_RX_DONE) != 0)
   {
      //Clear RxDone interrupt flag
      MAC_INTCLEAR = INT_RX_DONE;
 
      //Process all pending packets
      do
      {
         //Read incoming packet
         error = lpc23xxEthReceivePacket(interface);
 
         //No more data in the receive buffer?
      } while(error != ERROR_BUFFER_EMPTY);
   }
 
   //Re-enable TxDone and RxDone interrupts
   MAC_INTENABLE = INT_TX_DONE | INT_RX_DONE;
}
 
 
/**
 * @brief Send a packet
 * @param[in] interface Underlying network interface
 * @param[in] buffer Multi-part buffer containing the data to send
 * @param[in] offset Offset to the first data byte
 * @param[in] ancillary Additional options passed to the stack along with
 *   the packet
 * @return Error code
 **/
 
error_t lpc23xxEthSendPacket(NetInterface *interface,
   const NetBuffer *buffer, size_t offset, NetTxAncillary *ancillary)
{
   uint_t i;
   uint_t j;
   size_t length;
 
   //Retrieve the length of the packet
   length = netBufferGetLength(buffer) - offset;
 
   //Check the frame length
   if(!length)
   {
      //The transmitter can accept another packet
      osSetEvent(&interface->nicTxEvent);
      //We are done since the buffer is empty
      return NO_ERROR;
   }
   else if(length > LPC23XX_ETH_TX_BUFFER_SIZE)
   {
      //The transmitter can accept another packet
      osSetEvent(&interface->nicTxEvent);
      //Report an error
      return ERROR_INVALID_LENGTH;
   }
 
   //Get the index of the current descriptor
   i = MAC_TXPRODUCEINDEX;
   //Get the index of the next descriptor
   j = i + 1;
 
   //Wrap around if necessary
   if(j >= LPC23XX_ETH_TX_BUFFER_COUNT)
   {
      j = 0;
   }
 
   //Check whether the transmit descriptor array is full
   if(j == MAC_TXCONSUMEINDEX)
   {
      return ERROR_FAILURE;
   }
 
   //Copy user data to the transmit buffer
   netBufferRead((uint8_t *) txDesc[i].packet, buffer, offset, length);
 
   //Write the transmit control word
   txDesc[i].control = TX_CTRL_INTERRUPT | TX_CTRL_LAST |
      TX_CTRL_CRC | TX_CTRL_PAD | ((length - 1) & TX_CTRL_SIZE);
 
   //Increment index and wrap around if necessary
   if(++i >= LPC23XX_ETH_TX_BUFFER_COUNT)
   {
      i = 0;
   }
 
   //Save the resulting value
   MAC_TXPRODUCEINDEX = i;
 
   //Get the index of the next descriptor
   j = i + 1;
 
   //Wrap around if necessary
   if(j >= LPC23XX_ETH_TX_BUFFER_COUNT)
   {
      j = 0;
   }
 
   //Check whether the next buffer is available for writing
   if(j != MAC_TXCONSUMEINDEX)
   {
      //The transmitter can accept another packet
      osSetEvent(&interface->nicTxEvent);
   }
 
   //Successful write operation
   return NO_ERROR;
}
 
 
/**
 * @brief Receive a packet
 * @param[in] interface Underlying network interface
 * @return Error code
 **/
 
error_t lpc23xxEthReceivePacket(NetInterface *interface)
{
   error_t error;
   size_t n;
   uint_t i;
   NetRxAncillary ancillary;
 
   //Point to the current descriptor
   i = MAC_RXCONSUMEINDEX;
 
   //Current buffer available for reading?
   if(i != MAC_RXPRODUCEINDEX)
   {
      //Retrieve the length of the frame
      n = (rxStatus[i].info & RX_STATUS_SIZE) + 1;
      //Limit the number of data to read
      n = MIN(n, LPC23XX_ETH_RX_BUFFER_SIZE);
 
      //Additional options can be passed to the stack along with the packet
      ancillary = NET_DEFAULT_RX_ANCILLARY;
 
      //Pass the packet to the upper layer
      nicProcessPacket(interface, (uint8_t *) rxDesc[i].packet, n, &ancillary);
 
      //Increment index and wrap around if necessary
      if(++i >= LPC23XX_ETH_RX_BUFFER_COUNT)
      {
         i = 0;
      }
 
      //Save the resulting value
      MAC_RXCONSUMEINDEX = i;
 
      //Valid packet received
      error = NO_ERROR;
   }
   else
   {
      //No more data in the receive buffer
      error = ERROR_BUFFER_EMPTY;
   }
 
   //Return status code
   return error;
}
 
 
/**
 * @brief Configure MAC address filtering
 * @param[in] interface Underlying network interface
 * @return Error code
 **/
 
error_t lpc23xxEthUpdateMacAddrFilter(NetInterface *interface)
{
   uint_t i;
   uint_t k;
   uint32_t crc;
   uint32_t hashTable[2];
   MacFilterEntry *entry;
 
   //Debug message
   TRACE_DEBUG("Updating MAC filter...\r\n");
 
   //Set the MAC address of the station
   MAC_SA0 = interface->macAddr.w[2];
   MAC_SA1 = interface->macAddr.w[1];
   MAC_SA2 = interface->macAddr.w[0];
 
   //Clear hash table
   hashTable[0] = 0;
   hashTable[1] = 0;
 
   //The MAC address filter contains the list of MAC addresses to accept
   //when receiving an Ethernet frame
   for(i = 0; i < MAC_ADDR_FILTER_SIZE; i++)
   {
      //Point to the current entry
      entry = &interface->macAddrFilter[i];
 
      //Valid entry?
      if(entry->refCount > 0)
      {
         //Compute CRC over the current MAC address
         crc = lpc23xxEthCalcCrc(&entry->addr, sizeof(MacAddr));
         //Bits [28:23] are used to form the hash
         k = (crc >> 23) & 0x3F;
         //Update hash table contents
         hashTable[k / 32] |= (1 << (k % 32));
      }
   }
 
   //Write the hash table
   MAC_HASHFILTERL = hashTable[0];
   MAC_HASHFILTERH = hashTable[1];
 
   //Debug message
   TRACE_DEBUG("  HashFilterL = %08" PRIX32 "\r\n", MAC_HASHFILTERL);
   TRACE_DEBUG("  HashFilterH = %08" PRIX32 "\r\n", MAC_HASHFILTERH);
 
   //Successful processing
   return NO_ERROR;
}
 
 
/**
 * @brief Adjust MAC configuration parameters for proper operation
 * @param[in] interface Underlying network interface
 * @return Error code
 **/
 
error_t lpc23xxEthUpdateMacConfig(NetInterface *interface)
{
   //10BASE-T or 100BASE-TX operation mode?
   if(interface->linkSpeed == NIC_LINK_SPEED_100MBPS)
   {
      MAC_SUPP = SUPP_SPEED;
   }
   else
   {
      MAC_SUPP = 0;
   }
 
   //Half-duplex or full-duplex mode?
   if(interface->duplexMode == NIC_FULL_DUPLEX_MODE)
   {
      //The MAC operates in full-duplex mode
      MAC_MAC2 |= MAC2_FULL_DUPLEX;
      MAC_COMMAND |= COMMAND_FULL_DUPLEX;
      //Configure Back-to-Back Inter-Packet Gap
      MAC_IPGT = IPGT_FULL_DUPLEX;
   }
   else
   {
      //The MAC operates in half-duplex mode
      MAC_MAC2 &= ~MAC2_FULL_DUPLEX;
      MAC_COMMAND &= ~COMMAND_FULL_DUPLEX;
      //Configure Back-to-Back Inter-Packet Gap
      MAC_IPGT = IPGT_HALF_DUPLEX;
   }
 
   //Successful processing
   return NO_ERROR;
}
 
 
/**
 * @brief Write PHY register
 * @param[in] opcode Access type (2 bits)
 * @param[in] phyAddr PHY address (5 bits)
 * @param[in] regAddr Register address (5 bits)
 * @param[in] data Register value
 **/
 
void lpc23xxEthWritePhyReg(uint8_t opcode, uint8_t phyAddr,
   uint8_t regAddr, uint16_t data)
{
   //Valid opcode?
   if(opcode == SMI_OPCODE_WRITE)
   {
      //Clear MCMD register
      MAC_MCMD = 0;
 
      //PHY address
      MAC_MADR = (phyAddr << 8) & MADR_PHY_ADDRESS;
      //Register address
      MAC_MADR |= regAddr & MADR_REGISTER_ADDRESS;
      //Data to be written in the PHY register
      MAC_MWTD = data & MWTD_WRITE_DATA;
 
      //Wait for the write to complete
      while((MAC_MIND & MIND_BUSY) != 0)
      {
      }
   }
   else
   {
      //The MAC peripheral only supports standard Clause 22 opcodes
   }
}
 
 
/**
 * @brief Read PHY register
 * @param[in] opcode Access type (2 bits)
 * @param[in] phyAddr PHY address (5 bits)
 * @param[in] regAddr Register address (5 bits)
 * @return Register value
 **/
 
uint16_t lpc23xxEthReadPhyReg(uint8_t opcode, uint8_t phyAddr,
   uint8_t regAddr)
{
   uint16_t data;
 
   //Valid opcode?
   if(opcode == SMI_OPCODE_READ)
   {
      //PHY address
      MAC_MADR = (phyAddr << 8) & MADR_PHY_ADDRESS;
      //Register address
      MAC_MADR |= regAddr & MADR_REGISTER_ADDRESS;
 
      //Start a read operation
      MAC_MCMD = MCMD_READ;
      //Wait for the read to complete
      while((MAC_MIND & MIND_BUSY) != 0)
      {
      }
 
      //Clear MCMD register
      MAC_MCMD = 0;
 
      //Get register value
      data = MAC_MRDD & MRDD_READ_DATA;
   }
   else
   {
      //The MAC peripheral only supports standard Clause 22 opcodes
      data = 0;
   }
 
   //Return the value of the PHY register
   return data;
}
 
 
/**
 * @brief CRC calculation
 * @param[in] data Pointer to the data over which to calculate the CRC
 * @param[in] length Number of bytes to process
 * @return Resulting CRC value
 **/
 
uint32_t lpc23xxEthCalcCrc(const void *data, size_t length)
{
   uint_t i;
   uint_t j;
   uint32_t crc;
   const uint8_t *p;
 
   //Point to the data over which to calculate the CRC
   p = (uint8_t *) data;
   //CRC preset value
   crc = 0xFFFFFFFF;
 
   //Loop through data
   for(i = 0; i < length; i++)
   {
      //The message is processed bit by bit
      for(j = 0; j < 8; j++)
      {
         //Update CRC value
         if((((crc >> 31) ^ (p[i] >> j)) & 0x01) != 0)
         {
            crc = (crc << 1) ^ 0x04C11DB7;
         }
         else
         {
            crc = crc << 1;
         }
      }
   }
 
   //Return CRC value
   return crc;
}