| 1 |
// SPDX-License-Identifier: GPL-2.0+ |
| 2 |
/* |
| 3 |
* Driver for Vitesse PHYs |
| 4 |
* |
| 5 |
* Author: Kriston Carson |
| 6 |
*/ |
| 7 |
|
| 8 |
#include <linux/kernel.h> |
| 9 |
#include <linux/module.h> |
| 10 |
#include <linux/mii.h> |
| 11 |
#include <linux/ethtool.h> |
| 12 |
#include <linux/phy.h> |
| 13 |
#include <linux/bitfield.h> |
| 14 |
|
| 15 |
/* Vitesse Extended Page Magic Register(s) */ |
| 16 |
#define MII_VSC73XX_EXT_PAGE_1E 0x01 |
| 17 |
#define MII_VSC82X4_EXT_PAGE_16E 0x10 |
| 18 |
#define MII_VSC82X4_EXT_PAGE_17E 0x11 |
| 19 |
#define MII_VSC82X4_EXT_PAGE_18E 0x12 |
| 20 |
|
| 21 |
/* Vitesse Extended Control Register 1 */ |
| 22 |
#define MII_VSC8244_EXT_CON1 0x17 |
| 23 |
#define MII_VSC8244_EXTCON1_INIT 0x0000 |
| 24 |
#define MII_VSC8244_EXTCON1_TX_SKEW_MASK 0x0c00 |
| 25 |
#define MII_VSC8244_EXTCON1_RX_SKEW_MASK 0x0300 |
| 26 |
#define MII_VSC8244_EXTCON1_TX_SKEW 0x0800 |
| 27 |
#define MII_VSC8244_EXTCON1_RX_SKEW 0x0200 |
| 28 |
|
| 29 |
/* Vitesse Interrupt Mask Register */ |
| 30 |
#define MII_VSC8244_IMASK 0x19 |
| 31 |
#define MII_VSC8244_IMASK_IEN 0x8000 |
| 32 |
#define MII_VSC8244_IMASK_SPEED 0x4000 |
| 33 |
#define MII_VSC8244_IMASK_LINK 0x2000 |
| 34 |
#define MII_VSC8244_IMASK_DUPLEX 0x1000 |
| 35 |
#define MII_VSC8244_IMASK_MASK 0xf000 |
| 36 |
|
| 37 |
#define MII_VSC8221_IMASK_MASK 0xa000 |
| 38 |
|
| 39 |
/* Vitesse Interrupt Status Register */ |
| 40 |
#define MII_VSC8244_ISTAT 0x1a |
| 41 |
#define MII_VSC8244_ISTAT_STATUS 0x8000 |
| 42 |
#define MII_VSC8244_ISTAT_SPEED 0x4000 |
| 43 |
#define MII_VSC8244_ISTAT_LINK 0x2000 |
| 44 |
#define MII_VSC8244_ISTAT_DUPLEX 0x1000 |
| 45 |
#define MII_VSC8244_ISTAT_MASK (MII_VSC8244_ISTAT_SPEED | \ |
| 46 |
MII_VSC8244_ISTAT_LINK | \ |
| 47 |
MII_VSC8244_ISTAT_DUPLEX) |
| 48 |
|
| 49 |
#define MII_VSC8221_ISTAT_MASK MII_VSC8244_ISTAT_LINK |
| 50 |
|
| 51 |
/* Vitesse Auxiliary Control/Status Register */ |
| 52 |
#define MII_VSC8244_AUX_CONSTAT 0x1c |
| 53 |
#define MII_VSC8244_AUXCONSTAT_INIT 0x0000 |
| 54 |
#define MII_VSC8244_AUXCONSTAT_DUPLEX 0x0020 |
| 55 |
#define MII_VSC8244_AUXCONSTAT_SPEED 0x0018 |
| 56 |
#define MII_VSC8244_AUXCONSTAT_GBIT 0x0010 |
| 57 |
#define MII_VSC8244_AUXCONSTAT_100 0x0008 |
| 58 |
|
| 59 |
#define MII_VSC8221_AUXCONSTAT_INIT 0x0004 /* need to set this bit? */ |
| 60 |
#define MII_VSC8221_AUXCONSTAT_RESERVED 0x0004 |
| 61 |
|
| 62 |
/* Vitesse Extended Page Access Register */ |
| 63 |
#define MII_VSC82X4_EXT_PAGE_ACCESS 0x1f |
| 64 |
|
| 65 |
/* Vitesse VSC73XX Extended Control Register */ |
| 66 |
#define MII_VSC73XX_PHY_CTRL_EXT3 0x14 |
| 67 |
|
| 68 |
#define MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_EN BIT(4) |
| 69 |
#define MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_CNT GENMASK(3, 2) |
| 70 |
#define MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_STA BIT(1) |
| 71 |
#define MII_VSC73XX_DOWNSHIFT_MAX 5 |
| 72 |
#define MII_VSC73XX_DOWNSHIFT_INVAL 1 |
| 73 |
|
| 74 |
/* VSC73XX PHY_BYPASS_CTRL register*/ |
| 75 |
#define MII_VSC73XX_PHY_BYPASS_CTRL MII_DCOUNTER |
| 76 |
#define MII_VSC73XX_PBC_TX_DIS BIT(15) |
| 77 |
#define MII_VSC73XX_PBC_FOR_SPD_AUTO_MDIX_DIS BIT(7) |
| 78 |
#define MII_VSC73XX_PBC_PAIR_SWAP_DIS BIT(5) |
| 79 |
#define MII_VSC73XX_PBC_POL_INV_DIS BIT(4) |
| 80 |
#define MII_VSC73XX_PBC_PARALLEL_DET_DIS BIT(3) |
| 81 |
#define MII_VSC73XX_PBC_AUTO_NP_EXCHANGE_DIS BIT(1) |
| 82 |
|
| 83 |
/* VSC73XX PHY_AUX_CTRL_STAT register */ |
| 84 |
#define MII_VSC73XX_PHY_AUX_CTRL_STAT MII_NCONFIG |
| 85 |
#define MII_VSC73XX_PACS_NO_MDI_X_IND BIT(13) |
| 86 |
|
| 87 |
/* Vitesse VSC8601 Extended PHY Control Register 1 */ |
| 88 |
#define MII_VSC8601_EPHY_CTL 0x17 |
| 89 |
#define MII_VSC8601_EPHY_CTL_RGMII_SKEW (1 << 8) |
| 90 |
|
| 91 |
#define PHY_ID_VSC8234 0x000fc620 |
| 92 |
#define PHY_ID_VSC8244 0x000fc6c0 |
| 93 |
#define PHY_ID_VSC8572 0x000704d0 |
| 94 |
#define PHY_ID_VSC8601 0x00070420 |
| 95 |
#define PHY_ID_VSC7385 0x00070450 |
| 96 |
#define PHY_ID_VSC7388 0x00070480 |
| 97 |
#define PHY_ID_VSC7395 0x00070550 |
| 98 |
#define PHY_ID_VSC7398 0x00070580 |
| 99 |
#define PHY_ID_VSC8662 0x00070660 |
| 100 |
#define PHY_ID_VSC8221 0x000fc550 |
| 101 |
#define PHY_ID_VSC8211 0x000fc4b0 |
| 102 |
|
| 103 |
MODULE_DESCRIPTION("Vitesse PHY driver"); |
| 104 |
MODULE_AUTHOR("Kriston Carson"); |
| 105 |
MODULE_LICENSE("GPL"); |
| 106 |
|
| 107 |
static int vsc824x_add_skew(struct phy_device *phydev) |
| 108 |
{ |
| 109 |
int err; |
| 110 |
int extcon; |
| 111 |
|
| 112 |
extcon = phy_read(phydev, MII_VSC8244_EXT_CON1); |
| 113 |
|
| 114 |
if (extcon < 0) |
| 115 |
return extcon; |
| 116 |
|
| 117 |
extcon &= ~(MII_VSC8244_EXTCON1_TX_SKEW_MASK | |
| 118 |
MII_VSC8244_EXTCON1_RX_SKEW_MASK); |
| 119 |
|
| 120 |
extcon |= (MII_VSC8244_EXTCON1_TX_SKEW | |
| 121 |
MII_VSC8244_EXTCON1_RX_SKEW); |
| 122 |
|
| 123 |
err = phy_write(phydev, MII_VSC8244_EXT_CON1, extcon); |
| 124 |
|
| 125 |
return err; |
| 126 |
} |
| 127 |
|
| 128 |
static int vsc824x_config_init(struct phy_device *phydev) |
| 129 |
{ |
| 130 |
int err; |
| 131 |
|
| 132 |
err = phy_write(phydev, MII_VSC8244_AUX_CONSTAT, |
| 133 |
MII_VSC8244_AUXCONSTAT_INIT); |
| 134 |
if (err < 0) |
| 135 |
return err; |
| 136 |
|
| 137 |
if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID) |
| 138 |
err = vsc824x_add_skew(phydev); |
| 139 |
|
| 140 |
return err; |
| 141 |
} |
| 142 |
|
| 143 |
#define VSC73XX_EXT_PAGE_ACCESS 0x1f |
| 144 |
|
| 145 |
static int vsc73xx_read_page(struct phy_device *phydev) |
| 146 |
{ |
| 147 |
return __phy_read(phydev, VSC73XX_EXT_PAGE_ACCESS); |
| 148 |
} |
| 149 |
|
| 150 |
static int vsc73xx_write_page(struct phy_device *phydev, int page) |
| 151 |
{ |
| 152 |
return __phy_write(phydev, VSC73XX_EXT_PAGE_ACCESS, page); |
| 153 |
} |
| 154 |
|
| 155 |
static int vsc73xx_get_downshift(struct phy_device *phydev, u8 *data) |
| 156 |
{ |
| 157 |
int val, enable, cnt; |
| 158 |
|
| 159 |
val = phy_read_paged(phydev, MII_VSC73XX_EXT_PAGE_1E, |
| 160 |
MII_VSC73XX_PHY_CTRL_EXT3); |
| 161 |
if (val < 0) |
| 162 |
return val; |
| 163 |
|
| 164 |
enable = FIELD_GET(MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_EN, val); |
| 165 |
cnt = FIELD_GET(MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_CNT, val) + 2; |
| 166 |
|
| 167 |
*data = enable ? cnt : DOWNSHIFT_DEV_DISABLE; |
| 168 |
|
| 169 |
return 0; |
| 170 |
} |
| 171 |
|
| 172 |
static int vsc73xx_set_downshift(struct phy_device *phydev, u8 cnt) |
| 173 |
{ |
| 174 |
u16 mask, val; |
| 175 |
int ret; |
| 176 |
|
| 177 |
if (cnt > MII_VSC73XX_DOWNSHIFT_MAX) |
| 178 |
return -E2BIG; |
| 179 |
else if (cnt == MII_VSC73XX_DOWNSHIFT_INVAL) |
| 180 |
return -EINVAL; |
| 181 |
|
| 182 |
mask = MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_EN; |
| 183 |
|
| 184 |
if (!cnt) { |
| 185 |
val = 0; |
| 186 |
} else { |
| 187 |
mask |= MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_CNT; |
| 188 |
val = MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_EN | |
| 189 |
FIELD_PREP(MII_VSC73XX_PHY_CTRL_EXT3_DOWNSHIFT_CNT, |
| 190 |
cnt - 2); |
| 191 |
} |
| 192 |
|
| 193 |
ret = phy_modify_paged(phydev, MII_VSC73XX_EXT_PAGE_1E, |
| 194 |
MII_VSC73XX_PHY_CTRL_EXT3, mask, val); |
| 195 |
if (ret < 0) |
| 196 |
return ret; |
| 197 |
|
| 198 |
return genphy_soft_reset(phydev); |
| 199 |
} |
| 200 |
|
| 201 |
static int vsc73xx_get_tunable(struct phy_device *phydev, |
| 202 |
struct ethtool_tunable *tuna, void *data) |
| 203 |
{ |
| 204 |
switch (tuna->id) { |
| 205 |
case ETHTOOL_PHY_DOWNSHIFT: |
| 206 |
return vsc73xx_get_downshift(phydev, data); |
| 207 |
default: |
| 208 |
return -EOPNOTSUPP; |
| 209 |
} |
| 210 |
} |
| 211 |
|
| 212 |
static int vsc73xx_set_tunable(struct phy_device *phydev, |
| 213 |
struct ethtool_tunable *tuna, const void *data) |
| 214 |
{ |
| 215 |
switch (tuna->id) { |
| 216 |
case ETHTOOL_PHY_DOWNSHIFT: |
| 217 |
return vsc73xx_set_downshift(phydev, *(const u8 *)data); |
| 218 |
default: |
| 219 |
return -EOPNOTSUPP; |
| 220 |
} |
| 221 |
} |
| 222 |
|
| 223 |
static void vsc73xx_config_init(struct phy_device *phydev) |
| 224 |
{ |
| 225 |
/* Receiver init */ |
| 226 |
phy_write(phydev, 0x1f, 0x2a30); |
| 227 |
phy_modify(phydev, 0x0c, 0x0300, 0x0200); |
| 228 |
phy_write(phydev, 0x1f, 0x0000); |
| 229 |
|
| 230 |
/* Config LEDs 0x61 */ |
| 231 |
phy_modify(phydev, MII_TPISTATUS, 0xff00, 0x0061); |
| 232 |
|
| 233 |
/* Enable downshift by default */ |
| 234 |
vsc73xx_set_downshift(phydev, MII_VSC73XX_DOWNSHIFT_MAX); |
| 235 |
|
| 236 |
/* Set Auto MDI-X by default */ |
| 237 |
phydev->mdix_ctrl = ETH_TP_MDI_AUTO; |
| 238 |
} |
| 239 |
|
| 240 |
static int vsc738x_config_init(struct phy_device *phydev) |
| 241 |
{ |
| 242 |
u16 rev; |
| 243 |
/* This magic sequence appear in the application note |
| 244 |
* "VSC7385/7388 PHY Configuration". |
| 245 |
* |
| 246 |
* Maybe one day we will get to know what it all means. |
| 247 |
*/ |
| 248 |
phy_write(phydev, 0x1f, 0x2a30); |
| 249 |
phy_modify(phydev, 0x08, 0x0200, 0x0200); |
| 250 |
phy_write(phydev, 0x1f, 0x52b5); |
| 251 |
phy_write(phydev, 0x10, 0xb68a); |
| 252 |
phy_modify(phydev, 0x12, 0xff07, 0x0003); |
| 253 |
phy_modify(phydev, 0x11, 0x00ff, 0x00a2); |
| 254 |
phy_write(phydev, 0x10, 0x968a); |
| 255 |
phy_write(phydev, 0x1f, 0x2a30); |
| 256 |
phy_modify(phydev, 0x08, 0x0200, 0x0000); |
| 257 |
phy_write(phydev, 0x1f, 0x0000); |
| 258 |
|
| 259 |
/* Read revision */ |
| 260 |
rev = phy_read(phydev, MII_PHYSID2); |
| 261 |
rev &= 0x0f; |
| 262 |
|
| 263 |
/* Special quirk for revision 0 */ |
| 264 |
if (rev == 0) { |
| 265 |
phy_write(phydev, 0x1f, 0x2a30); |
| 266 |
phy_modify(phydev, 0x08, 0x0200, 0x0200); |
| 267 |
phy_write(phydev, 0x1f, 0x52b5); |
| 268 |
phy_write(phydev, 0x12, 0x0000); |
| 269 |
phy_write(phydev, 0x11, 0x0689); |
| 270 |
phy_write(phydev, 0x10, 0x8f92); |
| 271 |
phy_write(phydev, 0x1f, 0x52b5); |
| 272 |
phy_write(phydev, 0x12, 0x0000); |
| 273 |
phy_write(phydev, 0x11, 0x0e35); |
| 274 |
phy_write(phydev, 0x10, 0x9786); |
| 275 |
phy_write(phydev, 0x1f, 0x2a30); |
| 276 |
phy_modify(phydev, 0x08, 0x0200, 0x0000); |
| 277 |
phy_write(phydev, 0x17, 0xff80); |
| 278 |
phy_write(phydev, 0x17, 0x0000); |
| 279 |
} |
| 280 |
|
| 281 |
phy_write(phydev, 0x1f, 0x0000); |
| 282 |
phy_write(phydev, 0x12, 0x0048); |
| 283 |
|
| 284 |
if (rev == 0) { |
| 285 |
phy_write(phydev, 0x1f, 0x2a30); |
| 286 |
phy_write(phydev, 0x14, 0x6600); |
| 287 |
phy_write(phydev, 0x1f, 0x0000); |
| 288 |
phy_write(phydev, 0x18, 0xa24e); |
| 289 |
} else { |
| 290 |
phy_write(phydev, 0x1f, 0x2a30); |
| 291 |
phy_modify(phydev, 0x16, 0x0fc0, 0x0240); |
| 292 |
phy_modify(phydev, 0x14, 0x6000, 0x4000); |
| 293 |
/* bits 14-15 in extended register 0x14 controls DACG amplitude |
| 294 |
* 6 = -8%, 2 is hardware default |
| 295 |
*/ |
| 296 |
phy_write(phydev, 0x1f, 0x0001); |
| 297 |
phy_modify(phydev, 0x14, 0xe000, 0x6000); |
| 298 |
phy_write(phydev, 0x1f, 0x0000); |
| 299 |
} |
| 300 |
|
| 301 |
vsc73xx_config_init(phydev); |
| 302 |
|
| 303 |
return 0; |
| 304 |
} |
| 305 |
|
| 306 |
static int vsc739x_config_init(struct phy_device *phydev) |
| 307 |
{ |
| 308 |
/* This magic sequence appears in the VSC7395 SparX-G5e application |
| 309 |
* note "VSC7395/VSC7398 PHY Configuration" |
| 310 |
* |
| 311 |
* Maybe one day we will get to know what it all means. |
| 312 |
*/ |
| 313 |
phy_write(phydev, 0x1f, 0x2a30); |
| 314 |
phy_modify(phydev, 0x08, 0x0200, 0x0200); |
| 315 |
phy_write(phydev, 0x1f, 0x52b5); |
| 316 |
phy_write(phydev, 0x10, 0xb68a); |
| 317 |
phy_modify(phydev, 0x12, 0xff07, 0x0003); |
| 318 |
phy_modify(phydev, 0x11, 0x00ff, 0x00a2); |
| 319 |
phy_write(phydev, 0x10, 0x968a); |
| 320 |
phy_write(phydev, 0x1f, 0x2a30); |
| 321 |
phy_modify(phydev, 0x08, 0x0200, 0x0000); |
| 322 |
phy_write(phydev, 0x1f, 0x0000); |
| 323 |
|
| 324 |
phy_write(phydev, 0x1f, 0x0000); |
| 325 |
phy_write(phydev, 0x12, 0x0048); |
| 326 |
phy_write(phydev, 0x1f, 0x2a30); |
| 327 |
phy_modify(phydev, 0x16, 0x0fc0, 0x0240); |
| 328 |
phy_modify(phydev, 0x14, 0x6000, 0x4000); |
| 329 |
phy_write(phydev, 0x1f, 0x0001); |
| 330 |
phy_modify(phydev, 0x14, 0xe000, 0x6000); |
| 331 |
phy_write(phydev, 0x1f, 0x0000); |
| 332 |
|
| 333 |
vsc73xx_config_init(phydev); |
| 334 |
|
| 335 |
return 0; |
| 336 |
} |
| 337 |
|
| 338 |
static int vsc73xx_mdix_set(struct phy_device *phydev, u8 mdix) |
| 339 |
{ |
| 340 |
int ret; |
| 341 |
u16 val; |
| 342 |
|
| 343 |
val = phy_read(phydev, MII_VSC73XX_PHY_BYPASS_CTRL); |
| 344 |
|
| 345 |
switch (mdix) { |
| 346 |
case ETH_TP_MDI: |
| 347 |
val |= MII_VSC73XX_PBC_FOR_SPD_AUTO_MDIX_DIS | |
| 348 |
MII_VSC73XX_PBC_PAIR_SWAP_DIS | |
| 349 |
MII_VSC73XX_PBC_POL_INV_DIS; |
| 350 |
break; |
| 351 |
case ETH_TP_MDI_X: |
| 352 |
/* When MDI-X auto configuration is disabled, is possible |
| 353 |
* to force only MDI mode. Let's use autoconfig for forced |
| 354 |
* MDIX mode. |
| 355 |
*/ |
| 356 |
case ETH_TP_MDI_AUTO: |
| 357 |
val &= ~(MII_VSC73XX_PBC_FOR_SPD_AUTO_MDIX_DIS | |
| 358 |
MII_VSC73XX_PBC_PAIR_SWAP_DIS | |
| 359 |
MII_VSC73XX_PBC_POL_INV_DIS); |
| 360 |
break; |
| 361 |
default: |
| 362 |
return -EINVAL; |
| 363 |
} |
| 364 |
|
| 365 |
ret = phy_write(phydev, MII_VSC73XX_PHY_BYPASS_CTRL, val); |
| 366 |
if (ret) |
| 367 |
return ret; |
| 368 |
|
| 369 |
return genphy_restart_aneg(phydev); |
| 370 |
} |
| 371 |
|
| 372 |
static int vsc73xx_config_aneg(struct phy_device *phydev) |
| 373 |
{ |
| 374 |
int ret; |
| 375 |
|
| 376 |
ret = vsc73xx_mdix_set(phydev, phydev->mdix_ctrl); |
| 377 |
if (ret) |
| 378 |
return ret; |
| 379 |
|
| 380 |
return genphy_config_aneg(phydev); |
| 381 |
} |
| 382 |
|
| 383 |
static int vsc73xx_mdix_get(struct phy_device *phydev, u8 *mdix) |
| 384 |
{ |
| 385 |
u16 reg_val; |
| 386 |
|
| 387 |
reg_val = phy_read(phydev, MII_VSC73XX_PHY_AUX_CTRL_STAT); |
| 388 |
if (reg_val & MII_VSC73XX_PACS_NO_MDI_X_IND) |
| 389 |
*mdix = ETH_TP_MDI; |
| 390 |
else |
| 391 |
*mdix = ETH_TP_MDI_X; |
| 392 |
|
| 393 |
return 0; |
| 394 |
} |
| 395 |
|
| 396 |
static int vsc73xx_read_status(struct phy_device *phydev) |
| 397 |
{ |
| 398 |
int ret; |
| 399 |
|
| 400 |
ret = vsc73xx_mdix_get(phydev, &phydev->mdix); |
| 401 |
if (ret < 0) |
| 402 |
return ret; |
| 403 |
|
| 404 |
return genphy_read_status(phydev); |
| 405 |
} |
| 406 |
|
| 407 |
/* This adds a skew for both TX and RX clocks, so the skew should only be |
| 408 |
* applied to "rgmii-id" interfaces. It may not work as expected |
| 409 |
* on "rgmii-txid", "rgmii-rxid" or "rgmii" interfaces. |
| 410 |
*/ |
| 411 |
static int vsc8601_add_skew(struct phy_device *phydev) |
| 412 |
{ |
| 413 |
int ret; |
| 414 |
|
| 415 |
ret = phy_read(phydev, MII_VSC8601_EPHY_CTL); |
| 416 |
if (ret < 0) |
| 417 |
return ret; |
| 418 |
|
| 419 |
ret |= MII_VSC8601_EPHY_CTL_RGMII_SKEW; |
| 420 |
return phy_write(phydev, MII_VSC8601_EPHY_CTL, ret); |
| 421 |
} |
| 422 |
|
| 423 |
static int vsc8601_config_init(struct phy_device *phydev) |
| 424 |
{ |
| 425 |
int ret = 0; |
| 426 |
|
| 427 |
if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID) |
| 428 |
ret = vsc8601_add_skew(phydev); |
| 429 |
|
| 430 |
if (ret < 0) |
| 431 |
return ret; |
| 432 |
|
| 433 |
return 0; |
| 434 |
} |
| 435 |
|
| 436 |
static int vsc82xx_config_intr(struct phy_device *phydev) |
| 437 |
{ |
| 438 |
int err; |
| 439 |
|
| 440 |
if (phydev->interrupts == PHY_INTERRUPT_ENABLED) |
| 441 |
/* Don't bother to ACK the interrupts since the 824x cannot |
| 442 |
* clear the interrupts if they are disabled. |
| 443 |
*/ |
| 444 |
err = phy_write(phydev, MII_VSC8244_IMASK, |
| 445 |
(phydev->drv->phy_id == PHY_ID_VSC8234 || |
| 446 |
phydev->drv->phy_id == PHY_ID_VSC8244 || |
| 447 |
phydev->drv->phy_id == PHY_ID_VSC8572 || |
| 448 |
phydev->drv->phy_id == PHY_ID_VSC8601) ? |
| 449 |
MII_VSC8244_IMASK_MASK : |
| 450 |
MII_VSC8221_IMASK_MASK); |
| 451 |
else { |
| 452 |
/* The Vitesse PHY cannot clear the interrupt |
| 453 |
* once it has disabled them, so we clear them first |
| 454 |
*/ |
| 455 |
err = phy_read(phydev, MII_VSC8244_ISTAT); |
| 456 |
|
| 457 |
if (err < 0) |
| 458 |
return err; |
| 459 |
|
| 460 |
err = phy_write(phydev, MII_VSC8244_IMASK, 0); |
| 461 |
} |
| 462 |
|
| 463 |
return err; |
| 464 |
} |
| 465 |
|
| 466 |
static irqreturn_t vsc82xx_handle_interrupt(struct phy_device *phydev) |
| 467 |
{ |
| 468 |
int irq_status, irq_mask; |
| 469 |
|
| 470 |
if (phydev->drv->phy_id == PHY_ID_VSC8244 || |
| 471 |
phydev->drv->phy_id == PHY_ID_VSC8572 || |
| 472 |
phydev->drv->phy_id == PHY_ID_VSC8601) |
| 473 |
irq_mask = MII_VSC8244_ISTAT_MASK; |
| 474 |
else |
| 475 |
irq_mask = MII_VSC8221_ISTAT_MASK; |
| 476 |
|
| 477 |
irq_status = phy_read(phydev, MII_VSC8244_ISTAT); |
| 478 |
if (irq_status < 0) { |
| 479 |
phy_error(phydev); |
| 480 |
return IRQ_NONE; |
| 481 |
} |
| 482 |
|
| 483 |
if (!(irq_status & irq_mask)) |
| 484 |
return IRQ_NONE; |
| 485 |
|
| 486 |
phy_trigger_machine(phydev); |
| 487 |
|
| 488 |
return IRQ_HANDLED; |
| 489 |
} |
| 490 |
|
| 491 |
static int vsc8221_config_init(struct phy_device *phydev) |
| 492 |
{ |
| 493 |
int err; |
| 494 |
|
| 495 |
err = phy_write(phydev, MII_VSC8244_AUX_CONSTAT, |
| 496 |
MII_VSC8221_AUXCONSTAT_INIT); |
| 497 |
return err; |
| 498 |
|
| 499 |
/* Perhaps we should set EXT_CON1 based on the interface? |
| 500 |
* Options are 802.3Z SerDes or SGMII |
| 501 |
*/ |
| 502 |
} |
| 503 |
|
| 504 |
/* vsc82x4_config_autocross_enable - Enable auto MDI/MDI-X for forced links |
| 505 |
* @phydev: target phy_device struct |
| 506 |
* |
| 507 |
* Enable auto MDI/MDI-X when in 10/100 forced link speeds by writing |
| 508 |
* special values in the VSC8234/VSC8244 extended reserved registers |
| 509 |
*/ |
| 510 |
static int vsc82x4_config_autocross_enable(struct phy_device *phydev) |
| 511 |
{ |
| 512 |
int ret; |
| 513 |
|
| 514 |
if (phydev->autoneg == AUTONEG_ENABLE || phydev->speed > SPEED_100) |
| 515 |
return 0; |
| 516 |
|
| 517 |
/* map extended registers set 0x10 - 0x1e */ |
| 518 |
ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_ACCESS, 0x52b5); |
| 519 |
if (ret >= 0) |
| 520 |
ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_18E, 0x0012); |
| 521 |
if (ret >= 0) |
| 522 |
ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_17E, 0x2803); |
| 523 |
if (ret >= 0) |
| 524 |
ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_16E, 0x87fa); |
| 525 |
/* map standard registers set 0x10 - 0x1e */ |
| 526 |
if (ret >= 0) |
| 527 |
ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_ACCESS, 0x0000); |
| 528 |
else |
| 529 |
phy_write(phydev, MII_VSC82X4_EXT_PAGE_ACCESS, 0x0000); |
| 530 |
|
| 531 |
return ret; |
| 532 |
} |
| 533 |
|
| 534 |
/* vsc82x4_config_aneg - restart auto-negotiation or write BMCR |
| 535 |
* @phydev: target phy_device struct |
| 536 |
* |
| 537 |
* Description: If auto-negotiation is enabled, we configure the |
| 538 |
* advertising, and then restart auto-negotiation. If it is not |
| 539 |
* enabled, then we write the BMCR and also start the auto |
| 540 |
* MDI/MDI-X feature |
| 541 |
*/ |
| 542 |
static int vsc82x4_config_aneg(struct phy_device *phydev) |
| 543 |
{ |
| 544 |
int ret; |
| 545 |
|
| 546 |
/* Enable auto MDI/MDI-X when in 10/100 forced link speeds by |
| 547 |
* writing special values in the VSC8234 extended reserved registers |
| 548 |
*/ |
| 549 |
if (phydev->autoneg != AUTONEG_ENABLE && phydev->speed <= SPEED_100) { |
| 550 |
ret = genphy_setup_forced(phydev); |
| 551 |
|
| 552 |
if (ret < 0) /* error */ |
| 553 |
return ret; |
| 554 |
|
| 555 |
return vsc82x4_config_autocross_enable(phydev); |
| 556 |
} |
| 557 |
|
| 558 |
return genphy_config_aneg(phydev); |
| 559 |
} |
| 560 |
|
| 561 |
/* Vitesse 82xx */ |
| 562 |
static struct phy_driver vsc82xx_driver[] = { |
| 563 |
{ |
| 564 |
.phy_id = PHY_ID_VSC8234, |
| 565 |
.name = "Vitesse VSC8234", |
| 566 |
.phy_id_mask = 0x000ffff0, |
| 567 |
/* PHY_GBIT_FEATURES */ |
| 568 |
.config_init = &vsc824x_config_init, |
| 569 |
.config_aneg = &vsc82x4_config_aneg, |
| 570 |
.config_intr = &vsc82xx_config_intr, |
| 571 |
.handle_interrupt = &vsc82xx_handle_interrupt, |
| 572 |
}, { |
| 573 |
.phy_id = PHY_ID_VSC8244, |
| 574 |
.name = "Vitesse VSC8244", |
| 575 |
.phy_id_mask = 0x000fffc0, |
| 576 |
/* PHY_GBIT_FEATURES */ |
| 577 |
.config_init = &vsc824x_config_init, |
| 578 |
.config_aneg = &vsc82x4_config_aneg, |
| 579 |
.config_intr = &vsc82xx_config_intr, |
| 580 |
.handle_interrupt = &vsc82xx_handle_interrupt, |
| 581 |
}, { |
| 582 |
.phy_id = PHY_ID_VSC8572, |
| 583 |
.name = "Vitesse VSC8572", |
| 584 |
.phy_id_mask = 0x000ffff0, |
| 585 |
/* PHY_GBIT_FEATURES */ |
| 586 |
.config_init = &vsc824x_config_init, |
| 587 |
.config_aneg = &vsc82x4_config_aneg, |
| 588 |
.config_intr = &vsc82xx_config_intr, |
| 589 |
.handle_interrupt = &vsc82xx_handle_interrupt, |
| 590 |
}, { |
| 591 |
.phy_id = PHY_ID_VSC8601, |
| 592 |
.name = "Vitesse VSC8601", |
| 593 |
.phy_id_mask = 0x000ffff0, |
| 594 |
/* PHY_GBIT_FEATURES */ |
| 595 |
.config_init = &vsc8601_config_init, |
| 596 |
.config_intr = &vsc82xx_config_intr, |
| 597 |
.handle_interrupt = &vsc82xx_handle_interrupt, |
| 598 |
}, { |
| 599 |
.phy_id = PHY_ID_VSC7385, |
| 600 |
.name = "Vitesse VSC7385", |
| 601 |
.phy_id_mask = 0x000ffff0, |
| 602 |
/* PHY_GBIT_FEATURES */ |
| 603 |
.config_init = vsc738x_config_init, |
| 604 |
.config_aneg = vsc73xx_config_aneg, |
| 605 |
.read_status = vsc73xx_read_status, |
| 606 |
.read_page = vsc73xx_read_page, |
| 607 |
.write_page = vsc73xx_write_page, |
| 608 |
.get_tunable = vsc73xx_get_tunable, |
| 609 |
.set_tunable = vsc73xx_set_tunable, |
| 610 |
}, { |
| 611 |
.phy_id = PHY_ID_VSC7388, |
| 612 |
.name = "Vitesse VSC7388", |
| 613 |
.phy_id_mask = 0x000ffff0, |
| 614 |
/* PHY_GBIT_FEATURES */ |
| 615 |
.config_init = vsc738x_config_init, |
| 616 |
.config_aneg = vsc73xx_config_aneg, |
| 617 |
.read_status = vsc73xx_read_status, |
| 618 |
.read_page = vsc73xx_read_page, |
| 619 |
.write_page = vsc73xx_write_page, |
| 620 |
.get_tunable = vsc73xx_get_tunable, |
| 621 |
.set_tunable = vsc73xx_set_tunable, |
| 622 |
}, { |
| 623 |
.phy_id = PHY_ID_VSC7395, |
| 624 |
.name = "Vitesse VSC7395", |
| 625 |
.phy_id_mask = 0x000ffff0, |
| 626 |
/* PHY_GBIT_FEATURES */ |
| 627 |
.config_init = vsc739x_config_init, |
| 628 |
.config_aneg = vsc73xx_config_aneg, |
| 629 |
.read_status = vsc73xx_read_status, |
| 630 |
.read_page = vsc73xx_read_page, |
| 631 |
.write_page = vsc73xx_write_page, |
| 632 |
.get_tunable = vsc73xx_get_tunable, |
| 633 |
.set_tunable = vsc73xx_set_tunable, |
| 634 |
}, { |
| 635 |
.phy_id = PHY_ID_VSC7398, |
| 636 |
.name = "Vitesse VSC7398", |
| 637 |
.phy_id_mask = 0x000ffff0, |
| 638 |
/* PHY_GBIT_FEATURES */ |
| 639 |
.config_init = vsc739x_config_init, |
| 640 |
.config_aneg = vsc73xx_config_aneg, |
| 641 |
.read_status = vsc73xx_read_status, |
| 642 |
.read_page = vsc73xx_read_page, |
| 643 |
.write_page = vsc73xx_write_page, |
| 644 |
.get_tunable = vsc73xx_get_tunable, |
| 645 |
.set_tunable = vsc73xx_set_tunable, |
| 646 |
}, { |
| 647 |
.phy_id = PHY_ID_VSC8662, |
| 648 |
.name = "Vitesse VSC8662", |
| 649 |
.phy_id_mask = 0x000ffff0, |
| 650 |
/* PHY_GBIT_FEATURES */ |
| 651 |
.config_init = &vsc824x_config_init, |
| 652 |
.config_aneg = &vsc82x4_config_aneg, |
| 653 |
.config_intr = &vsc82xx_config_intr, |
| 654 |
.handle_interrupt = &vsc82xx_handle_interrupt, |
| 655 |
}, { |
| 656 |
/* Vitesse 8221 */ |
| 657 |
.phy_id = PHY_ID_VSC8221, |
| 658 |
.phy_id_mask = 0x000ffff0, |
| 659 |
.name = "Vitesse VSC8221", |
| 660 |
/* PHY_GBIT_FEATURES */ |
| 661 |
.config_init = &vsc8221_config_init, |
| 662 |
.config_intr = &vsc82xx_config_intr, |
| 663 |
.handle_interrupt = &vsc82xx_handle_interrupt, |
| 664 |
}, { |
| 665 |
/* Vitesse 8211 */ |
| 666 |
.phy_id = PHY_ID_VSC8211, |
| 667 |
.phy_id_mask = 0x000ffff0, |
| 668 |
.name = "Vitesse VSC8211", |
| 669 |
/* PHY_GBIT_FEATURES */ |
| 670 |
.config_init = &vsc8221_config_init, |
| 671 |
.config_intr = &vsc82xx_config_intr, |
| 672 |
.handle_interrupt = &vsc82xx_handle_interrupt, |
| 673 |
} }; |
| 674 |
|
| 675 |
module_phy_driver(vsc82xx_driver); |
| 676 |
|
| 677 |
static const struct mdio_device_id __maybe_unused vitesse_tbl[] = { |
| 678 |
{ PHY_ID_VSC8234, 0x000ffff0 }, |
| 679 |
{ PHY_ID_VSC8244, 0x000fffc0 }, |
| 680 |
{ PHY_ID_VSC8572, 0x000ffff0 }, |
| 681 |
{ PHY_ID_VSC7385, 0x000ffff0 }, |
| 682 |
{ PHY_ID_VSC7388, 0x000ffff0 }, |
| 683 |
{ PHY_ID_VSC7395, 0x000ffff0 }, |
| 684 |
{ PHY_ID_VSC7398, 0x000ffff0 }, |
| 685 |
{ PHY_ID_VSC8662, 0x000ffff0 }, |
| 686 |
{ PHY_ID_VSC8221, 0x000ffff0 }, |
| 687 |
{ PHY_ID_VSC8211, 0x000ffff0 }, |
| 688 |
{ } |
| 689 |
}; |
| 690 |
|
| 691 |
MODULE_DEVICE_TABLE(mdio, vitesse_tbl); |