| 1 | |
| 2 | * ipheth.c - Apple iPhone USB Ethernet driver
|
| 3 | *
|
| 4 | * Copyright (c) 2009 Diego Giagio <[email protected]>
|
| 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 | #include <linux/usb/cdc.h>
|
| 56 |
|
| 57 | #define USB_VENDOR_APPLE 0x05ac
|
| 58 |
|
| 59 | #define IPHETH_USBINTF_CLASS 255
|
| 60 | #define IPHETH_USBINTF_SUBCLASS 253
|
| 61 | #define IPHETH_USBINTF_PROTO 1
|
| 62 |
|
| 63 | #define IPHETH_IP_ALIGN 2
|
| 64 | |
| 65 | * - NTH16 (NCMH): 12 bytes, as per CDC NCM 1.0 spec
|
| 66 | * - NDP16 (NCM0): 96 bytes, of which
|
| 67 | * - NDP16 fixed header: 8 bytes
|
| 68 | * - maximum of 22 DPEs (21 datagrams + trailer), 4 bytes each
|
| 69 |
|
| 70 | #define IPHETH_NDP16_MAX_DPE 22
|
| 71 | #define IPHETH_NDP16_HEADER_SIZE (sizeof(struct usb_cdc_ncm_ndp16) + \
|
| 72 | IPHETH_NDP16_MAX_DPE * \
|
| 73 | sizeof(struct usb_cdc_ncm_dpe16))
|
| 74 | #define IPHETH_NCM_HEADER_SIZE (sizeof(struct usb_cdc_ncm_nth16) + \
|
| 75 | IPHETH_NDP16_HEADER_SIZE)
|
| 76 | #define IPHETH_TX_BUF_SIZE ETH_FRAME_LEN
|
| 77 | #define IPHETH_RX_BUF_SIZE_LEGACY (IPHETH_IP_ALIGN + ETH_FRAME_LEN)
|
| 78 | #define IPHETH_RX_BUF_SIZE_NCM 65536
|
| 79 |
|
| 80 | #define IPHETH_TX_TIMEOUT (5 * HZ)
|
| 81 |
|
| 82 | #define IPHETH_INTFNUM 2
|
| 83 | #define IPHETH_ALT_INTFNUM 1
|
| 84 |
|
| 85 | #define IPHETH_CTRL_ENDP 0x00
|
| 86 | #define IPHETH_CTRL_BUF_SIZE 0x40
|
| 87 | #define IPHETH_CTRL_TIMEOUT (5 * HZ)
|
| 88 |
|
| 89 | #define IPHETH_CMD_GET_MACADDR 0x00
|
| 90 | #define IPHETH_CMD_ENABLE_NCM 0x04
|
| 91 | #define IPHETH_CMD_CARRIER_CHECK 0x45
|
| 92 |
|
| 93 | #define IPHETH_CARRIER_CHECK_TIMEOUT round_jiffies_relative(1 * HZ)
|
| 94 | #define IPHETH_CARRIER_ON 0x04
|
| 95 |
|
| 96 | static const struct usb_device_id ipheth_table[] = {
|
| 97 | { USB_VENDOR_AND_INTERFACE_INFO(USB_VENDOR_APPLE, IPHETH_USBINTF_CLASS,
|
| 98 | IPHETH_USBINTF_SUBCLASS,
|
| 99 | IPHETH_USBINTF_PROTO) },
|
| 100 | { }
|
| 101 | };
|
| 102 | MODULE_DEVICE_TABLE(usb, ipheth_table);
|
| 103 |
|
| 104 | struct ipheth_device {
|
| 105 | struct usb_device *udev;
|
| 106 | struct usb_interface *intf;
|
| 107 | struct net_device *net;
|
| 108 | struct urb *tx_urb;
|
| 109 | struct urb *rx_urb;
|
| 110 | unsigned char *tx_buf;
|
| 111 | unsigned char *rx_buf;
|
| 112 | unsigned char *ctrl_buf;
|
| 113 | u8 bulk_in;
|
| 114 | u8 bulk_out;
|
| 115 | struct delayed_work carrier_work;
|
| 116 | bool confirmed_pairing;
|
| 117 | int (*rcvbulk_callback)(struct urb *urb);
|
| 118 | size_t rx_buf_len;
|
| 119 | };
|
| 120 |
|
| 121 | static int ipheth_rx_submit(struct ipheth_device *dev, gfp_t mem_flags);
|
| 122 |
|
| 123 | static int ipheth_alloc_urbs(struct ipheth_device *iphone)
|
| 124 | {
|
| 125 | struct urb *tx_urb = NULL;
|
| 126 | struct urb *rx_urb = NULL;
|
| 127 | u8 *tx_buf = NULL;
|
| 128 | u8 *rx_buf = NULL;
|
| 129 |
|
| 130 | tx_urb = usb_alloc_urb(0, GFP_KERNEL);
|
| 131 | if (tx_urb == NULL)
|
| 132 | goto error_nomem;
|
| 133 |
|
| 134 | rx_urb = usb_alloc_urb(0, GFP_KERNEL);
|
| 135 | if (rx_urb == NULL)
|
| 136 | goto free_tx_urb;
|
| 137 |
|
| 138 | tx_buf = usb_alloc_coherent(iphone->udev, IPHETH_TX_BUF_SIZE,
|
| 139 | GFP_KERNEL, &tx_urb->transfer_dma);
|
| 140 | if (tx_buf == NULL)
|
| 141 | goto free_rx_urb;
|
| 142 |
|
| 143 | rx_buf = usb_alloc_coherent(iphone->udev, iphone->rx_buf_len,
|
| 144 | GFP_KERNEL, &rx_urb->transfer_dma);
|
| 145 | if (rx_buf == NULL)
|
| 146 | goto free_tx_buf;
|
| 147 |
|
| 148 |
|
| 149 | iphone->tx_urb = tx_urb;
|
| 150 | iphone->rx_urb = rx_urb;
|
| 151 | iphone->tx_buf = tx_buf;
|
| 152 | iphone->rx_buf = rx_buf;
|
| 153 | return 0;
|
| 154 |
|
| 155 | free_tx_buf:
|
| 156 | usb_free_coherent(iphone->udev, IPHETH_TX_BUF_SIZE, tx_buf,
|
| 157 | tx_urb->transfer_dma);
|
| 158 | free_rx_urb:
|
| 159 | usb_free_urb(rx_urb);
|
| 160 | free_tx_urb:
|
| 161 | usb_free_urb(tx_urb);
|
| 162 | error_nomem:
|
| 163 | return -ENOMEM;
|
| 164 | }
|
| 165 |
|
| 166 | static void ipheth_free_urbs(struct ipheth_device *iphone)
|
| 167 | {
|
| 168 | usb_free_coherent(iphone->udev, iphone->rx_buf_len, iphone->rx_buf,
|
| 169 | iphone->rx_urb->transfer_dma);
|
| 170 | usb_free_coherent(iphone->udev, IPHETH_TX_BUF_SIZE, iphone->tx_buf,
|
| 171 | iphone->tx_urb->transfer_dma);
|
| 172 | usb_free_urb(iphone->rx_urb);
|
| 173 | usb_free_urb(iphone->tx_urb);
|
| 174 | }
|
| 175 |
|
| 176 | static void ipheth_kill_urbs(struct ipheth_device *dev)
|
| 177 | {
|
| 178 | usb_kill_urb(dev->tx_urb);
|
| 179 | usb_kill_urb(dev->rx_urb);
|
| 180 | }
|
| 181 |
|
| 182 | static int ipheth_consume_skb(char *buf, int len, struct ipheth_device *dev)
|
| 183 | {
|
| 184 | struct sk_buff *skb;
|
| 185 |
|
| 186 | skb = dev_alloc_skb(len);
|
| 187 | if (!skb) {
|
| 188 | dev->net->stats.rx_dropped++;
|
| 189 | return -ENOMEM;
|
| 190 | }
|
| 191 |
|
| 192 | skb_put_data(skb, buf, len);
|
| 193 | skb->dev = dev->net;
|
| 194 | skb->protocol = eth_type_trans(skb, dev->net);
|
| 195 |
|
| 196 | dev->net->stats.rx_packets++;
|
| 197 | dev->net->stats.rx_bytes += len;
|
| 198 | netif_rx(skb);
|
| 199 |
|
| 200 | return 0;
|
| 201 | }
|
| 202 |
|
| 203 | static int ipheth_rcvbulk_callback_legacy(struct urb *urb)
|
| 204 | {
|
| 205 | struct ipheth_device *dev;
|
| 206 | char *buf;
|
| 207 | int len;
|
| 208 |
|
| 209 | dev = urb->context;
|
| 210 |
|
| 211 | if (urb->actual_length <= IPHETH_IP_ALIGN) {
|
| 212 | dev->net->stats.rx_length_errors++;
|
| 213 | return -EINVAL;
|
| 214 | }
|
| 215 | len = urb->actual_length - IPHETH_IP_ALIGN;
|
| 216 | buf = urb->transfer_buffer + IPHETH_IP_ALIGN;
|
| 217 |
|
| 218 | return ipheth_consume_skb(buf, len, dev);
|
| 219 | }
|
| 220 |
|
| 221 | |
| 222 | * in NCM Transfer Blocks (similarly to CDC NCM). However, unlike reverse
|
| 223 | * tethering (handled by the `cdc_ncm` driver), regular tethering is not
|
| 224 | * compliant with the CDC NCM spec, as the device is missing the necessary
|
| 225 | * descriptors, and TX (computer->phone) traffic is not encapsulated
|
| 226 | * at all. Thus `ipheth` implements a very limited subset of the spec with
|
| 227 | * the sole purpose of parsing RX URBs.
|
| 228 |
|
| 229 | static int ipheth_rcvbulk_callback_ncm(struct urb *urb)
|
| 230 | {
|
| 231 | struct usb_cdc_ncm_nth16 *ncmh;
|
| 232 | struct usb_cdc_ncm_ndp16 *ncm0;
|
| 233 | struct usb_cdc_ncm_dpe16 *dpe;
|
| 234 | struct ipheth_device *dev;
|
| 235 | u16 dg_idx, dg_len;
|
| 236 | int retval = -EINVAL;
|
| 237 | char *buf;
|
| 238 |
|
| 239 | dev = urb->context;
|
| 240 |
|
| 241 | if (urb->actual_length < IPHETH_NCM_HEADER_SIZE) {
|
| 242 | dev->net->stats.rx_length_errors++;
|
| 243 | return retval;
|
| 244 | }
|
| 245 |
|
| 246 | ncmh = urb->transfer_buffer;
|
| 247 | if (ncmh->dwSignature != cpu_to_le32(USB_CDC_NCM_NTH16_SIGN) ||
|
| 248 |
|
| 249 | ncmh->wNdpIndex != cpu_to_le16(sizeof(struct usb_cdc_ncm_nth16)))
|
| 250 | goto rx_error;
|
| 251 |
|
| 252 | ncm0 = urb->transfer_buffer + sizeof(struct usb_cdc_ncm_nth16);
|
| 253 | if (ncm0->dwSignature != cpu_to_le32(USB_CDC_NCM_NDP16_NOCRC_SIGN))
|
| 254 | goto rx_error;
|
| 255 |
|
| 256 | dpe = ncm0->dpe16;
|
| 257 | for (int dpe_i = 0; dpe_i < IPHETH_NDP16_MAX_DPE; ++dpe_i, ++dpe) {
|
| 258 | dg_idx = le16_to_cpu(dpe->wDatagramIndex);
|
| 259 | dg_len = le16_to_cpu(dpe->wDatagramLength);
|
| 260 |
|
| 261 | |
| 262 | * (3.3.1 USB CDC NCM spec v1.0)
|
| 263 |
|
| 264 | if (dg_idx == 0 && dg_len == 0)
|
| 265 | return 0;
|
| 266 |
|
| 267 | if (dg_idx < IPHETH_NCM_HEADER_SIZE ||
|
| 268 | dg_idx >= urb->actual_length ||
|
| 269 | dg_len > urb->actual_length - dg_idx) {
|
| 270 | dev->net->stats.rx_length_errors++;
|
| 271 | return retval;
|
| 272 | }
|
| 273 |
|
| 274 | buf = urb->transfer_buffer + dg_idx;
|
| 275 |
|
| 276 | retval = ipheth_consume_skb(buf, dg_len, dev);
|
| 277 | if (retval != 0)
|
| 278 | return retval;
|
| 279 | }
|
| 280 |
|
| 281 | rx_error:
|
| 282 | dev->net->stats.rx_errors++;
|
| 283 | return retval;
|
| 284 | }
|
| 285 |
|
| 286 | static void ipheth_rcvbulk_callback(struct urb *urb)
|
| 287 | {
|
| 288 | struct ipheth_device *dev;
|
| 289 | int retval, status;
|
| 290 |
|
| 291 | dev = urb->context;
|
| 292 | if (dev == NULL)
|
| 293 | return;
|
| 294 |
|
| 295 | status = urb->status;
|
| 296 | switch (status) {
|
| 297 | case -ENOENT:
|
| 298 | case -ECONNRESET:
|
| 299 | case -ESHUTDOWN:
|
| 300 | case -EPROTO:
|
| 301 | return;
|
| 302 | case 0:
|
| 303 | break;
|
| 304 | default:
|
| 305 | dev_err(&dev->intf->dev, "%s: urb status: %d\n",
|
| 306 | __func__, status);
|
| 307 | return;
|
| 308 | }
|
| 309 |
|
| 310 | |
| 311 | * on the "bulk in" endpoint. It is safe to ignore them.
|
| 312 |
|
| 313 | if (urb->actual_length == 0)
|
| 314 | goto rx_submit;
|
| 315 |
|
| 316 | |
| 317 | * but rather are control frames. Their purpose is not documented, and
|
| 318 | * they don't affect driver functionality, okay to drop them.
|
| 319 | * There is usually just one 4-byte control frame as the very first
|
| 320 | * URB received from the bulk IN endpoint.
|
| 321 |
|
| 322 | if (unlikely
|
| 323 | (urb->actual_length == 4 &&
|
| 324 | ((char *)urb->transfer_buffer)[0] == 0 &&
|
| 325 | ((char *)urb->transfer_buffer)[1] == 1))
|
| 326 | goto rx_submit;
|
| 327 |
|
| 328 | retval = dev->rcvbulk_callback(urb);
|
| 329 | if (retval != 0) {
|
| 330 | dev_err(&dev->intf->dev, "%s: callback retval: %d\n",
|
| 331 | __func__, retval);
|
| 332 | }
|
| 333 |
|
| 334 | rx_submit:
|
| 335 | dev->confirmed_pairing = true;
|
| 336 | ipheth_rx_submit(dev, GFP_ATOMIC);
|
| 337 | }
|
| 338 |
|
| 339 | static void ipheth_sndbulk_callback(struct urb *urb)
|
| 340 | {
|
| 341 | struct ipheth_device *dev;
|
| 342 | int status = urb->status;
|
| 343 |
|
| 344 | dev = urb->context;
|
| 345 | if (dev == NULL)
|
| 346 | return;
|
| 347 |
|
| 348 | if (status != 0 &&
|
| 349 | status != -ENOENT &&
|
| 350 | status != -ECONNRESET &&
|
| 351 | status != -ESHUTDOWN)
|
| 352 | dev_err(&dev->intf->dev, "%s: urb status: %d\n",
|
| 353 | __func__, status);
|
| 354 |
|
| 355 | if (status == 0)
|
| 356 | netif_wake_queue(dev->net);
|
| 357 | else
|
| 358 | |
| 359 | schedule_delayed_work(&dev->carrier_work, 0);
|
| 360 | }
|
| 361 |
|
| 362 | static int ipheth_carrier_set(struct ipheth_device *dev)
|
| 363 | {
|
| 364 | struct usb_device *udev;
|
| 365 | int retval;
|
| 366 |
|
| 367 | if (!dev->confirmed_pairing)
|
| 368 | return 0;
|
| 369 |
|
| 370 | udev = dev->udev;
|
| 371 | retval = usb_control_msg(udev,
|
| 372 | usb_rcvctrlpipe(udev, IPHETH_CTRL_ENDP),
|
| 373 | IPHETH_CMD_CARRIER_CHECK,
|
| 374 | 0xc0,
|
| 375 | 0x00,
|
| 376 | 0x02,
|
| 377 | dev->ctrl_buf, IPHETH_CTRL_BUF_SIZE,
|
| 378 | IPHETH_CTRL_TIMEOUT);
|
| 379 | if (retval <= 0) {
|
| 380 | dev_err(&dev->intf->dev, "%s: usb_control_msg: %d\n",
|
| 381 | __func__, retval);
|
| 382 | return retval;
|
| 383 | }
|
| 384 |
|
| 385 | if ((retval == 1 && dev->ctrl_buf[0] == IPHETH_CARRIER_ON) ||
|
| 386 | (retval >= 2 && dev->ctrl_buf[1] == IPHETH_CARRIER_ON)) {
|
| 387 | netif_carrier_on(dev->net);
|
| 388 | if (dev->tx_urb->status != -EINPROGRESS)
|
| 389 | netif_wake_queue(dev->net);
|
| 390 | } else {
|
| 391 | netif_carrier_off(dev->net);
|
| 392 | netif_stop_queue(dev->net);
|
| 393 | }
|
| 394 | return 0;
|
| 395 | }
|
| 396 |
|
| 397 | static void ipheth_carrier_check_work(struct work_struct *work)
|
| 398 | {
|
| 399 | struct ipheth_device *dev = container_of(work, struct ipheth_device,
|
| 400 | carrier_work.work);
|
| 401 |
|
| 402 | ipheth_carrier_set(dev);
|
| 403 | schedule_delayed_work(&dev->carrier_work, IPHETH_CARRIER_CHECK_TIMEOUT);
|
| 404 | }
|
| 405 |
|
| 406 | static int ipheth_get_macaddr(struct ipheth_device *dev)
|
| 407 | {
|
| 408 | struct usb_device *udev = dev->udev;
|
| 409 | struct net_device *net = dev->net;
|
| 410 | int retval;
|
| 411 |
|
| 412 | retval = usb_control_msg(udev,
|
| 413 | usb_rcvctrlpipe(udev, IPHETH_CTRL_ENDP),
|
| 414 | IPHETH_CMD_GET_MACADDR,
|
| 415 | 0xc0,
|
| 416 | 0x00,
|
| 417 | 0x02,
|
| 418 | dev->ctrl_buf,
|
| 419 | IPHETH_CTRL_BUF_SIZE,
|
| 420 | IPHETH_CTRL_TIMEOUT);
|
| 421 | if (retval < 0) {
|
| 422 | dev_err(&dev->intf->dev, "%s: usb_control_msg: %d\n",
|
| 423 | __func__, retval);
|
| 424 | } else if (retval < ETH_ALEN) {
|
| 425 | dev_err(&dev->intf->dev,
|
| 426 | "%s: usb_control_msg: short packet: %d bytes\n",
|
| 427 | __func__, retval);
|
| 428 | retval = -EINVAL;
|
| 429 | } else {
|
| 430 | eth_hw_addr_set(net, dev->ctrl_buf);
|
| 431 | retval = 0;
|
| 432 | }
|
| 433 |
|
| 434 | return retval;
|
| 435 | }
|
| 436 |
|
| 437 | static int ipheth_enable_ncm(struct ipheth_device *dev)
|
| 438 | {
|
| 439 | struct usb_device *udev = dev->udev;
|
| 440 | int retval;
|
| 441 |
|
| 442 | retval = usb_control_msg(udev,
|
| 443 | usb_sndctrlpipe(udev, IPHETH_CTRL_ENDP),
|
| 444 | IPHETH_CMD_ENABLE_NCM,
|
| 445 | 0x41,
|
| 446 | 0x00,
|
| 447 | 0x02,
|
| 448 | NULL,
|
| 449 | 0,
|
| 450 | IPHETH_CTRL_TIMEOUT);
|
| 451 |
|
| 452 | dev_info(&dev->intf->dev, "%s: usb_control_msg: %d\n",
|
| 453 | __func__, retval);
|
| 454 |
|
| 455 | return retval;
|
| 456 | }
|
| 457 |
|
| 458 | static int ipheth_rx_submit(struct ipheth_device *dev, gfp_t mem_flags)
|
| 459 | {
|
| 460 | struct usb_device *udev = dev->udev;
|
| 461 | int retval;
|
| 462 |
|
| 463 | usb_fill_bulk_urb(dev->rx_urb, udev,
|
| 464 | usb_rcvbulkpipe(udev, dev->bulk_in),
|
| 465 | dev->rx_buf, dev->rx_buf_len,
|
| 466 | ipheth_rcvbulk_callback,
|
| 467 | dev);
|
| 468 | dev->rx_urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
|
| 469 |
|
| 470 | retval = usb_submit_urb(dev->rx_urb, mem_flags);
|
| 471 | if (retval)
|
| 472 | dev_err(&dev->intf->dev, "%s: usb_submit_urb: %d\n",
|
| 473 | __func__, retval);
|
| 474 | return retval;
|
| 475 | }
|
| 476 |
|
| 477 | static int ipheth_open(struct net_device *net)
|
| 478 | {
|
| 479 | struct ipheth_device *dev = netdev_priv(net);
|
| 480 | struct usb_device *udev = dev->udev;
|
| 481 | int retval = 0;
|
| 482 |
|
| 483 | usb_set_interface(udev, IPHETH_INTFNUM, IPHETH_ALT_INTFNUM);
|
| 484 |
|
| 485 | retval = ipheth_carrier_set(dev);
|
| 486 | if (retval)
|
| 487 | return retval;
|
| 488 |
|
| 489 | retval = ipheth_rx_submit(dev, GFP_KERNEL);
|
| 490 | if (retval)
|
| 491 | return retval;
|
| 492 |
|
| 493 | enable_delayed_work(&dev->carrier_work);
|
| 494 | schedule_delayed_work(&dev->carrier_work, IPHETH_CARRIER_CHECK_TIMEOUT);
|
| 495 | return retval;
|
| 496 | }
|
| 497 |
|
| 498 | static int ipheth_close(struct net_device *net)
|
| 499 | {
|
| 500 | struct ipheth_device *dev = netdev_priv(net);
|
| 501 |
|
| 502 | netif_stop_queue(net);
|
| 503 | |
| 504 | * try to re-arm the carrier work. Disable it instead of cancelling
|
| 505 | * it, so that such a schedule_delayed_work() is a no-op.
|
| 506 |
|
| 507 | disable_delayed_work_sync(&dev->carrier_work);
|
| 508 | return 0;
|
| 509 | }
|
| 510 |
|
| 511 | static netdev_tx_t ipheth_tx(struct sk_buff *skb, struct net_device *net)
|
| 512 | {
|
| 513 | struct ipheth_device *dev = netdev_priv(net);
|
| 514 | struct usb_device *udev = dev->udev;
|
| 515 | int retval;
|
| 516 |
|
| 517 |
|
| 518 | if (skb->len > IPHETH_TX_BUF_SIZE) {
|
| 519 | WARN(1, "%s: skb too large: %d bytes\n", __func__, skb->len);
|
| 520 | dev->net->stats.tx_dropped++;
|
| 521 | dev_kfree_skb_any(skb);
|
| 522 | return NETDEV_TX_OK;
|
| 523 | }
|
| 524 |
|
| 525 | memcpy(dev->tx_buf, skb->data, skb->len);
|
| 526 |
|
| 527 | usb_fill_bulk_urb(dev->tx_urb, udev,
|
| 528 | usb_sndbulkpipe(udev, dev->bulk_out),
|
| 529 | dev->tx_buf, skb->len,
|
| 530 | ipheth_sndbulk_callback,
|
| 531 | dev);
|
| 532 | dev->tx_urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
|
| 533 |
|
| 534 | netif_stop_queue(net);
|
| 535 | retval = usb_submit_urb(dev->tx_urb, GFP_ATOMIC);
|
| 536 | if (retval) {
|
| 537 | dev_err(&dev->intf->dev, "%s: usb_submit_urb: %d\n",
|
| 538 | __func__, retval);
|
| 539 | dev->net->stats.tx_errors++;
|
| 540 | dev_kfree_skb_any(skb);
|
| 541 | netif_wake_queue(net);
|
| 542 | } else {
|
| 543 | dev->net->stats.tx_packets++;
|
| 544 | dev->net->stats.tx_bytes += skb->len;
|
| 545 | dev_consume_skb_any(skb);
|
| 546 | }
|
| 547 |
|
| 548 | return NETDEV_TX_OK;
|
| 549 | }
|
| 550 |
|
| 551 | static void ipheth_tx_timeout(struct net_device *net, unsigned int txqueue)
|
| 552 | {
|
| 553 | struct ipheth_device *dev = netdev_priv(net);
|
| 554 |
|
| 555 | dev_err(&dev->intf->dev, "%s: TX timeout\n", __func__);
|
| 556 | dev->net->stats.tx_errors++;
|
| 557 | usb_unlink_urb(dev->tx_urb);
|
| 558 | }
|
| 559 |
|
| 560 | static u32 ipheth_ethtool_op_get_link(struct net_device *net)
|
| 561 | {
|
| 562 | struct ipheth_device *dev = netdev_priv(net);
|
| 563 | return netif_carrier_ok(dev->net);
|
| 564 | }
|
| 565 |
|
| 566 | static const struct ethtool_ops ops = {
|
| 567 | .get_link = ipheth_ethtool_op_get_link
|
| 568 | };
|
| 569 |
|
| 570 | static const struct net_device_ops ipheth_netdev_ops = {
|
| 571 | .ndo_open = ipheth_open,
|
| 572 | .ndo_stop = ipheth_close,
|
| 573 | .ndo_start_xmit = ipheth_tx,
|
| 574 | .ndo_tx_timeout = ipheth_tx_timeout,
|
| 575 | };
|
| 576 |
|
| 577 | static int ipheth_probe(struct usb_interface *intf,
|
| 578 | const struct usb_device_id *id)
|
| 579 | {
|
| 580 | struct usb_device *udev = interface_to_usbdev(intf);
|
| 581 | struct usb_endpoint_descriptor *ep_in, *ep_out;
|
| 582 | struct usb_host_interface *hintf;
|
| 583 | struct ipheth_device *dev;
|
| 584 | struct net_device *netdev;
|
| 585 | int retval;
|
| 586 |
|
| 587 | netdev = alloc_etherdev(sizeof(struct ipheth_device));
|
| 588 | if (!netdev)
|
| 589 | return -ENOMEM;
|
| 590 |
|
| 591 | netdev->netdev_ops = &ipheth_netdev_ops;
|
| 592 | netdev->watchdog_timeo = IPHETH_TX_TIMEOUT;
|
| 593 | strscpy(netdev->name, "eth%d", sizeof(netdev->name));
|
| 594 |
|
| 595 | dev = netdev_priv(netdev);
|
| 596 | dev->udev = udev;
|
| 597 | dev->net = netdev;
|
| 598 | dev->intf = intf;
|
| 599 | dev->confirmed_pairing = false;
|
| 600 | dev->rx_buf_len = IPHETH_RX_BUF_SIZE_LEGACY;
|
| 601 | dev->rcvbulk_callback = ipheth_rcvbulk_callback_legacy;
|
| 602 |
|
| 603 | hintf = usb_altnum_to_altsetting(intf, IPHETH_ALT_INTFNUM);
|
| 604 | if (hintf == NULL) {
|
| 605 | retval = -ENODEV;
|
| 606 | dev_err(&intf->dev, "Unable to find alternate settings interface\n");
|
| 607 | goto err_endpoints;
|
| 608 | }
|
| 609 |
|
| 610 | retval = usb_find_common_endpoints_reverse(hintf, &ep_in, &ep_out,
|
| 611 | NULL, NULL);
|
| 612 | if (retval) {
|
| 613 | dev_err(&intf->dev, "Unable to find endpoints\n");
|
| 614 | goto err_endpoints;
|
| 615 | }
|
| 616 |
|
| 617 | dev->bulk_in = ep_in->bEndpointAddress;
|
| 618 | dev->bulk_out = ep_out->bEndpointAddress;
|
| 619 |
|
| 620 | dev->ctrl_buf = kmalloc(IPHETH_CTRL_BUF_SIZE, GFP_KERNEL);
|
| 621 | if (dev->ctrl_buf == NULL) {
|
| 622 | retval = -ENOMEM;
|
| 623 | goto err_alloc_ctrl_buf;
|
| 624 | }
|
| 625 |
|
| 626 | retval = ipheth_get_macaddr(dev);
|
| 627 | if (retval)
|
| 628 | goto err_get_macaddr;
|
| 629 |
|
| 630 | retval = ipheth_enable_ncm(dev);
|
| 631 | if (!retval) {
|
| 632 | dev->rx_buf_len = IPHETH_RX_BUF_SIZE_NCM;
|
| 633 | dev->rcvbulk_callback = ipheth_rcvbulk_callback_ncm;
|
| 634 | }
|
| 635 |
|
| 636 | INIT_DELAYED_WORK(&dev->carrier_work, ipheth_carrier_check_work);
|
| 637 | |
| 638 | * disabled so the enable/disable counts balance from the first open.
|
| 639 |
|
| 640 | disable_delayed_work(&dev->carrier_work);
|
| 641 |
|
| 642 | retval = ipheth_alloc_urbs(dev);
|
| 643 | if (retval) {
|
| 644 | dev_err(&intf->dev, "error allocating urbs: %d\n", retval);
|
| 645 | goto err_alloc_urbs;
|
| 646 | }
|
| 647 |
|
| 648 | usb_set_intfdata(intf, dev);
|
| 649 |
|
| 650 | SET_NETDEV_DEV(netdev, &intf->dev);
|
| 651 | netdev->ethtool_ops = &ops;
|
| 652 |
|
| 653 | retval = register_netdev(netdev);
|
| 654 | if (retval) {
|
| 655 | dev_err(&intf->dev, "error registering netdev: %d\n", retval);
|
| 656 | retval = -EIO;
|
| 657 | goto err_register_netdev;
|
| 658 | }
|
| 659 | |
| 660 | netif_carrier_off(netdev);
|
| 661 | netif_tx_stop_all_queues(netdev);
|
| 662 | dev_info(&intf->dev, "Apple iPhone USB Ethernet device attached\n");
|
| 663 | return 0;
|
| 664 |
|
| 665 | err_register_netdev:
|
| 666 | ipheth_free_urbs(dev);
|
| 667 | err_alloc_urbs:
|
| 668 | err_get_macaddr:
|
| 669 | kfree(dev->ctrl_buf);
|
| 670 | err_alloc_ctrl_buf:
|
| 671 | err_endpoints:
|
| 672 | free_netdev(netdev);
|
| 673 | return retval;
|
| 674 | }
|
| 675 |
|
| 676 | static void ipheth_disconnect(struct usb_interface *intf)
|
| 677 | {
|
| 678 | struct ipheth_device *dev;
|
| 679 |
|
| 680 | dev = usb_get_intfdata(intf);
|
| 681 | if (dev != NULL) {
|
| 682 | unregister_netdev(dev->net);
|
| 683 | ipheth_kill_urbs(dev);
|
| 684 | ipheth_free_urbs(dev);
|
| 685 | kfree(dev->ctrl_buf);
|
| 686 | free_netdev(dev->net);
|
| 687 | }
|
| 688 | usb_set_intfdata(intf, NULL);
|
| 689 | dev_info(&intf->dev, "Apple iPhone USB Ethernet now disconnected\n");
|
| 690 | }
|
| 691 |
|
| 692 | static struct usb_driver ipheth_driver = {
|
| 693 | .name = "ipheth",
|
| 694 | .probe = ipheth_probe,
|
| 695 | .disconnect = ipheth_disconnect,
|
| 696 | .id_table = ipheth_table,
|
| 697 | .disable_hub_initiated_lpm = 1,
|
| 698 | };
|
| 699 |
|
| 700 | module_usb_driver(ipheth_driver);
|
| 701 |
|
| 702 | MODULE_AUTHOR("Diego Giagio <[email protected]>");
|
| 703 | MODULE_DESCRIPTION("Apple iPhone USB Ethernet driver");
|
| 704 | MODULE_LICENSE("Dual BSD/GPL");
|