Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 1 | /* |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 2 | * Fixed MDIO bus (MDIO bus emulation with fixed PHYs) |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 3 | * |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 4 | * Author: Vitaly Bordug <vbordug@ru.mvista.com> |
| 5 | * Anton Vorontsov <avorontsov@ru.mvista.com> |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 6 | * |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 7 | * Copyright (c) 2006-2007 MontaVista Software, Inc. |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 8 | * |
| 9 | * This program is free software; you can redistribute it and/or modify it |
| 10 | * under the terms of the GNU General Public License as published by the |
| 11 | * Free Software Foundation; either version 2 of the License, or (at your |
| 12 | * option) any later version. |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 13 | */ |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 14 | |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 15 | #include <linux/kernel.h> |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 16 | #include <linux/module.h> |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 17 | #include <linux/platform_device.h> |
| 18 | #include <linux/list.h> |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 19 | #include <linux/mii.h> |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 20 | #include <linux/phy.h> |
Vitaly Bordug | 7c32f47 | 2007-08-10 14:05:16 -0700 | [diff] [blame] | 21 | #include <linux/phy_fixed.h> |
Dan Carpenter | 57401d5 | 2009-04-11 01:52:29 -0700 | [diff] [blame] | 22 | #include <linux/err.h> |
Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 23 | #include <linux/slab.h> |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 24 | |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 25 | #define MII_REGS_NUM 29 |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 26 | |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 27 | struct fixed_mdio_bus { |
| 28 | int irqs[PHY_MAX_ADDR]; |
Lennert Buytenhek | 298cf9b | 2008-10-08 16:29:57 -0700 | [diff] [blame] | 29 | struct mii_bus *mii_bus; |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 30 | struct list_head phys; |
| 31 | }; |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 32 | |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 33 | struct fixed_phy { |
| 34 | int id; |
| 35 | u16 regs[MII_REGS_NUM]; |
| 36 | struct phy_device *phydev; |
| 37 | struct fixed_phy_status status; |
| 38 | int (*link_update)(struct net_device *, struct fixed_phy_status *); |
| 39 | struct list_head node; |
| 40 | }; |
| 41 | |
| 42 | static struct platform_device *pdev; |
| 43 | static struct fixed_mdio_bus platform_fmb = { |
| 44 | .phys = LIST_HEAD_INIT(platform_fmb.phys), |
| 45 | }; |
| 46 | |
| 47 | static int fixed_phy_update_regs(struct fixed_phy *fp) |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 48 | { |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 49 | u16 bmsr = BMSR_ANEGCAPABLE; |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 50 | u16 bmcr = 0; |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 51 | u16 lpagb = 0; |
| 52 | u16 lpa = 0; |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 53 | |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 54 | if (fp->status.duplex) { |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 55 | bmcr |= BMCR_FULLDPLX; |
| 56 | |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 57 | switch (fp->status.speed) { |
| 58 | case 1000: |
| 59 | bmsr |= BMSR_ESTATEN; |
| 60 | bmcr |= BMCR_SPEED1000; |
| 61 | lpagb |= LPA_1000FULL; |
| 62 | break; |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 63 | case 100: |
| 64 | bmsr |= BMSR_100FULL; |
| 65 | bmcr |= BMCR_SPEED100; |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 66 | lpa |= LPA_100FULL; |
Vitaly Bordug | 7c32f47 | 2007-08-10 14:05:16 -0700 | [diff] [blame] | 67 | break; |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 68 | case 10: |
| 69 | bmsr |= BMSR_10FULL; |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 70 | lpa |= LPA_10FULL; |
Vitaly Bordug | 7c32f47 | 2007-08-10 14:05:16 -0700 | [diff] [blame] | 71 | break; |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 72 | default: |
Joe Perches | 8d24248 | 2012-06-09 07:49:07 +0000 | [diff] [blame] | 73 | pr_warn("fixed phy: unknown speed\n"); |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 74 | return -EINVAL; |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 75 | } |
| 76 | } else { |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 77 | switch (fp->status.speed) { |
| 78 | case 1000: |
| 79 | bmsr |= BMSR_ESTATEN; |
| 80 | bmcr |= BMCR_SPEED1000; |
| 81 | lpagb |= LPA_1000HALF; |
| 82 | break; |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 83 | case 100: |
| 84 | bmsr |= BMSR_100HALF; |
| 85 | bmcr |= BMCR_SPEED100; |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 86 | lpa |= LPA_100HALF; |
Vitaly Bordug | 7c32f47 | 2007-08-10 14:05:16 -0700 | [diff] [blame] | 87 | break; |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 88 | case 10: |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 89 | bmsr |= BMSR_10HALF; |
| 90 | lpa |= LPA_10HALF; |
Vitaly Bordug | 7c32f47 | 2007-08-10 14:05:16 -0700 | [diff] [blame] | 91 | break; |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 92 | default: |
Joe Perches | 8d24248 | 2012-06-09 07:49:07 +0000 | [diff] [blame] | 93 | pr_warn("fixed phy: unknown speed\n"); |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 94 | return -EINVAL; |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 95 | } |
| 96 | } |
| 97 | |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 98 | if (fp->status.link) |
| 99 | bmsr |= BMSR_LSTATUS | BMSR_ANEGCOMPLETE; |
| 100 | |
| 101 | if (fp->status.pause) |
| 102 | lpa |= LPA_PAUSE_CAP; |
| 103 | |
| 104 | if (fp->status.asym_pause) |
| 105 | lpa |= LPA_PAUSE_ASYM; |
| 106 | |
| 107 | fp->regs[MII_PHYSID1] = fp->id >> 16; |
| 108 | fp->regs[MII_PHYSID2] = fp->id; |
| 109 | |
| 110 | fp->regs[MII_BMSR] = bmsr; |
| 111 | fp->regs[MII_BMCR] = bmcr; |
| 112 | fp->regs[MII_LPA] = lpa; |
| 113 | fp->regs[MII_STAT1000] = lpagb; |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 114 | |
| 115 | return 0; |
| 116 | } |
| 117 | |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 118 | static int fixed_mdio_read(struct mii_bus *bus, int phy_id, int reg_num) |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 119 | { |
Lennert Buytenhek | ec2a565 | 2008-10-09 09:45:04 -0700 | [diff] [blame] | 120 | struct fixed_mdio_bus *fmb = bus->priv; |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 121 | struct fixed_phy *fp; |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 122 | |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 123 | if (reg_num >= MII_REGS_NUM) |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 124 | return -1; |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 125 | |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 126 | list_for_each_entry(fp, &fmb->phys, node) { |
| 127 | if (fp->id == phy_id) { |
| 128 | /* Issue callback if user registered it. */ |
| 129 | if (fp->link_update) { |
| 130 | fp->link_update(fp->phydev->attached_dev, |
| 131 | &fp->status); |
| 132 | fixed_phy_update_regs(fp); |
| 133 | } |
| 134 | return fp->regs[reg_num]; |
| 135 | } |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 136 | } |
| 137 | |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 138 | return 0xFFFF; |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 139 | } |
| 140 | |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 141 | static int fixed_mdio_write(struct mii_bus *bus, int phy_id, int reg_num, |
| 142 | u16 val) |
| 143 | { |
| 144 | return 0; |
| 145 | } |
| 146 | |
| 147 | /* |
| 148 | * If something weird is required to be done with link/speed, |
| 149 | * network driver is able to assign a function to implement this. |
| 150 | * May be useful for PHY's that need to be software-driven. |
| 151 | */ |
| 152 | int fixed_phy_set_link_update(struct phy_device *phydev, |
| 153 | int (*link_update)(struct net_device *, |
| 154 | struct fixed_phy_status *)) |
| 155 | { |
| 156 | struct fixed_mdio_bus *fmb = &platform_fmb; |
| 157 | struct fixed_phy *fp; |
| 158 | |
| 159 | if (!link_update || !phydev || !phydev->bus) |
| 160 | return -EINVAL; |
| 161 | |
| 162 | list_for_each_entry(fp, &fmb->phys, node) { |
| 163 | if (fp->id == phydev->phy_id) { |
| 164 | fp->link_update = link_update; |
| 165 | fp->phydev = phydev; |
| 166 | return 0; |
| 167 | } |
| 168 | } |
| 169 | |
| 170 | return -ENOENT; |
| 171 | } |
| 172 | EXPORT_SYMBOL_GPL(fixed_phy_set_link_update); |
| 173 | |
| 174 | int fixed_phy_add(unsigned int irq, int phy_id, |
| 175 | struct fixed_phy_status *status) |
| 176 | { |
| 177 | int ret; |
| 178 | struct fixed_mdio_bus *fmb = &platform_fmb; |
| 179 | struct fixed_phy *fp; |
| 180 | |
| 181 | fp = kzalloc(sizeof(*fp), GFP_KERNEL); |
| 182 | if (!fp) |
| 183 | return -ENOMEM; |
| 184 | |
| 185 | memset(fp->regs, 0xFF, sizeof(fp->regs[0]) * MII_REGS_NUM); |
| 186 | |
| 187 | fmb->irqs[phy_id] = irq; |
| 188 | |
| 189 | fp->id = phy_id; |
| 190 | fp->status = *status; |
| 191 | |
| 192 | ret = fixed_phy_update_regs(fp); |
| 193 | if (ret) |
| 194 | goto err_regs; |
| 195 | |
| 196 | list_add_tail(&fp->node, &fmb->phys); |
| 197 | |
| 198 | return 0; |
| 199 | |
| 200 | err_regs: |
| 201 | kfree(fp); |
| 202 | return ret; |
| 203 | } |
| 204 | EXPORT_SYMBOL_GPL(fixed_phy_add); |
| 205 | |
| 206 | static int __init fixed_mdio_bus_init(void) |
| 207 | { |
| 208 | struct fixed_mdio_bus *fmb = &platform_fmb; |
| 209 | int ret; |
| 210 | |
| 211 | pdev = platform_device_register_simple("Fixed MDIO bus", 0, NULL, 0); |
Dan Carpenter | 57401d5 | 2009-04-11 01:52:29 -0700 | [diff] [blame] | 212 | if (IS_ERR(pdev)) { |
| 213 | ret = PTR_ERR(pdev); |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 214 | goto err_pdev; |
| 215 | } |
| 216 | |
Lennert Buytenhek | 298cf9b | 2008-10-08 16:29:57 -0700 | [diff] [blame] | 217 | fmb->mii_bus = mdiobus_alloc(); |
| 218 | if (fmb->mii_bus == NULL) { |
| 219 | ret = -ENOMEM; |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 220 | goto err_mdiobus_reg; |
Lennert Buytenhek | 298cf9b | 2008-10-08 16:29:57 -0700 | [diff] [blame] | 221 | } |
| 222 | |
Florian Fainelli | 9e6c643 | 2012-01-09 23:59:25 +0000 | [diff] [blame] | 223 | snprintf(fmb->mii_bus->id, MII_BUS_ID_SIZE, "fixed-0"); |
Lennert Buytenhek | 298cf9b | 2008-10-08 16:29:57 -0700 | [diff] [blame] | 224 | fmb->mii_bus->name = "Fixed MDIO Bus"; |
Lennert Buytenhek | ec2a565 | 2008-10-09 09:45:04 -0700 | [diff] [blame] | 225 | fmb->mii_bus->priv = fmb; |
Lennert Buytenhek | 298cf9b | 2008-10-08 16:29:57 -0700 | [diff] [blame] | 226 | fmb->mii_bus->parent = &pdev->dev; |
| 227 | fmb->mii_bus->read = &fixed_mdio_read; |
| 228 | fmb->mii_bus->write = &fixed_mdio_write; |
| 229 | fmb->mii_bus->irq = fmb->irqs; |
| 230 | |
| 231 | ret = mdiobus_register(fmb->mii_bus); |
| 232 | if (ret) |
| 233 | goto err_mdiobus_alloc; |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 234 | |
| 235 | return 0; |
| 236 | |
Lennert Buytenhek | 298cf9b | 2008-10-08 16:29:57 -0700 | [diff] [blame] | 237 | err_mdiobus_alloc: |
| 238 | mdiobus_free(fmb->mii_bus); |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 239 | err_mdiobus_reg: |
| 240 | platform_device_unregister(pdev); |
| 241 | err_pdev: |
| 242 | return ret; |
| 243 | } |
| 244 | module_init(fixed_mdio_bus_init); |
| 245 | |
| 246 | static void __exit fixed_mdio_bus_exit(void) |
| 247 | { |
| 248 | struct fixed_mdio_bus *fmb = &platform_fmb; |
Adrian Bunk | 651be3a | 2008-02-02 23:15:02 +0200 | [diff] [blame] | 249 | struct fixed_phy *fp, *tmp; |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 250 | |
Lennert Buytenhek | 298cf9b | 2008-10-08 16:29:57 -0700 | [diff] [blame] | 251 | mdiobus_unregister(fmb->mii_bus); |
| 252 | mdiobus_free(fmb->mii_bus); |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 253 | platform_device_unregister(pdev); |
| 254 | |
Adrian Bunk | 651be3a | 2008-02-02 23:15:02 +0200 | [diff] [blame] | 255 | list_for_each_entry_safe(fp, tmp, &fmb->phys, node) { |
Vitaly Bordug | a79d8e9 | 2007-12-07 01:51:22 +0300 | [diff] [blame] | 256 | list_del(&fp->node); |
| 257 | kfree(fp); |
| 258 | } |
| 259 | } |
| 260 | module_exit(fixed_mdio_bus_exit); |
| 261 | |
| 262 | MODULE_DESCRIPTION("Fixed MDIO bus (MDIO bus emulation with fixed PHYs)"); |
Vitaly Bordug | 11b0bac | 2006-08-14 23:00:29 -0700 | [diff] [blame] | 263 | MODULE_AUTHOR("Vitaly Bordug"); |
| 264 | MODULE_LICENSE("GPL"); |