| xj | b04a402 | 2021-11-25 15:01:52 +0800 | [diff] [blame] | 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); |