| Start/ | End/ | |||
| True | False | - | Line | Source |
| 1 | /* | |||
| 2 | * ASIX AX8817X based USB 2.0 Ethernet Devices | |||
| 3 | * Copyright (C) 2003-2005 David Hollis <dhollis@davehollis.com> | |||
| 4 | * Copyright (C) 2005 Phil Chang <pchang23@sbcglobal.net> | |||
| 5 | * Copyright (c) 2002-2003 TiVo Inc. | |||
| 6 | * | |||
| 7 | * This program is free software; you can redistribute it and/or modify | |||
| 8 | * it under the terms of the GNU General Public License as published by | |||
| 9 | * the Free Software Foundation; either version 2 of the License, or | |||
| 10 | * (at your option) any later version. | |||
| 11 | * | |||
| 12 | * This program is distributed in the hope that it will be useful, | |||
| 13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |||
| 14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |||
| 15 | * GNU General Public License for more details. | |||
| 16 | * | |||
| 17 | * You should have received a copy of the GNU General Public License | |||
| 18 | * along with this program; if not, write to the Free Software | |||
| 19 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |||
| 20 | */ | |||
| 21 | ||||
| 22 | // #define DEBUG // error path messages, extra info | |||
| 23 | // #define VERBOSE // more; success messages | |||
| 24 | ||||
| 25 | #include <linux/config.h> | |||
| 26 | #include <linux/module.h> | |||
| 27 | #include <linux/kmod.h> | |||
| 28 | #include <linux/sched.h> | |||
| 29 | #include <linux/init.h> | |||
| 30 | #include <linux/netdevice.h> | |||
| 31 | #include <linux/etherdevice.h> | |||
| 32 | #include <linux/ethtool.h> | |||
| 33 | #include <linux/workqueue.h> | |||
| 34 | #include <linux/mii.h> | |||
| 35 | #include <linux/usb.h> | |||
| 36 | #include <linux/crc32.h> | |||
| 37 | ||||
| 38 | #include "usbnet.h" | |||
| 39 | ||||
| 40 | ||||
| 41 | /* ASIX AX8817X based USB 2.0 Ethernet Devices */ | |||
| 42 | ||||
| 43 | #define AX_CMD_SET_SW_MII 0x06 | |||
| 44 | #define AX_CMD_READ_MII_REG 0x07 | |||
| 45 | #define AX_CMD_WRITE_MII_REG 0x08 | |||
| 46 | #define AX_CMD_SET_HW_MII 0x0a | |||
| 47 | #define AX_CMD_READ_EEPROM 0x0b | |||
| 48 | #define AX_CMD_WRITE_EEPROM 0x0c | |||
| 49 | #define AX_CMD_WRITE_ENABLE 0x0d | |||
| 50 | #define AX_CMD_WRITE_DISABLE 0x0e | |||
| 51 | #define AX_CMD_WRITE_RX_CTL 0x10 | |||
| 52 | #define AX_CMD_READ_IPG012 0x11 | |||
| 53 | #define AX_CMD_WRITE_IPG0 0x12 | |||
| 54 | #define AX_CMD_WRITE_IPG1 0x13 | |||
| 55 | #define AX_CMD_WRITE_IPG2 0x14 | |||
| 56 | #define AX_CMD_WRITE_MULTI_FILTER 0x16 | |||
| 57 | #define AX_CMD_READ_NODE_ID 0x17 | |||
| 58 | #define AX_CMD_READ_PHY_ID 0x19 | |||
| 59 | #define AX_CMD_READ_MEDIUM_STATUS 0x1a | |||
| 60 | #define AX_CMD_WRITE_MEDIUM_MODE 0x1b | |||
| 61 | #define AX_CMD_READ_MONITOR_MODE 0x1c | |||
| 62 | #define AX_CMD_WRITE_MONITOR_MODE 0x1d | |||
| 63 | #define AX_CMD_WRITE_GPIOS 0x1f | |||
| 64 | #define AX_CMD_SW_RESET 0x20 | |||
| 65 | #define AX_CMD_SW_PHY_STATUS 0x21 | |||
| 66 | #define AX_CMD_SW_PHY_SELECT 0x22 | |||
| 67 | #define AX88772_CMD_READ_NODE_ID 0x13 | |||
| 68 | ||||
| 69 | #define AX_MONITOR_MODE 0x01 | |||
| 70 | #define AX_MONITOR_LINK 0x02 | |||
| 71 | #define AX_MONITOR_MAGIC 0x04 | |||
| 72 | #define AX_MONITOR_HSFS 0x10 | |||
| 73 | ||||
| 74 | /* AX88172 Medium Status Register values */ | |||
| 75 | #define AX_MEDIUM_FULL_DUPLEX 0x02 | |||
| 76 | #define AX_MEDIUM_TX_ABORT_ALLOW 0x04 | |||
| 77 | #define AX_MEDIUM_FLOW_CONTROL_EN 0x10 | |||
| 78 | ||||
| 79 | #define AX_MCAST_FILTER_SIZE 8 | |||
| 80 | #define AX_MAX_MCAST 64 | |||
| 81 | ||||
| 82 | #define AX_EEPROM_LEN 0x40 | |||
| 83 | ||||
| 84 | #define AX_SWRESET_CLEAR 0x00 | |||
| 85 | #define AX_SWRESET_RR 0x01 | |||
| 86 | #define AX_SWRESET_RT 0x02 | |||
| 87 | #define AX_SWRESET_PRTE 0x04 | |||
| 88 | #define AX_SWRESET_PRL 0x08 | |||
| 89 | #define AX_SWRESET_BZ 0x10 | |||
| 90 | #define AX_SWRESET_IPRL 0x20 | |||
| 91 | #define AX_SWRESET_IPPD 0x40 | |||
| 92 | ||||
| 93 | #define AX88772_IPG0_DEFAULT 0x15 | |||
| 94 | #define AX88772_IPG1_DEFAULT 0x0c | |||
| 95 | #define AX88772_IPG2_DEFAULT 0x12 | |||
| 96 | ||||
| 97 | #define AX88772_MEDIUM_FULL_DUPLEX 0x0002 | |||
| 98 | #define AX88772_MEDIUM_RESERVED 0x0004 | |||
| 99 | #define AX88772_MEDIUM_RX_FC_ENABLE 0x0010 | |||
| 100 | #define AX88772_MEDIUM_TX_FC_ENABLE 0x0020 | |||
| 101 | #define AX88772_MEDIUM_PAUSE_FORMAT 0x0080 | |||
| 102 | #define AX88772_MEDIUM_RX_ENABLE 0x0100 | |||
| 103 | #define AX88772_MEDIUM_100MB 0x0200 | |||
| 104 | #define AX88772_MEDIUM_DEFAULT \ | |||
| 105 | (AX88772_MEDIUM_FULL_DUPLEX | AX88772_MEDIUM_RX_FC_ENABLE | \ | |||
| 106 | AX88772_MEDIUM_TX_FC_ENABLE | AX88772_MEDIUM_100MB | \ | |||
| 107 | AX88772_MEDIUM_RESERVED | AX88772_MEDIUM_RX_ENABLE ) | |||
| 108 | ||||
| 109 | #define AX_EEPROM_MAGIC 0xdeadbeef | |||
| 110 | ||||
| 111 | /* This structure cannot exceed sizeof(unsigned long [5]) AKA 20 bytes */ | |||
| 112 | struct ax8817x_data { | |||
| 113 | u8 multi_filter[AX_MCAST_FILTER_SIZE]; | |||
| 114 | }; | |||
| 115 | ||||
| 116 | struct ax88172_int_data { | |||
| 117 | u16 res1; | |||
| 118 | u8 link; | |||
| 119 | u16 res2; | |||
| 120 | u8 status; | |||
| 121 | u16 res3; | |||
| 122 | } __attribute__ ((packed)); | |||
| 123 | ||||
| 0 | 0 | - | 124 | static int ax8817x_read_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index, |
| 125 | u16 size, void *data) | |||
| 126 | { | |||
| 127 | return usb_control_msg( | |||
| 128 | dev->udev, | |||
| 129 | usb_rcvctrlpipe(dev->udev, 0), | |||
| 130 | cmd, | |||
| 131 | USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE, | |||
| 132 | value, | |||
| 133 | index, | |||
| 134 | data, | |||
| 135 | size, | |||
| 0 | - | 136 | USB_CTRL_GET_TIMEOUT); | |
| 137 | } | |||
| 138 | ||||
| 0 | 0 | - | 139 | static int ax8817x_write_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index, |
| 140 | u16 size, void *data) | |||
| 141 | { | |||
| 142 | return usb_control_msg( | |||
| 143 | dev->udev, | |||
| 144 | usb_sndctrlpipe(dev->udev, 0), | |||
| 145 | cmd, | |||
| 146 | USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE, | |||
| 147 | value, | |||
| 148 | index, | |||
| 149 | data, | |||
| 150 | size, | |||
| 0 | - | 151 | USB_CTRL_SET_TIMEOUT); | |
| 152 | } | |||
| 153 | ||||
| 0 | 0 | - | 154 | static void ax8817x_async_cmd_callback(struct urb *urb, struct pt_regs *regs) |
| 155 | { | |||
| 156 | struct usb_ctrlrequest *req = (struct usb_ctrlrequest *)urb->context; | |||
| 157 | ||||
| 0 | 0 | - | 158 | if (urb->status < 0) |
| 159 | printk(KERN_DEBUG "ax8817x_async_cmd_callback() failed with %d", | |||
| 160 | urb->status); | |||
| 161 | ||||
| 162 | kfree(req); | |||
| 163 | usb_free_urb(urb); | |||
| 164 | } | |||
| 165 | ||||
| 0 | 0 | - | 166 | static void ax8817x_status(struct usbnet *dev, struct urb *urb) |
| 167 | { | |||
| 168 | struct ax88172_int_data *event; | |||
| 169 | int link; | |||
| 170 | ||||
| 0 | 0 | - | 171 | if (urb->actual_length < 8) |
| 0 | - | 172 | return; | |
| 173 | ||||
| 174 | event = urb->transfer_buffer; | |||
| 175 | link = event->link & 0x01; | |||
| 0 | 0 | - | 176 | if (netif_carrier_ok(dev->net) != link) { |
| 0 | 0 | - | 177 | if (link) { |
| 178 | netif_carrier_on(dev->net); | |||
| 179 | usbnet_defer_kevent (dev, EVENT_LINK_RESET ); | |||
| 180 | } else | |||
| 181 | netif_carrier_off(dev->net); | |||
| 182 | devdbg(dev, "ax8817x - Link Status is: %d", link); | |||
| 183 | } | |||
| 184 | } | |||
| 185 | ||||
| 186 | static void | |||
| 0 | 0 | - | 187 | ax8817x_write_cmd_async(struct usbnet *dev, u8 cmd, u16 value, u16 index, |
| 188 | u16 size, void *data) | |||
| 189 | { | |||
| 190 | struct usb_ctrlrequest *req; | |||
| 191 | int status; | |||
| 192 | struct urb *urb; | |||
| 193 | ||||
| 0 | 0 | - | 194 | if ((urb = usb_alloc_urb(0, GFP_ATOMIC)) == NULL) { |
| 195 | devdbg(dev, "Error allocating URB in write_cmd_async!"); | |||
| 0 | - | 196 | return; | |
| 197 | } | |||
| 198 | ||||
| 0 | 0 | - | 199 | if ((req = kmalloc(sizeof(struct usb_ctrlrequest), GFP_ATOMIC)) == NULL) { |
| 200 | deverr(dev, "Failed to allocate memory for control request"); | |||
| 201 | usb_free_urb(urb); | |||
| 0 | - | 202 | return; | |
| 203 | } | |||
| 204 | ||||
| 205 | req->bRequestType = USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE; | |||
| 206 | req->bRequest = cmd; | |||
| 207 | req->wValue = cpu_to_le16(value); | |||
| 208 | req->wIndex = cpu_to_le16(index); | |||
| 209 | req->wLength = cpu_to_le16(size); | |||
| 210 | ||||
| 211 | usb_fill_control_urb(urb, dev->udev, | |||
| 212 | usb_sndctrlpipe(dev->udev, 0), | |||
| 213 | (void *)req, data, size, | |||
| 214 | ax8817x_async_cmd_callback, req); | |||
| 215 | ||||
| 0 | 0 | - | 216 | if((status = usb_submit_urb(urb, GFP_ATOMIC)) < 0) { |
| 217 | deverr(dev, "Error submitting the control message: status=%d", | |||
| 218 | status); | |||
| 219 | kfree(req); | |||
| 220 | usb_free_urb(urb); | |||
| 221 | } | |||
| 222 | } | |||
| 223 | ||||
| 0 | 0 | - | 224 | static void ax8817x_set_multicast(struct net_device *net) |
| 225 | { | |||
| 226 | struct usbnet *dev = netdev_priv(net); | |||
| 227 | struct ax8817x_data *data = (struct ax8817x_data *)&dev->data; | |||
| 228 | u8 rx_ctl = 0x8c; | |||
| 229 | ||||
| 0 | 0 | - | 230 | if (net->flags & IFF_PROMISC) { |
| 231 | rx_ctl |= 0x01; | |||
| 232 | } else if (net->flags & IFF_ALLMULTI | |||
| 0 | 0 | - | 233 | || net->mc_count > AX_MAX_MCAST) { |
| 0 | - | 233 | T || _ | |
| 0 | - | 233 | F || T | |
| 0 | - | 233 | F || F | |
| 234 | rx_ctl |= 0x02; | |||
| 0 | 0 | - | 235 | } else if (net->mc_count == 0) { |
| 236 | /* just broadcast and directed */ | |||
| 237 | } else { | |||
| 238 | /* We use the 20 byte dev->data | |||
| 239 | * for our 8 byte filter buffer | |||
| 240 | * to avoid allocating memory that | |||
| 241 | * is tricky to free later */ | |||
| 242 | struct dev_mc_list *mc_list = net->mc_list; | |||
| 243 | u32 crc_bits; | |||
| 244 | int i; | |||
| 245 | ||||
| 246 | memset(data->multi_filter, 0, AX_MCAST_FILTER_SIZE); | |||
| 247 | ||||
| 248 | /* Build the multicast hash filter. */ | |||
| 0 | 0 | - | 249 | for (i = 0; i < net->mc_count; i++) { |
| 250 | crc_bits = | |||
| 251 | ether_crc(ETH_ALEN, | |||
| 252 | mc_list->dmi_addr) >> 26; | |||
| 253 | data->multi_filter[crc_bits >> 3] |= | |||
| 254 | 1 << (crc_bits & 7); | |||
| 255 | mc_list = mc_list->next; | |||
| 256 | } | |||
| 257 | ||||
| 258 | ax8817x_write_cmd_async(dev, AX_CMD_WRITE_MULTI_FILTER, 0, 0, | |||
| 259 | AX_MCAST_FILTER_SIZE, data->multi_filter); | |||
| 260 | ||||
| 261 | rx_ctl |= 0x10; | |||
| 262 | } | |||
| 263 | ||||
| 264 | ax8817x_write_cmd_async(dev, AX_CMD_WRITE_RX_CTL, rx_ctl, 0, 0, NULL); | |||
| 265 | } | |||
| 266 | ||||
| 0 | 0 | - | 267 | static int ax8817x_mdio_read(struct net_device *netdev, int phy_id, int loc) |
| 268 | { | |||
| 269 | struct usbnet *dev = netdev_priv(netdev); | |||
| 270 | u16 res; | |||
| 271 | u8 buf[1]; | |||
| 272 | ||||
| 273 | ax8817x_write_cmd(dev, AX_CMD_SET_SW_MII, 0, 0, 0, &buf); | |||
| 274 | ax8817x_read_cmd(dev, AX_CMD_READ_MII_REG, phy_id, | |||
| 275 | (__u16)loc, 2, (u16 *)&res); | |||
| 276 | ax8817x_write_cmd(dev, AX_CMD_SET_HW_MII, 0, 0, 0, &buf); | |||
| 277 | ||||
| 0 | - | 278 | return res & 0xffff; | |
| 279 | } | |||
| 280 | ||||
| 281 | /* same as above, but converts resulting value to cpu byte order */ | |||
| 0 | 0 | - | 282 | static int ax8817x_mdio_read_le(struct net_device *netdev, int phy_id, int loc) |
| 283 | { | |||
| 0 | - | 284 | return le16_to_cpu(ax8817x_mdio_read(netdev,phy_id, loc)); | |
| 285 | } | |||
| 286 | ||||
| 287 | static void | |||
| 0 | 0 | - | 288 | ax8817x_mdio_write(struct net_device *netdev, int phy_id, int loc, int val) |
| 289 | { | |||
| 290 | struct usbnet *dev = netdev_priv(netdev); | |||
| 291 | u16 res = val; | |||
| 292 | u8 buf[1]; | |||
| 293 | ||||
| 294 | ax8817x_write_cmd(dev, AX_CMD_SET_SW_MII, 0, 0, 0, &buf); | |||
| 295 | ax8817x_write_cmd(dev, AX_CMD_WRITE_MII_REG, phy_id, | |||
| 296 | (__u16)loc, 2, (u16 *)&res); | |||
| 297 | ax8817x_write_cmd(dev, AX_CMD_SET_HW_MII, 0, 0, 0, &buf); | |||
| 298 | } | |||
| 299 | ||||
| 300 | /* same as above, but converts new value to le16 byte order before writing */ | |||
| 301 | static void | |||
| 0 | 0 | - | 302 | ax8817x_mdio_write_le(struct net_device *netdev, int phy_id, int loc, int val) |
| 303 | { | |||
| 304 | ax8817x_mdio_write( netdev, phy_id, loc, cpu_to_le16(val) ); | |||
| 305 | } | |||
| 306 | ||||
| 0 | 0 | - | 307 | static int ax88172_link_reset(struct usbnet *dev) |
| 308 | { | |||
| 309 | u16 lpa; | |||
| 310 | u16 adv; | |||
| 311 | u16 res; | |||
| 312 | u8 mode; | |||
| 313 | ||||
| 314 | mode = AX_MEDIUM_TX_ABORT_ALLOW | AX_MEDIUM_FLOW_CONTROL_EN; | |||
| 315 | lpa = ax8817x_mdio_read_le(dev->net, dev->mii.phy_id, MII_LPA); | |||
| 316 | adv = ax8817x_mdio_read_le(dev->net, dev->mii.phy_id, MII_ADVERTISE); | |||
| 317 | res = mii_nway_result(lpa|adv); | |||
| 0 | 0 | - | 318 | if (res & LPA_DUPLEX) |
| 319 | mode |= AX_MEDIUM_FULL_DUPLEX; | |||
| 320 | ax8817x_write_cmd(dev, AX_CMD_WRITE_MEDIUM_MODE, mode, 0, 0, NULL); | |||
| 321 | ||||
| 0 | - | 322 | return 0; | |
| 323 | } | |||
| 324 | ||||
| 325 | static void | |||
| 0 | 0 | - | 326 | ax8817x_get_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo) |
| 327 | { | |||
| 328 | struct usbnet *dev = netdev_priv(net); | |||
| 329 | u8 opt; | |||
| 330 | ||||
| 0 | 0 | - | 331 | if (ax8817x_read_cmd(dev, AX_CMD_READ_MONITOR_MODE, 0, 0, 1, &opt) < 0) { |
| 332 | wolinfo->supported = 0; | |||
| 333 | wolinfo->wolopts = 0; | |||
| 0 | - | 334 | return; | |
| 335 | } | |||
| 336 | wolinfo->supported = WAKE_PHY | WAKE_MAGIC; | |||
| 337 | wolinfo->wolopts = 0; | |||
| 0 | 0 | - | 338 | if (opt & AX_MONITOR_MODE) { |
| 0 | 0 | - | 339 | if (opt & AX_MONITOR_LINK) |
| 340 | wolinfo->wolopts |= WAKE_PHY; | |||
| 0 | 0 | - | 341 | if (opt & AX_MONITOR_MAGIC) |
| 342 | wolinfo->wolopts |= WAKE_MAGIC; | |||
| 343 | } | |||
| 344 | } | |||
| 345 | ||||
| 346 | static int | |||
| 0 | 0 | - | 347 | ax8817x_set_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo) |
| 348 | { | |||
| 349 | struct usbnet *dev = netdev_priv(net); | |||
| 350 | u8 opt = 0; | |||
| 351 | u8 buf[1]; | |||
| 352 | ||||
| 0 | 0 | - | 353 | if (wolinfo->wolopts & WAKE_PHY) |
| 354 | opt |= AX_MONITOR_LINK; | |||
| 0 | 0 | - | 355 | if (wolinfo->wolopts & WAKE_MAGIC) |
| 356 | opt |= AX_MONITOR_MAGIC; | |||
| 0 | 0 | - | 357 | if (opt != 0) |
| 358 | opt |= AX_MONITOR_MODE; | |||
| 359 | ||||
| 360 | if (ax8817x_write_cmd(dev, AX_CMD_WRITE_MONITOR_MODE, | |||
| 0 | 0 | - | 361 | opt, 0, 0, &buf) < 0) |
| 0 | - | 362 | return -EINVAL; | |
| 363 | ||||
| 0 | - | 364 | return 0; | |
| 365 | } | |||
| 366 | ||||
| 0 | 0 | - | 367 | static int ax8817x_get_eeprom_len(struct net_device *net) |
| 368 | { | |||
| 0 | - | 369 | return AX_EEPROM_LEN; | |
| 370 | } | |||
| 371 | ||||
| 0 | 0 | - | 372 | static int ax8817x_get_eeprom(struct net_device *net, |
| 373 | struct ethtool_eeprom *eeprom, u8 *data) | |||
| 374 | { | |||
| 375 | struct usbnet *dev = netdev_priv(net); | |||
| 376 | u16 *ebuf = (u16 *)data; | |||
| 377 | int i; | |||
| 378 | ||||
| 379 | /* Crude hack to ensure that we don't overwrite memory | |||
| 380 | * if an odd length is supplied | |||
| 381 | */ | |||
| 0 | 0 | - | 382 | if (eeprom->len % 2) |
| 0 | - | 383 | return -EINVAL; | |
| 384 | ||||
| 385 | eeprom->magic = AX_EEPROM_MAGIC; | |||
| 386 | ||||
| 387 | /* ax8817x returns 2 bytes from eeprom on read */ | |||
| 0 | 0 | - | 388 | for (i=0; i < eeprom->len / 2; i++) { |
| 389 | if (ax8817x_read_cmd(dev, AX_CMD_READ_EEPROM, | |||
| 0 | 0 | - | 390 | eeprom->offset + i, 0, 2, &ebuf[i]) < 0) |
| 0 | - | 391 | return -EINVAL; | |
| 392 | } | |||
| 0 | - | 393 | return 0; | |
| 394 | } | |||
| 395 | ||||
| 0 | 0 | - | 396 | static void ax8817x_get_drvinfo (struct net_device *net, |
| 397 | struct ethtool_drvinfo *info) | |||
| 398 | { | |||
| 399 | /* Inherit standard device info */ | |||
| 400 | usbnet_get_drvinfo(net, info); | |||
| 401 | info->eedump_len = 0x3e; | |||
| 402 | } | |||
| 403 | ||||
| 0 | 0 | - | 404 | static int ax8817x_get_settings(struct net_device *net, struct ethtool_cmd *cmd) |
| 405 | { | |||
| 406 | struct usbnet *dev = netdev_priv(net); | |||
| 407 | ||||
| 0 | - | 408 | return mii_ethtool_gset(&dev->mii,cmd); | |
| 409 | } | |||
| 410 | ||||
| 0 | 0 | - | 411 | static int ax8817x_set_settings(struct net_device *net, struct ethtool_cmd *cmd) |
| 412 | { | |||
| 413 | struct usbnet *dev = netdev_priv(net); | |||
| 414 | ||||
| 0 | - | 415 | return mii_ethtool_sset(&dev->mii,cmd); | |
| 416 | } | |||
| 417 | ||||
| 418 | /* We need to override some ethtool_ops so we require our | |||
| 419 | own structure so we don't interfere with other usbnet | |||
| 420 | devices that may be connected at the same time. */ | |||
| 421 | static struct ethtool_ops ax8817x_ethtool_ops = { | |||
| 422 | .get_drvinfo = ax8817x_get_drvinfo, | |||
| 423 | .get_link = ethtool_op_get_link, | |||
| 424 | .get_msglevel = usbnet_get_msglevel, | |||
| 425 | .set_msglevel = usbnet_set_msglevel, | |||
| 426 | .get_wol = ax8817x_get_wol, | |||
| 427 | .set_wol = ax8817x_set_wol, | |||
| 428 | .get_eeprom_len = ax8817x_get_eeprom_len, | |||
| 429 | .get_eeprom = ax8817x_get_eeprom, | |||
| 430 | .get_settings = ax8817x_get_settings, | |||
| 431 | .set_settings = ax8817x_set_settings, | |||
| 432 | }; | |||
| 433 | ||||
| 0 | 0 | - | 434 | static int ax8817x_ioctl (struct net_device *net, struct ifreq *rq, int cmd) |
| 435 | { | |||
| 436 | struct usbnet *dev = netdev_priv(net); | |||
| 437 | ||||
| 0 | - | 438 | return generic_mii_ioctl(&dev->mii, if_mii(rq), cmd, NULL); | |
| 439 | } | |||
| 440 | ||||
| 0 | 0 | - | 441 | static int ax8817x_bind(struct usbnet *dev, struct usb_interface *intf) |
| 442 | { | |||
| 443 | int ret = 0; | |||
| 444 | void *buf; | |||
| 445 | int i; | |||
| 446 | unsigned long gpio_bits = dev->driver_info->data; | |||
| 447 | ||||
| 448 | usbnet_get_endpoints(dev,intf); | |||
| 449 | ||||
| 450 | buf = kmalloc(ETH_ALEN, GFP_KERNEL); | |||
| 0 | 0 | - | 451 | if(!buf) { |
| 452 | ret = -ENOMEM; | |||
| 0 | - | 453 | goto out1; | |
| 454 | } | |||
| 455 | ||||
| 456 | /* Toggle the GPIOs in a manufacturer/model specific way */ | |||
| 0 | 0 | - | 457 | for (i = 2; i >= 0; i--) { |
| 458 | if ((ret = ax8817x_write_cmd(dev, AX_CMD_WRITE_GPIOS, | |||
| 459 | (gpio_bits >> (i * 8)) & 0xff, 0, 0, | |||
| 0 | 0 | - | 460 | buf)) < 0) |
| 0 | - | 461 | goto out2; | |
| 462 | msleep(5); | |||
| 463 | } | |||
| 464 | ||||
| 465 | if ((ret = ax8817x_write_cmd(dev, AX_CMD_WRITE_RX_CTL, | |||
| 0 | 0 | - | 466 | 0x80, 0, 0, buf)) < 0) { |
| 467 | dbg("send AX_CMD_WRITE_RX_CTL failed: %d", ret); | |||
| 0 | - | 468 | goto out2; | |
| 469 | } | |||
| 470 | ||||
| 471 | /* Get the MAC address */ | |||
| 472 | memset(buf, 0, ETH_ALEN); | |||
| 473 | if ((ret = ax8817x_read_cmd(dev, AX_CMD_READ_NODE_ID, | |||
| 0 | 0 | - | 474 | 0, 0, 6, buf)) < 0) { |
| 475 | dbg("read AX_CMD_READ_NODE_ID failed: %d", ret); | |||
| 0 | - | 476 | goto out2; | |
| 477 | } | |||
| 478 | memcpy(dev->net->dev_addr, buf, ETH_ALEN); | |||
| 479 | ||||
| 480 | /* Get the PHY id */ | |||
| 481 | if ((ret = ax8817x_read_cmd(dev, AX_CMD_READ_PHY_ID, | |||
| 0 | 0 | - | 482 | 0, 0, 2, buf)) < 0) { |
| 483 | dbg("error on read AX_CMD_READ_PHY_ID: %02x", ret); | |||
| 0 | - | 484 | goto out2; | |
| 0 | 0 | - | 485 | } else if (ret < 2) { |
| 486 | /* this should always return 2 bytes */ | |||
| 487 | dbg("AX_CMD_READ_PHY_ID returned less than 2 bytes: ret=%02x", | |||
| 488 | ret); | |||
| 489 | ret = -EIO; | |||
| 0 | - | 490 | goto out2; | |
| 491 | } | |||
| 492 | ||||
| 493 | /* Initialize MII structure */ | |||
| 494 | dev->mii.dev = dev->net; | |||
| 495 | dev->mii.mdio_read = ax8817x_mdio_read; | |||
| 496 | dev->mii.mdio_write = ax8817x_mdio_write; | |||
| 497 | dev->mii.phy_id_mask = 0x3f; | |||
| 498 | dev->mii.reg_num_mask = 0x1f; | |||
| 499 | dev->mii.phy_id = *((u8 *)buf + 1); | |||
| 500 | dev->net->do_ioctl = ax8817x_ioctl; | |||
| 501 | ||||
| 502 | dev->net->set_multicast_list = ax8817x_set_multicast; | |||
| 503 | dev->net->ethtool_ops = &ax8817x_ethtool_ops; | |||
| 504 | ||||
| 505 | ax8817x_mdio_write_le(dev->net, dev->mii.phy_id, MII_BMCR, BMCR_RESET); | |||
| 506 | ax8817x_mdio_write_le(dev->net, dev->mii.phy_id, MII_ADVERTISE, | |||
| 507 | ADVERTISE_ALL | ADVERTISE_CSMA | ADVERTISE_PAUSE_CAP); | |||
| 508 | mii_nway_restart(&dev->mii); | |||
| 509 | ||||
| 0 | - | 510 | return 0; | |
| 511 | out2: | |||
| 512 | kfree(buf); | |||
| 513 | out1: | |||
| 0 | - | 514 | return ret; | |
| 515 | } | |||
| 516 | ||||
| 517 | static struct ethtool_ops ax88772_ethtool_ops = { | |||
| 518 | .get_drvinfo = ax8817x_get_drvinfo, | |||
| 519 | .get_link = ethtool_op_get_link, | |||
| 520 | .get_msglevel = usbnet_get_msglevel, | |||
| 521 | .set_msglevel = usbnet_set_msglevel, | |||
| 522 | .get_wol = ax8817x_get_wol, | |||
| 523 | .set_wol = ax8817x_set_wol, | |||
| 524 | .get_eeprom_len = ax8817x_get_eeprom_len, | |||
| 525 | .get_eeprom = ax8817x_get_eeprom, | |||
| 526 | .get_settings = ax8817x_get_settings, | |||
| 527 | .set_settings = ax8817x_set_settings, | |||
| 528 | }; | |||
| 529 | ||||
| 0 | 0 | - | 530 | static int ax88772_bind(struct usbnet *dev, struct usb_interface *intf) |
| 531 | { | |||
| 532 | int ret; | |||
| 533 | void *buf; | |||
| 534 | ||||
| 535 | usbnet_get_endpoints(dev,intf); | |||
| 536 | ||||
| 537 | buf = kmalloc(6, GFP_KERNEL); | |||
| 0 | 0 | - | 538 | if(!buf) { |
| 539 | dbg ("Cannot allocate memory for buffer"); | |||
| 540 | ret = -ENOMEM; | |||
| 0 | - | 541 | goto out1; | |
| 542 | } | |||
| 543 | ||||
| 544 | if ((ret = ax8817x_write_cmd(dev, AX_CMD_WRITE_GPIOS, | |||
| 0 | 0 | - | 545 | 0x00B0, 0, 0, buf)) < 0) |
| 0 | - | 546 | goto out2; | |
| 547 | ||||
| 548 | msleep(5); | |||
| 549 | if ((ret = ax8817x_write_cmd(dev, AX_CMD_SW_PHY_SELECT, | |||
| 0 | 0 | - | 550 | 0x0001, 0, 0, buf)) < 0) { |
| 551 | dbg("Select PHY #1 failed: %d", ret); | |||
| 0 | - | 552 | goto out2; | |
| 553 | } | |||
| 554 | ||||
| 555 | if ((ret = ax8817x_write_cmd(dev, AX_CMD_SW_RESET, AX_SWRESET_IPPD, | |||
| 0 | 0 | - | 556 | 0, 0, buf)) < 0) { |
| 557 | dbg("Failed to power | |||