^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) #include <linux/of_mdio.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) #include <linux/phy.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) #include <linux/usb.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #define USB_MARVELL_VID 0x1286
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) static const struct usb_device_id mvusb_mdio_table[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) { USB_DEVICE(USB_MARVELL_VID, 0x1fa4) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) {}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) MODULE_DEVICE_TABLE(usb, mvusb_mdio_table);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) enum {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) MVUSB_CMD_PREAMBLE0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) MVUSB_CMD_PREAMBLE1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) MVUSB_CMD_ADDR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) MVUSB_CMD_VAL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) struct mvusb_mdio {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) struct usb_device *udev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) struct mii_bus *mdio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) __le16 buf[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) static int mvusb_mdio_read(struct mii_bus *mdio, int dev, int reg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) struct mvusb_mdio *mvusb = mdio->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) int err, alen;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) if (dev & MII_ADDR_C45)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) mvusb->buf[MVUSB_CMD_ADDR] = cpu_to_le16(0xa400 | (dev << 5) | reg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) err = usb_bulk_msg(mvusb->udev, usb_sndbulkpipe(mvusb->udev, 2),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) mvusb->buf, 6, &alen, 100);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) err = usb_bulk_msg(mvusb->udev, usb_rcvbulkpipe(mvusb->udev, 6),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) &mvusb->buf[MVUSB_CMD_VAL], 2, &alen, 100);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) return le16_to_cpu(mvusb->buf[MVUSB_CMD_VAL]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) static int mvusb_mdio_write(struct mii_bus *mdio, int dev, int reg, u16 val)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) struct mvusb_mdio *mvusb = mdio->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) int alen;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) if (dev & MII_ADDR_C45)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) mvusb->buf[MVUSB_CMD_ADDR] = cpu_to_le16(0x8000 | (dev << 5) | reg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) mvusb->buf[MVUSB_CMD_VAL] = cpu_to_le16(val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) return usb_bulk_msg(mvusb->udev, usb_sndbulkpipe(mvusb->udev, 2),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) mvusb->buf, 8, &alen, 100);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) static int mvusb_mdio_probe(struct usb_interface *interface,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) const struct usb_device_id *id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) struct device *dev = &interface->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) struct mvusb_mdio *mvusb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) struct mii_bus *mdio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) mdio = devm_mdiobus_alloc_size(dev, sizeof(*mvusb));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) if (!mdio)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) mvusb = mdio->priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) mvusb->mdio = mdio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) mvusb->udev = usb_get_dev(interface_to_usbdev(interface));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) /* Reversed from USB PCAPs, no idea what these mean. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) mvusb->buf[MVUSB_CMD_PREAMBLE0] = cpu_to_le16(0xe800);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) mvusb->buf[MVUSB_CMD_PREAMBLE1] = cpu_to_le16(0x0001);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) snprintf(mdio->id, MII_BUS_ID_SIZE, "mvusb-%s", dev_name(dev));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) mdio->name = mdio->id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) mdio->parent = dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) mdio->read = mvusb_mdio_read;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) mdio->write = mvusb_mdio_write;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) usb_set_intfdata(interface, mvusb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) return of_mdiobus_register(mdio, dev->of_node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) static void mvusb_mdio_disconnect(struct usb_interface *interface)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) struct mvusb_mdio *mvusb = usb_get_intfdata(interface);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) struct usb_device *udev = mvusb->udev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) mdiobus_unregister(mvusb->mdio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) usb_set_intfdata(interface, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) usb_put_dev(udev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) static struct usb_driver mvusb_mdio_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) .name = "mvusb_mdio",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) .id_table = mvusb_mdio_table,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) .probe = mvusb_mdio_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) .disconnect = mvusb_mdio_disconnect,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) module_usb_driver(mvusb_mdio_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) MODULE_AUTHOR("Tobias Waldekranz <tobias@waldekranz.com>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) MODULE_DESCRIPTION("Marvell USB MDIO Adapter");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) MODULE_LICENSE("GPL");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags