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