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