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