diff options
Diffstat (limited to 'src/drivers/net/smsc95xx.c')
| -rw-r--r-- | src/drivers/net/smsc95xx.c | 1127 |
1 files changed, 1127 insertions, 0 deletions
diff --git a/src/drivers/net/smsc95xx.c b/src/drivers/net/smsc95xx.c new file mode 100644 index 000000000..9cd428cf9 --- /dev/null +++ b/src/drivers/net/smsc95xx.c @@ -0,0 +1,1127 @@ +/* + * Copyright (C) 2015 Michael Brown <mbrown@fensystems.co.uk>. + * + * 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. + * + * You can also choose to distribute this program under the terms of + * the Unmodified Binary Distribution Licence (as given in the file + * COPYING.UBDL), provided that you have satisfied its requirements. + */ + +FILE_LICENCE ( GPL2_OR_LATER_OR_UBDL ); + +#include <string.h> +#include <unistd.h> +#include <errno.h> +#include <byteswap.h> +#include <ipxe/ethernet.h> +#include <ipxe/usb.h> +#include <ipxe/usbnet.h> +#include <ipxe/profile.h> +#include "smsc95xx.h" + +/** @file + * + * SMSC LAN95xx USB Ethernet driver + * + */ + +/** Interrupt completion profiler */ +static struct profiler smsc95xx_intr_profiler __profiler = + { .name = "smsc95xx.intr" }; + +/** Bulk IN completion profiler */ +static struct profiler smsc95xx_in_profiler __profiler = + { .name = "smsc95xx.in" }; + +/** Bulk OUT profiler */ +static struct profiler smsc95xx_out_profiler __profiler = + { .name = "smsc95xx.out" }; + +/****************************************************************************** + * + * Register access + * + ****************************************************************************** + */ + +/** + * Write register (without byte-swapping) + * + * @v smsc95xx SMSC95xx device + * @v address Register address + * @v value Register value + * @ret rc Return status code + */ +static int smsc95xx_raw_writel ( struct smsc95xx_device *smsc95xx, + unsigned int address, uint32_t value ) { + int rc; + + /* Write register */ + DBGCIO ( smsc95xx, "SMSC95XX %p [%03x] <= %08x\n", + smsc95xx, address, le32_to_cpu ( value ) ); + if ( ( rc = usb_control ( smsc95xx->usb, SMSC95XX_REGISTER_WRITE, 0, + address, &value, sizeof ( value ) ) ) != 0 ) { + DBGC ( smsc95xx, "SMSC95XX %p could not write %03x: %s\n", + smsc95xx, address, strerror ( rc ) ); + return rc; + } + + return 0; +} + +/** + * Write register + * + * @v smsc95xx SMSC95xx device + * @v address Register address + * @v value Register value + * @ret rc Return status code + */ +static inline __attribute__ (( always_inline )) int +smsc95xx_writel ( struct smsc95xx_device *smsc95xx, unsigned int address, + uint32_t value ) { + int rc; + + /* Write register */ + if ( ( rc = smsc95xx_raw_writel ( smsc95xx, address, + cpu_to_le32 ( value ) ) ) != 0 ) + return rc; + + return 0; +} + +/** + * Read register (without byte-swapping) + * + * @v smsc95xx SMSC95xx device + * @v address Register address + * @ret value Register value + * @ret rc Return status code + */ +static int smsc95xx_raw_readl ( struct smsc95xx_device *smsc95xx, + unsigned int address, uint32_t *value ) { + int rc; + + /* Read register */ + if ( ( rc = usb_control ( smsc95xx->usb, SMSC95XX_REGISTER_READ, 0, + address, value, sizeof ( *value ) ) ) != 0 ) { + DBGC ( smsc95xx, "SMSC95XX %p could not read %03x: %s\n", + smsc95xx, address, strerror ( rc ) ); + return rc; + } + DBGCIO ( smsc95xx, "SMSC95XX %p [%03x] => %08x\n", + smsc95xx, address, le32_to_cpu ( *value ) ); + + return 0; +} + +/** + * Read register + * + * @v smsc95xx SMSC95xx device + * @v address Register address + * @ret value Register value + * @ret rc Return status code + */ +static inline __attribute__ (( always_inline )) int +smsc95xx_readl ( struct smsc95xx_device *smsc95xx, unsigned int address, + uint32_t *value ) { + int rc; + + /* Read register */ + if ( ( rc = smsc95xx_raw_readl ( smsc95xx, address, value ) ) != 0 ) + return rc; + le32_to_cpus ( value ); + + return 0; +} + +/****************************************************************************** + * + * EEPROM access + * + ****************************************************************************** + */ + +/** + * Wait for EEPROM to become idle + * + * @v smsc95xx SMSC95xx device + * @ret rc Return status code + */ +static int smsc95xx_eeprom_wait ( struct smsc95xx_device *smsc95xx ) { + uint32_t e2p_cmd; + unsigned int i; + int rc; + + /* Wait for EPC_BSY to become clear */ + for ( i = 0 ; i < SMSC95XX_EEPROM_MAX_WAIT_MS ; i++ ) { + + /* Read E2P_CMD and check EPC_BSY */ + if ( ( rc = smsc95xx_readl ( smsc95xx, SMSC95XX_E2P_CMD, + &e2p_cmd ) ) != 0 ) + return rc; + if ( ! ( e2p_cmd & SMSC95XX_E2P_CMD_EPC_BSY ) ) + return 0; + + /* Delay */ + mdelay ( 1 ); + } + + DBGC ( smsc95xx, "SMSC95XX %p timed out waiting for EEPROM\n", + smsc95xx ); + return -ETIMEDOUT; +} + +/** + * Read byte from EEPROM + * + * @v smsc95xx SMSC95xx device + * @v address EEPROM address + * @ret byte Byte read, or negative error + */ +static int smsc95xx_eeprom_read_byte ( struct smsc95xx_device *smsc95xx, + unsigned int address ) { + uint32_t e2p_cmd; + uint32_t e2p_data; + int rc; + + /* Wait for EEPROM to become idle */ + if ( ( rc = smsc95xx_eeprom_wait ( smsc95xx ) ) != 0 ) + return rc; + + /* Initiate read command */ + e2p_cmd = ( SMSC95XX_E2P_CMD_EPC_BSY | SMSC95XX_E2P_CMD_EPC_CMD_READ | + SMSC95XX_E2P_CMD_EPC_ADDR ( address ) ); + if ( ( rc = smsc95xx_writel ( smsc95xx, SMSC95XX_E2P_CMD, + e2p_cmd ) ) != 0 ) + return rc; + + /* Wait for command to complete */ + if ( ( rc = smsc95xx_eeprom_wait ( smsc95xx ) ) != 0 ) + return rc; + + /* Read EEPROM data */ + if ( ( rc = smsc95xx_readl ( smsc95xx, SMSC95XX_E2P_DATA, + &e2p_data ) ) != 0 ) + return rc; + + return SMSC95XX_E2P_DATA_GET ( e2p_data ); +} + +/** + * Read data from EEPROM + * + * @v smsc95xx SMSC95xx device + * @v address EEPROM address + * @v data Data buffer + * @v len Length of data + * @ret rc Return status code + */ +static int smsc95xx_eeprom_read ( struct smsc95xx_device *smsc95xx, + unsigned int address, void *data, + size_t len ) { + uint8_t *bytes; + int byte; + + /* Read bytes */ + for ( bytes = data ; len-- ; address++, bytes++ ) { + byte = smsc95xx_eeprom_read_byte ( smsc95xx, address ); + if ( byte < 0 ) + return byte; + *bytes = byte; + } + + return 0; +} + +/****************************************************************************** + * + * MII access + * + ****************************************************************************** + */ + +/** + * Wait for MII to become idle + * + * @v smsc95xx SMSC95xx device + * @ret rc Return status code + */ +static int smsc95xx_mii_wait ( struct smsc95xx_device *smsc95xx ) { + uint32_t mii_access; + unsigned int i; + int rc; + + /* Wait for MIIBZY to become clear */ + for ( i = 0 ; i < SMSC95XX_MII_MAX_WAIT_MS ; i++ ) { + + /* Read MII_ACCESS and check MIIBZY */ + if ( ( rc = smsc95xx_readl ( smsc95xx, SMSC95XX_MII_ACCESS, + &mii_access ) ) != 0 ) + return rc; + if ( ! ( mii_access & SMSC95XX_MII_ACCESS_MIIBZY ) ) + return 0; + + /* Delay */ + mdelay ( 1 ); + } + + DBGC ( smsc95xx, "SMSC95XX %p timed out waiting for MII\n", + smsc95xx ); + return -ETIMEDOUT; +} + +/** + * Read from MII register + * + * @v mii MII interface + * @v reg Register address + * @ret value Data read, or negative error + */ +static int smsc95xx_mii_read ( struct mii_interface *mii, unsigned int reg ) { + struct smsc95xx_device *smsc95xx = + container_of ( mii, struct smsc95xx_device, mii ); + uint32_t mii_access; + uint32_t mii_data; + int rc; + + /* Wait for MII to become idle */ + if ( ( rc = smsc95xx_mii_wait ( smsc95xx ) ) != 0 ) + return rc; + + /* Initiate read command */ + mii_access = ( SMSC95XX_MII_ACCESS_PHY_ADDRESS | + SMSC95XX_MII_ACCESS_MIIRINDA ( reg ) | + SMSC95XX_MII_ACCESS_MIIBZY ); + if ( ( rc = smsc95xx_writel ( smsc95xx, SMSC95XX_MII_ACCESS, + mii_access ) ) != 0 ) + return rc; + + /* Wait for command to complete */ + if ( ( rc = smsc95xx_mii_wait ( smsc95xx ) ) != 0 ) + return rc; + + /* Read MII data */ + if ( ( rc = smsc95xx_readl ( smsc95xx, SMSC95XX_MII_DATA, + &mii_data ) ) != 0 ) + return rc; + + return SMSC95XX_MII_DATA_GET ( mii_data ); +} + +/** + * Write to MII register + * + * @v mii MII interface + * @v reg Register address + * @v data Data to write + * @ret rc Return status code + */ +static int smsc95xx_mii_write ( struct mii_interface *mii, unsigned int reg, + unsigned int data ) { + struct smsc95xx_device *smsc95xx = + container_of ( mii, struct smsc95xx_device, mii ); + uint32_t mii_access; + uint32_t mii_data; + int rc; + + /* Wait for MII to become idle */ + if ( ( rc = smsc95xx_mii_wait ( smsc95xx ) ) != 0 ) + return rc; + + /* Write MII data */ + mii_data = SMSC95XX_MII_DATA_SET ( data ); + if ( ( rc = smsc95xx_writel ( smsc95xx, SMSC95XX_MII_DATA, + mii_data ) ) != 0 ) + return rc; + + /* Initiate write command */ + mii_access = ( SMSC95XX_MII_ACCESS_PHY_ADDRESS | + SMSC95XX_MII_ACCESS_MIIRINDA ( reg ) | + SMSC95XX_MII_ACCESS_MIIWNR | + SMSC95XX_MII_ACCESS_MIIBZY ); + if ( ( rc = smsc95xx_writel ( smsc95xx, SMSC95XX_MII_ACCESS, + mii_access ) ) != 0 ) + return rc; + + /* Wait for command to complete */ + if ( ( rc = smsc95xx_mii_wait ( smsc95xx ) ) != 0 ) + return rc; + + return 0; +} + +/** MII operations */ +static struct mii_operations smsc95xx_mii_operations = { + .read = smsc95xx_mii_read, + .write = smsc95xx_mii_write, +}; + +/** + * Check link status + * + * @v smsc95xx SMSC95xx device + * @ret rc Return status code + */ +static int smsc95xx_check_link ( struct smsc95xx_device *smsc95xx ) { + struct net_device *netdev = smsc95xx->netdev; + int intr; + int rc; + + /* Read PHY interrupt source */ + intr = mii_read ( &smsc95xx->mii, SMSC95XX_MII_PHY_INTR_SOURCE ); + if ( intr < 0 ) { + rc = intr; + DBGC ( smsc95xx, "SMSC95XX %p could not get PHY interrupt " + "source: %s\n", smsc95xx, strerror ( rc ) ); + return rc; + } + + /* Acknowledge PHY interrupt */ + if ( ( rc = mii_write ( &smsc95xx->mii, SMSC95XX_MII_PHY_INTR_SOURCE, + intr ) ) != 0 ) { + DBGC ( smsc95xx, "SMSC95XX %p could not acknowledge PHY " + "interrupt: %s\n", smsc95xx, strerror ( rc ) ); + return rc; + } + + /* Check link status */ + if ( ( rc = mii_check_link ( &smsc95xx->mii, netdev ) ) != 0 ) { + DBGC ( smsc95xx, "SMSC95XX %p could not check link: %s\n", + smsc95xx, strerror ( rc ) ); + return rc; + } + + DBGC ( smsc95xx, "SMSC95XX %p link %s (intr %#04x)\n", + smsc95xx, ( netdev_link_ok ( netdev ) ? "up" : "down" ), intr ); + return 0; +} + +/****************************************************************************** + * + * Statistics (for debugging) + * + ****************************************************************************** + */ + +/** + * Get RX statistics + * + * @v smsc95xx SMSC95xx device + * @v stats Statistics to fill in + * @ret rc Return status code + */ +static int smsc95xx_get_rx_statistics ( struct smsc95xx_device *smsc95xx, + struct smsc95xx_rx_statistics *stats ) { + int rc; + + /* Get statistics */ + if ( ( rc = usb_control ( smsc95xx->usb, SMSC95XX_GET_STATISTICS, 0, + SMSC95XX_RX_STATISTICS, stats, + sizeof ( *stats ) ) ) != 0 ) { + DBGC ( smsc95xx, "SMSC95XX %p could not get RX statistics: " + "%s\n", smsc95xx, strerror ( rc ) ); + return rc; + } + + return 0; +} + +/** + * Get TX statistics + * + * @v smsc95xx SMSC95xx device + * @v stats Statistics to fill in + * @ret rc Return status code + */ +static int smsc95xx_get_tx_statistics ( struct smsc95xx_device *smsc95xx, + struct smsc95xx_tx_statistics *stats ) { + int rc; + + /* Get statistics */ + if ( ( rc = usb_control ( smsc95xx->usb, SMSC95XX_GET_STATISTICS, 0, + SMSC95XX_TX_STATISTICS, stats, + sizeof ( *stats ) ) ) != 0 ) { + DBGC ( smsc95xx, "SMSC95XX %p could not get TX statistics: " + "%s\n", smsc95xx, strerror ( rc ) ); + return rc; + } + + return 0; +} + +/** + * Dump statistics (for debugging) + * + * @v smsc95xx SMSC95xx device + * @ret rc Return status code + */ +static int smsc95xx_dump_statistics ( struct smsc95xx_device *smsc95xx ) { + struct smsc95xx_rx_statistics rx; + struct smsc95xx_tx_statistics tx; + int rc; + + /* Do nothing unless debugging is enabled */ + if ( ! DBG_LOG ) + return 0; + + /* Get RX statistics */ + if ( ( rc = smsc95xx_get_rx_statistics ( smsc95xx, &rx ) ) != 0 ) + return rc; + + /* Get TX statistics */ + if ( ( rc = smsc95xx_get_tx_statistics ( smsc95xx, &tx ) ) != 0 ) + return rc; + + /* Dump statistics */ + DBGC ( smsc95xx, "SMSC95XX %p RX good %d bad %d crc %d und %d aln %d " + "ovr %d lat %d drp %d\n", smsc95xx, le32_to_cpu ( rx.good ), + le32_to_cpu ( rx.bad ), le32_to_cpu ( rx.crc ), + le32_to_cpu ( rx.undersize ), le32_to_cpu ( rx.alignment ), + le32_to_cpu ( rx.oversize ), le32_to_cpu ( rx.late ), + le32_to_cpu ( rx.dropped ) ); + DBGC ( smsc95xx, "SMSC95XX %p TX good %d bad %d pau %d sgl %d mul %d " + "exc %d lat %d und %d def %d car %d\n", smsc95xx, + le32_to_cpu ( tx.good ), le32_to_cpu ( tx.bad ), + le32_to_cpu ( tx.pause ), le32_to_cpu ( tx.single ), + le32_to_cpu ( tx.multiple ), le32_to_cpu ( tx.excessive ), + le32_to_cpu ( tx.late ), le32_to_cpu ( tx.underrun ), + le32_to_cpu ( tx.deferred ), le32_to_cpu ( tx.carrier ) ); + + return 0; +} + +/****************************************************************************** + * + * Device reset + * + ****************************************************************************** + */ + +/** + * Reset device + * + * @v smsc95xx SMSC95xx device + * @ret rc Return status code + */ +static int smsc95xx_reset ( struct smsc95xx_device *smsc95xx ) { + uint32_t hw_cfg; + int rc; + + /* Reset device */ + if ( ( rc = smsc95xx_writel ( smsc95xx, SMSC95XX_HW_CFG, + SMSC95XX_HW_CFG_LRST ) ) != 0 ) + return rc; + + /* Wait for reset to complete */ + udelay ( SMSC95XX_RESET_DELAY_US ); + + /* Check that reset has completed */ + if ( ( rc = smsc95xx_readl ( smsc95xx, SMSC95XX_HW_CFG, + &hw_cfg ) ) != 0 ) + return rc; + if ( hw_cfg & SMSC95XX_HW_CFG_LRST ) { + DBGC ( smsc95xx, "SMSC95XX %p failed to reset\n", smsc95xx ); + return -ETIMEDOUT; + } + + return 0; +} + +/****************************************************************************** + * + * Endpoint operations + * + ****************************************************************************** + */ + +/** + * Complete interrupt transfer + * + * @v ep USB endpoint + * @v iobuf I/O buffer + * @v rc Completion status code + */ +static void smsc95xx_intr_complete ( struct usb_endpoint *ep, + struct io_buffer *iobuf, int rc ) { + struct smsc95xx_device *smsc95xx = + container_of ( ep, struct smsc95xx_device, usbnet.intr ); + struct net_device *netdev = smsc95xx->netdev; + struct smsc95xx_interrupt *intr; + + /* Profile completions */ + profile_start ( &smsc95xx_intr_profiler ); + + /* Ignore packets cancelled when the endpoint closes */ + if ( ! ep->open ) + goto done; + + /* Record USB errors against the network device */ + if ( rc != 0 ) { + DBGC ( smsc95xx, "SMSC95XX %p interrupt failed: %s\n", + smsc95xx, strerror ( rc ) ); + DBGC_HDA ( smsc95xx, 0, iobuf->data, iob_len ( iobuf ) ); + netdev_rx_err ( netdev, NULL, rc ); + goto done; + } + + /* Extract interrupt data */ + if ( iob_len ( iobuf ) != sizeof ( *intr ) ) { + DBGC ( smsc95xx, "SMSC95XX %p malformed interrupt\n", + smsc95xx ); + DBGC_HDA ( smsc95xx, 0, iobuf->data, iob_len ( iobuf ) ); + netdev_rx_err ( netdev, NULL, rc ); + goto done; + } + intr = iobuf->data; + + /* Record interrupt status */ + smsc95xx->int_sts = le32_to_cpu ( intr->int_sts ); + profile_stop ( &smsc95xx_intr_profiler ); + + done: + /* Free I/O buffer */ + free_iob ( iobuf ); +} + +/** Interrupt endpoint operations */ +static struct usb_endpoint_driver_operations smsc95xx_intr_operations = { + .complete = smsc95xx_intr_complete, +}; + +/** + * Complete bulk IN transfer + * + * @v ep USB endpoint + * @v iobuf I/O buffer + * @v rc Completion status code + */ +static void smsc95xx_in_complete ( struct usb_endpoint *ep, + struct io_buffer *iobuf, int rc ) { + struct smsc95xx_device *smsc95xx = + container_of ( ep, struct smsc95xx_device, usbnet.in ); + struct net_device *netdev = smsc95xx->netdev; + struct smsc95xx_rx_header *header; + + /* Profile completions */ + profile_start ( &smsc95xx_in_profiler ); + + /* Ignore packets cancelled when the endpoint closes */ + if ( ! ep->open ) { + free_iob ( iobuf ); + return; + } + + /* Record USB errors against the network device */ + if ( rc != 0 ) { + DBGC ( smsc95xx, "SMSC95XX %p bulk IN failed: %s\n", + smsc95xx, strerror ( rc ) ); + goto err; + } + + /* Sanity check */ + if ( iob_len ( iobuf ) < ( sizeof ( *header ) + 4 /* CRC */ ) ) { + DBGC ( smsc95xx, "SMSC95XX %p underlength bulk IN\n", + smsc95xx ); + DBGC_HDA ( smsc95xx, 0, iobuf->data, iob_len ( iobuf ) ); + rc = -EINVAL; + goto err; + } + + /* Strip header and CRC */ + header = iobuf->data; + iob_pull ( iobuf, sizeof ( *header ) ); + iob_unput ( iobuf, 4 /* CRC */ ); + + /* Check for errors */ + if ( header->command & cpu_to_le32 ( SMSC95XX_RX_RUNT | + SMSC95XX_RX_LATE | + SMSC95XX_RX_CRC ) ) { + DBGC ( smsc95xx, "SMSC95XX %p receive error (%08x):\n", + smsc95xx, le32_to_cpu ( header->command ) ); + DBGC_HDA ( smsc95xx, 0, iobuf->data, iob_len ( iobuf ) ); + rc = -EIO; + goto err; + } + + /* Hand off to network stack */ + netdev_rx ( netdev, iob_disown ( iobuf ) ); + + profile_stop ( &smsc95xx_in_profiler ); + return; + + err: + /* Hand off to network stack */ + netdev_rx_err ( netdev, iob_disown ( iobuf ), rc ); +} + +/** Bulk IN endpoint operations */ +static struct usb_endpoint_driver_operations smsc95xx_in_operations = { + .complete = smsc95xx_in_complete, +}; + +/** + * Transmit packet + * + * @v smsc95xx SMSC95xx device + * @v iobuf I/O buffer + * @ret rc Return status code + */ +static int smsc95xx_out_transmit ( struct smsc95xx_device *smsc95xx, + struct io_buffer *iobuf ) { + struct smsc95xx_tx_header *header; + size_t len = iob_len ( iobuf ); + int rc; + + /* Profile transmissions */ + profile_start ( &smsc95xx_out_profiler ); + + /* Prepend header */ + if ( ( rc = iob_ensure_headroom ( iobuf, sizeof ( *header ) ) ) != 0 ) + return rc; + header = iob_push ( iobuf, sizeof ( *header ) ); + header->command = cpu_to_le32 ( SMSC95XX_TX_FIRST | SMSC95XX_TX_LAST | + SMSC95XX_TX_LEN ( len ) ); + header->len = cpu_to_le32 ( len ); + + /* Enqueue I/O buffer */ + if ( ( rc = usb_stream ( &smsc95xx->usbnet.out, iobuf, 0 ) ) != 0 ) + return rc; + + profile_stop ( &smsc95xx_out_profiler ); + return 0; +} + +/** + * Complete bulk OUT transfer + * + * @v ep USB endpoint + * @v iobuf I/O buffer + * @v rc Completion status code + */ +static void smsc95xx_out_complete ( struct usb_endpoint *ep, + struct io_buffer *iobuf, int rc ) { + struct smsc95xx_device *smsc95xx = + container_of ( ep, struct smsc95xx_device, usbnet.out ); + struct net_device *netdev = smsc95xx->netdev; + + /* Report TX completion */ + netdev_tx_complete_err ( netdev, iobuf, rc ); +} + +/** Bulk OUT endpoint operations */ +static struct usb_endpoint_driver_operations smsc95xx_out_operations = { + .complete = smsc95xx_out_complete, +}; + +/****************************************************************************** + * + * Network device interface + * + ****************************************************************************** + */ + +/** + * Open network device + * + * @v netdev Network device + * @ret rc Return status code + */ +static int smsc95xx_open ( struct net_device *netdev ) { + struct smsc95xx_device *smsc95xx = netdev->priv; + union smsc95xx_mac mac; + int rc; + + /* Clear stored interrupt status */ + smsc95xx->int_sts = 0; + + /* Copy MAC address */ + memset ( &mac, 0, sizeof ( mac ) ); + memcpy ( mac.raw, netdev->ll_addr, ETH_ALEN ); + + /* Configure bulk IN empty response */ + if ( ( rc = smsc95xx_writel ( smsc95xx, SMSC95XX_HW_CFG, + SMSC95XX_HW_CFG_BIR ) ) != 0 ) + goto err_hw_cfg; + + /* Open USB network device */ + if ( ( rc = usbnet_open ( &smsc95xx->usbnet ) ) != 0 ) { + DBGC ( smsc95xx, "SMSC95XX %p could not open: %s\n", + smsc95xx, strerror ( rc ) ); + goto err_open; + } + + /* Configure interrupt endpoint */ + if ( ( rc = smsc95xx_writel ( smsc95xx, SMSC95XX_INT_EP_CTL, + ( SMSC95XX_INT_EP_CTL_RXDF_EN | + SMSC95XX_INT_EP_CTL_PHY_EN ) ) ) != 0 ) + goto err_int_ep_ctl; + + /* Configure bulk IN delay */ + if ( ( rc = smsc95xx_writel ( smsc95xx, SMSC95XX_BULK_IN_DLY, + SMSC95XX_BULK_IN_DLY_SET ( 0 ) ) ) != 0 ) + goto err_bulk_in_dly; + + /* Configure MAC */ + if ( ( rc = smsc95xx_writel ( smsc95xx, SMSC95XX_MAC_CR, + ( SMSC95XX_MAC_CR_RXALL | + SMSC95XX_MAC_CR_FDPX | + SMSC95XX_MAC_CR_MCPAS | + SMSC95XX_MAC_CR_PRMS | + SMSC95XX_MAC_CR_PASSBAD | + SMSC95XX_MAC_CR_TXEN | + SMSC95XX_MAC_CR_RXEN ) ) ) != 0 ) + goto err_mac_cr; + + /* Configure transmit datapath */ + if ( ( rc = smsc95xx_writel ( smsc95xx, SMSC95XX_TX_CFG, + SMSC95XX_TX_CFG_ON ) ) != 0 ) + goto err_tx_cfg; + + /* Write MAC address high register */ + if ( ( rc = smsc95xx_raw_writel ( smsc95xx, SMSC95XX_ADDRH, + mac.addr.h ) ) != 0 ) + goto err_addrh; + + /* Write MAC address low register */ + if ( ( rc = smsc95xx_raw_writel ( smsc95xx, SMSC95XX_ADDRL, + mac.addr.l ) ) != 0 ) + goto err_addrl; + + /* Enable PHY interrupts */ + if ( ( rc = mii_write ( &smsc95xx->mii, SMSC95XX_MII_PHY_INTR_MASK, + ( SMSC95XX_PHY_INTR_ANEG_DONE | + SMSC95XX_PHY_INTR_LINK_DOWN ) ) ) != 0 ) { + DBGC ( smsc95xx, "SMSC95XX %p could not set PHY interrupt " + "mask: %s\n", smsc95xx, strerror ( rc ) ); + goto err_phy_intr_mask; + } + + /* Update link status */ + smsc95xx_check_link ( smsc95xx ); + + return 0; + + err_phy_intr_mask: + err_addrl: + err_addrh: + err_tx_cfg: + err_mac_cr: + err_bulk_in_dly: + err_int_ep_ctl: + usbnet_close ( &smsc95xx->usbnet ); + err_open: + err_hw_cfg: + smsc95xx_reset ( smsc95xx ); + return rc; +} + +/** + * Close network device + * + * @v netdev Network device + */ +static void smsc95xx_close ( struct net_device *netdev ) { + struct smsc95xx_device *smsc95xx = netdev->priv; + + /* Close USB network device */ + usbnet_close ( &smsc95xx->usbnet ); + + /* Dump statistics (for debugging) */ + smsc95xx_dump_statistics ( smsc95xx ); + + /* Reset device */ + smsc95xx_reset ( smsc95xx ); +} + +/** + * Transmit packet + * + * @v netdev Network device + * @v iobuf I/O buffer + * @ret rc Return status code + */ +static int smsc95xx_transmit ( struct net_device *netdev, + struct io_buffer *iobuf ) { + struct smsc95xx_device *smsc95xx = netdev->priv; + int rc; + + /* Transmit packet */ + if ( ( rc = smsc95xx_out_transmit ( smsc95xx, iobuf ) ) != 0 ) + return rc; + + return 0; +} + +/** + * Poll for completed and received packets + * + * @v netdev Network device + */ +static void smsc95xx_poll ( struct net_device *netdev ) { + struct smsc95xx_device *smsc95xx = netdev->priv; + uint32_t int_sts; + int rc; + + /* Poll USB bus */ + usb_poll ( smsc95xx->bus ); + + /* Refill endpoints */ + if ( ( rc = usbnet_refill ( &smsc95xx->usbnet ) ) != 0 ) + netdev_rx_err ( netdev, NULL, rc ); + + /* Do nothing more unless there are interrupts to handle */ + int_sts = smsc95xx->int_sts; + if ( ! int_sts ) + return; + + /* Check link status if applicable */ + if ( int_sts & SMSC95XX_INT_STS_PHY_INT ) { + smsc95xx_check_link ( smsc95xx ); + int_sts &= ~SMSC95XX_INT_STS_PHY_INT; + } + + /* Record RX FIFO overflow if applicable */ + if ( int_sts & SMSC95XX_INT_STS_RXDF_INT ) { + DBGC2 ( smsc95xx, "SMSC95XX %p RX FIFO overflowed\n", + smsc95xx ); + netdev_rx_err ( netdev, NULL, -ENOBUFS ); + int_sts &= ~SMSC95XX_INT_STS_RXDF_INT; + } + + /* Check for unexpected interrupts */ + if ( int_sts ) { + DBGC ( smsc95xx, "SMSC95XX %p unexpected interrupt %#08x\n", + smsc95xx, int_sts ); + netdev_rx_err ( netdev, NULL, -ENOTTY ); + } + + /* Clear interrupts */ + if ( ( rc = smsc95xx_writel ( smsc95xx, SMSC95XX_INT_STS, + smsc95xx->int_sts ) ) != 0 ) + netdev_rx_err ( netdev, NULL, rc ); + smsc95xx->int_sts = 0; +} + +/** SMSC95xx network device operations */ +static struct net_device_operations smsc95xx_operations = { + .open = smsc95xx_open, + .close = smsc95xx_close, + .transmit = smsc95xx_transmit, + .poll = smsc95xx_poll, +}; + +/****************************************************************************** + * + * USB interface + * + ****************************************************************************** + */ + +/** + * Probe device + * + * @v func USB function + * @v config Configuration descriptor + * @ret rc Return status code + */ +static int smsc95xx_probe ( struct usb_function *func, + struct usb_configuration_descriptor *config ) { + struct usb_device *usb = func->usb; + struct net_device *netdev; + struct smsc95xx_device *smsc95xx; + int rc; + + /* Allocate and initialise structure */ + netdev = alloc_etherdev ( sizeof ( *smsc95xx ) ); + if ( ! netdev ) { + rc = -ENOMEM; + goto err_alloc; + } + netdev_init ( netdev, &smsc95xx_operations ); + netdev->dev = &func->dev; + smsc95xx = netdev->priv; + memset ( smsc95xx, 0, sizeof ( *smsc95xx ) ); + smsc95xx->usb = usb; + smsc95xx->bus = usb->port->hub->bus; + smsc95xx->netdev = netdev; + usbnet_init ( &smsc95xx->usbnet, func, &smsc95xx_intr_operations, + &smsc95xx_in_operations, &smsc95xx_out_operations ); + usb_refill_init ( &smsc95xx->usbnet.intr, 0, SMSC95XX_INTR_MAX_FILL ); + usb_refill_init ( &smsc95xx->usbnet.in, SMSC95XX_IN_MTU, + SMSC95XX_IN_MAX_FILL ); + mii_init ( &smsc95xx->mii, &smsc95xx_mii_operations ); + DBGC ( smsc95xx, "SMSC95XX %p on %s\n", smsc95xx, func->name ); + + /* Describe USB network device */ + if ( ( rc = usbnet_describe ( &smsc95xx->usbnet, config ) ) != 0 ) { + DBGC ( smsc95xx, "SMSC95XX %p could not describe: %s\n", + smsc95xx, strerror ( rc ) ); + goto err_describe; + } + + /* Reset device */ + if ( ( rc = smsc95xx_reset ( smsc95xx ) ) != 0 ) + goto err_reset; + + /* Read MAC address */ + if ( ( rc = smsc95xx_eeprom_read ( smsc95xx, SMSC95XX_EEPROM_MAC, + netdev->hw_addr, ETH_ALEN ) ) != 0 ) + goto err_eeprom_read; + + /* Generate MAC address if EEPROM is not present */ + if ( ! is_valid_ether_addr ( netdev->hw_addr ) ) { + DBGC ( smsc95xx, "SMSC95XX %p has no EEPROM (%s)\n", + smsc95xx, eth_ntoa ( netdev->hw_addr ) ); + eth_random_addr ( netdev->hw_addr ); + } + + /* Register network device */ + if ( ( rc = register_netdev ( netdev ) ) != 0 ) + goto err_register; + + usb_func_set_drvdata ( func, netdev ); + return 0; + + unregister_netdev ( netdev ); + err_register: + err_eeprom_read: + err_reset: + err_describe: + netdev_nullify ( netdev ); + netdev_put ( netdev ); + err_alloc: + return rc; +} + +/** + * Remove device + * + * @v func USB function + */ +static void smsc95xx_remove ( struct usb_function *func ) { + struct net_device *netdev = usb_func_get_drvdata ( func ); + + unregister_netdev ( netdev ); + netdev_nullify ( netdev ); + netdev_put ( netdev ); +} + +/** SMSC95xx device IDs */ +static struct usb_device_id smsc95xx_ids[] = { + { + .name = "smsc9500", + .vendor = 0x0424, + .product = 0x9500, + }, + { + .name = "smsc9505", + .vendor = 0x0424, + .product = 0x9505, + }, + { + .name = "smsc9500a", + .vendor = 0x0424, + .product = 0x9e00, + }, + { + .name = "smsc9505a", + .vendor = 0x0424, + .product = 0x9e01, + }, + { + .name = "smsc9514", + .vendor = 0x0424, + .product = 0xec00, + }, + { + .name = "smsc9500-s", + .vendor = 0x0424, + .product = 0x9900, + }, + { + .name = "smsc9505-s", + .vendor = 0x0424, + .product = 0x9901, + }, + { + .name = "smsc9500a-s", + .vendor = 0x0424, + .product = 0x9902, + }, + { + .name = "smsc9505a-s", + .vendor = 0x0424, + .product = 0x9903, + }, + { + .name = "smsc9514-s", + .vendor = 0x0424, + .product = 0x9904, + }, + { + .name = "smsc9500a-h", + .vendor = 0x0424, + .product = 0x9905, + }, + { + .name = "smsc9505a-h", + .vendor = 0x0424, + .product = 0x9906, + }, + { + .name = "smsc9500-2", + .vendor = 0x0424, + .product = 0x9907, + }, + { + .name = "smsc9500a-2", + .vendor = 0x0424, + .product = 0x9908, + }, + { + .name = "smsc9514-2", + .vendor = 0x0424, + .product = 0x9909, + }, + { + .name = "smsc9530", + .vendor = 0x0424, + .product = 0x9530, + }, + { + .name = "smsc9730", + .vendor = 0x0424, + .product = 0x9730, + }, + { + .name = "smsc89530", + .vendor = 0x0424, + .product = 0x9e08, + }, +}; + +/** SMSC LAN95xx driver */ +struct usb_driver smsc95xx_driver __usb_driver = { + .ids = smsc95xx_ids, + .id_count = ( sizeof ( smsc95xx_ids ) / sizeof ( smsc95xx_ids[0] ) ), + .class = USB_CLASS_ID ( 0xff, 0x00, 0xff ), + .score = USB_SCORE_NORMAL, + .probe = smsc95xx_probe, + .remove = smsc95xx_remove, +}; |