net/dsa/lan9303_mdio.c

0001 // SPDX-License-Identifier: GPL-2.0-only
0002 /*
0003  * Copyright (C) 2017 Pengutronix, Juergen Borleis <kernel@pengutronix.de>
0004  *
0005  * Partially based on a patch from
0006  * Copyright (c) 2014 Stefan Roese <sr@denx.de>
0007  */
0008 #include <linux/kernel.h>
0009 #include <linux/module.h>
0010 #include <linux/mdio.h>
0011 #include <linux/phy.h>
0012 #include <linux/of.h>
0013
0014 #include "lan9303.h"
0015
0016 /* Generate phy-addr and -reg from the input address */
0017 #define PHY_ADDR(x) ((((x) >> 6) + 0x10) & 0x1f)
0018 #define PHY_REG(x) (((x) >> 1) & 0x1f)
0019
0020 struct lan9303_mdio {
0021     struct mdio_device *device;
0022     struct lan9303 chip;
0023 };
0024
0025 static void lan9303_mdio_real_write(struct mdio_device *mdio, int reg, u16 val)
0026 {
0027     mdio->bus->write(mdio->bus, PHY_ADDR(reg), PHY_REG(reg), val);
0028 }
0029
0030 static int lan9303_mdio_write(void *ctx, uint32_t reg, uint32_t val)
0031 {
0032     struct lan9303_mdio *sw_dev = (struct lan9303_mdio *)ctx;
0033
0034     reg <<= 2; /* reg num to offset */
0035     mutex_lock(&sw_dev->device->bus->mdio_lock);
0036     lan9303_mdio_real_write(sw_dev->device, reg, val & 0xffff);
0037     lan9303_mdio_real_write(sw_dev->device, reg + 2, (val >> 16) & 0xffff);
0038     mutex_unlock(&sw_dev->device->bus->mdio_lock);
0039
0040     return 0;
0041 }
0042
0043 static u16 lan9303_mdio_real_read(struct mdio_device *mdio, int reg)
0044 {
0045     return mdio->bus->read(mdio->bus, PHY_ADDR(reg), PHY_REG(reg));
0046 }
0047
0048 static int lan9303_mdio_read(void *ctx, uint32_t reg, uint32_t *val)
0049 {
0050     struct lan9303_mdio *sw_dev = (struct lan9303_mdio *)ctx;
0051
0052     reg <<= 2; /* reg num to offset */
0053     mutex_lock(&sw_dev->device->bus->mdio_lock);
0054     *val = lan9303_mdio_real_read(sw_dev->device, reg);
0055     *val |= (lan9303_mdio_real_read(sw_dev->device, reg + 2) << 16);
0056     mutex_unlock(&sw_dev->device->bus->mdio_lock);
0057
0058     return 0;
0059 }
0060
0061 static int lan9303_mdio_phy_write(struct lan9303 *chip, int phy, int reg,
0062                   u16 val)
0063 {
0064     struct lan9303_mdio *sw_dev = dev_get_drvdata(chip->dev);
0065
0066     return mdiobus_write_nested(sw_dev->device->bus, phy, reg, val);
0067 }
0068
0069 static int lan9303_mdio_phy_read(struct lan9303 *chip, int phy,  int reg)
0070 {
0071     struct lan9303_mdio *sw_dev = dev_get_drvdata(chip->dev);
0072
0073     return mdiobus_read_nested(sw_dev->device->bus, phy, reg);
0074 }
0075
0076 static const struct lan9303_phy_ops lan9303_mdio_phy_ops = {
0077     .phy_read = lan9303_mdio_phy_read,
0078     .phy_write = lan9303_mdio_phy_write,
0079 };
0080
0081 static const struct regmap_config lan9303_mdio_regmap_config = {
0082     .reg_bits = 8,
0083     .val_bits = 32,
0084     .reg_stride = 1,
0085     .can_multi_write = true,
0086     .max_register = 0x0ff, /* address bits 0..1 are not used */
0087     .reg_format_endian = REGMAP_ENDIAN_LITTLE,
0088
0089     .volatile_table = &lan9303_register_set,
0090     .wr_table = &lan9303_register_set,
0091     .rd_table = &lan9303_register_set,
0092
0093     .reg_read = lan9303_mdio_read,
0094     .reg_write = lan9303_mdio_write,
0095
0096     .cache_type = REGCACHE_NONE,
0097 };
0098
0099 static int lan9303_mdio_probe(struct mdio_device *mdiodev)
0100 {
0101     struct lan9303_mdio *sw_dev;
0102     int ret;
0103
0104     sw_dev = devm_kzalloc(&mdiodev->dev, sizeof(struct lan9303_mdio),
0105                   GFP_KERNEL);
0106     if (!sw_dev)
0107         return -ENOMEM;
0108
0109     sw_dev->chip.regmap = devm_regmap_init(&mdiodev->dev, NULL, sw_dev,
0110                            &lan9303_mdio_regmap_config);
0111     if (IS_ERR(sw_dev->chip.regmap)) {
0112         ret = PTR_ERR(sw_dev->chip.regmap);
0113         dev_err(&mdiodev->dev, "regmap init failed: %d\n", ret);
0114         return ret;
0115     }
0116
0117     /* link forward and backward */
0118     sw_dev->device = mdiodev;
0119     dev_set_drvdata(&mdiodev->dev, sw_dev);
0120     sw_dev->chip.dev = &mdiodev->dev;
0121
0122     sw_dev->chip.ops = &lan9303_mdio_phy_ops;
0123
0124     ret = lan9303_probe(&sw_dev->chip, mdiodev->dev.of_node);
0125     if (ret != 0)
0126         return ret;
0127
0128     dev_info(&mdiodev->dev, "LAN9303 MDIO driver loaded successfully\n");
0129
0130     return 0;
0131 }
0132
0133 static void lan9303_mdio_remove(struct mdio_device *mdiodev)
0134 {
0135     struct lan9303_mdio *sw_dev = dev_get_drvdata(&mdiodev->dev);
0136
0137     if (!sw_dev)
0138         return;
0139
0140     lan9303_remove(&sw_dev->chip);
0141
0142     dev_set_drvdata(&mdiodev->dev, NULL);
0143 }
0144
0145 static void lan9303_mdio_shutdown(struct mdio_device *mdiodev)
0146 {
0147     struct lan9303_mdio *sw_dev = dev_get_drvdata(&mdiodev->dev);
0148
0149     if (!sw_dev)
0150         return;
0151
0152     lan9303_shutdown(&sw_dev->chip);
0153
0154     dev_set_drvdata(&mdiodev->dev, NULL);
0155 }
0156
0157 /*-------------------------------------------------------------------------*/
0158
0159 static const struct of_device_id lan9303_mdio_of_match[] = {
0160     { .compatible = "smsc,lan9303-mdio" },
0161     { /* sentinel */ },
0162 };
0163 MODULE_DEVICE_TABLE(of, lan9303_mdio_of_match);
0164
0165 static struct mdio_driver lan9303_mdio_driver = {
0166     .mdiodrv.driver = {
0167         .name = "LAN9303_MDIO",
0168         .of_match_table = of_match_ptr(lan9303_mdio_of_match),
0169     },
0170     .probe  = lan9303_mdio_probe,
0171     .remove = lan9303_mdio_remove,
0172     .shutdown = lan9303_mdio_shutdown,
0173 };
0174 mdio_module_driver(lan9303_mdio_driver);
0175
0176 MODULE_AUTHOR("Stefan Roese <sr@denx.de>, Juergen Borleis <kernel@pengutronix.de>");
0177 MODULE_DESCRIPTION("Driver for SMSC/Microchip LAN9303 three port ethernet switch in MDIO managed mode");
0178 MODULE_LICENSE("GPL v2");