1
2
3
4
5
6
7
8
9
10#include <linux/module.h>
11#include <linux/sched/signal.h>
12#include <linux/netdevice.h>
13#include <linux/ethtool.h>
14#include <linux/etherdevice.h>
15#include <linux/if_arp.h>
16#include <linux/mii.h>
17#include <linux/rtnetlink.h>
18#include <linux/usb.h>
19#include <linux/usb/cdc.h>
20#include <linux/usb/usbnet.h>
21#include <linux/usb/cdc-wdm.h>
22#include <linux/u64_stats_sync.h>
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49struct qmi_wwan_state {
50 struct usb_driver *subdriver;
51 atomic_t pmcount;
52 unsigned long flags;
53 struct usb_interface *control;
54 struct usb_interface *data;
55};
56
57enum qmi_wwan_flags {
58 QMI_WWAN_FLAG_RAWIP = 1 << 0,
59 QMI_WWAN_FLAG_MUX = 1 << 1,
60};
61
62enum qmi_wwan_quirks {
63 QMI_WWAN_QUIRK_DTR = 1 << 0,
64};
65
66struct qmimux_hdr {
67 u8 pad;
68 u8 mux_id;
69 __be16 pkt_len;
70};
71
72struct qmimux_priv {
73 struct net_device *real_dev;
74 u8 mux_id;
75 struct pcpu_sw_netstats __percpu *stats64;
76};
77
78static int qmimux_open(struct net_device *dev)
79{
80 struct qmimux_priv *priv = netdev_priv(dev);
81 struct net_device *real_dev = priv->real_dev;
82
83 if (!(priv->real_dev->flags & IFF_UP))
84 return -ENETDOWN;
85
86 if (netif_carrier_ok(real_dev))
87 netif_carrier_on(dev);
88 return 0;
89}
90
91static int qmimux_stop(struct net_device *dev)
92{
93 netif_carrier_off(dev);
94 return 0;
95}
96
97static netdev_tx_t qmimux_start_xmit(struct sk_buff *skb, struct net_device *dev)
98{
99 struct qmimux_priv *priv = netdev_priv(dev);
100 unsigned int len = skb->len;
101 struct qmimux_hdr *hdr;
102 netdev_tx_t ret;
103
104 hdr = skb_push(skb, sizeof(struct qmimux_hdr));
105 hdr->pad = 0;
106 hdr->mux_id = priv->mux_id;
107 hdr->pkt_len = cpu_to_be16(len);
108 skb->dev = priv->real_dev;
109 ret = dev_queue_xmit(skb);
110
111 if (likely(ret == NET_XMIT_SUCCESS || ret == NET_XMIT_CN)) {
112 struct pcpu_sw_netstats *stats64 = this_cpu_ptr(priv->stats64);
113
114 u64_stats_update_begin(&stats64->syncp);
115 stats64->tx_packets++;
116 stats64->tx_bytes += len;
117 u64_stats_update_end(&stats64->syncp);
118 } else {
119 dev->stats.tx_dropped++;
120 }
121
122 return ret;
123}
124
125static void qmimux_get_stats64(struct net_device *net,
126 struct rtnl_link_stats64 *stats)
127{
128 struct qmimux_priv *priv = netdev_priv(net);
129
130 netdev_stats_to_stats64(stats, &net->stats);
131 dev_fetch_sw_netstats(stats, priv->stats64);
132}
133
134static const struct net_device_ops qmimux_netdev_ops = {
135 .ndo_open = qmimux_open,
136 .ndo_stop = qmimux_stop,
137 .ndo_start_xmit = qmimux_start_xmit,
138 .ndo_get_stats64 = qmimux_get_stats64,
139};
140
141static void qmimux_setup(struct net_device *dev)
142{
143 dev->header_ops = NULL;
144 dev->type = ARPHRD_NONE;
145 dev->hard_header_len = 0;
146 dev->addr_len = 0;
147 dev->flags = IFF_POINTOPOINT | IFF_NOARP | IFF_MULTICAST;
148 dev->netdev_ops = &qmimux_netdev_ops;
149 dev->mtu = 1500;
150 dev->needs_free_netdev = true;
151}
152
153static struct net_device *qmimux_find_dev(struct usbnet *dev, u8 mux_id)
154{
155 struct qmimux_priv *priv;
156 struct list_head *iter;
157 struct net_device *ldev;
158
159 rcu_read_lock();
160 netdev_for_each_upper_dev_rcu(dev->net, ldev, iter) {
161 priv = netdev_priv(ldev);
162 if (priv->mux_id == mux_id) {
163 rcu_read_unlock();
164 return ldev;
165 }
166 }
167 rcu_read_unlock();
168 return NULL;
169}
170
171static bool qmimux_has_slaves(struct usbnet *dev)
172{
173 return !list_empty(&dev->net->adj_list.upper);
174}
175
176static int qmimux_rx_fixup(struct usbnet *dev, struct sk_buff *skb)
177{
178 unsigned int len, offset = 0, pad_len, pkt_len;
179 struct qmimux_hdr *hdr;
180 struct net_device *net;
181 struct sk_buff *skbn;
182 u8 qmimux_hdr_sz = sizeof(*hdr);
183
184 while (offset + qmimux_hdr_sz < skb->len) {
185 hdr = (struct qmimux_hdr *)(skb->data + offset);
186 len = be16_to_cpu(hdr->pkt_len);
187
188
189 if (offset + len + qmimux_hdr_sz > skb->len)
190 return 0;
191
192
193 if (hdr->pad & 0x80)
194 goto skip;
195
196
197 pad_len = hdr->pad & 0x3f;
198 if (len == 0 || pad_len >= len)
199 goto skip;
200 pkt_len = len - pad_len;
201
202 net = qmimux_find_dev(dev, hdr->mux_id);
203 if (!net)
204 goto skip;
205 skbn = netdev_alloc_skb(net, pkt_len);
206 if (!skbn)
207 return 0;
208 skbn->dev = net;
209
210 switch (skb->data[offset + qmimux_hdr_sz] & 0xf0) {
211 case 0x40:
212 skbn->protocol = htons(ETH_P_IP);
213 break;
214 case 0x60:
215 skbn->protocol = htons(ETH_P_IPV6);
216 break;
217 default:
218
219 goto skip;
220 }
221
222 skb_put_data(skbn, skb->data + offset + qmimux_hdr_sz, pkt_len);
223 if (netif_rx(skbn) != NET_RX_SUCCESS) {
224 net->stats.rx_errors++;
225 return 0;
226 } else {
227 struct pcpu_sw_netstats *stats64;
228 struct qmimux_priv *priv = netdev_priv(net);
229
230 stats64 = this_cpu_ptr(priv->stats64);
231 u64_stats_update_begin(&stats64->syncp);
232 stats64->rx_packets++;
233 stats64->rx_bytes += pkt_len;
234 u64_stats_update_end(&stats64->syncp);
235 }
236
237skip:
238 offset += len + qmimux_hdr_sz;
239 }
240 return 1;
241}
242
243static int qmimux_register_device(struct net_device *real_dev, u8 mux_id)
244{
245 struct net_device *new_dev;
246 struct qmimux_priv *priv;
247 int err;
248
249 new_dev = alloc_netdev(sizeof(struct qmimux_priv),
250 "qmimux%d", NET_NAME_UNKNOWN, qmimux_setup);
251 if (!new_dev)
252 return -ENOBUFS;
253
254 dev_net_set(new_dev, dev_net(real_dev));
255 priv = netdev_priv(new_dev);
256 priv->mux_id = mux_id;
257 priv->real_dev = real_dev;
258
259 priv->stats64 = netdev_alloc_pcpu_stats(struct pcpu_sw_netstats);
260 if (!priv->stats64) {
261 err = -ENOBUFS;
262 goto out_free_newdev;
263 }
264
265 err = register_netdevice(new_dev);
266 if (err < 0)
267 goto out_free_newdev;
268
269
270 dev_hold(real_dev);
271
272 err = netdev_upper_dev_link(real_dev, new_dev, NULL);
273 if (err)
274 goto out_unregister_netdev;
275
276 netif_stacked_transfer_operstate(real_dev, new_dev);
277
278 return 0;
279
280out_unregister_netdev:
281 unregister_netdevice(new_dev);
282 dev_put(real_dev);
283
284out_free_newdev:
285 free_netdev(new_dev);
286 return err;
287}
288
289static void qmimux_unregister_device(struct net_device *dev,
290 struct list_head *head)
291{
292 struct qmimux_priv *priv = netdev_priv(dev);
293 struct net_device *real_dev = priv->real_dev;
294
295 free_percpu(priv->stats64);
296 netdev_upper_dev_unlink(real_dev, dev);
297 unregister_netdevice_queue(dev, head);
298
299
300 dev_put(real_dev);
301}
302
303static void qmi_wwan_netdev_setup(struct net_device *net)
304{
305 struct usbnet *dev = netdev_priv(net);
306 struct qmi_wwan_state *info = (void *)&dev->data;
307
308 if (info->flags & QMI_WWAN_FLAG_RAWIP) {
309 net->header_ops = NULL;
310 net->type = ARPHRD_NONE;
311 net->hard_header_len = 0;
312 net->addr_len = 0;
313 net->flags = IFF_POINTOPOINT | IFF_NOARP | IFF_MULTICAST;
314 set_bit(EVENT_NO_IP_ALIGN, &dev->flags);
315 netdev_dbg(net, "mode: raw IP\n");
316 } else if (!net->header_ops) {
317 ether_setup(net);
318
319 net->min_mtu = 0;
320 net->max_mtu = ETH_MAX_MTU;
321 clear_bit(EVENT_NO_IP_ALIGN, &dev->flags);
322 netdev_dbg(net, "mode: Ethernet\n");
323 }
324
325
326 usbnet_change_mtu(net, net->mtu);
327}
328
329static ssize_t raw_ip_show(struct device *d, struct device_attribute *attr, char *buf)
330{
331 struct usbnet *dev = netdev_priv(to_net_dev(d));
332 struct qmi_wwan_state *info = (void *)&dev->data;
333
334 return sprintf(buf, "%c\n", info->flags & QMI_WWAN_FLAG_RAWIP ? 'Y' : 'N');
335}
336
337static ssize_t raw_ip_store(struct device *d, struct device_attribute *attr, const char *buf, size_t len)
338{
339 struct usbnet *dev = netdev_priv(to_net_dev(d));
340 struct qmi_wwan_state *info = (void *)&dev->data;
341 bool enable;
342 int ret;
343
344 if (strtobool(buf, &enable))
345 return -EINVAL;
346
347
348 if (enable == (info->flags & QMI_WWAN_FLAG_RAWIP))
349 return len;
350
351 if (!rtnl_trylock())
352 return restart_syscall();
353
354
355 if (netif_running(dev->net)) {
356 netdev_err(dev->net, "Cannot change a running device\n");
357 ret = -EBUSY;
358 goto err;
359 }
360
361
362 ret = call_netdevice_notifiers(NETDEV_PRE_TYPE_CHANGE, dev->net);
363 ret = notifier_to_errno(ret);
364 if (ret) {
365 netdev_err(dev->net, "Type change was refused\n");
366 goto err;
367 }
368
369 if (enable)
370 info->flags |= QMI_WWAN_FLAG_RAWIP;
371 else
372 info->flags &= ~QMI_WWAN_FLAG_RAWIP;
373 qmi_wwan_netdev_setup(dev->net);
374 call_netdevice_notifiers(NETDEV_POST_TYPE_CHANGE, dev->net);
375 ret = len;
376err:
377 rtnl_unlock();
378 return ret;
379}
380
381static ssize_t add_mux_show(struct device *d, struct device_attribute *attr, char *buf)
382{
383 struct net_device *dev = to_net_dev(d);
384 struct qmimux_priv *priv;
385 struct list_head *iter;
386 struct net_device *ldev;
387 ssize_t count = 0;
388
389 rcu_read_lock();
390 netdev_for_each_upper_dev_rcu(dev, ldev, iter) {
391 priv = netdev_priv(ldev);
392 count += scnprintf(&buf[count], PAGE_SIZE - count,
393 "0x%02x\n", priv->mux_id);
394 }
395 rcu_read_unlock();
396 return count;
397}
398
399static ssize_t add_mux_store(struct device *d, struct device_attribute *attr, const char *buf, size_t len)
400{
401 struct usbnet *dev = netdev_priv(to_net_dev(d));
402 struct qmi_wwan_state *info = (void *)&dev->data;
403 u8 mux_id;
404 int ret;
405
406 if (kstrtou8(buf, 0, &mux_id))
407 return -EINVAL;
408
409
410 if (mux_id < 1 || mux_id > 254)
411 return -EINVAL;
412
413 if (!rtnl_trylock())
414 return restart_syscall();
415
416 if (qmimux_find_dev(dev, mux_id)) {
417 netdev_err(dev->net, "mux_id already present\n");
418 ret = -EINVAL;
419 goto err;
420 }
421
422
423 if (netif_running(dev->net)) {
424 netdev_err(dev->net, "Cannot change a running device\n");
425 ret = -EBUSY;
426 goto err;
427 }
428
429 ret = qmimux_register_device(dev->net, mux_id);
430 if (!ret) {
431 info->flags |= QMI_WWAN_FLAG_MUX;
432 ret = len;
433 }
434err:
435 rtnl_unlock();
436 return ret;
437}
438
439static ssize_t del_mux_show(struct device *d, struct device_attribute *attr, char *buf)
440{
441 return add_mux_show(d, attr, buf);
442}
443
444static ssize_t del_mux_store(struct device *d, struct device_attribute *attr, const char *buf, size_t len)
445{
446 struct usbnet *dev = netdev_priv(to_net_dev(d));
447 struct qmi_wwan_state *info = (void *)&dev->data;
448 struct net_device *del_dev;
449 u8 mux_id;
450 int ret = 0;
451
452 if (kstrtou8(buf, 0, &mux_id))
453 return -EINVAL;
454
455 if (!rtnl_trylock())
456 return restart_syscall();
457
458
459 if (netif_running(dev->net)) {
460 netdev_err(dev->net, "Cannot change a running device\n");
461 ret = -EBUSY;
462 goto err;
463 }
464
465 del_dev = qmimux_find_dev(dev, mux_id);
466 if (!del_dev) {
467 netdev_err(dev->net, "mux_id not present\n");
468 ret = -EINVAL;
469 goto err;
470 }
471 qmimux_unregister_device(del_dev, NULL);
472
473 if (!qmimux_has_slaves(dev))
474 info->flags &= ~QMI_WWAN_FLAG_MUX;
475 ret = len;
476err:
477 rtnl_unlock();
478 return ret;
479}
480
481static DEVICE_ATTR_RW(raw_ip);
482static DEVICE_ATTR_RW(add_mux);
483static DEVICE_ATTR_RW(del_mux);
484
485static struct attribute *qmi_wwan_sysfs_attrs[] = {
486 &dev_attr_raw_ip.attr,
487 &dev_attr_add_mux.attr,
488 &dev_attr_del_mux.attr,
489 NULL,
490};
491
492static struct attribute_group qmi_wwan_sysfs_attr_group = {
493 .name = "qmi",
494 .attrs = qmi_wwan_sysfs_attrs,
495};
496
497
498static const u8 default_modem_addr[ETH_ALEN] = {0x02, 0x50, 0xf3};
499
500static const u8 buggy_fw_addr[ETH_ALEN] = {0x00, 0xa0, 0xc6, 0x00, 0x00, 0x00};
501
502
503
504
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520
521
522static int qmi_wwan_rx_fixup(struct usbnet *dev, struct sk_buff *skb)
523{
524 struct qmi_wwan_state *info = (void *)&dev->data;
525 bool rawip = info->flags & QMI_WWAN_FLAG_RAWIP;
526 __be16 proto;
527
528
529 if (skb->len < dev->net->hard_header_len)
530 return 0;
531
532 if (info->flags & QMI_WWAN_FLAG_MUX)
533 return qmimux_rx_fixup(dev, skb);
534
535 switch (skb->data[0] & 0xf0) {
536 case 0x40:
537 proto = htons(ETH_P_IP);
538 break;
539 case 0x60:
540 proto = htons(ETH_P_IPV6);
541 break;
542 case 0x00:
543 if (rawip)
544 return 0;
545 if (is_multicast_ether_addr(skb->data))
546 return 1;
547
548 skb_reset_mac_header(skb);
549 goto fix_dest;
550 default:
551 if (rawip)
552 return 0;
553
554 return 1;
555 }
556 if (rawip) {
557 skb_reset_mac_header(skb);
558 skb->dev = dev->net;
559 skb->protocol = proto;
560 return 1;
561 }
562
563 if (skb_headroom(skb) < ETH_HLEN)
564 return 0;
565 skb_push(skb, ETH_HLEN);
566 skb_reset_mac_header(skb);
567 eth_hdr(skb)->h_proto = proto;
568 eth_zero_addr(eth_hdr(skb)->h_source);
569fix_dest:
570 memcpy(eth_hdr(skb)->h_dest, dev->net->dev_addr, ETH_ALEN);
571 return 1;
572}
573
574
575static bool possibly_iphdr(const char *data)
576{
577 return (data[0] & 0xd0) == 0x40;
578}
579
580
581static int qmi_wwan_mac_addr(struct net_device *dev, void *p)
582{
583 int ret;
584 struct sockaddr *addr = p;
585
586 ret = eth_prepare_mac_addr_change(dev, p);
587 if (ret < 0)
588 return ret;
589 if (possibly_iphdr(addr->sa_data))
590 return -EADDRNOTAVAIL;
591 eth_commit_mac_addr_change(dev, p);
592 return 0;
593}
594
595static const struct net_device_ops qmi_wwan_netdev_ops = {
596 .ndo_open = usbnet_open,
597 .ndo_stop = usbnet_stop,
598 .ndo_start_xmit = usbnet_start_xmit,
599 .ndo_tx_timeout = usbnet_tx_timeout,
600 .ndo_change_mtu = usbnet_change_mtu,
601 .ndo_get_stats64 = usbnet_get_stats64,
602 .ndo_set_mac_address = qmi_wwan_mac_addr,
603 .ndo_validate_addr = eth_validate_addr,
604};
605
606
607
608
609static int qmi_wwan_manage_power(struct usbnet *dev, int on)
610{
611 struct qmi_wwan_state *info = (void *)&dev->data;
612 int rv;
613
614 dev_dbg(&dev->intf->dev, "%s() pmcount=%d, on=%d\n", __func__,
615 atomic_read(&info->pmcount), on);
616
617 if ((on && atomic_add_return(1, &info->pmcount) == 1) ||
618 (!on && atomic_dec_and_test(&info->pmcount))) {
619
620
621
622 rv = usb_autopm_get_interface(dev->intf);
623 dev->intf->needs_remote_wakeup = on;
624 if (!rv)
625 usb_autopm_put_interface(dev->intf);
626 }
627 return 0;
628}
629
630static int qmi_wwan_cdc_wdm_manage_power(struct usb_interface *intf, int on)
631{
632 struct usbnet *dev = usb_get_intfdata(intf);
633
634
635 if (!dev)
636 return 0;
637 return qmi_wwan_manage_power(dev, on);
638}
639
640
641static int qmi_wwan_register_subdriver(struct usbnet *dev)
642{
643 int rv;
644 struct usb_driver *subdriver = NULL;
645 struct qmi_wwan_state *info = (void *)&dev->data;
646
647
648 rv = usbnet_get_endpoints(dev, info->data);
649 if (rv < 0)
650 goto err;
651
652
653 if (info->control != info->data)
654 dev->status = &info->control->cur_altsetting->endpoint[0];
655
656
657 if (!dev->status) {
658 rv = -EINVAL;
659 goto err;
660 }
661
662
663 atomic_set(&info->pmcount, 0);
664
665
666 subdriver = usb_cdc_wdm_register(info->control, &dev->status->desc,
667 4096, &qmi_wwan_cdc_wdm_manage_power);
668 if (IS_ERR(subdriver)) {
669 dev_err(&info->control->dev, "subdriver registration failed\n");
670 rv = PTR_ERR(subdriver);
671 goto err;
672 }
673
674
675 dev->status = NULL;
676
677
678 info->subdriver = subdriver;
679
680err:
681 return rv;
682}
683
684
685
686
687
688
689static int qmi_wwan_change_dtr(struct usbnet *dev, bool on)
690{
691 u8 intf = dev->intf->cur_altsetting->desc.bInterfaceNumber;
692
693 return usbnet_write_cmd(dev, USB_CDC_REQ_SET_CONTROL_LINE_STATE,
694 USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
695 on ? 0x01 : 0x00, intf, NULL, 0);
696}
697
698static int qmi_wwan_bind(struct usbnet *dev, struct usb_interface *intf)
699{
700 int status;
701 u8 *buf = intf->cur_altsetting->extra;
702 int len = intf->cur_altsetting->extralen;
703 struct usb_interface_descriptor *desc = &intf->cur_altsetting->desc;
704 struct usb_cdc_union_desc *cdc_union;
705 struct usb_cdc_ether_desc *cdc_ether;
706 struct usb_driver *driver = driver_of(intf);
707 struct qmi_wwan_state *info = (void *)&dev->data;
708 struct usb_cdc_parsed_header hdr;
709
710 BUILD_BUG_ON((sizeof(((struct usbnet *)0)->data) <
711 sizeof(struct qmi_wwan_state)));
712
713
714 info->control = intf;
715 info->data = intf;
716
717
718 cdc_parse_cdc_header(&hdr, intf, buf, len);
719 cdc_union = hdr.usb_cdc_union_desc;
720 cdc_ether = hdr.usb_cdc_ether_desc;
721
722
723 if (cdc_union) {
724 info->data = usb_ifnum_to_if(dev->udev,
725 cdc_union->bSlaveInterface0);
726 if (desc->bInterfaceNumber != cdc_union->bMasterInterface0 ||
727 !info->data) {
728 dev_err(&intf->dev,
729 "bogus CDC Union: master=%u, slave=%u\n",
730 cdc_union->bMasterInterface0,
731 cdc_union->bSlaveInterface0);
732
733
734 cdc_union = NULL;
735 info->data = intf;
736 }
737 }
738
739
740 if (cdc_ether && cdc_ether->wMaxSegmentSize) {
741 dev->hard_mtu = le16_to_cpu(cdc_ether->wMaxSegmentSize);
742 usbnet_get_ethernet_addr(dev, cdc_ether->iMACAddress);
743 }
744
745
746 if (info->control != info->data) {
747 status = usb_driver_claim_interface(driver, info->data, dev);
748 if (status < 0)
749 goto err;
750 }
751
752 status = qmi_wwan_register_subdriver(dev);
753 if (status < 0 && info->control != info->data) {
754 usb_set_intfdata(info->data, NULL);
755 usb_driver_release_interface(driver, info->data);
756 }
757
758
759
760
761
762
763
764
765
766
767
768
769
770
771
772
773
774
775 if (dev->driver_info->data & QMI_WWAN_QUIRK_DTR ||
776 le16_to_cpu(dev->udev->descriptor.bcdUSB) >= 0x0201) {
777 qmi_wwan_manage_power(dev, 1);
778 qmi_wwan_change_dtr(dev, true);
779 }
780
781
782
783
784
785 if (ether_addr_equal(dev->net->dev_addr, default_modem_addr) ||
786 ether_addr_equal(dev->net->dev_addr, buggy_fw_addr))
787 eth_hw_addr_random(dev->net);
788
789
790 if (possibly_iphdr(dev->net->dev_addr)) {
791 dev->net->dev_addr[0] |= 0x02;
792 dev->net->dev_addr[0] &= 0xbf;
793 }
794 dev->net->netdev_ops = &qmi_wwan_netdev_ops;
795 dev->net->sysfs_groups[0] = &qmi_wwan_sysfs_attr_group;
796err:
797 return status;
798}
799
800static void qmi_wwan_unbind(struct usbnet *dev, struct usb_interface *intf)
801{
802 struct qmi_wwan_state *info = (void *)&dev->data;
803 struct usb_driver *driver = driver_of(intf);
804 struct usb_interface *other;
805
806 if (info->subdriver && info->subdriver->disconnect)
807 info->subdriver->disconnect(info->control);
808
809
810 if (le16_to_cpu(dev->udev->descriptor.bcdUSB) >= 0x0201) {
811 qmi_wwan_change_dtr(dev, false);
812 qmi_wwan_manage_power(dev, 0);
813 }
814
815
816 if (intf == info->control)
817 other = info->data;
818 else
819 other = info->control;
820
821
822 if (other && intf != other) {
823 usb_set_intfdata(other, NULL);
824 usb_driver_release_interface(driver, other);
825 }
826
827 info->subdriver = NULL;
828 info->data = NULL;
829 info->control = NULL;
830}
831
832
833
834
835
836
837
838static int qmi_wwan_suspend(struct usb_interface *intf, pm_message_t message)
839{
840 struct usbnet *dev = usb_get_intfdata(intf);
841 struct qmi_wwan_state *info = (void *)&dev->data;
842 int ret;
843
844
845
846
847
848 ret = usbnet_suspend(intf, message);
849 if (ret < 0)
850 goto err;
851
852 if (intf == info->control && info->subdriver &&
853 info->subdriver->suspend)
854 ret = info->subdriver->suspend(intf, message);
855 if (ret < 0)
856 usbnet_resume(intf);
857err:
858 return ret;
859}
860
861static int qmi_wwan_resume(struct usb_interface *intf)
862{
863 struct usbnet *dev = usb_get_intfdata(intf);
864 struct qmi_wwan_state *info = (void *)&dev->data;
865 int ret = 0;
866 bool callsub = (intf == info->control && info->subdriver &&
867 info->subdriver->resume);
868
869 if (callsub)
870 ret = info->subdriver->resume(intf);
871 if (ret < 0)
872 goto err;
873 ret = usbnet_resume(intf);
874 if (ret < 0 && callsub)
875 info->subdriver->suspend(intf, PMSG_SUSPEND);
876err:
877 return ret;
878}
879
880static const struct driver_info qmi_wwan_info = {
881 .description = "WWAN/QMI device",
882 .flags = FLAG_WWAN | FLAG_SEND_ZLP,
883 .bind = qmi_wwan_bind,
884 .unbind = qmi_wwan_unbind,
885 .manage_power = qmi_wwan_manage_power,
886 .rx_fixup = qmi_wwan_rx_fixup,
887};
888
889static const struct driver_info qmi_wwan_info_quirk_dtr = {
890 .description = "WWAN/QMI device",
891 .flags = FLAG_WWAN | FLAG_SEND_ZLP,
892 .bind = qmi_wwan_bind,
893 .unbind = qmi_wwan_unbind,
894 .manage_power = qmi_wwan_manage_power,
895 .rx_fixup = qmi_wwan_rx_fixup,
896 .data = QMI_WWAN_QUIRK_DTR,
897};
898
899#define HUAWEI_VENDOR_ID 0x12D1
900
901
902#define QMI_FIXED_INTF(vend, prod, num) \
903 USB_DEVICE_INTERFACE_NUMBER(vend, prod, num), \
904 .driver_info = (unsigned long)&qmi_wwan_info
905
906
907#define QMI_QUIRK_SET_DTR(vend, prod, num) \
908 USB_DEVICE_INTERFACE_NUMBER(vend, prod, num), \
909 .driver_info = (unsigned long)&qmi_wwan_info_quirk_dtr
910
911
912#define QMI_GOBI1K_DEVICE(vend, prod) \
913 QMI_FIXED_INTF(vend, prod, 3)
914
915
916#define QMI_GOBI_DEVICE(vend, prod) \
917 QMI_FIXED_INTF(vend, prod, 0)
918
919
920
921
922
923
924
925
926
927#define QMI_MATCH_FF_FF_FF(vend, prod) \
928 USB_DEVICE_AND_INTERFACE_INFO(vend, prod, USB_CLASS_VENDOR_SPEC, \
929 USB_SUBCLASS_VENDOR_SPEC, 0xff), \
930 .driver_info = (unsigned long)&qmi_wwan_info_quirk_dtr
931
932static const struct usb_device_id products[] = {
933
934 {
935 USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, USB_CLASS_VENDOR_SPEC, 1, 9),
936 .driver_info = (unsigned long)&qmi_wwan_info,
937 },
938 {
939 USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, USB_CLASS_VENDOR_SPEC, 1, 57),
940 .driver_info = (unsigned long)&qmi_wwan_info,
941 },
942 {
943 USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, USB_CLASS_VENDOR_SPEC, 0x01, 0x69),
944 .driver_info = (unsigned long)&qmi_wwan_info,
945 },
946 {
947 USB_VENDOR_AND_INTERFACE_INFO(0x22b8, USB_CLASS_VENDOR_SPEC, 0xfb, 0xff),
948 .driver_info = (unsigned long)&qmi_wwan_info,
949 },
950
951
952 {
953 USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, USB_CLASS_VENDOR_SPEC, 1, 7),
954 .driver_info = (unsigned long)&qmi_wwan_info,
955 },
956 {
957 USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, USB_CLASS_VENDOR_SPEC, 1, 17),
958 .driver_info = (unsigned long)&qmi_wwan_info,
959 },
960 {
961 USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, USB_CLASS_VENDOR_SPEC, 0x01, 0x37),
962 .driver_info = (unsigned long)&qmi_wwan_info,
963 },
964 {
965 USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, USB_CLASS_VENDOR_SPEC, 0x01, 0x67),
966 .driver_info = (unsigned long)&qmi_wwan_info,
967 },
968 {
969 USB_VENDOR_AND_INTERFACE_INFO(0x106c, USB_CLASS_VENDOR_SPEC, 0xf0, 0xff),
970 .driver_info = (unsigned long)&qmi_wwan_info,
971 },
972 {
973 USB_VENDOR_AND_INTERFACE_INFO(0x106c, USB_CLASS_VENDOR_SPEC, 0xf1, 0xff),
974 .driver_info = (unsigned long)&qmi_wwan_info,
975 },
976 {
977 USB_DEVICE_AND_INTERFACE_INFO(0x1410, 0xb001,
978 USB_CLASS_COMM,
979 USB_CDC_SUBCLASS_ETHERNET,
980 USB_CDC_PROTO_NONE),
981 .driver_info = (unsigned long)&qmi_wwan_info,
982 },
983 {
984 USB_DEVICE_AND_INTERFACE_INFO(0x1410, 0x9010,
985 USB_CLASS_COMM,
986 USB_CDC_SUBCLASS_ETHERNET,
987 USB_CDC_PROTO_NONE),
988 .driver_info = (unsigned long)&qmi_wwan_info,
989 },
990 {
991 USB_DEVICE_AND_INTERFACE_INFO(0x1410, 0x9011,
992 USB_CLASS_COMM,
993 USB_CDC_SUBCLASS_ETHERNET,
994 USB_CDC_PROTO_NONE),
995 .driver_info = (unsigned long)&qmi_wwan_info,
996 },
997 {
998 USB_DEVICE_AND_INTERFACE_INFO(0x413C, 0x8195,
999 USB_CLASS_COMM,
1000 USB_CDC_SUBCLASS_ETHERNET,
1001 USB_CDC_PROTO_NONE),
1002 .driver_info = (unsigned long)&qmi_wwan_info,
1003 },
1004 {
1005 USB_DEVICE_AND_INTERFACE_INFO(0x413C, 0x8196,
1006 USB_CLASS_COMM,
1007 USB_CDC_SUBCLASS_ETHERNET,
1008 USB_CDC_PROTO_NONE),
1009 .driver_info = (unsigned long)&qmi_wwan_info,
1010 },
1011 {
1012 USB_DEVICE_AND_INTERFACE_INFO(0x413C, 0x819b,
1013 USB_CLASS_COMM,
1014 USB_CDC_SUBCLASS_ETHERNET,
1015 USB_CDC_PROTO_NONE),
1016 .driver_info = (unsigned long)&qmi_wwan_info,
1017 },
1018 {
1019 USB_DEVICE_AND_INTERFACE_INFO(0x16d5, 0x650a,
1020 USB_CLASS_COMM,
1021 USB_CDC_SUBCLASS_ETHERNET,
1022 USB_CDC_PROTO_NONE),
1023 .driver_info = (unsigned long)&qmi_wwan_info,
1024 },
1025 {
1026 USB_DEVICE_AND_INTERFACE_INFO(0x03f0, 0x421d,
1027 USB_CLASS_COMM,
1028 USB_CDC_SUBCLASS_ETHERNET,
1029 USB_CDC_PROTO_NONE),
1030 .driver_info = (unsigned long)&qmi_wwan_info,
1031 },
1032 {
1033 USB_DEVICE_AND_INTERFACE_INFO(0x03f0, 0x581d, USB_CLASS_VENDOR_SPEC, 1, 7),
1034 .driver_info = (unsigned long)&qmi_wwan_info,
1035 },
1036 {QMI_MATCH_FF_FF_FF(0x2c7c, 0x0125)},
1037 {QMI_MATCH_FF_FF_FF(0x2c7c, 0x0306)},
1038 {QMI_MATCH_FF_FF_FF(0x2c7c, 0x0512)},
1039 {QMI_MATCH_FF_FF_FF(0x2c7c, 0x0800)},
1040
1041
1042 {QMI_FIXED_INTF(0x0408, 0xea42, 4)},
1043 {QMI_FIXED_INTF(0x05c6, 0x6001, 3)},
1044 {QMI_FIXED_INTF(0x05c6, 0x7000, 0)},
1045 {QMI_FIXED_INTF(0x05c6, 0x7001, 1)},
1046 {QMI_FIXED_INTF(0x05c6, 0x7002, 1)},
1047 {QMI_FIXED_INTF(0x05c6, 0x7101, 1)},
1048 {QMI_FIXED_INTF(0x05c6, 0x7101, 2)},
1049 {QMI_FIXED_INTF(0x05c6, 0x7101, 3)},
1050 {QMI_FIXED_INTF(0x05c6, 0x7102, 1)},
1051 {QMI_FIXED_INTF(0x05c6, 0x7102, 2)},
1052 {QMI_FIXED_INTF(0x05c6, 0x7102, 3)},
1053 {QMI_FIXED_INTF(0x05c6, 0x8000, 7)},
1054 {QMI_FIXED_INTF(0x05c6, 0x8001, 6)},
1055 {QMI_FIXED_INTF(0x05c6, 0x9000, 4)},
1056 {QMI_FIXED_INTF(0x05c6, 0x9003, 4)},
1057 {QMI_FIXED_INTF(0x05c6, 0x9005, 2)},
1058 {QMI_FIXED_INTF(0x05c6, 0x900a, 4)},
1059 {QMI_FIXED_INTF(0x05c6, 0x900b, 2)},
1060 {QMI_FIXED_INTF(0x05c6, 0x900c, 4)},
1061 {QMI_FIXED_INTF(0x05c6, 0x900c, 5)},
1062 {QMI_FIXED_INTF(0x05c6, 0x900c, 6)},
1063 {QMI_FIXED_INTF(0x05c6, 0x900d, 5)},
1064 {QMI_FIXED_INTF(0x05c6, 0x900f, 3)},
1065 {QMI_FIXED_INTF(0x05c6, 0x900f, 4)},
1066 {QMI_FIXED_INTF(0x05c6, 0x900f, 5)},
1067 {QMI_FIXED_INTF(0x05c6, 0x9010, 4)},
1068 {QMI_FIXED_INTF(0x05c6, 0x9010, 5)},
1069 {QMI_FIXED_INTF(0x05c6, 0x9011, 3)},
1070 {QMI_FIXED_INTF(0x05c6, 0x9011, 4)},
1071 {QMI_FIXED_INTF(0x05c6, 0x9021, 1)},
1072 {QMI_FIXED_INTF(0x05c6, 0x9022, 2)},
1073 {QMI_QUIRK_SET_DTR(0x05c6, 0x9025, 4)},
1074 {QMI_FIXED_INTF(0x05c6, 0x9026, 3)},
1075 {QMI_FIXED_INTF(0x05c6, 0x902e, 5)},
1076 {QMI_FIXED_INTF(0x05c6, 0x9031, 5)},
1077 {QMI_FIXED_INTF(0x05c6, 0x9032, 4)},
1078 {QMI_FIXED_INTF(0x05c6, 0x9033, 3)},
1079 {QMI_FIXED_INTF(0x05c6, 0x9033, 4)},
1080 {QMI_FIXED_INTF(0x05c6, 0x9033, 5)},
1081 {QMI_FIXED_INTF(0x05c6, 0x9033, 6)},
1082 {QMI_FIXED_INTF(0x05c6, 0x9034, 3)},
1083 {QMI_FIXED_INTF(0x05c6, 0x9034, 4)},
1084 {QMI_FIXED_INTF(0x05c6, 0x9034, 5)},
1085 {QMI_FIXED_INTF(0x05c6, 0x9034, 6)},
1086 {QMI_FIXED_INTF(0x05c6, 0x9034, 7)},
1087 {QMI_FIXED_INTF(0x05c6, 0x9035, 4)},
1088 {QMI_FIXED_INTF(0x05c6, 0x9036, 3)},
1089 {QMI_FIXED_INTF(0x05c6, 0x9037, 5)},
1090 {QMI_FIXED_INTF(0x05c6, 0x9038, 4)},
1091 {QMI_FIXED_INTF(0x05c6, 0x903b, 7)},
1092 {QMI_FIXED_INTF(0x05c6, 0x903c, 6)},
1093 {QMI_FIXED_INTF(0x05c6, 0x903d, 6)},
1094 {QMI_FIXED_INTF(0x05c6, 0x903e, 5)},
1095 {QMI_FIXED_INTF(0x05c6, 0x9043, 3)},
1096 {QMI_FIXED_INTF(0x05c6, 0x9046, 3)},
1097 {QMI_FIXED_INTF(0x05c6, 0x9046, 4)},
1098 {QMI_FIXED_INTF(0x05c6, 0x9046, 5)},
1099 {QMI_FIXED_INTF(0x05c6, 0x9047, 2)},
1100 {QMI_FIXED_INTF(0x05c6, 0x9047, 3)},
1101 {QMI_FIXED_INTF(0x05c6, 0x9047, 4)},
1102 {QMI_FIXED_INTF(0x05c6, 0x9048, 4)},
1103 {QMI_FIXED_INTF(0x05c6, 0x9048, 5)},
1104 {QMI_FIXED_INTF(0x05c6, 0x9048, 6)},
1105 {QMI_FIXED_INTF(0x05c6, 0x9048, 7)},
1106 {QMI_FIXED_INTF(0x05c6, 0x9048, 8)},
1107 {QMI_FIXED_INTF(0x05c6, 0x904c, 5)},
1108 {QMI_FIXED_INTF(0x05c6, 0x904c, 6)},
1109 {QMI_FIXED_INTF(0x05c6, 0x904c, 7)},
1110 {QMI_FIXED_INTF(0x05c6, 0x904c, 8)},
1111 {QMI_FIXED_INTF(0x05c6, 0x9050, 3)},
1112 {QMI_FIXED_INTF(0x05c6, 0x9052, 4)},
1113 {QMI_FIXED_INTF(0x05c6, 0x9053, 6)},
1114 {QMI_FIXED_INTF(0x05c6, 0x9053, 7)},
1115 {QMI_FIXED_INTF(0x05c6, 0x9054, 5)},
1116 {QMI_FIXED_INTF(0x05c6, 0x9054, 6)},
1117 {QMI_FIXED_INTF(0x05c6, 0x9055, 3)},
1118 {QMI_FIXED_INTF(0x05c6, 0x9055, 4)},
1119 {QMI_FIXED_INTF(0x05c6, 0x9055, 5)},
1120 {QMI_FIXED_INTF(0x05c6, 0x9055, 6)},
1121 {QMI_FIXED_INTF(0x05c6, 0x9055, 7)},
1122 {QMI_FIXED_INTF(0x05c6, 0x9056, 3)},
1123 {QMI_FIXED_INTF(0x05c6, 0x9062, 2)},
1124 {QMI_FIXED_INTF(0x05c6, 0x9062, 3)},
1125 {QMI_FIXED_INTF(0x05c6, 0x9062, 4)},
1126 {QMI_FIXED_INTF(0x05c6, 0x9062, 5)},
1127 {QMI_FIXED_INTF(0x05c6, 0x9062, 6)},
1128 {QMI_FIXED_INTF(0x05c6, 0x9062, 7)},
1129 {QMI_FIXED_INTF(0x05c6, 0x9062, 8)},
1130 {QMI_FIXED_INTF(0x05c6, 0x9062, 9)},
1131 {QMI_FIXED_INTF(0x05c6, 0x9064, 3)},
1132 {QMI_FIXED_INTF(0x05c6, 0x9065, 6)},
1133 {QMI_FIXED_INTF(0x05c6, 0x9065, 7)},
1134 {QMI_FIXED_INTF(0x05c6, 0x9066, 5)},
1135 {QMI_FIXED_INTF(0x05c6, 0x9066, 6)},
1136 {QMI_FIXED_INTF(0x05c6, 0x9067, 1)},
1137 {QMI_FIXED_INTF(0x05c6, 0x9068, 2)},
1138 {QMI_FIXED_INTF(0x05c6, 0x9068, 3)},
1139 {QMI_FIXED_INTF(0x05c6, 0x9068, 4)},
1140 {QMI_FIXED_INTF(0x05c6, 0x9068, 5)},
1141 {QMI_FIXED_INTF(0x05c6, 0x9068, 6)},
1142 {QMI_FIXED_INTF(0x05c6, 0x9068, 7)},
1143 {QMI_FIXED_INTF(0x05c6, 0x9069, 5)},
1144 {QMI_FIXED_INTF(0x05c6, 0x9069, 6)},
1145 {QMI_FIXED_INTF(0x05c6, 0x9069, 7)},
1146 {QMI_FIXED_INTF(0x05c6, 0x9069, 8)},
1147 {QMI_FIXED_INTF(0x05c6, 0x9070, 4)},
1148 {QMI_FIXED_INTF(0x05c6, 0x9070, 5)},
1149 {QMI_FIXED_INTF(0x05c6, 0x9075, 5)},
1150 {QMI_FIXED_INTF(0x05c6, 0x9076, 4)},
1151 {QMI_FIXED_INTF(0x05c6, 0x9076, 5)},
1152 {QMI_FIXED_INTF(0x05c6, 0x9076, 6)},
1153 {QMI_FIXED_INTF(0x05c6, 0x9076, 7)},
1154 {QMI_FIXED_INTF(0x05c6, 0x9076, 8)},
1155 {QMI_FIXED_INTF(0x05c6, 0x9077, 3)},
1156 {QMI_FIXED_INTF(0x05c6, 0x9077, 4)},
1157 {QMI_FIXED_INTF(0x05c6, 0x9077, 5)},
1158 {QMI_FIXED_INTF(0x05c6, 0x9077, 6)},
1159 {QMI_FIXED_INTF(0x05c6, 0x9078, 3)},
1160 {QMI_FIXED_INTF(0x05c6, 0x9079, 4)},
1161 {QMI_FIXED_INTF(0x05c6, 0x9079, 5)},
1162 {QMI_FIXED_INTF(0x05c6, 0x9079, 6)},
1163 {QMI_FIXED_INTF(0x05c6, 0x9079, 7)},
1164 {QMI_FIXED_INTF(0x05c6, 0x9079, 8)},
1165 {QMI_FIXED_INTF(0x05c6, 0x9080, 5)},
1166 {QMI_FIXED_INTF(0x05c6, 0x9080, 6)},
1167 {QMI_FIXED_INTF(0x05c6, 0x9080, 7)},
1168 {QMI_FIXED_INTF(0x05c6, 0x9080, 8)},
1169 {QMI_FIXED_INTF(0x05c6, 0x9083, 3)},
1170 {QMI_FIXED_INTF(0x05c6, 0x9084, 4)},
1171 {QMI_FIXED_INTF(0x05c6, 0x90b2, 3)},
1172 {QMI_FIXED_INTF(0x05c6, 0x920d, 0)},
1173 {QMI_FIXED_INTF(0x05c6, 0x920d, 5)},
1174 {QMI_QUIRK_SET_DTR(0x05c6, 0x9625, 4)},
1175 {QMI_FIXED_INTF(0x0846, 0x68a2, 8)},
1176 {QMI_FIXED_INTF(0x0846, 0x68d3, 8)},
1177 {QMI_FIXED_INTF(0x12d1, 0x140c, 1)},
1178 {QMI_FIXED_INTF(0x12d1, 0x14ac, 1)},
1179 {QMI_FIXED_INTF(0x1435, 0x0918, 3)},
1180 {QMI_FIXED_INTF(0x1435, 0x0918, 4)},
1181 {QMI_FIXED_INTF(0x1435, 0x0918, 5)},
1182 {QMI_FIXED_INTF(0x1435, 0x3185, 4)},
1183 {QMI_FIXED_INTF(0x1435, 0xd111, 4)},
1184 {QMI_FIXED_INTF(0x1435, 0xd181, 3)},
1185 {QMI_FIXED_INTF(0x1435, 0xd181, 4)},
1186 {QMI_FIXED_INTF(0x1435, 0xd181, 5)},
1187 {QMI_FIXED_INTF(0x1435, 0xd182, 4)},
1188 {QMI_FIXED_INTF(0x1435, 0xd182, 5)},
1189 {QMI_FIXED_INTF(0x1435, 0xd191, 4)},
1190 {QMI_QUIRK_SET_DTR(0x1508, 0x1001, 4)},
1191 {QMI_FIXED_INTF(0x1690, 0x7588, 4)},
1192 {QMI_FIXED_INTF(0x16d8, 0x6003, 0)},
1193 {QMI_FIXED_INTF(0x16d8, 0x6007, 0)},
1194 {QMI_FIXED_INTF(0x16d8, 0x6008, 0)},
1195 {QMI_FIXED_INTF(0x16d8, 0x6280, 0)},
1196 {QMI_FIXED_INTF(0x16d8, 0x7001, 0)},
1197 {QMI_FIXED_INTF(0x16d8, 0x7002, 0)},
1198 {QMI_FIXED_INTF(0x16d8, 0x7003, 4)},
1199 {QMI_FIXED_INTF(0x16d8, 0x7004, 3)},
1200 {QMI_FIXED_INTF(0x16d8, 0x7006, 5)},
1201 {QMI_FIXED_INTF(0x16d8, 0x700a, 4)},
1202 {QMI_FIXED_INTF(0x16d8, 0x7211, 0)},
1203 {QMI_FIXED_INTF(0x16d8, 0x7212, 0)},
1204 {QMI_FIXED_INTF(0x16d8, 0x7213, 0)},
1205 {QMI_FIXED_INTF(0x16d8, 0x7251, 1)},
1206 {QMI_FIXED_INTF(0x16d8, 0x7252, 1)},
1207 {QMI_FIXED_INTF(0x16d8, 0x7253, 1)},
1208 {QMI_FIXED_INTF(0x19d2, 0x0002, 1)},
1209 {QMI_FIXED_INTF(0x19d2, 0x0012, 1)},
1210 {QMI_FIXED_INTF(0x19d2, 0x0017, 3)},
1211 {QMI_FIXED_INTF(0x19d2, 0x0019, 3)},
1212 {QMI_FIXED_INTF(0x19d2, 0x0021, 4)},
1213 {QMI_FIXED_INTF(0x19d2, 0x0025, 1)},
1214 {QMI_FIXED_INTF(0x19d2, 0x0031, 4)},
1215 {QMI_FIXED_INTF(0x19d2, 0x0042, 4)},
1216 {QMI_FIXED_INTF(0x19d2, 0x0049, 5)},
1217 {QMI_FIXED_INTF(0x19d2, 0x0052, 4)},
1218 {QMI_FIXED_INTF(0x19d2, 0x0055, 1)},
1219 {QMI_FIXED_INTF(0x19d2, 0x0058, 4)},
1220 {QMI_FIXED_INTF(0x19d2, 0x0063, 4)},
1221 {QMI_FIXED_INTF(0x19d2, 0x0104, 4)},
1222 {QMI_FIXED_INTF(0x19d2, 0x0113, 5)},
1223 {QMI_FIXED_INTF(0x19d2, 0x0118, 5)},
1224 {QMI_FIXED_INTF(0x19d2, 0x0121, 5)},
1225 {QMI_FIXED_INTF(0x19d2, 0x0123, 4)},
1226 {QMI_FIXED_INTF(0x19d2, 0x0124, 5)},
1227 {QMI_FIXED_INTF(0x19d2, 0x0125, 6)},
1228 {QMI_FIXED_INTF(0x19d2, 0x0126, 5)},
1229 {QMI_FIXED_INTF(0x19d2, 0x0130, 1)},
1230 {QMI_FIXED_INTF(0x19d2, 0x0133, 3)},
1231 {QMI_FIXED_INTF(0x19d2, 0x0141, 5)},
1232 {QMI_FIXED_INTF(0x19d2, 0x0157, 5)},
1233 {QMI_FIXED_INTF(0x19d2, 0x0158, 3)},
1234 {QMI_FIXED_INTF(0x19d2, 0x0167, 4)},
1235 {QMI_FIXED_INTF(0x19d2, 0x0168, 4)},
1236 {QMI_FIXED_INTF(0x19d2, 0x0176, 3)},
1237 {QMI_FIXED_INTF(0x19d2, 0x0178, 3)},
1238 {QMI_FIXED_INTF(0x19d2, 0x0191, 4)},
1239 {QMI_FIXED_INTF(0x19d2, 0x0199, 1)},
1240 {QMI_FIXED_INTF(0x19d2, 0x0200, 1)},
1241 {QMI_FIXED_INTF(0x19d2, 0x0257, 3)},
1242 {QMI_FIXED_INTF(0x19d2, 0x0265, 4)},
1243 {QMI_FIXED_INTF(0x19d2, 0x0284, 4)},
1244 {QMI_FIXED_INTF(0x19d2, 0x0326, 4)},
1245 {QMI_FIXED_INTF(0x19d2, 0x0396, 3)},
1246 {QMI_FIXED_INTF(0x19d2, 0x0412, 4)},
1247 {QMI_FIXED_INTF(0x19d2, 0x1008, 4)},
1248 {QMI_FIXED_INTF(0x19d2, 0x1010, 4)},
1249 {QMI_FIXED_INTF(0x19d2, 0x1012, 4)},
1250 {QMI_FIXED_INTF(0x19d2, 0x1018, 3)},
1251 {QMI_FIXED_INTF(0x19d2, 0x1021, 2)},
1252 {QMI_FIXED_INTF(0x19d2, 0x1245, 4)},
1253 {QMI_FIXED_INTF(0x19d2, 0x1247, 4)},
1254 {QMI_FIXED_INTF(0x19d2, 0x1252, 4)},
1255 {QMI_FIXED_INTF(0x19d2, 0x1254, 4)},
1256 {QMI_FIXED_INTF(0x19d2, 0x1255, 3)},
1257 {QMI_FIXED_INTF(0x19d2, 0x1255, 4)},
1258 {QMI_FIXED_INTF(0x19d2, 0x1256, 4)},
1259 {QMI_FIXED_INTF(0x19d2, 0x1270, 5)},
1260 {QMI_FIXED_INTF(0x19d2, 0x1401, 2)},
1261 {QMI_FIXED_INTF(0x19d2, 0x1402, 2)},
1262 {QMI_FIXED_INTF(0x19d2, 0x1424, 2)},
1263 {QMI_FIXED_INTF(0x19d2, 0x1425, 2)},
1264 {QMI_FIXED_INTF(0x19d2, 0x1426, 2)},
1265 {QMI_FIXED_INTF(0x19d2, 0x1428, 2)},
1266 {QMI_FIXED_INTF(0x19d2, 0x1432, 3)},
1267 {QMI_FIXED_INTF(0x19d2, 0x2002, 4)},
1268 {QMI_FIXED_INTF(0x2001, 0x7e16, 3)},
1269 {QMI_FIXED_INTF(0x2001, 0x7e19, 4)},
1270 {QMI_FIXED_INTF(0x2001, 0x7e35, 4)},
1271 {QMI_FIXED_INTF(0x2001, 0x7e3d, 4)},
1272 {QMI_FIXED_INTF(0x2020, 0x2031, 4)},
1273 {QMI_FIXED_INTF(0x2020, 0x2033, 4)},
1274 {QMI_FIXED_INTF(0x2020, 0x2060, 4)},
1275 {QMI_FIXED_INTF(0x0f3d, 0x68a2, 8)},
1276 {QMI_FIXED_INTF(0x114f, 0x68a2, 8)},
1277 {QMI_FIXED_INTF(0x1199, 0x68a2, 8)},
1278 {QMI_FIXED_INTF(0x1199, 0x68a2, 19)},
1279 {QMI_QUIRK_SET_DTR(0x1199, 0x68c0, 8)},
1280 {QMI_QUIRK_SET_DTR(0x1199, 0x68c0, 10)},
1281 {QMI_FIXED_INTF(0x1199, 0x901c, 8)},
1282 {QMI_FIXED_INTF(0x1199, 0x901f, 8)},
1283 {QMI_FIXED_INTF(0x1199, 0x9041, 8)},
1284 {QMI_FIXED_INTF(0x1199, 0x9041, 10)},
1285 {QMI_FIXED_INTF(0x1199, 0x9051, 8)},
1286 {QMI_FIXED_INTF(0x1199, 0x9053, 8)},
1287 {QMI_FIXED_INTF(0x1199, 0x9054, 8)},
1288 {QMI_FIXED_INTF(0x1199, 0x9055, 8)},
1289 {QMI_FIXED_INTF(0x1199, 0x9056, 8)},
1290 {QMI_FIXED_INTF(0x1199, 0x9057, 8)},
1291 {QMI_FIXED_INTF(0x1199, 0x9061, 8)},
1292 {QMI_FIXED_INTF(0x1199, 0x9063, 8)},
1293 {QMI_FIXED_INTF(0x1199, 0x9063, 10)},
1294 {QMI_QUIRK_SET_DTR(0x1199, 0x9071, 8)},
1295 {QMI_QUIRK_SET_DTR(0x1199, 0x9071, 10)},
1296 {QMI_QUIRK_SET_DTR(0x1199, 0x9079, 8)},
1297 {QMI_QUIRK_SET_DTR(0x1199, 0x9079, 10)},
1298 {QMI_QUIRK_SET_DTR(0x1199, 0x907b, 8)},
1299 {QMI_QUIRK_SET_DTR(0x1199, 0x907b, 10)},
1300 {QMI_QUIRK_SET_DTR(0x1199, 0x9091, 8)},
1301 {QMI_FIXED_INTF(0x1bbb, 0x011e, 4)},
1302 {QMI_FIXED_INTF(0x1bbb, 0x0203, 2)},
1303 {QMI_FIXED_INTF(0x2357, 0x0201, 4)},
1304 {QMI_FIXED_INTF(0x2357, 0x9000, 4)},
1305 {QMI_QUIRK_SET_DTR(0x1bc7, 0x1031, 3)},
1306 {QMI_QUIRK_SET_DTR(0x1bc7, 0x1040, 2)},
1307 {QMI_QUIRK_SET_DTR(0x1bc7, 0x1050, 2)},
1308 {QMI_FIXED_INTF(0x1bc7, 0x1100, 3)},
1309 {QMI_FIXED_INTF(0x1bc7, 0x1101, 3)},
1310 {QMI_FIXED_INTF(0x1bc7, 0x1200, 5)},
1311 {QMI_QUIRK_SET_DTR(0x1bc7, 0x1201, 2)},
1312 {QMI_QUIRK_SET_DTR(0x1bc7, 0x1230, 2)},
1313 {QMI_QUIRK_SET_DTR(0x1bc7, 0x1260, 2)},
1314 {QMI_QUIRK_SET_DTR(0x1bc7, 0x1261, 2)},
1315 {QMI_QUIRK_SET_DTR(0x1bc7, 0x1900, 1)},
1316 {QMI_FIXED_INTF(0x1c9e, 0x9801, 3)},
1317 {QMI_FIXED_INTF(0x1c9e, 0x9803, 4)},
1318 {QMI_FIXED_INTF(0x1c9e, 0x9b01, 3)},
1319 {QMI_FIXED_INTF(0x0b3c, 0xc000, 4)},
1320 {QMI_FIXED_INTF(0x0b3c, 0xc001, 4)},
1321 {QMI_FIXED_INTF(0x0b3c, 0xc002, 4)},
1322 {QMI_FIXED_INTF(0x0b3c, 0xc004, 6)},
1323 {QMI_FIXED_INTF(0x0b3c, 0xc005, 6)},
1324 {QMI_FIXED_INTF(0x0b3c, 0xc00a, 6)},
1325 {QMI_FIXED_INTF(0x0b3c, 0xc00b, 4)},
1326 {QMI_FIXED_INTF(0x1e2d, 0x0060, 4)},
1327 {QMI_FIXED_INTF(0x1e2d, 0x0053, 4)},
1328 {QMI_FIXED_INTF(0x1e2d, 0x0063, 10)},
1329 {QMI_FIXED_INTF(0x1e2d, 0x0082, 4)},
1330 {QMI_FIXED_INTF(0x1e2d, 0x0082, 5)},
1331 {QMI_FIXED_INTF(0x1e2d, 0x0083, 4)},
1332 {QMI_QUIRK_SET_DTR(0x1e2d, 0x00b0, 4)},
1333 {QMI_FIXED_INTF(0x413c, 0x81a2, 8)},
1334 {QMI_FIXED_INTF(0x413c, 0x81a3, 8)},
1335 {QMI_FIXED_INTF(0x413c, 0x81a4, 8)},
1336 {QMI_FIXED_INTF(0x413c, 0x81a8, 8)},
1337 {QMI_FIXED_INTF(0x413c, 0x81a9, 8)},
1338 {QMI_FIXED_INTF(0x413c, 0x81b1, 8)},
1339 {QMI_FIXED_INTF(0x413c, 0x81b3, 8)},
1340 {QMI_FIXED_INTF(0x413c, 0x81b6, 8)},
1341 {QMI_FIXED_INTF(0x413c, 0x81b6, 10)},
1342 {QMI_FIXED_INTF(0x413c, 0x81cc, 8)},
1343 {QMI_FIXED_INTF(0x413c, 0x81d7, 0)},
1344 {QMI_FIXED_INTF(0x413c, 0x81d7, 1)},
1345 {QMI_FIXED_INTF(0x413c, 0x81e0, 0)},
1346 {QMI_FIXED_INTF(0x03f0, 0x4e1d, 8)},
1347 {QMI_FIXED_INTF(0x03f0, 0x9d1d, 1)},
1348 {QMI_FIXED_INTF(0x22de, 0x9061, 3)},
1349 {QMI_QUIRK_SET_DTR(0x1e0e, 0x9001, 5)},
1350 {QMI_QUIRK_SET_DTR(0x2c7c, 0x0121, 4)},
1351 {QMI_QUIRK_SET_DTR(0x2c7c, 0x0191, 4)},
1352 {QMI_QUIRK_SET_DTR(0x2c7c, 0x0195, 4)},
1353 {QMI_FIXED_INTF(0x2c7c, 0x0296, 4)},
1354 {QMI_QUIRK_SET_DTR(0x2cb7, 0x0104, 4)},
1355 {QMI_FIXED_INTF(0x0489, 0xe0b4, 0)},
1356 {QMI_FIXED_INTF(0x0489, 0xe0b5, 0)},
1357 {QMI_FIXED_INTF(0x2692, 0x9025, 4)},
1358
1359
1360 {QMI_GOBI1K_DEVICE(0x05c6, 0x9212)},
1361 {QMI_GOBI1K_DEVICE(0x03f0, 0x1f1d)},
1362 {QMI_GOBI1K_DEVICE(0x04da, 0x250d)},
1363 {QMI_GOBI1K_DEVICE(0x413c, 0x8172)},
1364 {QMI_GOBI1K_DEVICE(0x1410, 0xa001)},
1365 {QMI_GOBI1K_DEVICE(0x1410, 0xa002)},
1366 {QMI_GOBI1K_DEVICE(0x1410, 0xa003)},
1367 {QMI_GOBI1K_DEVICE(0x1410, 0xa004)},
1368 {QMI_GOBI1K_DEVICE(0x1410, 0xa005)},
1369 {QMI_GOBI1K_DEVICE(0x1410, 0xa006)},
1370 {QMI_GOBI1K_DEVICE(0x1410, 0xa007)},
1371 {QMI_GOBI1K_DEVICE(0x0b05, 0x1776)},
1372 {QMI_GOBI1K_DEVICE(0x19d2, 0xfff3)},
1373 {QMI_GOBI1K_DEVICE(0x05c6, 0x9001)},
1374 {QMI_GOBI1K_DEVICE(0x05c6, 0x9002)},
1375 {QMI_GOBI1K_DEVICE(0x05c6, 0x9202)},
1376 {QMI_GOBI1K_DEVICE(0x05c6, 0x9203)},
1377 {QMI_GOBI1K_DEVICE(0x05c6, 0x9222)},
1378 {QMI_GOBI1K_DEVICE(0x05c6, 0x9009)},
1379
1380
1381 {QMI_GOBI_DEVICE(0x413c, 0x8186)},
1382 {QMI_GOBI_DEVICE(0x413c, 0x8194)},
1383 {QMI_GOBI_DEVICE(0x05c6, 0x920b)},
1384 {QMI_GOBI_DEVICE(0x05c6, 0x9225)},
1385 {QMI_GOBI_DEVICE(0x05c6, 0x9245)},
1386 {QMI_GOBI_DEVICE(0x03f0, 0x251d)},
1387 {QMI_GOBI_DEVICE(0x05c6, 0x9215)},
1388 {QMI_FIXED_INTF(0x05c6, 0x9215, 4)},
1389 {QMI_GOBI_DEVICE(0x05c6, 0x9265)},
1390 {QMI_GOBI_DEVICE(0x05c6, 0x9235)},
1391 {QMI_GOBI_DEVICE(0x05c6, 0x9275)},
1392 {QMI_GOBI_DEVICE(0x0af0, 0x8120)},
1393 {QMI_GOBI_DEVICE(0x1199, 0x68a5)},
1394 {QMI_GOBI_DEVICE(0x1199, 0x68a9)},
1395 {QMI_GOBI_DEVICE(0x1199, 0x9001)},
1396 {QMI_GOBI_DEVICE(0x1199, 0x9002)},
1397 {QMI_GOBI_DEVICE(0x1199, 0x9003)},
1398 {QMI_GOBI_DEVICE(0x1199, 0x9004)},
1399 {QMI_GOBI_DEVICE(0x1199, 0x9005)},
1400 {QMI_GOBI_DEVICE(0x1199, 0x9006)},
1401 {QMI_GOBI_DEVICE(0x1199, 0x9007)},
1402 {QMI_GOBI_DEVICE(0x1199, 0x9008)},
1403 {QMI_GOBI_DEVICE(0x1199, 0x9009)},
1404 {QMI_GOBI_DEVICE(0x1199, 0x900a)},
1405 {QMI_GOBI_DEVICE(0x1199, 0x9011)},
1406 {QMI_GOBI_DEVICE(0x16d8, 0x8002)},
1407 {QMI_GOBI_DEVICE(0x05c6, 0x9205)},
1408 {QMI_GOBI_DEVICE(0x1199, 0x9013)},
1409 {QMI_GOBI_DEVICE(0x03f0, 0x371d)},
1410 {QMI_GOBI_DEVICE(0x1199, 0x9015)},
1411 {QMI_GOBI_DEVICE(0x1199, 0x9019)},
1412 {QMI_GOBI_DEVICE(0x1199, 0x901b)},
1413 {QMI_GOBI_DEVICE(0x12d1, 0x14f1)},
1414 {QMI_GOBI_DEVICE(0x1410, 0xa021)},
1415
1416 { }
1417};
1418MODULE_DEVICE_TABLE(usb, products);
1419
1420static bool quectel_ec20_detected(struct usb_interface *intf)
1421{
1422 struct usb_device *dev = interface_to_usbdev(intf);
1423
1424 if (dev->actconfig &&
1425 le16_to_cpu(dev->descriptor.idVendor) == 0x05c6 &&
1426 le16_to_cpu(dev->descriptor.idProduct) == 0x9215 &&
1427 dev->actconfig->desc.bNumInterfaces == 5)
1428 return true;
1429
1430 return false;
1431}
1432
1433static int qmi_wwan_probe(struct usb_interface *intf,
1434 const struct usb_device_id *prod)
1435{
1436 struct usb_device_id *id = (struct usb_device_id *)prod;
1437 struct usb_interface_descriptor *desc = &intf->cur_altsetting->desc;
1438
1439
1440
1441
1442
1443
1444 if (!id->driver_info) {
1445 dev_dbg(&intf->dev, "setting defaults for dynamic device id\n");
1446 id->driver_info = (unsigned long)&qmi_wwan_info;
1447 }
1448
1449
1450
1451
1452
1453 if (id->match_flags & USB_DEVICE_ID_MATCH_INT_NUMBER &&
1454 desc->bInterfaceClass != USB_CLASS_VENDOR_SPEC) {
1455 dev_dbg(&intf->dev,
1456 "Rejecting interface number match for class %02x\n",
1457 desc->bInterfaceClass);
1458 return -ENODEV;
1459 }
1460
1461
1462 if (quectel_ec20_detected(intf) && desc->bInterfaceNumber == 0) {
1463 dev_dbg(&intf->dev, "Quectel EC20 quirk, skipping interface 0\n");
1464 return -ENODEV;
1465 }
1466
1467
1468
1469
1470
1471
1472
1473 if (desc->bNumEndpoints == 2)
1474 return -ENODEV;
1475
1476 return usbnet_probe(intf, id);
1477}
1478
1479static void qmi_wwan_disconnect(struct usb_interface *intf)
1480{
1481 struct usbnet *dev = usb_get_intfdata(intf);
1482 struct qmi_wwan_state *info;
1483 struct list_head *iter;
1484 struct net_device *ldev;
1485 LIST_HEAD(list);
1486
1487
1488 if (!dev)
1489 return;
1490 info = (void *)&dev->data;
1491 if (info->flags & QMI_WWAN_FLAG_MUX) {
1492 if (!rtnl_trylock()) {
1493 restart_syscall();
1494 return;
1495 }
1496 rcu_read_lock();
1497 netdev_for_each_upper_dev_rcu(dev->net, ldev, iter)
1498 qmimux_unregister_device(ldev, &list);
1499 rcu_read_unlock();
1500 unregister_netdevice_many(&list);
1501 rtnl_unlock();
1502 info->flags &= ~QMI_WWAN_FLAG_MUX;
1503 }
1504 usbnet_disconnect(intf);
1505}
1506
1507static struct usb_driver qmi_wwan_driver = {
1508 .name = "qmi_wwan",
1509 .id_table = products,
1510 .probe = qmi_wwan_probe,
1511 .disconnect = qmi_wwan_disconnect,
1512 .suspend = qmi_wwan_suspend,
1513 .resume = qmi_wwan_resume,
1514 .reset_resume = qmi_wwan_resume,
1515 .supports_autosuspend = 1,
1516 .disable_hub_initiated_lpm = 1,
1517};
1518
1519module_usb_driver(qmi_wwan_driver);
1520
1521MODULE_AUTHOR("Bjørn Mork <bjorn@mork.no>");
1522MODULE_DESCRIPTION("Qualcomm MSM Interface (QMI) WWAN driver");
1523MODULE_LICENSE("GPL");
1524