drivers/net/phy/aquantia.c

   1 /*
   2  * Driver for Aquantia PHY
   3  *
   4  * Author: Shaohui Xie <Shaohui.Xie@freescale.com>
   5  *
   6  * Copyright 2015 Freescale Semiconductor, Inc.
   7  *
   8  * This file is licensed under the terms of the GNU General Public License
   9  * version 2.  This program is licensed "as is" without any warranty of any
  10  * kind, whether express or implied.
  11  */
  12
  13 #include <linux/kernel.h>
  14 #include <linux/module.h>
  15 #include <linux/delay.h>
  16 #include <linux/mii.h>
  17 #include <linux/ethtool.h>
  18 #include <linux/phy.h>
  19 #include <linux/mdio.h>
  20
  21 #define PHY_ID_AQ1202   0x03a1b445
  22 #define PHY_ID_AQ2104   0x03a1b460
  23 #define PHY_ID_AQR105   0x03a1b4a2
  24 #define PHY_ID_AQR405   0x03a1b4b0
  25
  26 #define PHY_AQUANTIA_FEATURES   (SUPPORTED_10000baseT_Full | \
  27                                  SUPPORTED_1000baseT_Full | \
  28                                  SUPPORTED_100baseT_Full | \
  29                                  PHY_DEFAULT_FEATURES)
  30
  31 static int aquantia_config_aneg(struct phy_device *phydev)
  32 {
  33         phydev->supported = PHY_AQUANTIA_FEATURES;
  34         phydev->advertising = phydev->supported;
  35
  36         return 0;
  37 }
  38
  39 static int aquantia_aneg_done(struct phy_device *phydev)
  40 {
  41         int reg;
  42
  43         reg = phy_read_mmd(phydev, MDIO_MMD_AN, MDIO_STAT1);
  44         return (reg < 0) ? reg : (reg & BMSR_ANEGCOMPLETE);
  45 }
  46
  47 static int aquantia_read_status(struct phy_device *phydev)
  48 {
  49         int reg;
  50
  51         reg = phy_read_mmd(phydev, MDIO_MMD_AN, MDIO_STAT1);
  52         reg = phy_read_mmd(phydev, MDIO_MMD_AN, MDIO_STAT1);
  53         if (reg & MDIO_STAT1_LSTATUS)
  54                 phydev->link = 1;
  55         else
  56                 phydev->link = 0;
  57
  58         reg = phy_read_mmd(phydev, MDIO_MMD_AN, 0xc800);
  59         mdelay(10);
  60         reg = phy_read_mmd(phydev, MDIO_MMD_AN, 0xc800);
  61
  62         switch (reg) {
  63         case 0x9:
  64                 phydev->speed = SPEED_2500;
  65                 break;
  66         case 0x5:
  67                 phydev->speed = SPEED_1000;
  68                 break;
  69         case 0x3:
  70                 phydev->speed = SPEED_100;
  71                 break;
  72         case 0x7:
  73         default:
  74                 phydev->speed = SPEED_10000;
  75                 break;
  76         }
  77         phydev->duplex = DUPLEX_FULL;
  78
  79         return 0;
  80 }
  81
  82 static struct phy_driver aquantia_driver[] = {
  83 {
  84         .phy_id         = PHY_ID_AQ1202,
  85         .phy_id_mask    = 0xfffffff0,
  86         .name           = "Aquantia AQ1202",
  87         .features       = PHY_AQUANTIA_FEATURES,
  88         .aneg_done      = aquantia_aneg_done,
  89         .config_aneg    = aquantia_config_aneg,
  90         .read_status    = aquantia_read_status,
  91         .driver         = { .owner = THIS_MODULE,},
  92 },
  93 {
  94         .phy_id         = PHY_ID_AQ2104,
  95         .phy_id_mask    = 0xfffffff0,
  96         .name           = "Aquantia AQ2104",
  97         .features       = PHY_AQUANTIA_FEATURES,
  98         .aneg_done      = aquantia_aneg_done,
  99         .config_aneg    = aquantia_config_aneg,
 100         .read_status    = aquantia_read_status,
 101         .driver         = { .owner = THIS_MODULE,},
 102 },
 103 {
 104         .phy_id         = PHY_ID_AQR105,
 105         .phy_id_mask    = 0xfffffff0,
 106         .name           = "Aquantia AQR105",
 107         .features       = PHY_AQUANTIA_FEATURES,
 108         .aneg_done      = aquantia_aneg_done,
 109         .config_aneg    = aquantia_config_aneg,
 110         .read_status    = aquantia_read_status,
 111         .driver         = { .owner = THIS_MODULE,},
 112 },
 113 {
 114         .phy_id         = PHY_ID_AQR405,
 115         .phy_id_mask    = 0xfffffff0,
 116         .name           = "Aquantia AQR405",
 117         .features       = PHY_AQUANTIA_FEATURES,
 118         .aneg_done      = aquantia_aneg_done,
 119         .config_aneg    = aquantia_config_aneg,
 120         .read_status    = aquantia_read_status,
 121         .driver         = { .owner = THIS_MODULE,},
 122 },
 123 };
 124
 125 static int __init aquantia_init(void)
 126 {
 127         return phy_drivers_register(aquantia_driver,
 128                                     ARRAY_SIZE(aquantia_driver));
 129 }
 130
 131 static void __exit aquantia_exit(void)
 132 {
 133         return phy_drivers_unregister(aquantia_driver,
 134                                       ARRAY_SIZE(aquantia_driver));
 135 }
 136
 137 module_init(aquantia_init);
 138 module_exit(aquantia_exit);
 139
 140 static struct mdio_device_id __maybe_unused aquantia_tbl[] = {
 141         { PHY_ID_AQ1202, 0xfffffff0 },
 142         { PHY_ID_AQ2104, 0xfffffff0 },
 143         { PHY_ID_AQR105, 0xfffffff0 },
 144         { PHY_ID_AQR405, 0xfffffff0 },
 145         { }
 146 };
 147
 148 MODULE_DEVICE_TABLE(mdio, aquantia_tbl);
 149
 150 MODULE_DESCRIPTION("Aquantia PHY driver");
 151 MODULE_AUTHOR("Shaohui Xie <Shaohui.Xie@freescale.com>");
 152 MODULE_LICENSE("GPL v2");