drivers/net/phy/fixed.c

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