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
 12static 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
 33out:
 34	return ret;
 35}
 36
 37static 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
 67out:
 68	return ret;
 69}
 70
 71static 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
 82out:
 83	return ret;
 84}
 85
 86static 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
 98static 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
115static 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
124static 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};
141MODULE_DEVICE_TABLE(usb, products);
142
143static 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
154static 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
166module_usb_driver(r8153_ecm_driver);
167
168MODULE_AUTHOR("Hayes Wang");
169MODULE_DESCRIPTION("Realtek USB ECM device");
170MODULE_LICENSE("GPL");