1 /* 2 * ipheth.c - Apple iPhone USB Ethernet driver 3 * 4 * Copyright (c) 2009 Diego Giagio <diego@giagio.com> 5 * All rights reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 1. Redistributions of source code must retain the above copyright 11 * notice, this list of conditions and the following disclaimer. 12 * 2. Redistributions in binary form must reproduce the above copyright 13 * notice, this list of conditions and the following disclaimer in the 14 * documentation and/or other materials provided with the distribution. 15 * 3. Neither the name of GIAGIO.COM nor the names of its contributors 16 * may be used to endorse or promote products derived from this software 17 * without specific prior written permission. 18 * 19 * Alternatively, provided that this notice is retained in full, this 20 * software may be distributed under the terms of the GNU General 21 * Public License ("GPL") version 2, in which case the provisions of the 22 * GPL apply INSTEAD OF those given above. 23 * 24 * The provided data structures and external interfaces from this code 25 * are not restricted to be used by modules with a GPL compatible license. 26 * 27 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 28 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 29 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 30 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 31 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 32 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 33 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 34 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 35 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 36 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 37 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH 38 * DAMAGE. 39 * 40 * 41 * Attention: iPhone device must be paired, otherwise it won't respond to our 42 * driver. For more info: http://giagio.com/wiki/moin.cgi/iPhoneEthernetDriver 43 * 44 */ 45 46 #include <linux/kernel.h> 47 #include <linux/errno.h> 48 #include <linux/slab.h> 49 #include <linux/module.h> 50 #include <linux/netdevice.h> 51 #include <linux/etherdevice.h> 52 #include <linux/ethtool.h> 53 #include <linux/usb.h> 54 #include <linux/workqueue.h> 55 56 #define USB_VENDOR_APPLE 0x05ac 57 58 #define IPHETH_USBINTF_CLASS 255 59 #define IPHETH_USBINTF_SUBCLASS 253 60 #define IPHETH_USBINTF_PROTO 1 61 62 #define IPHETH_BUF_SIZE 1516 63 #define IPHETH_IP_ALIGN 2 /* padding at front of URB */ 64 #define IPHETH_TX_TIMEOUT (5 * HZ) 65 66 #define IPHETH_INTFNUM 2 67 #define IPHETH_ALT_INTFNUM 1 68 69 #define IPHETH_CTRL_ENDP 0x00 70 #define IPHETH_CTRL_BUF_SIZE 0x40 71 #define IPHETH_CTRL_TIMEOUT (5 * HZ) 72 73 #define IPHETH_CMD_GET_MACADDR 0x00 74 #define IPHETH_CMD_CARRIER_CHECK 0x45 75 76 #define IPHETH_CARRIER_CHECK_TIMEOUT round_jiffies_relative(1 * HZ) 77 #define IPHETH_CARRIER_ON 0x04 78 79 static const struct usb_device_id ipheth_table[] = { 80 { USB_VENDOR_AND_INTERFACE_INFO(USB_VENDOR_APPLE, IPHETH_USBINTF_CLASS, 81 IPHETH_USBINTF_SUBCLASS, 82 IPHETH_USBINTF_PROTO) }, 83 { } 84 }; 85 MODULE_DEVICE_TABLE(usb, ipheth_table); 86 87 struct ipheth_device { 88 struct usb_device *udev; 89 struct usb_interface *intf; 90 struct net_device *net; 91 struct urb *tx_urb; 92 struct urb *rx_urb; 93 unsigned char *tx_buf; 94 unsigned char *rx_buf; 95 unsigned char *ctrl_buf; 96 u8 bulk_in; 97 u8 bulk_out; 98 struct delayed_work carrier_work; 99 bool confirmed_pairing; 100 }; 101 102 static int ipheth_rx_submit(struct ipheth_device *dev, gfp_t mem_flags); 103 104 static int ipheth_alloc_urbs(struct ipheth_device *iphone) 105 { 106 struct urb *tx_urb = NULL; 107 struct urb *rx_urb = NULL; 108 u8 *tx_buf = NULL; 109 u8 *rx_buf = NULL; 110 111 tx_urb = usb_alloc_urb(0, GFP_KERNEL); 112 if (tx_urb == NULL) 113 goto error_nomem; 114 115 rx_urb = usb_alloc_urb(0, GFP_KERNEL); 116 if (rx_urb == NULL) 117 goto free_tx_urb; 118 119 tx_buf = usb_alloc_coherent(iphone->udev, IPHETH_BUF_SIZE, 120 GFP_KERNEL, &tx_urb->transfer_dma); 121 if (tx_buf == NULL) 122 goto free_rx_urb; 123 124 rx_buf = usb_alloc_coherent(iphone->udev, IPHETH_BUF_SIZE, 125 GFP_KERNEL, &rx_urb->transfer_dma); 126 if (rx_buf == NULL) 127 goto free_tx_buf; 128 129 130 iphone->tx_urb = tx_urb; 131 iphone->rx_urb = rx_urb; 132 iphone->tx_buf = tx_buf; 133 iphone->rx_buf = rx_buf; 134 return 0; 135 136 free_tx_buf: 137 usb_free_coherent(iphone->udev, IPHETH_BUF_SIZE, tx_buf, 138 tx_urb->transfer_dma); 139 free_rx_urb: 140 usb_free_urb(rx_urb); 141 free_tx_urb: 142 usb_free_urb(tx_urb); 143 error_nomem: 144 return -ENOMEM; 145 } 146 147 static void ipheth_free_urbs(struct ipheth_device *iphone) 148 { 149 usb_free_coherent(iphone->udev, IPHETH_BUF_SIZE, iphone->rx_buf, 150 iphone->rx_urb->transfer_dma); 151 usb_free_coherent(iphone->udev, IPHETH_BUF_SIZE, iphone->tx_buf, 152 iphone->tx_urb->transfer_dma); 153 usb_free_urb(iphone->rx_urb); 154 usb_free_urb(iphone->tx_urb); 155 } 156 157 static void ipheth_kill_urbs(struct ipheth_device *dev) 158 { 159 usb_kill_urb(dev->tx_urb); 160 usb_kill_urb(dev->rx_urb); 161 } 162 163 static void ipheth_rcvbulk_callback(struct urb *urb) 164 { 165 struct ipheth_device *dev; 166 struct sk_buff *skb; 167 int status; 168 char *buf; 169 int len; 170 171 dev = urb->context; 172 if (dev == NULL) 173 return; 174 175 status = urb->status; 176 switch (status) { 177 case -ENOENT: 178 case -ECONNRESET: 179 case -ESHUTDOWN: 180 case -EPROTO: 181 return; 182 case 0: 183 break; 184 default: 185 dev_err(&dev->intf->dev, "%s: urb status: %d\n", 186 __func__, status); 187 return; 188 } 189 190 if (urb->actual_length <= IPHETH_IP_ALIGN) { 191 dev->net->stats.rx_length_errors++; 192 return; 193 } 194 len = urb->actual_length - IPHETH_IP_ALIGN; 195 buf = urb->transfer_buffer + IPHETH_IP_ALIGN; 196 197 skb = dev_alloc_skb(len); 198 if (!skb) { 199 dev_err(&dev->intf->dev, "%s: dev_alloc_skb: -ENOMEM\n", 200 __func__); 201 dev->net->stats.rx_dropped++; 202 return; 203 } 204 205 skb_put_data(skb, buf, len); 206 skb->dev = dev->net; 207 skb->protocol = eth_type_trans(skb, dev->net); 208 209 dev->net->stats.rx_packets++; 210 dev->net->stats.rx_bytes += len; 211 dev->confirmed_pairing = true; 212 netif_rx(skb); 213 ipheth_rx_submit(dev, GFP_ATOMIC); 214 } 215 216 static void ipheth_sndbulk_callback(struct urb *urb) 217 { 218 struct ipheth_device *dev; 219 int status = urb->status; 220 221 dev = urb->context; 222 if (dev == NULL) 223 return; 224 225 if (status != 0 && 226 status != -ENOENT && 227 status != -ECONNRESET && 228 status != -ESHUTDOWN) 229 dev_err(&dev->intf->dev, "%s: urb status: %d\n", 230 __func__, status); 231 232 if (status == 0) 233 netif_wake_queue(dev->net); 234 else 235 // on URB error, trigger immediate poll 236 schedule_delayed_work(&dev->carrier_work, 0); 237 } 238 239 static int ipheth_carrier_set(struct ipheth_device *dev) 240 { 241 struct usb_device *udev; 242 int retval; 243 244 if (!dev->confirmed_pairing) 245 return 0; 246 247 udev = dev->udev; 248 retval = usb_control_msg(udev, 249 usb_rcvctrlpipe(udev, IPHETH_CTRL_ENDP), 250 IPHETH_CMD_CARRIER_CHECK, /* request */ 251 0xc0, /* request type */ 252 0x00, /* value */ 253 0x02, /* index */ 254 dev->ctrl_buf, IPHETH_CTRL_BUF_SIZE, 255 IPHETH_CTRL_TIMEOUT); 256 if (retval < 0) { 257 dev_err(&dev->intf->dev, "%s: usb_control_msg: %d\n", 258 __func__, retval); 259 return retval; 260 } 261 262 if (dev->ctrl_buf[0] == IPHETH_CARRIER_ON) { 263 netif_carrier_on(dev->net); 264 if (dev->tx_urb->status != -EINPROGRESS) 265 netif_wake_queue(dev->net); 266 } else { 267 netif_carrier_off(dev->net); 268 netif_stop_queue(dev->net); 269 } 270 return 0; 271 } 272 273 static void ipheth_carrier_check_work(struct work_struct *work) 274 { 275 struct ipheth_device *dev = container_of(work, struct ipheth_device, 276 carrier_work.work); 277 278 ipheth_carrier_set(dev); 279 schedule_delayed_work(&dev->carrier_work, IPHETH_CARRIER_CHECK_TIMEOUT); 280 } 281 282 static int ipheth_get_macaddr(struct ipheth_device *dev) 283 { 284 struct usb_device *udev = dev->udev; 285 struct net_device *net = dev->net; 286 int retval; 287 288 retval = usb_control_msg(udev, 289 usb_rcvctrlpipe(udev, IPHETH_CTRL_ENDP), 290 IPHETH_CMD_GET_MACADDR, /* request */ 291 0xc0, /* request type */ 292 0x00, /* value */ 293 0x02, /* index */ 294 dev->ctrl_buf, 295 IPHETH_CTRL_BUF_SIZE, 296 IPHETH_CTRL_TIMEOUT); 297 if (retval < 0) { 298 dev_err(&dev->intf->dev, "%s: usb_control_msg: %d\n", 299 __func__, retval); 300 } else if (retval < ETH_ALEN) { 301 dev_err(&dev->intf->dev, 302 "%s: usb_control_msg: short packet: %d bytes\n", 303 __func__, retval); 304 retval = -EINVAL; 305 } else { 306 memcpy(net->dev_addr, dev->ctrl_buf, ETH_ALEN); 307 retval = 0; 308 } 309 310 return retval; 311 } 312 313 static int ipheth_rx_submit(struct ipheth_device *dev, gfp_t mem_flags) 314 { 315 struct usb_device *udev = dev->udev; 316 int retval; 317 318 usb_fill_bulk_urb(dev->rx_urb, udev, 319 usb_rcvbulkpipe(udev, dev->bulk_in), 320 dev->rx_buf, IPHETH_BUF_SIZE, 321 ipheth_rcvbulk_callback, 322 dev); 323 dev->rx_urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; 324 325 retval = usb_submit_urb(dev->rx_urb, mem_flags); 326 if (retval) 327 dev_err(&dev->intf->dev, "%s: usb_submit_urb: %d\n", 328 __func__, retval); 329 return retval; 330 } 331 332 static int ipheth_open(struct net_device *net) 333 { 334 struct ipheth_device *dev = netdev_priv(net); 335 struct usb_device *udev = dev->udev; 336 int retval = 0; 337 338 usb_set_interface(udev, IPHETH_INTFNUM, IPHETH_ALT_INTFNUM); 339 340 retval = ipheth_carrier_set(dev); 341 if (retval) 342 return retval; 343 344 retval = ipheth_rx_submit(dev, GFP_KERNEL); 345 if (retval) 346 return retval; 347 348 schedule_delayed_work(&dev->carrier_work, IPHETH_CARRIER_CHECK_TIMEOUT); 349 return retval; 350 } 351 352 static int ipheth_close(struct net_device *net) 353 { 354 struct ipheth_device *dev = netdev_priv(net); 355 356 cancel_delayed_work_sync(&dev->carrier_work); 357 netif_stop_queue(net); 358 return 0; 359 } 360 361 static int ipheth_tx(struct sk_buff *skb, struct net_device *net) 362 { 363 struct ipheth_device *dev = netdev_priv(net); 364 struct usb_device *udev = dev->udev; 365 int retval; 366 367 /* Paranoid */ 368 if (skb->len > IPHETH_BUF_SIZE) { 369 WARN(1, "%s: skb too large: %d bytes\n", __func__, skb->len); 370 dev->net->stats.tx_dropped++; 371 dev_kfree_skb_any(skb); 372 return NETDEV_TX_OK; 373 } 374 375 memcpy(dev->tx_buf, skb->data, skb->len); 376 if (skb->len < IPHETH_BUF_SIZE) 377 memset(dev->tx_buf + skb->len, 0, IPHETH_BUF_SIZE - skb->len); 378 379 usb_fill_bulk_urb(dev->tx_urb, udev, 380 usb_sndbulkpipe(udev, dev->bulk_out), 381 dev->tx_buf, IPHETH_BUF_SIZE, 382 ipheth_sndbulk_callback, 383 dev); 384 dev->tx_urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; 385 386 retval = usb_submit_urb(dev->tx_urb, GFP_ATOMIC); 387 if (retval) { 388 dev_err(&dev->intf->dev, "%s: usb_submit_urb: %d\n", 389 __func__, retval); 390 dev->net->stats.tx_errors++; 391 dev_kfree_skb_any(skb); 392 } else { 393 dev->net->stats.tx_packets++; 394 dev->net->stats.tx_bytes += skb->len; 395 dev_consume_skb_any(skb); 396 netif_stop_queue(net); 397 } 398 399 return NETDEV_TX_OK; 400 } 401 402 static void ipheth_tx_timeout(struct net_device *net) 403 { 404 struct ipheth_device *dev = netdev_priv(net); 405 406 dev_err(&dev->intf->dev, "%s: TX timeout\n", __func__); 407 dev->net->stats.tx_errors++; 408 usb_unlink_urb(dev->tx_urb); 409 } 410 411 static u32 ipheth_ethtool_op_get_link(struct net_device *net) 412 { 413 struct ipheth_device *dev = netdev_priv(net); 414 return netif_carrier_ok(dev->net); 415 } 416 417 static const struct ethtool_ops ops = { 418 .get_link = ipheth_ethtool_op_get_link 419 }; 420 421 static const struct net_device_ops ipheth_netdev_ops = { 422 .ndo_open = ipheth_open, 423 .ndo_stop = ipheth_close, 424 .ndo_start_xmit = ipheth_tx, 425 .ndo_tx_timeout = ipheth_tx_timeout, 426 }; 427 428 static int ipheth_probe(struct usb_interface *intf, 429 const struct usb_device_id *id) 430 { 431 struct usb_device *udev = interface_to_usbdev(intf); 432 struct usb_host_interface *hintf; 433 struct usb_endpoint_descriptor *endp; 434 struct ipheth_device *dev; 435 struct net_device *netdev; 436 int i; 437 int retval; 438 439 netdev = alloc_etherdev(sizeof(struct ipheth_device)); 440 if (!netdev) 441 return -ENOMEM; 442 443 netdev->netdev_ops = &ipheth_netdev_ops; 444 netdev->watchdog_timeo = IPHETH_TX_TIMEOUT; 445 strcpy(netdev->name, "eth%d"); 446 447 dev = netdev_priv(netdev); 448 dev->udev = udev; 449 dev->net = netdev; 450 dev->intf = intf; 451 dev->confirmed_pairing = false; 452 /* Set up endpoints */ 453 hintf = usb_altnum_to_altsetting(intf, IPHETH_ALT_INTFNUM); 454 if (hintf == NULL) { 455 retval = -ENODEV; 456 dev_err(&intf->dev, "Unable to find alternate settings interface\n"); 457 goto err_endpoints; 458 } 459 460 for (i = 0; i < hintf->desc.bNumEndpoints; i++) { 461 endp = &hintf->endpoint[i].desc; 462 if (usb_endpoint_is_bulk_in(endp)) 463 dev->bulk_in = endp->bEndpointAddress; 464 else if (usb_endpoint_is_bulk_out(endp)) 465 dev->bulk_out = endp->bEndpointAddress; 466 } 467 if (!(dev->bulk_in && dev->bulk_out)) { 468 retval = -ENODEV; 469 dev_err(&intf->dev, "Unable to find endpoints\n"); 470 goto err_endpoints; 471 } 472 473 dev->ctrl_buf = kmalloc(IPHETH_CTRL_BUF_SIZE, GFP_KERNEL); 474 if (dev->ctrl_buf == NULL) { 475 retval = -ENOMEM; 476 goto err_alloc_ctrl_buf; 477 } 478 479 retval = ipheth_get_macaddr(dev); 480 if (retval) 481 goto err_get_macaddr; 482 483 INIT_DELAYED_WORK(&dev->carrier_work, ipheth_carrier_check_work); 484 485 retval = ipheth_alloc_urbs(dev); 486 if (retval) { 487 dev_err(&intf->dev, "error allocating urbs: %d\n", retval); 488 goto err_alloc_urbs; 489 } 490 491 usb_set_intfdata(intf, dev); 492 493 SET_NETDEV_DEV(netdev, &intf->dev); 494 netdev->ethtool_ops = &ops; 495 496 retval = register_netdev(netdev); 497 if (retval) { 498 dev_err(&intf->dev, "error registering netdev: %d\n", retval); 499 retval = -EIO; 500 goto err_register_netdev; 501 } 502 // carrier down and transmit queues stopped until packet from device 503 netif_carrier_off(netdev); 504 netif_tx_stop_all_queues(netdev); 505 dev_info(&intf->dev, "Apple iPhone USB Ethernet device attached\n"); 506 return 0; 507 508 err_register_netdev: 509 ipheth_free_urbs(dev); 510 err_alloc_urbs: 511 err_get_macaddr: 512 err_alloc_ctrl_buf: 513 kfree(dev->ctrl_buf); 514 err_endpoints: 515 free_netdev(netdev); 516 return retval; 517 } 518 519 static void ipheth_disconnect(struct usb_interface *intf) 520 { 521 struct ipheth_device *dev; 522 523 dev = usb_get_intfdata(intf); 524 if (dev != NULL) { 525 unregister_netdev(dev->net); 526 ipheth_kill_urbs(dev); 527 ipheth_free_urbs(dev); 528 kfree(dev->ctrl_buf); 529 free_netdev(dev->net); 530 } 531 usb_set_intfdata(intf, NULL); 532 dev_info(&intf->dev, "Apple iPhone USB Ethernet now disconnected\n"); 533 } 534 535 static struct usb_driver ipheth_driver = { 536 .name = "ipheth", 537 .probe = ipheth_probe, 538 .disconnect = ipheth_disconnect, 539 .id_table = ipheth_table, 540 .disable_hub_initiated_lpm = 1, 541 }; 542 543 module_usb_driver(ipheth_driver); 544 545 MODULE_AUTHOR("Diego Giagio <diego@giagio.com>"); 546 MODULE_DESCRIPTION("Apple iPhone USB Ethernet driver"); 547 MODULE_LICENSE("Dual BSD/GPL"); 548