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 dev->net->dev_addr[0] |= 0x02;
839 dev->net->dev_addr[0] &= 0xbf;
840 }
841 dev->net->netdev_ops = &qmi_wwan_netdev_ops;
842 dev->net->sysfs_groups[0] = &qmi_wwan_sysfs_attr_group;
843err:
844 return status;
845}
846
847static void qmi_wwan_unbind(struct usbnet *dev, struct usb_interface *intf)
848{
849 struct qmi_wwan_state *info = (void *)&dev->data;
850 struct usb_driver *driver = driver_of(intf);
851 struct usb_interface *other;
852
853 if (info->subdriver && info->subdriver->disconnect)
854 info->subdriver->disconnect(info->control);
855
856
857 if (le16_to_cpu(dev->udev->descriptor.bcdUSB) >= 0x0201) {
858 qmi_wwan_change_dtr(dev, false);
859 qmi_wwan_manage_power(dev, 0);
860 }
861
862
863 if (intf == info->control)
864 other = info->data;
865 else
866 other = info->control;
867
868
869 if (other && intf != other) {
870 usb_set_intfdata(other, NULL);
871 usb_driver_release_interface(driver, other);
872 }
873
874 info->subdriver = NULL;
875 info->data = NULL;
876 info->control = NULL;
877}
878
879
880
881
882
883
884
885static int qmi_wwan_suspend(struct usb_interface *intf, pm_message_t message)
886{
887 struct usbnet *dev = usb_get_intfdata(intf);
888 struct qmi_wwan_state *info = (void *)&dev->data;
889 int ret;
890
891
892
893
894
895 ret = usbnet_suspend(intf, message);
896 if (ret < 0)
897 goto err;
898
899 if (intf == info->control && info->subdriver &&
900 info->subdriver->suspend)
901 ret = info->subdriver->suspend(intf, message);
902 if (ret < 0)
903 usbnet_resume(intf);
904err:
905 return ret;
906}
907
908static int qmi_wwan_resume(struct usb_interface *intf)
909{
910 struct usbnet *dev = usb_get_intfdata(intf);
911 struct qmi_wwan_state *info = (void *)&dev->data;
912 int ret = 0;
913 bool callsub = (intf == info->control && info->subdriver &&
914 info->subdriver->resume);
915
916 if (callsub)
917 ret = info->subdriver->resume(intf);
918 if (ret < 0)
919 goto err;
920 ret = usbnet_resume(intf);
921 if (ret < 0 && callsub)
922 info->subdriver->suspend(intf, PMSG_SUSPEND);
923err:
924 return ret;
925}
926
927static const struct driver_info qmi_wwan_info = {
928 .description = "WWAN/QMI device",
929 .flags = FLAG_WWAN | FLAG_SEND_ZLP,
930 .bind = qmi_wwan_bind,
931 .unbind = qmi_wwan_unbind,
932 .manage_power = qmi_wwan_manage_power,
933 .rx_fixup = qmi_wwan_rx_fixup,
934};
935
936static const struct driver_info qmi_wwan_info_quirk_dtr = {
937 .description = "WWAN/QMI device",
938 .flags = FLAG_WWAN | FLAG_SEND_ZLP,
939 .bind = qmi_wwan_bind,
940 .unbind = qmi_wwan_unbind,
941 .manage_power = qmi_wwan_manage_power,
942 .rx_fixup = qmi_wwan_rx_fixup,
943 .data = QMI_WWAN_QUIRK_DTR,
944};
945
946#define HUAWEI_VENDOR_ID 0x12D1
947
948
949#define QMI_FIXED_INTF(vend, prod, num) \
950 USB_DEVICE_INTERFACE_NUMBER(vend, prod, num), \
951 .driver_info = (unsigned long)&qmi_wwan_info
952
953
954#define QMI_QUIRK_SET_DTR(vend, prod, num) \
955 USB_DEVICE_INTERFACE_NUMBER(vend, prod, num), \
956 .driver_info = (unsigned long)&qmi_wwan_info_quirk_dtr
957
958
959#define QMI_GOBI1K_DEVICE(vend, prod) \
960 QMI_FIXED_INTF(vend, prod, 3)
961
962
963#define QMI_GOBI_DEVICE(vend, prod) \
964 QMI_FIXED_INTF(vend, prod, 0)
965
966
967
968
969
970
971
972
973
974#define QMI_MATCH_FF_FF_FF(vend, prod) \
975 USB_DEVICE_AND_INTERFACE_INFO(vend, prod, USB_CLASS_VENDOR_SPEC, \
976 USB_SUBCLASS_VENDOR_SPEC, 0xff), \
977 .driver_info = (unsigned long)&qmi_wwan_info_quirk_dtr
978
979static const struct usb_device_id products[] = {
980
981 {
982 USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, USB_CLASS_VENDOR_SPEC, 1, 9),
983 .driver_info = (unsigned long)&qmi_wwan_info,
984 },
985 {
986 USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, USB_CLASS_VENDOR_SPEC, 1, 57),
987 .driver_info = (unsigned long)&qmi_wwan_info,
988 },
989 {
990 USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, USB_CLASS_VENDOR_SPEC, 0x01, 0x69),
991 .driver_info = (unsigned long)&qmi_wwan_info,
992 },
993 {
994 USB_VENDOR_AND_INTERFACE_INFO(0x22b8, USB_CLASS_VENDOR_SPEC, 0xfb, 0xff),
995 .driver_info = (unsigned long)&qmi_wwan_info,
996 },
997
998
999 {
1000 USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, USB_CLASS_VENDOR_SPEC, 1, 7),
1001 .driver_info = (unsigned long)&qmi_wwan_info,
1002 },
1003 {
1004 USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, USB_CLASS_VENDOR_SPEC, 1, 17),
1005 .driver_info = (unsigned long)&qmi_wwan_info,
1006 },
1007 {
1008 USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, USB_CLASS_VENDOR_SPEC, 0x01, 0x37),
1009 .driver_info = (unsigned long)&qmi_wwan_info,
1010 },
1011 {
1012 USB_VENDOR_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, USB_CLASS_VENDOR_SPEC, 0x01, 0x67),
1013 .driver_info = (unsigned long)&qmi_wwan_info,
1014 },
1015 {
1016 USB_VENDOR_AND_INTERFACE_INFO(0x106c, USB_CLASS_VENDOR_SPEC, 0xf0, 0xff),
1017 .driver_info = (unsigned long)&qmi_wwan_info,
1018 },
1019 {
1020 USB_VENDOR_AND_INTERFACE_INFO(0x106c, USB_CLASS_VENDOR_SPEC, 0xf1, 0xff),
1021 .driver_info = (unsigned long)&qmi_wwan_info,
1022 },
1023 {
1024 USB_DEVICE_AND_INTERFACE_INFO(0x1410, 0xb001,
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(0x1410, 0x9010,
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(0x1410, 0x9011,
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(0x413C, 0x8195,
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(0x413C, 0x8196,
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(0x413C, 0x819b,
1060 USB_CLASS_COMM,
1061 USB_CDC_SUBCLASS_ETHERNET,
1062 USB_CDC_PROTO_NONE),
1063 .driver_info = (unsigned long)&qmi_wwan_info,
1064 },
1065 {
1066 USB_DEVICE_AND_INTERFACE_INFO(0x16d5, 0x650a,
1067 USB_CLASS_COMM,
1068 USB_CDC_SUBCLASS_ETHERNET,
1069 USB_CDC_PROTO_NONE),
1070 .driver_info = (unsigned long)&qmi_wwan_info,
1071 },
1072 {
1073 USB_DEVICE_AND_INTERFACE_INFO(0x03f0, 0x421d,
1074 USB_CLASS_COMM,
1075 USB_CDC_SUBCLASS_ETHERNET,
1076 USB_CDC_PROTO_NONE),
1077 .driver_info = (unsigned long)&qmi_wwan_info,
1078 },
1079 {
1080 USB_DEVICE_AND_INTERFACE_INFO(0x03f0, 0x581d, USB_CLASS_VENDOR_SPEC, 1, 7),
1081 .driver_info = (unsigned long)&qmi_wwan_info,
1082 },
1083 {QMI_MATCH_FF_FF_FF(0x2c7c, 0x0125)},
1084 {QMI_MATCH_FF_FF_FF(0x2c7c, 0x0306)},
1085 {QMI_MATCH_FF_FF_FF(0x2c7c, 0x0512)},
1086 {QMI_MATCH_FF_FF_FF(0x2c7c, 0x0620)},
1087 {QMI_MATCH_FF_FF_FF(0x2c7c, 0x0800)},
1088
1089
1090 {QMI_FIXED_INTF(0x0408, 0xea42, 4)},
1091 {QMI_FIXED_INTF(0x05c6, 0x6001, 3)},
1092 {QMI_FIXED_INTF(0x05c6, 0x7000, 0)},
1093 {QMI_FIXED_INTF(0x05c6, 0x7001, 1)},
1094 {QMI_FIXED_INTF(0x05c6, 0x7002, 1)},
1095 {QMI_FIXED_INTF(0x05c6, 0x7101, 1)},
1096 {QMI_FIXED_INTF(0x05c6, 0x7101, 2)},
1097 {QMI_FIXED_INTF(0x05c6, 0x7101, 3)},
1098 {QMI_FIXED_INTF(0x05c6, 0x7102, 1)},
1099 {QMI_FIXED_INTF(0x05c6, 0x7102, 2)},
1100 {QMI_FIXED_INTF(0x05c6, 0x7102, 3)},
1101 {QMI_FIXED_INTF(0x05c6, 0x8000, 7)},
1102 {QMI_FIXED_INTF(0x05c6, 0x8001, 6)},
1103 {QMI_FIXED_INTF(0x05c6, 0x9000, 4)},
1104 {QMI_FIXED_INTF(0x05c6, 0x9003, 4)},
1105 {QMI_FIXED_INTF(0x05c6, 0x9005, 2)},
1106 {QMI_FIXED_INTF(0x05c6, 0x900a, 4)},
1107 {QMI_FIXED_INTF(0x05c6, 0x900b, 2)},
1108 {QMI_FIXED_INTF(0x05c6, 0x900c, 4)},
1109 {QMI_FIXED_INTF(0x05c6, 0x900c, 5)},
1110 {QMI_FIXED_INTF(0x05c6, 0x900c, 6)},
1111 {QMI_FIXED_INTF(0x05c6, 0x900d, 5)},
1112 {QMI_FIXED_INTF(0x05c6, 0x900f, 3)},
1113 {QMI_FIXED_INTF(0x05c6, 0x900f, 4)},
1114 {QMI_FIXED_INTF(0x05c6, 0x900f, 5)},
1115 {QMI_FIXED_INTF(0x05c6, 0x9010, 4)},
1116 {QMI_FIXED_INTF(0x05c6, 0x9010, 5)},
1117 {QMI_FIXED_INTF(0x05c6, 0x9011, 3)},
1118 {QMI_FIXED_INTF(0x05c6, 0x9011, 4)},
1119 {QMI_FIXED_INTF(0x05c6, 0x9021, 1)},
1120 {QMI_FIXED_INTF(0x05c6, 0x9022, 2)},
1121 {QMI_QUIRK_SET_DTR(0x05c6, 0x9025, 4)},
1122 {QMI_FIXED_INTF(0x05c6, 0x9026, 3)},
1123 {QMI_FIXED_INTF(0x05c6, 0x902e, 5)},
1124 {QMI_FIXED_INTF(0x05c6, 0x9031, 5)},
1125 {QMI_FIXED_INTF(0x05c6, 0x9032, 4)},
1126 {QMI_FIXED_INTF(0x05c6, 0x9033, 3)},
1127 {QMI_FIXED_INTF(0x05c6, 0x9033, 4)},
1128 {QMI_FIXED_INTF(0x05c6, 0x9033, 5)},
1129 {QMI_FIXED_INTF(0x05c6, 0x9033, 6)},
1130 {QMI_FIXED_INTF(0x05c6, 0x9034, 3)},
1131 {QMI_FIXED_INTF(0x05c6, 0x9034, 4)},
1132 {QMI_FIXED_INTF(0x05c6, 0x9034, 5)},
1133 {QMI_FIXED_INTF(0x05c6, 0x9034, 6)},
1134 {QMI_FIXED_INTF(0x05c6, 0x9034, 7)},
1135 {QMI_FIXED_INTF(0x05c6, 0x9035, 4)},
1136 {QMI_FIXED_INTF(0x05c6, 0x9036, 3)},
1137 {QMI_FIXED_INTF(0x05c6, 0x9037, 5)},
1138 {QMI_FIXED_INTF(0x05c6, 0x9038, 4)},
1139 {QMI_FIXED_INTF(0x05c6, 0x903b, 7)},
1140 {QMI_FIXED_INTF(0x05c6, 0x903c, 6)},
1141 {QMI_FIXED_INTF(0x05c6, 0x903d, 6)},
1142 {QMI_FIXED_INTF(0x05c6, 0x903e, 5)},
1143 {QMI_FIXED_INTF(0x05c6, 0x9043, 3)},
1144 {QMI_FIXED_INTF(0x05c6, 0x9046, 3)},
1145 {QMI_FIXED_INTF(0x05c6, 0x9046, 4)},
1146 {QMI_FIXED_INTF(0x05c6, 0x9046, 5)},
1147 {QMI_FIXED_INTF(0x05c6, 0x9047, 2)},
1148 {QMI_FIXED_INTF(0x05c6, 0x9047, 3)},
1149 {QMI_FIXED_INTF(0x05c6, 0x9047, 4)},
1150 {QMI_FIXED_INTF(0x05c6, 0x9048, 4)},
1151 {QMI_FIXED_INTF(0x05c6, 0x9048, 5)},
1152 {QMI_FIXED_INTF(0x05c6, 0x9048, 6)},
1153 {QMI_FIXED_INTF(0x05c6, 0x9048, 7)},
1154 {QMI_FIXED_INTF(0x05c6, 0x9048, 8)},
1155 {QMI_FIXED_INTF(0x05c6, 0x904c, 5)},
1156 {QMI_FIXED_INTF(0x05c6, 0x904c, 6)},
1157 {QMI_FIXED_INTF(0x05c6, 0x904c, 7)},
1158 {QMI_FIXED_INTF(0x05c6, 0x904c, 8)},
1159 {QMI_FIXED_INTF(0x05c6, 0x9050, 3)},
1160 {QMI_FIXED_INTF(0x05c6, 0x9052, 4)},
1161 {QMI_FIXED_INTF(0x05c6, 0x9053, 6)},
1162 {QMI_FIXED_INTF(0x05c6, 0x9053, 7)},
1163 {QMI_FIXED_INTF(0x05c6, 0x9054, 5)},
1164 {QMI_FIXED_INTF(0x05c6, 0x9054, 6)},
1165 {QMI_FIXED_INTF(0x05c6, 0x9055, 3)},
1166 {QMI_FIXED_INTF(0x05c6, 0x9055, 4)},
1167 {QMI_FIXED_INTF(0x05c6, 0x9055, 5)},
1168 {QMI_FIXED_INTF(0x05c6, 0x9055, 6)},
1169 {QMI_FIXED_INTF(0x05c6, 0x9055, 7)},
1170 {QMI_FIXED_INTF(0x05c6, 0x9056, 3)},
1171 {QMI_FIXED_INTF(0x05c6, 0x9062, 2)},
1172 {QMI_FIXED_INTF(0x05c6, 0x9062, 3)},
1173 {QMI_FIXED_INTF(0x05c6, 0x9062, 4)},
1174 {QMI_FIXED_INTF(0x05c6, 0x9062, 5)},
1175 {QMI_FIXED_INTF(0x05c6, 0x9062, 6)},
1176 {QMI_FIXED_INTF(0x05c6, 0x9062, 7)},
1177 {QMI_FIXED_INTF(0x05c6, 0x9062, 8)},
1178 {QMI_FIXED_INTF(0x05c6, 0x9062, 9)},
1179 {QMI_FIXED_INTF(0x05c6, 0x9064, 3)},
1180 {QMI_FIXED_INTF(0x05c6, 0x9065, 6)},
1181 {QMI_FIXED_INTF(0x05c6, 0x9065, 7)},
1182 {QMI_FIXED_INTF(0x05c6, 0x9066, 5)},
1183 {QMI_FIXED_INTF(0x05c6, 0x9066, 6)},
1184 {QMI_FIXED_INTF(0x05c6, 0x9067, 1)},
1185 {QMI_FIXED_INTF(0x05c6, 0x9068, 2)},
1186 {QMI_FIXED_INTF(0x05c6, 0x9068, 3)},
1187 {QMI_FIXED_INTF(0x05c6, 0x9068, 4)},
1188 {QMI_FIXED_INTF(0x05c6, 0x9068, 5)},
1189 {QMI_FIXED_INTF(0x05c6, 0x9068, 6)},
1190 {QMI_FIXED_INTF(0x05c6, 0x9068, 7)},
1191 {QMI_FIXED_INTF(0x05c6, 0x9069, 5)},
1192 {QMI_FIXED_INTF(0x05c6, 0x9069, 6)},
1193 {QMI_FIXED_INTF(0x05c6, 0x9069, 7)},
1194 {QMI_FIXED_INTF(0x05c6, 0x9069, 8)},
1195 {QMI_FIXED_INTF(0x05c6, 0x9070, 4)},
1196 {QMI_FIXED_INTF(0x05c6, 0x9070, 5)},
1197 {QMI_FIXED_INTF(0x05c6, 0x9075, 5)},
1198 {QMI_FIXED_INTF(0x05c6, 0x9076, 4)},
1199 {QMI_FIXED_INTF(0x05c6, 0x9076, 5)},
1200 {QMI_FIXED_INTF(0x05c6, 0x9076, 6)},
1201 {QMI_FIXED_INTF(0x05c6, 0x9076, 7)},
1202 {QMI_FIXED_INTF(0x05c6, 0x9076, 8)},
1203 {QMI_FIXED_INTF(0x05c6, 0x9077, 3)},
1204 {QMI_FIXED_INTF(0x05c6, 0x9077, 4)},
1205 {QMI_FIXED_INTF(0x05c6, 0x9077, 5)},
1206 {QMI_FIXED_INTF(0x05c6, 0x9077, 6)},
1207 {QMI_FIXED_INTF(0x05c6, 0x9078, 3)},
1208 {QMI_FIXED_INTF(0x05c6, 0x9079, 4)},
1209 {QMI_FIXED_INTF(0x05c6, 0x9079, 5)},
1210 {QMI_FIXED_INTF(0x05c6, 0x9079, 6)},
1211 {QMI_FIXED_INTF(0x05c6, 0x9079, 7)},
1212 {QMI_FIXED_INTF(0x05c6, 0x9079, 8)},
1213 {QMI_FIXED_INTF(0x05c6, 0x9080, 5)},
1214 {QMI_FIXED_INTF(0x05c6, 0x9080, 6)},
1215 {QMI_FIXED_INTF(0x05c6, 0x9080, 7)},
1216 {QMI_FIXED_INTF(0x05c6, 0x9080, 8)},
1217 {QMI_FIXED_INTF(0x05c6, 0x9083, 3)},
1218 {QMI_FIXED_INTF(0x05c6, 0x9084, 4)},
1219 {QMI_FIXED_INTF(0x05c6, 0x90b2, 3)},
1220 {QMI_FIXED_INTF(0x05c6, 0x920d, 0)},
1221 {QMI_FIXED_INTF(0x05c6, 0x920d, 5)},
1222 {QMI_QUIRK_SET_DTR(0x05c6, 0x9625, 4)},
1223 {QMI_FIXED_INTF(0x0846, 0x68a2, 8)},
1224 {QMI_FIXED_INTF(0x0846, 0x68d3, 8)},
1225 {QMI_FIXED_INTF(0x12d1, 0x140c, 1)},
1226 {QMI_FIXED_INTF(0x12d1, 0x14ac, 1)},
1227 {QMI_FIXED_INTF(0x1435, 0x0918, 3)},
1228 {QMI_FIXED_INTF(0x1435, 0x0918, 4)},
1229 {QMI_FIXED_INTF(0x1435, 0x0918, 5)},
1230 {QMI_FIXED_INTF(0x1435, 0x3185, 4)},
1231 {QMI_FIXED_INTF(0x1435, 0xd111, 4)},
1232 {QMI_FIXED_INTF(0x1435, 0xd181, 3)},
1233 {QMI_FIXED_INTF(0x1435, 0xd181, 4)},
1234 {QMI_FIXED_INTF(0x1435, 0xd181, 5)},
1235 {QMI_FIXED_INTF(0x1435, 0xd182, 4)},
1236 {QMI_FIXED_INTF(0x1435, 0xd182, 5)},
1237 {QMI_FIXED_INTF(0x1435, 0xd191, 4)},
1238 {QMI_QUIRK_SET_DTR(0x1508, 0x1001, 4)},
1239 {QMI_FIXED_INTF(0x1690, 0x7588, 4)},
1240 {QMI_FIXED_INTF(0x16d8, 0x6003, 0)},
1241 {QMI_FIXED_INTF(0x16d8, 0x6007, 0)},
1242 {QMI_FIXED_INTF(0x16d8, 0x6008, 0)},
1243 {QMI_FIXED_INTF(0x16d8, 0x6280, 0)},
1244 {QMI_FIXED_INTF(0x16d8, 0x7001, 0)},
1245 {QMI_FIXED_INTF(0x16d8, 0x7002, 0)},
1246 {QMI_FIXED_INTF(0x16d8, 0x7003, 4)},
1247 {QMI_FIXED_INTF(0x16d8, 0x7004, 3)},
1248 {QMI_FIXED_INTF(0x16d8, 0x7006, 5)},
1249 {QMI_FIXED_INTF(0x16d8, 0x700a, 4)},
1250 {QMI_FIXED_INTF(0x16d8, 0x7211, 0)},
1251 {QMI_FIXED_INTF(0x16d8, 0x7212, 0)},
1252 {QMI_FIXED_INTF(0x16d8, 0x7213, 0)},
1253 {QMI_FIXED_INTF(0x16d8, 0x7251, 1)},
1254 {QMI_FIXED_INTF(0x16d8, 0x7252, 1)},
1255 {QMI_FIXED_INTF(0x16d8, 0x7253, 1)},
1256 {QMI_FIXED_INTF(0x19d2, 0x0002, 1)},
1257 {QMI_FIXED_INTF(0x19d2, 0x0012, 1)},
1258 {QMI_FIXED_INTF(0x19d2, 0x0017, 3)},
1259 {QMI_FIXED_INTF(0x19d2, 0x0019, 3)},
1260 {QMI_FIXED_INTF(0x19d2, 0x0021, 4)},
1261 {QMI_FIXED_INTF(0x19d2, 0x0025, 1)},
1262 {QMI_FIXED_INTF(0x19d2, 0x0031, 4)},
1263 {QMI_FIXED_INTF(0x19d2, 0x0042, 4)},
1264 {QMI_FIXED_INTF(0x19d2, 0x0049, 5)},
1265 {QMI_FIXED_INTF(0x19d2, 0x0052, 4)},
1266 {QMI_FIXED_INTF(0x19d2, 0x0055, 1)},
1267 {QMI_FIXED_INTF(0x19d2, 0x0058, 4)},
1268 {QMI_FIXED_INTF(0x19d2, 0x0063, 4)},
1269 {QMI_FIXED_INTF(0x19d2, 0x0104, 4)},
1270 {QMI_FIXED_INTF(0x19d2, 0x0113, 5)},
1271 {QMI_FIXED_INTF(0x19d2, 0x0118, 5)},
1272 {QMI_FIXED_INTF(0x19d2, 0x0121, 5)},
1273 {QMI_FIXED_INTF(0x19d2, 0x0123, 4)},
1274 {QMI_FIXED_INTF(0x19d2, 0x0124, 5)},
1275 {QMI_FIXED_INTF(0x19d2, 0x0125, 6)},
1276 {QMI_FIXED_INTF(0x19d2, 0x0126, 5)},
1277 {QMI_FIXED_INTF(0x19d2, 0x0130, 1)},
1278 {QMI_FIXED_INTF(0x19d2, 0x0133, 3)},
1279 {QMI_FIXED_INTF(0x19d2, 0x0141, 5)},
1280 {QMI_FIXED_INTF(0x19d2, 0x0157, 5)},
1281 {QMI_FIXED_INTF(0x19d2, 0x0158, 3)},
1282 {QMI_FIXED_INTF(0x19d2, 0x0167, 4)},
1283 {QMI_FIXED_INTF(0x19d2, 0x0168, 4)},
1284 {QMI_FIXED_INTF(0x19d2, 0x0176, 3)},
1285 {QMI_FIXED_INTF(0x19d2, 0x0178, 3)},
1286 {QMI_FIXED_INTF(0x19d2, 0x0191, 4)},
1287 {QMI_FIXED_INTF(0x19d2, 0x0199, 1)},
1288 {QMI_FIXED_INTF(0x19d2, 0x0200, 1)},
1289 {QMI_FIXED_INTF(0x19d2, 0x0257, 3)},
1290 {QMI_FIXED_INTF(0x19d2, 0x0265, 4)},
1291 {QMI_FIXED_INTF(0x19d2, 0x0284, 4)},
1292 {QMI_FIXED_INTF(0x19d2, 0x0326, 4)},
1293 {QMI_FIXED_INTF(0x19d2, 0x0396, 3)},
1294 {QMI_FIXED_INTF(0x19d2, 0x0412, 4)},
1295 {QMI_FIXED_INTF(0x19d2, 0x1008, 4)},
1296 {QMI_FIXED_INTF(0x19d2, 0x1010, 4)},
1297 {QMI_FIXED_INTF(0x19d2, 0x1012, 4)},
1298 {QMI_FIXED_INTF(0x19d2, 0x1018, 3)},
1299 {QMI_FIXED_INTF(0x19d2, 0x1021, 2)},
1300 {QMI_FIXED_INTF(0x19d2, 0x1245, 4)},
1301 {QMI_FIXED_INTF(0x19d2, 0x1247, 4)},
1302 {QMI_FIXED_INTF(0x19d2, 0x1252, 4)},
1303 {QMI_FIXED_INTF(0x19d2, 0x1254, 4)},
1304 {QMI_FIXED_INTF(0x19d2, 0x1255, 3)},
1305 {QMI_FIXED_INTF(0x19d2, 0x1255, 4)},
1306 {QMI_FIXED_INTF(0x19d2, 0x1256, 4)},
1307 {QMI_FIXED_INTF(0x19d2, 0x1270, 5)},
1308 {QMI_FIXED_INTF(0x19d2, 0x1275, 3)},
1309 {QMI_FIXED_INTF(0x19d2, 0x1401, 2)},
1310 {QMI_FIXED_INTF(0x19d2, 0x1402, 2)},
1311 {QMI_FIXED_INTF(0x19d2, 0x1424, 2)},
1312 {QMI_FIXED_INTF(0x19d2, 0x1425, 2)},
1313 {QMI_FIXED_INTF(0x19d2, 0x1426, 2)},
1314 {QMI_FIXED_INTF(0x19d2, 0x1428, 2)},
1315 {QMI_FIXED_INTF(0x19d2, 0x1432, 3)},
1316 {QMI_FIXED_INTF(0x19d2, 0x2002, 4)},
1317 {QMI_FIXED_INTF(0x2001, 0x7e16, 3)},
1318 {QMI_FIXED_INTF(0x2001, 0x7e19, 4)},
1319 {QMI_FIXED_INTF(0x2001, 0x7e35, 4)},
1320 {QMI_FIXED_INTF(0x2001, 0x7e3d, 4)},
1321 {QMI_FIXED_INTF(0x2020, 0x2031, 4)},
1322 {QMI_FIXED_INTF(0x2020, 0x2033, 4)},
1323 {QMI_FIXED_INTF(0x2020, 0x2060, 4)},
1324 {QMI_FIXED_INTF(0x0f3d, 0x68a2, 8)},
1325 {QMI_FIXED_INTF(0x114f, 0x68a2, 8)},
1326 {QMI_FIXED_INTF(0x1199, 0x68a2, 8)},
1327 {QMI_FIXED_INTF(0x1199, 0x68a2, 19)},
1328 {QMI_QUIRK_SET_DTR(0x1199, 0x68c0, 8)},
1329 {QMI_QUIRK_SET_DTR(0x1199, 0x68c0, 10)},
1330 {QMI_FIXED_INTF(0x1199, 0x901c, 8)},
1331 {QMI_FIXED_INTF(0x1199, 0x901f, 8)},
1332 {QMI_FIXED_INTF(0x1199, 0x9041, 8)},
1333 {QMI_FIXED_INTF(0x1199, 0x9041, 10)},
1334 {QMI_FIXED_INTF(0x1199, 0x9051, 8)},
1335 {QMI_FIXED_INTF(0x1199, 0x9053, 8)},
1336 {QMI_FIXED_INTF(0x1199, 0x9054, 8)},
1337 {QMI_FIXED_INTF(0x1199, 0x9055, 8)},
1338 {QMI_FIXED_INTF(0x1199, 0x9056, 8)},
1339 {QMI_FIXED_INTF(0x1199, 0x9057, 8)},
1340 {QMI_FIXED_INTF(0x1199, 0x9061, 8)},
1341 {QMI_FIXED_INTF(0x1199, 0x9063, 8)},
1342 {QMI_FIXED_INTF(0x1199, 0x9063, 10)},
1343 {QMI_QUIRK_SET_DTR(0x1199, 0x9071, 8)},
1344 {QMI_QUIRK_SET_DTR(0x1199, 0x9071, 10)},
1345 {QMI_QUIRK_SET_DTR(0x1199, 0x9079, 8)},
1346 {QMI_QUIRK_SET_DTR(0x1199, 0x9079, 10)},
1347 {QMI_QUIRK_SET_DTR(0x1199, 0x907b, 8)},
1348 {QMI_QUIRK_SET_DTR(0x1199, 0x907b, 10)},
1349 {QMI_QUIRK_SET_DTR(0x1199, 0x9091, 8)},
1350 {QMI_FIXED_INTF(0x1bbb, 0x011e, 4)},
1351 {QMI_FIXED_INTF(0x1bbb, 0x0203, 2)},
1352 {QMI_FIXED_INTF(0x2357, 0x0201, 4)},
1353 {QMI_FIXED_INTF(0x2357, 0x9000, 4)},
1354 {QMI_QUIRK_SET_DTR(0x1bc7, 0x1031, 3)},
1355 {QMI_QUIRK_SET_DTR(0x1bc7, 0x1040, 2)},
1356 {QMI_QUIRK_SET_DTR(0x1bc7, 0x1050, 2)},
1357 {QMI_QUIRK_SET_DTR(0x1bc7, 0x1060, 2)},
1358 {QMI_FIXED_INTF(0x1bc7, 0x1100, 3)},
1359 {QMI_FIXED_INTF(0x1bc7, 0x1101, 3)},
1360 {QMI_FIXED_INTF(0x1bc7, 0x1200, 5)},
1361 {QMI_QUIRK_SET_DTR(0x1bc7, 0x1201, 2)},
1362 {QMI_QUIRK_SET_DTR(0x1bc7, 0x1230, 2)},
1363 {QMI_QUIRK_SET_DTR(0x1bc7, 0x1260, 2)},
1364 {QMI_QUIRK_SET_DTR(0x1bc7, 0x1261, 2)},
1365 {QMI_QUIRK_SET_DTR(0x1bc7, 0x1900, 1)},
1366 {QMI_FIXED_INTF(0x1c9e, 0x9801, 3)},
1367 {QMI_FIXED_INTF(0x1c9e, 0x9803, 4)},
1368 {QMI_FIXED_INTF(0x1c9e, 0x9b01, 3)},
1369 {QMI_FIXED_INTF(0x0b3c, 0xc000, 4)},
1370 {QMI_FIXED_INTF(0x0b3c, 0xc001, 4)},
1371 {QMI_FIXED_INTF(0x0b3c, 0xc002, 4)},
1372 {QMI_FIXED_INTF(0x0b3c, 0xc004, 6)},
1373 {QMI_FIXED_INTF(0x0b3c, 0xc005, 6)},
1374 {QMI_FIXED_INTF(0x0b3c, 0xc00a, 6)},
1375 {QMI_FIXED_INTF(0x0b3c, 0xc00b, 4)},
1376 {QMI_FIXED_INTF(0x1e2d, 0x0060, 4)},
1377 {QMI_QUIRK_SET_DTR(0x1e2d, 0x006f, 8)},
1378 {QMI_FIXED_INTF(0x1e2d, 0x0053, 4)},
1379 {QMI_FIXED_INTF(0x1e2d, 0x0063, 10)},
1380 {QMI_FIXED_INTF(0x1e2d, 0x0082, 4)},
1381 {QMI_FIXED_INTF(0x1e2d, 0x0082, 5)},
1382 {QMI_FIXED_INTF(0x1e2d, 0x0083, 4)},
1383 {QMI_QUIRK_SET_DTR(0x1e2d, 0x00b0, 4)},
1384 {QMI_FIXED_INTF(0x1e2d, 0x00b7, 0)},
1385 {QMI_FIXED_INTF(0x413c, 0x81a2, 8)},
1386 {QMI_FIXED_INTF(0x413c, 0x81a3, 8)},
1387 {QMI_FIXED_INTF(0x413c, 0x81a4, 8)},
1388 {QMI_FIXED_INTF(0x413c, 0x81a8, 8)},
1389 {QMI_FIXED_INTF(0x413c, 0x81a9, 8)},
1390 {QMI_FIXED_INTF(0x413c, 0x81b1, 8)},
1391 {QMI_FIXED_INTF(0x413c, 0x81b3, 8)},
1392 {QMI_FIXED_INTF(0x413c, 0x81b6, 8)},
1393 {QMI_FIXED_INTF(0x413c, 0x81b6, 10)},
1394 {QMI_FIXED_INTF(0x413c, 0x81cc, 8)},
1395 {QMI_FIXED_INTF(0x413c, 0x81d7, 0)},
1396 {QMI_FIXED_INTF(0x413c, 0x81d7, 1)},
1397 {QMI_FIXED_INTF(0x413c, 0x81e0, 0)},
1398 {QMI_FIXED_INTF(0x03f0, 0x4e1d, 8)},
1399 {QMI_FIXED_INTF(0x03f0, 0x9d1d, 1)},
1400 {QMI_FIXED_INTF(0x22de, 0x9061, 3)},
1401 {QMI_QUIRK_SET_DTR(0x1e0e, 0x9001, 5)},
1402 {QMI_QUIRK_SET_DTR(0x2c7c, 0x0121, 4)},
1403 {QMI_QUIRK_SET_DTR(0x2c7c, 0x0191, 4)},
1404 {QMI_QUIRK_SET_DTR(0x2c7c, 0x0195, 4)},
1405 {QMI_FIXED_INTF(0x2c7c, 0x0296, 4)},
1406 {QMI_QUIRK_SET_DTR(0x2cb7, 0x0104, 4)},
1407 {QMI_FIXED_INTF(0x0489, 0xe0b4, 0)},
1408 {QMI_FIXED_INTF(0x0489, 0xe0b5, 0)},
1409 {QMI_FIXED_INTF(0x2692, 0x9025, 4)},
1410
1411
1412 {QMI_GOBI1K_DEVICE(0x05c6, 0x9212)},
1413 {QMI_GOBI1K_DEVICE(0x03f0, 0x1f1d)},
1414 {QMI_GOBI1K_DEVICE(0x04da, 0x250d)},
1415 {QMI_GOBI1K_DEVICE(0x413c, 0x8172)},
1416 {QMI_GOBI1K_DEVICE(0x1410, 0xa001)},
1417 {QMI_GOBI1K_DEVICE(0x1410, 0xa002)},
1418 {QMI_GOBI1K_DEVICE(0x1410, 0xa003)},
1419 {QMI_GOBI1K_DEVICE(0x1410, 0xa004)},
1420 {QMI_GOBI1K_DEVICE(0x1410, 0xa005)},
1421 {QMI_GOBI1K_DEVICE(0x1410, 0xa006)},
1422 {QMI_GOBI1K_DEVICE(0x1410, 0xa007)},
1423 {QMI_GOBI1K_DEVICE(0x0b05, 0x1776)},
1424 {QMI_GOBI1K_DEVICE(0x19d2, 0xfff3)},
1425 {QMI_GOBI1K_DEVICE(0x05c6, 0x9001)},
1426 {QMI_GOBI1K_DEVICE(0x05c6, 0x9002)},
1427 {QMI_GOBI1K_DEVICE(0x05c6, 0x9202)},
1428 {QMI_GOBI1K_DEVICE(0x05c6, 0x9203)},
1429 {QMI_GOBI1K_DEVICE(0x05c6, 0x9222)},
1430 {QMI_GOBI1K_DEVICE(0x05c6, 0x9009)},
1431
1432
1433 {QMI_GOBI_DEVICE(0x413c, 0x8186)},
1434 {QMI_GOBI_DEVICE(0x413c, 0x8194)},
1435 {QMI_GOBI_DEVICE(0x05c6, 0x920b)},
1436 {QMI_GOBI_DEVICE(0x05c6, 0x9225)},
1437 {QMI_GOBI_DEVICE(0x05c6, 0x9245)},
1438 {QMI_GOBI_DEVICE(0x03f0, 0x251d)},
1439 {QMI_GOBI_DEVICE(0x05c6, 0x9215)},
1440 {QMI_FIXED_INTF(0x05c6, 0x9215, 4)},
1441 {QMI_GOBI_DEVICE(0x05c6, 0x9265)},
1442 {QMI_GOBI_DEVICE(0x05c6, 0x9235)},
1443 {QMI_GOBI_DEVICE(0x05c6, 0x9275)},
1444 {QMI_GOBI_DEVICE(0x0af0, 0x8120)},
1445 {QMI_GOBI_DEVICE(0x1199, 0x68a5)},
1446 {QMI_GOBI_DEVICE(0x1199, 0x68a9)},
1447 {QMI_GOBI_DEVICE(0x1199, 0x9001)},
1448 {QMI_GOBI_DEVICE(0x1199, 0x9002)},
1449 {QMI_GOBI_DEVICE(0x1199, 0x9003)},
1450 {QMI_GOBI_DEVICE(0x1199, 0x9004)},
1451 {QMI_GOBI_DEVICE(0x1199, 0x9005)},
1452 {QMI_GOBI_DEVICE(0x1199, 0x9006)},
1453 {QMI_GOBI_DEVICE(0x1199, 0x9007)},
1454 {QMI_GOBI_DEVICE(0x1199, 0x9008)},
1455 {QMI_GOBI_DEVICE(0x1199, 0x9009)},
1456 {QMI_GOBI_DEVICE(0x1199, 0x900a)},
1457 {QMI_GOBI_DEVICE(0x1199, 0x9011)},
1458 {QMI_GOBI_DEVICE(0x16d8, 0x8002)},
1459 {QMI_GOBI_DEVICE(0x05c6, 0x9205)},
1460 {QMI_GOBI_DEVICE(0x1199, 0x9013)},
1461 {QMI_GOBI_DEVICE(0x03f0, 0x371d)},
1462 {QMI_GOBI_DEVICE(0x1199, 0x9015)},
1463 {QMI_GOBI_DEVICE(0x1199, 0x9019)},
1464 {QMI_GOBI_DEVICE(0x1199, 0x901b)},
1465 {QMI_GOBI_DEVICE(0x12d1, 0x14f1)},
1466 {QMI_GOBI_DEVICE(0x1410, 0xa021)},
1467
1468 { }
1469};
1470MODULE_DEVICE_TABLE(usb, products);
1471
1472static bool quectel_ec20_detected(struct usb_interface *intf)
1473{
1474 struct usb_device *dev = interface_to_usbdev(intf);
1475
1476 if (dev->actconfig &&
1477 le16_to_cpu(dev->descriptor.idVendor) == 0x05c6 &&
1478 le16_to_cpu(dev->descriptor.idProduct) == 0x9215 &&
1479 dev->actconfig->desc.bNumInterfaces == 5)
1480 return true;
1481
1482 return false;
1483}
1484
1485static int qmi_wwan_probe(struct usb_interface *intf,
1486 const struct usb_device_id *prod)
1487{
1488 struct usb_device_id *id = (struct usb_device_id *)prod;
1489 struct usb_interface_descriptor *desc = &intf->cur_altsetting->desc;
1490
1491
1492
1493
1494
1495
1496 if (!id->driver_info) {
1497 dev_dbg(&intf->dev, "setting defaults for dynamic device id\n");
1498 id->driver_info = (unsigned long)&qmi_wwan_info;
1499 }
1500
1501
1502
1503
1504
1505 if (id->match_flags & USB_DEVICE_ID_MATCH_INT_NUMBER &&
1506 desc->bInterfaceClass != USB_CLASS_VENDOR_SPEC) {
1507 dev_dbg(&intf->dev,
1508 "Rejecting interface number match for class %02x\n",
1509 desc->bInterfaceClass);
1510 return -ENODEV;
1511 }
1512
1513
1514 if (quectel_ec20_detected(intf) && desc->bInterfaceNumber == 0) {
1515 dev_dbg(&intf->dev, "Quectel EC20 quirk, skipping interface 0\n");
1516 return -ENODEV;
1517 }
1518
1519
1520
1521
1522
1523
1524
1525 if (desc->bNumEndpoints == 2)
1526 return -ENODEV;
1527
1528 return usbnet_probe(intf, id);
1529}
1530
1531static void qmi_wwan_disconnect(struct usb_interface *intf)
1532{
1533 struct usbnet *dev = usb_get_intfdata(intf);
1534 struct qmi_wwan_state *info;
1535 struct list_head *iter;
1536 struct net_device *ldev;
1537 LIST_HEAD(list);
1538
1539
1540 if (!dev)
1541 return;
1542 info = (void *)&dev->data;
1543 if (info->flags & QMI_WWAN_FLAG_MUX) {
1544 if (!rtnl_trylock()) {
1545 restart_syscall();
1546 return;
1547 }
1548 rcu_read_lock();
1549 netdev_for_each_upper_dev_rcu(dev->net, ldev, iter)
1550 qmimux_unregister_device(ldev, &list);
1551 rcu_read_unlock();
1552 unregister_netdevice_many(&list);
1553 rtnl_unlock();
1554 info->flags &= ~QMI_WWAN_FLAG_MUX;
1555 }
1556 usbnet_disconnect(intf);
1557}
1558
1559static struct usb_driver qmi_wwan_driver = {
1560 .name = "qmi_wwan",
1561 .id_table = products,
1562 .probe = qmi_wwan_probe,
1563 .disconnect = qmi_wwan_disconnect,
1564 .suspend = qmi_wwan_suspend,
1565 .resume = qmi_wwan_resume,
1566 .reset_resume = qmi_wwan_resume,
1567 .supports_autosuspend = 1,
1568 .disable_hub_initiated_lpm = 1,
1569};
1570
1571module_usb_driver(qmi_wwan_driver);
1572
1573MODULE_AUTHOR("Bjørn Mork <bjorn@mork.no>");
1574MODULE_DESCRIPTION("Qualcomm MSM Interface (QMI) WWAN driver");
1575MODULE_LICENSE("GPL");
1576