| /* | |
| * Copyright (C) 2016 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 ); | |
| FILE_SECBOOT ( PERMITTED ); | |
| #include <stdint.h> | |
| #include <string.h> | |
| #include <unistd.h> | |
| #include <errno.h> | |
| #include <ipxe/netdevice.h> | |
| #include <ipxe/ethernet.h> | |
| #include <ipxe/if_ether.h> | |
| #include <ipxe/profile.h> | |
| #include <ipxe/usb.h> | |
| #include "axge.h" | |
| /** @file | |
| * | |
| * Asix 10/100/1000 USB Ethernet driver | |
| * | |
| * Large chunks of functionality are undocumented in the available | |
| * datasheets. The gaps are deduced from combinations of the Linux | |
| * driver, the FreeBSD driver, and experimentation with the hardware. | |
| */ | |
| /** Interrupt completion profiler */ | |
| static struct profiler axge_intr_profiler __profiler = | |
| { .name = "axge.intr" }; | |
| /** Bulk IN completion profiler */ | |
| static struct profiler axge_in_profiler __profiler = | |
| { .name = "axge.in" }; | |
| /** Bulk OUT profiler */ | |
| static struct profiler axge_out_profiler __profiler = | |
| { .name = "axge.out" }; | |
| /** Default bulk IN configuration | |
| * | |
| * The Linux and FreeBSD drivers have set of magic constants which are | |
| * chosen based on both the Ethernet and USB link speeds. | |
| * | |
| * Experimentation shows that setting the "timer" value to zero seems | |
| * to prevent the device from ever coalescing multiple packets into a | |
| * single bulk IN transfer. This allows us to get away with using a | |
| * 2kB receive I/O buffer and a zerocopy receive path. | |
| */ | |
| static struct axge_bulk_in_control axge_bicr = { | |
| .ctrl = 7, | |
| .timer = cpu_to_le16 ( 0 ), | |
| .size = 0, | |
| .ifg = 0, | |
| }; | |
| /****************************************************************************** | |
| * | |
| * Register access | |
| * | |
| ****************************************************************************** | |
| */ | |
| /** | |
| * Read register | |
| * | |
| * @v asix AXGE device | |
| * @v offset Register offset | |
| * @v data Data buffer | |
| * @v len Length of data | |
| * @ret rc Return status code | |
| */ | |
| static inline int axge_read_register ( struct axge_device *axge, | |
| unsigned int offset, void *data, | |
| size_t len ) { | |
| return usb_control ( axge->usb, AXGE_READ_MAC_REGISTER, | |
| offset, len, data, len ); | |
| } | |
| /** | |
| * Read one-byte register | |
| * | |
| * @v asix AXGE device | |
| * @v offset Register offset | |
| * @v value Value to fill in | |
| * @ret rc Return status code | |
| */ | |
| static inline int axge_read_byte ( struct axge_device *axge, | |
| unsigned int offset, uint8_t *value ) { | |
| return axge_read_register ( axge, offset, value, sizeof ( *value ) ); | |
| } | |
| /** | |
| * Read two-byte register | |
| * | |
| * @v asix AXGE device | |
| * @v offset Register offset | |
| * @v value Value to fill in | |
| * @ret rc Return status code | |
| */ | |
| static inline int axge_read_word ( struct axge_device *axge, | |
| unsigned int offset, uint16_t *value ) { | |
| return axge_read_register ( axge, offset, value, sizeof ( *value ) ); | |
| } | |
| /** | |
| * Read four-byte register | |
| * | |
| * @v asix AXGE device | |
| * @v offset Register offset | |
| * @v value Value to fill in | |
| * @ret rc Return status code | |
| */ | |
| static inline int axge_read_dword ( struct axge_device *axge, | |
| unsigned int offset, uint32_t *value ) { | |
| return axge_read_register ( axge, offset, value, sizeof ( *value ) ); | |
| } | |
| /** | |
| * Write register | |
| * | |
| * @v asix AXGE device | |
| * @v offset Register offset | |
| * @v data Data buffer | |
| * @v len Length of data | |
| * @ret rc Return status code | |
| */ | |
| static inline int axge_write_register ( struct axge_device *axge, | |
| unsigned int offset, void *data, | |
| size_t len ) { | |
| return usb_control ( axge->usb, AXGE_WRITE_MAC_REGISTER, | |
| offset, len, data, len ); | |
| } | |
| /** | |
| * Write one-byte register | |
| * | |
| * @v asix AXGE device | |
| * @v offset Register offset | |
| * @v value Value | |
| * @ret rc Return status code | |
| */ | |
| static inline int axge_write_byte ( struct axge_device *axge, | |
| unsigned int offset, uint8_t value ) { | |
| return axge_write_register ( axge, offset, &value, sizeof ( value )); | |
| } | |
| /** | |
| * Write two-byte register | |
| * | |
| * @v asix AXGE device | |
| * @v offset Register offset | |
| * @v value Value | |
| * @ret rc Return status code | |
| */ | |
| static inline int axge_write_word ( struct axge_device *axge, | |
| unsigned int offset, uint16_t value ) { | |
| return axge_write_register ( axge, offset, &value, sizeof ( value )); | |
| } | |
| /** | |
| * Write one-byte register | |
| * | |
| * @v asix AXGE device | |
| * @v offset Register offset | |
| * @v value Value | |
| * @ret rc Return status code | |
| */ | |
| static inline int axge_write_dword ( struct axge_device *axge, | |
| unsigned int offset, uint32_t value ) { | |
| return axge_write_register ( axge, offset, &value, sizeof ( value )); | |
| } | |
| /****************************************************************************** | |
| * | |
| * Link status | |
| * | |
| ****************************************************************************** | |
| */ | |
| /** | |
| * Get link status | |
| * | |
| * @v asix AXGE device | |
| * @ret rc Return status code | |
| */ | |
| static int axge_check_link ( struct axge_device *axge ) { | |
| struct net_device *netdev = axge->netdev; | |
| uint8_t plsr; | |
| uint16_t msr; | |
| int rc; | |
| /* Read physical link status register */ | |
| if ( ( rc = axge_read_byte ( axge, AXGE_PLSR, &plsr ) ) != 0 ) { | |
| DBGC ( axge, "AXGE %p could not read PLSR: %s\n", | |
| axge, strerror ( rc ) ); | |
| return rc; | |
| } | |
| /* Write medium status register */ | |
| msr = cpu_to_le16 ( AXGE_MSR_FD | AXGE_MSR_RFC | AXGE_MSR_TFC | | |
| AXGE_MSR_RE ); | |
| if ( plsr & AXGE_PLSR_EPHY_1000 ) { | |
| msr |= cpu_to_le16 ( AXGE_MSR_GM ); | |
| } else if ( plsr & AXGE_PLSR_EPHY_100 ) { | |
| msr |= cpu_to_le16 ( AXGE_MSR_PS ); | |
| } | |
| if ( ( rc = axge_write_word ( axge, AXGE_MSR, msr ) ) != 0 ) { | |
| DBGC ( axge, "AXGE %p could not write MSR: %s\n", | |
| axge, strerror ( rc ) ); | |
| return rc; | |
| } | |
| /* Update link status */ | |
| if ( plsr & AXGE_PLSR_EPHY_ANY ) { | |
| DBGC ( axge, "AXGE %p link up (PLSR %02x MSR %04x)\n", | |
| axge, plsr, msr ); | |
| netdev_link_up ( netdev ); | |
| } else { | |
| DBGC ( axge, "AXGE %p link down (PLSR %02x MSR %04x)\n", | |
| axge, plsr, msr ); | |
| netdev_link_down ( netdev ); | |
| } | |
| return 0; | |
| } | |
| /****************************************************************************** | |
| * | |
| * AXGE communications interface | |
| * | |
| ****************************************************************************** | |
| */ | |
| /** | |
| * Complete interrupt transfer | |
| * | |
| * @v ep USB endpoint | |
| * @v iobuf I/O buffer | |
| * @v rc Completion status code | |
| */ | |
| static void axge_intr_complete ( struct usb_endpoint *ep, | |
| struct io_buffer *iobuf, int rc ) { | |
| struct axge_device *axge = container_of ( ep, struct axge_device, | |
| usbnet.intr ); | |
| struct net_device *netdev = axge->netdev; | |
| struct axge_interrupt *intr; | |
| size_t len = iob_len ( iobuf ); | |
| unsigned int link_ok; | |
| /* Profile completions */ | |
| profile_start ( &axge_intr_profiler ); | |
| /* Ignore packets cancelled when the endpoint closes */ | |
| if ( ! ep->open ) | |
| goto ignore; | |
| /* Drop packets with errors */ | |
| if ( rc != 0 ) { | |
| DBGC ( axge, "AXGE %p interrupt failed: %s\n", | |
| axge, strerror ( rc ) ); | |
| DBGC_HDA ( axge, 0, iobuf->data, iob_len ( iobuf ) ); | |
| goto error; | |
| } | |
| /* Extract message header */ | |
| if ( len < sizeof ( *intr ) ) { | |
| DBGC ( axge, "AXGE %p underlength interrupt:\n", axge ); | |
| DBGC_HDA ( axge, 0, iobuf->data, iob_len ( iobuf ) ); | |
| rc = -EINVAL; | |
| goto error; | |
| } | |
| intr = iobuf->data; | |
| /* Check magic signature */ | |
| if ( intr->magic != cpu_to_le16 ( AXGE_INTR_MAGIC ) ) { | |
| DBGC ( axge, "AXGE %p malformed interrupt:\n", axge ); | |
| DBGC_HDA ( axge, 0, iobuf->data, iob_len ( iobuf ) ); | |
| rc = -EINVAL; | |
| goto error; | |
| } | |
| /* Extract link status */ | |
| link_ok = ( intr->link & cpu_to_le16 ( AXGE_INTR_LINK_PPLS ) ); | |
| if ( ( !! link_ok ) ^ ( !! netdev_link_ok ( netdev ) ) ) | |
| axge->check_link = 1; | |
| /* Free I/O buffer */ | |
| free_iob ( iobuf ); | |
| profile_stop ( &axge_intr_profiler ); | |
| return; | |
| error: | |
| netdev_rx_err ( netdev, iob_disown ( iobuf ), rc ); | |
| ignore: | |
| free_iob ( iobuf ); | |
| return; | |
| } | |
| /** Interrupt endpoint operations */ | |
| static struct usb_endpoint_driver_operations axge_intr_operations = { | |
| .complete = axge_intr_complete, | |
| }; | |
| /****************************************************************************** | |
| * | |
| * AXGE data interface | |
| * | |
| ****************************************************************************** | |
| */ | |
| /** | |
| * Complete bulk IN transfer | |
| * | |
| * @v ep USB endpoint | |
| * @v iobuf I/O buffer | |
| * @v rc Completion status code | |
| */ | |
| static void axge_in_complete ( struct usb_endpoint *ep, | |
| struct io_buffer *iobuf, int rc ) { | |
| struct axge_device *axge = container_of ( ep, struct axge_device, | |
| usbnet.in ); | |
| struct net_device *netdev = axge->netdev; | |
| struct axge_rx_footer *ftr; | |
| struct axge_rx_descriptor *desc; | |
| struct io_buffer *pkt; | |
| unsigned int count; | |
| unsigned int offset; | |
| size_t len; | |
| size_t padded_len; | |
| /* Profile receive completions */ | |
| profile_start ( &axge_in_profiler ); | |
| /* Ignore packets cancelled when the endpoint closes */ | |
| if ( ! ep->open ) | |
| goto ignore; | |
| /* Record USB errors against the network device */ | |
| if ( rc != 0 ) { | |
| DBGC ( axge, "AXGE %p bulk IN failed: %s\n", | |
| axge, strerror ( rc ) ); | |
| goto error; | |
| } | |
| /* Sanity check */ | |
| if ( iob_len ( iobuf ) < sizeof ( *ftr ) ) { | |
| DBGC ( axge, "AXGE %p underlength bulk IN:\n", axge ); | |
| DBGC_HDA ( axge, 0, iobuf->data, iob_len ( iobuf ) ); | |
| rc = -EINVAL; | |
| goto error; | |
| } | |
| /* Parse ftr, strip ftr and descriptors */ | |
| iob_unput ( iobuf, sizeof ( *ftr ) ); | |
| ftr = ( iobuf->data + iob_len ( iobuf ) ); | |
| count = le16_to_cpu ( ftr->count ); | |
| if ( count == 0 ) { | |
| DBGC ( axge, "AXGE %p zero-packet bulk IN:\n", axge ); | |
| DBGC_HDA ( axge, 0, iobuf->data, iob_len ( iobuf ) ); | |
| goto ignore; | |
| } | |
| offset = le16_to_cpu ( ftr->offset ); | |
| if ( ( iob_len ( iobuf ) < offset ) || | |
| ( ( iob_len ( iobuf ) - offset ) < ( count * sizeof ( *desc ) ) )){ | |
| DBGC ( axge, "AXGE %p malformed bulk IN footer:\n", axge ); | |
| DBGC_HDA ( axge, 0, iobuf->data, iob_len ( iobuf ) ); | |
| rc = -EINVAL; | |
| goto error; | |
| } | |
| desc = ( iobuf->data + offset ); | |
| iob_unput ( iobuf, ( iob_len ( iobuf ) - offset ) ); | |
| /* Process packets */ | |
| for ( ; count-- ; desc++ ) { | |
| /* Parse descriptor */ | |
| len = ( le16_to_cpu ( desc->len_flags ) & AXGE_RX_LEN_MASK ); | |
| padded_len = ( ( len + AXGE_RX_LEN_PAD_ALIGN - 1 ) & | |
| ~( AXGE_RX_LEN_PAD_ALIGN - 1 ) ); | |
| if ( iob_len ( iobuf ) < padded_len ) { | |
| DBGC ( axge, "AXGE %p malformed bulk IN descriptor:\n", | |
| axge ); | |
| DBGC_HDA ( axge, 0, iobuf->data, iob_len ( iobuf ) ); | |
| rc = -EINVAL; | |
| goto error; | |
| } | |
| /* Check for previous dropped packets */ | |
| if ( desc->len_flags & cpu_to_le16 ( AXGE_RX_CRC_ERROR ) ) | |
| netdev_rx_err ( netdev, NULL, -EIO ); | |
| if ( desc->len_flags & cpu_to_le16 ( AXGE_RX_DROP_ERROR ) ) | |
| netdev_rx_err ( netdev, NULL, -ENOBUFS ); | |
| /* Allocate new I/O buffer, if applicable */ | |
| if ( count ) { | |
| /* More packets remain: allocate a new buffer */ | |
| pkt = alloc_iob ( AXGE_IN_RESERVE + len ); | |
| if ( ! pkt ) { | |
| /* Record error and continue */ | |
| netdev_rx_err ( netdev, NULL, -ENOMEM ); | |
| iob_pull ( iobuf, padded_len ); | |
| continue; | |
| } | |
| iob_reserve ( pkt, AXGE_IN_RESERVE ); | |
| memcpy ( iob_put ( pkt, len ), iobuf->data, len ); | |
| iob_pull ( iobuf, padded_len ); | |
| } else { | |
| /* This is the last (or only) packet: use this buffer */ | |
| iob_unput ( iobuf, ( padded_len - len ) ); | |
| pkt = iob_disown ( iobuf ); | |
| } | |
| /* Hand off to network stack */ | |
| netdev_rx ( netdev, iob_disown ( pkt ) ); | |
| } | |
| assert ( iobuf == NULL ); | |
| profile_stop ( &axge_in_profiler ); | |
| return; | |
| error: | |
| netdev_rx_err ( netdev, iob_disown ( iobuf ), rc ); | |
| ignore: | |
| free_iob ( iobuf ); | |
| } | |
| /** Bulk IN endpoint operations */ | |
| static struct usb_endpoint_driver_operations axge_in_operations = { | |
| .complete = axge_in_complete, | |
| }; | |
| /** | |
| * Transmit packet | |
| * | |
| * @v asix AXGE device | |
| * @v iobuf I/O buffer | |
| * @ret rc Return status code | |
| */ | |
| static int axge_out_transmit ( struct axge_device *axge, | |
| struct io_buffer *iobuf ) { | |
| struct axge_tx_header *hdr; | |
| size_t len = iob_len ( iobuf ); | |
| int rc; | |
| /* Profile transmissions */ | |
| profile_start ( &axge_out_profiler ); | |
| /* Prepend header */ | |
| if ( ( rc = iob_ensure_headroom ( iobuf, sizeof ( *hdr ) ) ) != 0 ) | |
| return rc; | |
| hdr = iob_push ( iobuf, sizeof ( *hdr ) ); | |
| hdr->len = cpu_to_le32 ( len ); | |
| hdr->wtf = 0; | |
| /* Enqueue I/O buffer */ | |
| if ( ( rc = usb_stream ( &axge->usbnet.out, iobuf, 0 ) ) != 0 ) | |
| return rc; | |
| profile_stop ( &axge_out_profiler ); | |
| return 0; | |
| } | |
| /** | |
| * Complete bulk OUT transfer | |
| * | |
| * @v ep USB endpoint | |
| * @v iobuf I/O buffer | |
| * @v rc Completion status code | |
| */ | |
| static void axge_out_complete ( struct usb_endpoint *ep, | |
| struct io_buffer *iobuf, int rc ) { | |
| struct axge_device *axge = container_of ( ep, struct axge_device, | |
| usbnet.out ); | |
| struct net_device *netdev = axge->netdev; | |
| /* Report TX completion */ | |
| netdev_tx_complete_err ( netdev, iobuf, rc ); | |
| } | |
| /** Bulk OUT endpoint operations */ | |
| static struct usb_endpoint_driver_operations axge_out_operations = { | |
| .complete = axge_out_complete, | |
| }; | |
| /****************************************************************************** | |
| * | |
| * Network device interface | |
| * | |
| ****************************************************************************** | |
| */ | |
| /** | |
| * Open network device | |
| * | |
| * @v netdev Network device | |
| * @ret rc Return status code | |
| */ | |
| static int axge_open ( struct net_device *netdev ) { | |
| struct axge_device *axge = netdev->priv; | |
| uint16_t rcr; | |
| int rc; | |
| /* Reapply device configuration to avoid transaction errors */ | |
| if ( ( rc = usb_set_configuration ( axge->usb, axge->config ) ) != 0 ) { | |
| DBGC ( axge, "AXGE %p could not set configuration: %s\n", | |
| axge, strerror ( rc ) ); | |
| goto err_set_configuration; | |
| } | |
| /* Open USB network device */ | |
| if ( ( rc = usbnet_open ( &axge->usbnet ) ) != 0 ) { | |
| DBGC ( axge, "AXGE %p could not open: %s\n", | |
| axge, strerror ( rc ) ); | |
| goto err_open; | |
| } | |
| /* Set MAC address */ | |
| if ( ( rc = axge_write_register ( axge, AXGE_NIDR, | |
| netdev->ll_addr, ETH_ALEN ) ) !=0){ | |
| DBGC ( axge, "AXGE %p could not set MAC address: %s\n", | |
| axge, strerror ( rc ) ); | |
| goto err_write_mac; | |
| } | |
| /* Enable receiver */ | |
| rcr = cpu_to_le16 ( AXGE_RCR_PRO | AXGE_RCR_AMALL | | |
| AXGE_RCR_AB | AXGE_RCR_SO ); | |
| if ( ( rc = axge_write_word ( axge, AXGE_RCR, rcr ) ) != 0 ) { | |
| DBGC ( axge, "AXGE %p could not write RCR: %s\n", | |
| axge, strerror ( rc ) ); | |
| goto err_write_rcr; | |
| } | |
| /* Update link status */ | |
| if ( ( rc = axge_check_link ( axge ) ) != 0 ) | |
| goto err_check_link; | |
| return 0; | |
| err_check_link: | |
| axge_write_word ( axge, AXGE_RCR, 0 ); | |
| err_write_rcr: | |
| err_write_mac: | |
| usbnet_close ( &axge->usbnet ); | |
| err_open: | |
| err_set_configuration: | |
| return rc; | |
| } | |
| /** | |
| * Close network device | |
| * | |
| * @v netdev Network device | |
| */ | |
| static void axge_close ( struct net_device *netdev ) { | |
| struct axge_device *axge = netdev->priv; | |
| /* Disable receiver */ | |
| axge_write_word ( axge, AXGE_RCR, 0 ); | |
| /* Close USB network device */ | |
| usbnet_close ( &axge->usbnet ); | |
| } | |
| /** | |
| * Transmit packet | |
| * | |
| * @v netdev Network device | |
| * @v iobuf I/O buffer | |
| * @ret rc Return status code | |
| */ | |
| static int axge_transmit ( struct net_device *netdev, | |
| struct io_buffer *iobuf ) { | |
| struct axge_device *axge = netdev->priv; | |
| int rc; | |
| /* Transmit packet */ | |
| if ( ( rc = axge_out_transmit ( axge, iobuf ) ) != 0 ) | |
| return rc; | |
| return 0; | |
| } | |
| /** | |
| * Poll for completed and received packets | |
| * | |
| * @v netdev Network device | |
| */ | |
| static void axge_poll ( struct net_device *netdev ) { | |
| struct axge_device *axge = netdev->priv; | |
| int rc; | |
| /* Poll USB bus */ | |
| usb_poll ( axge->bus ); | |
| /* Refill endpoints */ | |
| if ( ( rc = usbnet_refill ( &axge->usbnet ) ) != 0 ) | |
| netdev_rx_err ( netdev, NULL, rc ); | |
| /* Update link state, if applicable */ | |
| if ( axge->check_link ) { | |
| if ( ( rc = axge_check_link ( axge ) ) == 0 ) { | |
| axge->check_link = 0; | |
| } else { | |
| netdev_rx_err ( netdev, NULL, rc ); | |
| } | |
| } | |
| } | |
| /** AXGE network device operations */ | |
| static struct net_device_operations axge_operations = { | |
| .open = axge_open, | |
| .close = axge_close, | |
| .transmit = axge_transmit, | |
| .poll = axge_poll, | |
| }; | |
| /****************************************************************************** | |
| * | |
| * USB interface | |
| * | |
| ****************************************************************************** | |
| */ | |
| /** | |
| * Probe device | |
| * | |
| * @v func USB function | |
| * @v config Configuration descriptor | |
| * @ret rc Return status code | |
| */ | |
| static int axge_probe ( struct usb_function *func, | |
| struct usb_configuration_descriptor *config ) { | |
| struct usb_device *usb = func->usb; | |
| struct net_device *netdev; | |
| struct axge_device *axge; | |
| uint16_t epprcr; | |
| uint8_t csr; | |
| int rc; | |
| /* Allocate and initialise structure */ | |
| netdev = alloc_etherdev ( sizeof ( *axge ) ); | |
| if ( ! netdev ) { | |
| rc = -ENOMEM; | |
| goto err_alloc; | |
| } | |
| netdev_init ( netdev, &axge_operations ); | |
| netdev->dev = &func->dev; | |
| axge = netdev->priv; | |
| memset ( axge, 0, sizeof ( *axge ) ); | |
| axge->usb = usb; | |
| axge->bus = usb->port->hub->bus; | |
| axge->netdev = netdev; | |
| axge->config = config->config; | |
| usbnet_init ( &axge->usbnet, func, &axge_intr_operations, | |
| &axge_in_operations, &axge_out_operations ); | |
| usb_refill_init ( &axge->usbnet.intr, 0, 0, AXGE_INTR_MAX_FILL ); | |
| usb_refill_init ( &axge->usbnet.in, AXGE_IN_RESERVE, | |
| AXGE_IN_MTU, AXGE_IN_MAX_FILL ); | |
| DBGC ( axge, "AXGE %p on %s\n", axge, func->name ); | |
| /* Describe USB network device */ | |
| if ( ( rc = usbnet_describe ( &axge->usbnet, config ) ) != 0 ) { | |
| DBGC ( axge, "AXGE %p could not describe: %s\n", | |
| axge, strerror ( rc ) ); | |
| goto err_describe; | |
| } | |
| /* Fetch MAC address */ | |
| if ( ( rc = axge_read_register ( axge, AXGE_NIDR, netdev->hw_addr, | |
| ETH_ALEN ) ) != 0 ) { | |
| DBGC ( axge, "AXGE %p could not fetch MAC address: %s\n", | |
| axge, strerror ( rc ) ); | |
| goto err_read_mac; | |
| } | |
| /* Power up PHY */ | |
| if ( ( rc = axge_write_word ( axge, AXGE_EPPRCR, 0 ) ) != 0 ) { | |
| DBGC ( axge, "AXGE %p could not write EPPRCR: %s\n", | |
| axge, strerror ( rc ) ); | |
| goto err_write_epprcr_off; | |
| } | |
| epprcr = cpu_to_le16 ( AXGE_EPPRCR_IPRL ); | |
| if ( ( rc = axge_write_word ( axge, AXGE_EPPRCR, epprcr ) ) != 0){ | |
| DBGC ( axge, "AXGE %p could not write EPPRCR: %s\n", | |
| axge, strerror ( rc ) ); | |
| goto err_write_epprcr_on; | |
| } | |
| mdelay ( AXGE_EPPRCR_DELAY_MS ); | |
| /* Select clocks */ | |
| csr = ( AXGE_CSR_BCS | AXGE_CSR_ACS ); | |
| if ( ( rc = axge_write_byte ( axge, AXGE_CSR, csr ) ) != 0){ | |
| DBGC ( axge, "AXGE %p could not write CSR: %s\n", | |
| axge, strerror ( rc ) ); | |
| goto err_write_csr; | |
| } | |
| mdelay ( AXGE_CSR_DELAY_MS ); | |
| /* Configure bulk IN pipeline */ | |
| if ( ( rc = axge_write_register ( axge, AXGE_BICR, &axge_bicr, | |
| sizeof ( axge_bicr ) ) ) != 0 ){ | |
| DBGC ( axge, "AXGE %p could not write BICR: %s\n", | |
| axge, strerror ( rc ) ); | |
| goto err_write_bicr; | |
| } | |
| /* Register network device */ | |
| if ( ( rc = register_netdev ( netdev ) ) != 0 ) | |
| goto err_register; | |
| /* Update link status */ | |
| if ( ( rc = axge_check_link ( axge ) ) != 0 ) | |
| goto err_check_link; | |
| usb_func_set_drvdata ( func, axge ); | |
| return 0; | |
| err_check_link: | |
| unregister_netdev ( netdev ); | |
| err_register: | |
| err_write_bicr: | |
| err_write_csr: | |
| err_write_epprcr_on: | |
| err_write_epprcr_off: | |
| err_read_mac: | |
| err_describe: | |
| netdev_nullify ( netdev ); | |
| netdev_put ( netdev ); | |
| err_alloc: | |
| return rc; | |
| } | |
| /** | |
| * Remove device | |
| * | |
| * @v func USB function | |
| */ | |
| static void axge_remove ( struct usb_function *func ) { | |
| struct axge_device *axge = usb_func_get_drvdata ( func ); | |
| struct net_device *netdev = axge->netdev; | |
| unregister_netdev ( netdev ); | |
| netdev_nullify ( netdev ); | |
| netdev_put ( netdev ); | |
| } | |
| /** AXGE device IDs */ | |
| static struct usb_device_id axge_ids[] = { | |
| USB_ROM ( 0x0b95, 0x1790, "ax88179", "AX88179", 0 ), | |
| USB_ROM ( 0x0b95, 0x178a, "ax88178a", "AX88178A", 0 ), | |
| USB_ROM ( 0x2001, 0x4a00, "dub1312", "DUB-1312", 0 ), | |
| USB_ROM ( 0x0df6, 0x0072, "axge-sitecom", "AX88179 (Sitecom)", 0 ), | |
| USB_ROM ( 0x04e8, 0xa100, "axge-samsung", "AX88179 (Samsung)", 0 ), | |
| USB_ROM ( 0x17ef, 0x304b, "onelinkdock", "ThinkPad OneLink dock", 0 ), | |
| }; | |
| /** AXGE driver */ | |
| struct usb_driver axge_driver __usb_driver = { | |
| .ids = axge_ids, | |
| .id_count = ( sizeof ( axge_ids ) / sizeof ( axge_ids[0] ) ), | |
| .class = USB_CLASS_ID ( USB_ANY_ID, USB_ANY_ID, USB_ANY_ID ), | |
| .score = USB_SCORE_NORMAL, | |
| .probe = axge_probe, | |
| .remove = axge_remove, | |
| }; |