drivers/net/phy/uPD60620.c

   1 /*
   2  * Driver for the Renesas PHY uPD60620.
   3  *
   4  * Copyright (C) 2015 Softing Industrial Automation GmbH
   5  *
   6  *  This program is free software; you can redistribute it and/or modify
   7  *  it under the terms of the GNU General Public License as published by
   8  *  the Free Software Foundation; either version 2 of the License, or
   9  *  (at your option) any later version.
  10  *
  11  */
  12
  13 #include <linux/kernel.h>
  14 #include <linux/module.h>
  15 #include <linux/phy.h>
  16
  17 #define UPD60620_PHY_ID    0xb8242824
  18
  19 /* Extended Registers and values */
  20 /* PHY Special Control/Status    */
  21 #define PHY_PHYSCR         0x1F      /* PHY.31 */
  22 #define PHY_PHYSCR_10MB    0x0004    /* PHY speed = 10mb */
  23 #define PHY_PHYSCR_100MB   0x0008    /* PHY speed = 100mb */
  24 #define PHY_PHYSCR_DUPLEX  0x0010    /* PHY Duplex */
  25
  26 /* PHY Special Modes */
  27 #define PHY_SPM            0x12      /* PHY.18 */
  28
  29 /* Init PHY */
  30
  31 static int upd60620_config_init(struct phy_device *phydev)
  32 {
  33         /* Enable support for passive HUBs (could be a strap option) */
  34         /* PHYMODE: All speeds, HD in parallel detect */
  35         return phy_write(phydev, PHY_SPM, 0x0180 | phydev->mdio.addr);
  36 }
  37
  38 /* Get PHY status from common registers */
  39
  40 static int upd60620_read_status(struct phy_device *phydev)
  41 {
  42         int phy_state;
  43
  44         /* Read negotiated state */
  45         phy_state = phy_read(phydev, MII_BMSR);
  46         if (phy_state < 0)
  47                 return phy_state;
  48
  49         phydev->link = 0;
  50         phydev->lp_advertising = 0;
  51         phydev->pause = 0;
  52         phydev->asym_pause = 0;
  53
  54         if (phy_state & (BMSR_ANEGCOMPLETE | BMSR_LSTATUS)) {
  55                 phy_state = phy_read(phydev, PHY_PHYSCR);
  56                 if (phy_state < 0)
  57                         return phy_state;
  58
  59                 if (phy_state & (PHY_PHYSCR_10MB | PHY_PHYSCR_100MB)) {
  60                         phydev->link = 1;
  61                         phydev->speed = SPEED_10;
  62                         phydev->duplex = DUPLEX_HALF;
  63
  64                         if (phy_state & PHY_PHYSCR_100MB)
  65                                 phydev->speed = SPEED_100;
  66                         if (phy_state & PHY_PHYSCR_DUPLEX)
  67                                 phydev->duplex = DUPLEX_FULL;
  68
  69                         phy_state = phy_read(phydev, MII_LPA);
  70                         if (phy_state < 0)
  71                                 return phy_state;
  72
  73                         phydev->lp_advertising
  74                                 = mii_lpa_to_ethtool_lpa_t(phy_state);
  75
  76                         if (phydev->duplex == DUPLEX_FULL) {
  77                                 if (phy_state & LPA_PAUSE_CAP)
  78                                         phydev->pause = 1;
  79                                 if (phy_state & LPA_PAUSE_ASYM)
  80                                         phydev->asym_pause = 1;
  81                         }
  82                 }
  83         }
  84         return 0;
  85 }
  86
  87 MODULE_DESCRIPTION("Renesas uPD60620 PHY driver");
  88 MODULE_AUTHOR("Bernd Edlinger <bernd.edlinger@hotmail.de>");
  89 MODULE_LICENSE("GPL");
  90
  91 static struct phy_driver upd60620_driver[1] = { {
  92         .phy_id         = UPD60620_PHY_ID,
  93         .phy_id_mask    = 0xfffffffe,
  94         .name           = "Renesas uPD60620",
  95         .features       = PHY_BASIC_FEATURES,
  96         .flags          = 0,
  97         .config_init    = upd60620_config_init,
  98         .read_status    = upd60620_read_status,
  99 } };
 100
 101 module_phy_driver(upd60620_driver);
 102
 103 static struct mdio_device_id __maybe_unused upd60620_tbl[] = {
 104         { UPD60620_PHY_ID, 0xfffffffe },
 105         { }
 106 };
 107
 108 MODULE_DEVICE_TABLE(mdio, upd60620_tbl);