1 // SPDX-License-Identifier: GPL-2.0-or-later
2 #include <linux/module.h>
3 #include <linux/netdevice.h>
4 #include <linux/mii.h>
5 #include <linux/usb.h>
6 #include <linux/usb/cdc.h>
7 #include <linux/usb/usbnet.h>
8 #include <linux/usb/r8152.h>
9
10 #define OCP_BASE 0xe86c
11
pla_read_word(struct usbnet * dev,u16 index)12 static int pla_read_word(struct usbnet *dev, u16 index)
13 {
14 u16 byen = BYTE_EN_WORD;
15 u8 shift = index & 2;
16 __le32 tmp;
17 int ret;
18
19 if (shift)
20 byen <<= shift;
21
22 index &= ~3;
23
24 ret = usbnet_read_cmd(dev, RTL8152_REQ_GET_REGS, RTL8152_REQT_READ, index,
25 MCU_TYPE_PLA | byen, &tmp, sizeof(tmp));
26 if (ret < 0)
27 goto out;
28
29 ret = __le32_to_cpu(tmp);
30 ret >>= (shift * 8);
31 ret &= 0xffff;
32
33 out:
34 return ret;
35 }
36
pla_write_word(struct usbnet * dev,u16 index,u32 data)37 static int pla_write_word(struct usbnet *dev, u16 index, u32 data)
38 {
39 u32 mask = 0xffff;
40 u16 byen = BYTE_EN_WORD;
41 u8 shift = index & 2;
42 __le32 tmp;
43 int ret;
44
45 data &= mask;
46
47 if (shift) {
48 byen <<= shift;
49 mask <<= (shift * 8);
50 data <<= (shift * 8);
51 }
52
53 index &= ~3;
54
55 ret = usbnet_read_cmd(dev, RTL8152_REQ_GET_REGS, RTL8152_REQT_READ, index,
56 MCU_TYPE_PLA | byen, &tmp, sizeof(tmp));
57
58 if (ret < 0)
59 goto out;
60
61 data |= __le32_to_cpu(tmp) & ~mask;
62 tmp = __cpu_to_le32(data);
63
64 ret = usbnet_write_cmd(dev, RTL8152_REQ_SET_REGS, RTL8152_REQT_WRITE, index,
65 MCU_TYPE_PLA | byen, &tmp, sizeof(tmp));
66
67 out:
68 return ret;
69 }
70
r8153_ecm_mdio_read(struct net_device * netdev,int phy_id,int reg)71 static int r8153_ecm_mdio_read(struct net_device *netdev, int phy_id, int reg)
72 {
73 struct usbnet *dev = netdev_priv(netdev);
74 int ret;
75
76 ret = pla_write_word(dev, OCP_BASE, 0xa000);
77 if (ret < 0)
78 goto out;
79
80 ret = pla_read_word(dev, 0xb400 + reg * 2);
81
82 out:
83 return ret;
84 }
85
r8153_ecm_mdio_write(struct net_device * netdev,int phy_id,int reg,int val)86 static void r8153_ecm_mdio_write(struct net_device *netdev, int phy_id, int reg, int val)
87 {
88 struct usbnet *dev = netdev_priv(netdev);
89 int ret;
90
91 ret = pla_write_word(dev, OCP_BASE, 0xa000);
92 if (ret < 0)
93 return;
94
95 ret = pla_write_word(dev, 0xb400 + reg * 2, val);
96 }
97
r8153_bind(struct usbnet * dev,struct usb_interface * intf)98 static int r8153_bind(struct usbnet *dev, struct usb_interface *intf)
99 {
100 int status;
101
102 status = usbnet_cdc_bind(dev, intf);
103 if (status < 0)
104 return status;
105
106 dev->mii.dev = dev->net;
107 dev->mii.mdio_read = r8153_ecm_mdio_read;
108 dev->mii.mdio_write = r8153_ecm_mdio_write;
109 dev->mii.reg_num_mask = 0x1f;
110 dev->mii.supports_gmii = 1;
111
112 return status;
113 }
114
115 static const struct driver_info r8153_info = {
116 .description = "RTL8153 ECM Device",
117 .flags = FLAG_ETHER,
118 .bind = r8153_bind,
119 .unbind = usbnet_cdc_unbind,
120 .status = usbnet_cdc_status,
121 .manage_power = usbnet_manage_power,
122 };
123
124 static const struct usb_device_id products[] = {
125 /* Realtek RTL8153 Based USB 3.0 Ethernet Adapters */
126 {
127 USB_DEVICE_AND_INTERFACE_INFO(VENDOR_ID_REALTEK, 0x8153, USB_CLASS_COMM,
128 USB_CDC_SUBCLASS_ETHERNET, USB_CDC_PROTO_NONE),
129 .driver_info = (unsigned long)&r8153_info,
130 },
131
132 /* Lenovo Powered USB-C Travel Hub (4X90S92381, based on Realtek RTL8153) */
133 {
134 USB_DEVICE_AND_INTERFACE_INFO(VENDOR_ID_LENOVO, 0x721e, USB_CLASS_COMM,
135 USB_CDC_SUBCLASS_ETHERNET, USB_CDC_PROTO_NONE),
136 .driver_info = (unsigned long)&r8153_info,
137 },
138
139 { }, /* END */
140 };
141 MODULE_DEVICE_TABLE(usb, products);
142
rtl8153_ecm_probe(struct usb_interface * intf,const struct usb_device_id * id)143 static int rtl8153_ecm_probe(struct usb_interface *intf,
144 const struct usb_device_id *id)
145 {
146 #if IS_REACHABLE(CONFIG_USB_RTL8152)
147 if (rtl8152_get_version(intf))
148 return -ENODEV;
149 #endif
150
151 return usbnet_probe(intf, id);
152 }
153
154 static struct usb_driver r8153_ecm_driver = {
155 .name = "r8153_ecm",
156 .id_table = products,
157 .probe = rtl8153_ecm_probe,
158 .disconnect = usbnet_disconnect,
159 .suspend = usbnet_suspend,
160 .resume = usbnet_resume,
161 .reset_resume = usbnet_resume,
162 .supports_autosuspend = 1,
163 .disable_hub_initiated_lpm = 1,
164 };
165
166 module_usb_driver(r8153_ecm_driver);
167
168 MODULE_AUTHOR("Hayes Wang");
169 MODULE_DESCRIPTION("Realtek USB ECM device");
170 MODULE_LICENSE("GPL");
171