drivers/net/dsa/mv88e6xxx/phy.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  * Marvell 88e6xxx Ethernet switch PHY and PPU support
   4  *
   5  * Copyright (c) 2008 Marvell Semiconductor
   6  *
   7  * Copyright (c) 2017 Andrew Lunn <andrew@lunn.ch>
   8  */
   9
  10 #include <linux/mdio.h>
  11 #include <linux/module.h>
  12
  13 #include "chip.h"
  14 #include "phy.h"
  15
  16 int mv88e6165_phy_read(struct mv88e6xxx_chip *chip, struct mii_bus *bus,
  17                        int addr, int reg, u16 *val)
  18 {
  19         return mv88e6xxx_read(chip, addr, reg, val);
  20 }
  21
  22 int mv88e6165_phy_write(struct mv88e6xxx_chip *chip, struct mii_bus *bus,
  23                         int addr, int reg, u16 val)
  24 {
  25         return mv88e6xxx_write(chip, addr, reg, val);
  26 }
  27
  28 int mv88e6xxx_phy_read(struct mv88e6xxx_chip *chip, int phy, int reg, u16 *val)
  29 {
  30         int addr = phy; /* PHY devices addresses start at 0x0 */
  31         struct mii_bus *bus;
  32
  33         bus = mv88e6xxx_default_mdio_bus(chip);
  34         if (!bus)
  35                 return -EOPNOTSUPP;
  36
  37         if (!chip->info->ops->phy_read)
  38                 return -EOPNOTSUPP;
  39
  40         return chip->info->ops->phy_read(chip, bus, addr, reg, val);
  41 }
  42
  43 int mv88e6xxx_phy_write(struct mv88e6xxx_chip *chip, int phy, int reg, u16 val)
  44 {
  45         int addr = phy; /* PHY devices addresses start at 0x0 */
  46         struct mii_bus *bus;
  47
  48         bus = mv88e6xxx_default_mdio_bus(chip);
  49         if (!bus)
  50                 return -EOPNOTSUPP;
  51
  52         if (!chip->info->ops->phy_write)
  53                 return -EOPNOTSUPP;
  54
  55         return chip->info->ops->phy_write(chip, bus, addr, reg, val);
  56 }
  57
  58 static int mv88e6xxx_phy_page_get(struct mv88e6xxx_chip *chip, int phy, u8 page)
  59 {
  60         return mv88e6xxx_phy_write(chip, phy, MV88E6XXX_PHY_PAGE, page);
  61 }
  62
  63 static void mv88e6xxx_phy_page_put(struct mv88e6xxx_chip *chip, int phy)
  64 {
  65         int err;
  66
  67         /* Restore PHY page Copper 0x0 for access via the registered
  68          * MDIO bus
  69          */
  70         err = mv88e6xxx_phy_write(chip, phy, MV88E6XXX_PHY_PAGE,
  71                                   MV88E6XXX_PHY_PAGE_COPPER);
  72         if (unlikely(err)) {
  73                 dev_err(chip->dev,
  74                         "failed to restore PHY %d page Copper (%d)\n",
  75                         phy, err);
  76         }
  77 }
  78
  79 int mv88e6xxx_phy_page_read(struct mv88e6xxx_chip *chip, int phy,
  80                             u8 page, int reg, u16 *val)
  81 {
  82         int err;
  83
  84         /* There is no paging for registers 22 */
  85         if (reg == MV88E6XXX_PHY_PAGE)
  86                 return -EINVAL;
  87
  88         err = mv88e6xxx_phy_page_get(chip, phy, page);
  89         if (!err) {
  90                 err = mv88e6xxx_phy_read(chip, phy, reg, val);
  91                 mv88e6xxx_phy_page_put(chip, phy);
  92         }
  93
  94         return err;
  95 }
  96
  97 int mv88e6xxx_phy_page_write(struct mv88e6xxx_chip *chip, int phy,
  98                              u8 page, int reg, u16 val)
  99 {
 100         int err;
 101
 102         /* There is no paging for registers 22 */
 103         if (reg == MV88E6XXX_PHY_PAGE)
 104                 return -EINVAL;
 105
 106         err = mv88e6xxx_phy_page_get(chip, phy, page);
 107         if (!err) {
 108                 err = mv88e6xxx_phy_write(chip, phy, MV88E6XXX_PHY_PAGE, page);
 109                 if (!err)
 110                         err = mv88e6xxx_phy_write(chip, phy, reg, val);
 111
 112                 mv88e6xxx_phy_page_put(chip, phy);
 113         }
 114
 115         return err;
 116 }
 117
 118 static int mv88e6xxx_phy_ppu_disable(struct mv88e6xxx_chip *chip)
 119 {
 120         if (!chip->info->ops->ppu_disable)
 121                 return 0;
 122
 123         return chip->info->ops->ppu_disable(chip);
 124 }
 125
 126 static int mv88e6xxx_phy_ppu_enable(struct mv88e6xxx_chip *chip)
 127 {
 128         if (!chip->info->ops->ppu_enable)
 129                 return 0;
 130
 131         return chip->info->ops->ppu_enable(chip);
 132 }
 133
 134 static void mv88e6xxx_phy_ppu_reenable_work(struct work_struct *ugly)
 135 {
 136         struct mv88e6xxx_chip *chip;
 137
 138         chip = container_of(ugly, struct mv88e6xxx_chip, ppu_work);
 139
 140         mv88e6xxx_reg_lock(chip);
 141
 142         if (mutex_trylock(&chip->ppu_mutex)) {
 143                 if (mv88e6xxx_phy_ppu_enable(chip) == 0)
 144                         chip->ppu_disabled = 0;
 145                 mutex_unlock(&chip->ppu_mutex);
 146         }
 147
 148         mv88e6xxx_reg_unlock(chip);
 149 }
 150
 151 static void mv88e6xxx_phy_ppu_reenable_timer(struct timer_list *t)
 152 {
 153         struct mv88e6xxx_chip *chip = from_timer(chip, t, ppu_timer);
 154
 155         schedule_work(&chip->ppu_work);
 156 }
 157
 158 static int mv88e6xxx_phy_ppu_access_get(struct mv88e6xxx_chip *chip)
 159 {
 160         int ret;
 161
 162         mutex_lock(&chip->ppu_mutex);
 163
 164         /* If the PHY polling unit is enabled, disable it so that
 165          * we can access the PHY registers.  If it was already
 166          * disabled, cancel the timer that is going to re-enable
 167          * it.
 168          */
 169         if (!chip->ppu_disabled) {
 170                 ret = mv88e6xxx_phy_ppu_disable(chip);
 171                 if (ret < 0) {
 172                         mutex_unlock(&chip->ppu_mutex);
 173                         return ret;
 174                 }
 175                 chip->ppu_disabled = 1;
 176         } else {
 177                 del_timer(&chip->ppu_timer);
 178                 ret = 0;
 179         }
 180
 181         return ret;
 182 }
 183
 184 static void mv88e6xxx_phy_ppu_access_put(struct mv88e6xxx_chip *chip)
 185 {
 186         /* Schedule a timer to re-enable the PHY polling unit. */
 187         mod_timer(&chip->ppu_timer, jiffies + msecs_to_jiffies(10));
 188         mutex_unlock(&chip->ppu_mutex);
 189 }
 190
 191 static void mv88e6xxx_phy_ppu_state_init(struct mv88e6xxx_chip *chip)
 192 {
 193         mutex_init(&chip->ppu_mutex);
 194         INIT_WORK(&chip->ppu_work, mv88e6xxx_phy_ppu_reenable_work);
 195         timer_setup(&chip->ppu_timer, mv88e6xxx_phy_ppu_reenable_timer, 0);
 196 }
 197
 198 static void mv88e6xxx_phy_ppu_state_destroy(struct mv88e6xxx_chip *chip)
 199 {
 200         del_timer_sync(&chip->ppu_timer);
 201 }
 202
 203 int mv88e6185_phy_ppu_read(struct mv88e6xxx_chip *chip, struct mii_bus *bus,
 204                            int addr, int reg, u16 *val)
 205 {
 206         int err;
 207
 208         err = mv88e6xxx_phy_ppu_access_get(chip);
 209         if (!err) {
 210                 err = mv88e6xxx_read(chip, addr, reg, val);
 211                 mv88e6xxx_phy_ppu_access_put(chip);
 212         }
 213
 214         return err;
 215 }
 216
 217 int mv88e6185_phy_ppu_write(struct mv88e6xxx_chip *chip, struct mii_bus *bus,
 218                             int addr, int reg, u16 val)
 219 {
 220         int err;
 221
 222         err = mv88e6xxx_phy_ppu_access_get(chip);
 223         if (!err) {
 224                 err = mv88e6xxx_write(chip, addr, reg, val);
 225                 mv88e6xxx_phy_ppu_access_put(chip);
 226         }
 227
 228         return err;
 229 }
 230
 231 void mv88e6xxx_phy_init(struct mv88e6xxx_chip *chip)
 232 {
 233         if (chip->info->ops->ppu_enable && chip->info->ops->ppu_disable)
 234                 mv88e6xxx_phy_ppu_state_init(chip);
 235 }
 236
 237 void mv88e6xxx_phy_destroy(struct mv88e6xxx_chip *chip)
 238 {
 239         if (chip->info->ops->ppu_enable && chip->info->ops->ppu_disable)
 240                 mv88e6xxx_phy_ppu_state_destroy(chip);
 241 }
 242
 243 int mv88e6xxx_phy_setup(struct mv88e6xxx_chip *chip)
 244 {
 245         return mv88e6xxx_phy_ppu_enable(chip);
 246 }