micrel.c 25.2 KB
Newer Older
1 2 3 4 5 6 7
/*
 * drivers/net/phy/micrel.c
 *
 * Driver for Micrel PHYs
 *
 * Author: David J. Choi
 *
8
 * Copyright (c) 2010-2013 Micrel, Inc.
9
 * Copyright (c) 2014 Johan Hovold <johan@kernel.org>
10 11 12 13 14 15
 *
 * This program is free software; you can redistribute  it and/or modify it
 * under  the terms of  the GNU General  Public License as published by the
 * Free Software Foundation;  either version 2 of the  License, or (at your
 * option) any later version.
 *
16 17 18 19 20 21 22
 * Support : Micrel Phys:
 *		Giga phys: ksz9021, ksz9031
 *		100/10 Phys : ksz8001, ksz8721, ksz8737, ksz8041
 *			   ksz8021, ksz8031, ksz8051,
 *			   ksz8081, ksz8091,
 *			   ksz8061,
 *		Switch : ksz8873, ksz886x
23 24 25 26 27
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/phy.h>
28
#include <linux/micrel_phy.h>
29
#include <linux/of.h>
30
#include <linux/clk.h>
31

32 33
/* Operation Mode Strap Override */
#define MII_KSZPHY_OMSO				0x16
J
Johan Hovold 已提交
34
#define KSZPHY_OMSO_B_CAST_OFF			BIT(9)
35
#define KSZPHY_OMSO_NAND_TREE_ON		BIT(5)
J
Johan Hovold 已提交
36 37
#define KSZPHY_OMSO_RMII_OVERRIDE		BIT(1)
#define KSZPHY_OMSO_MII_OVERRIDE		BIT(0)
38

C
Choi, David 已提交
39 40
/* general Interrupt control/status reg in vendor specific block. */
#define MII_KSZPHY_INTCS			0x1B
J
Johan Hovold 已提交
41 42 43 44 45 46 47 48
#define	KSZPHY_INTCS_JABBER			BIT(15)
#define	KSZPHY_INTCS_RECEIVE_ERR		BIT(14)
#define	KSZPHY_INTCS_PAGE_RECEIVE		BIT(13)
#define	KSZPHY_INTCS_PARELLEL			BIT(12)
#define	KSZPHY_INTCS_LINK_PARTNER_ACK		BIT(11)
#define	KSZPHY_INTCS_LINK_DOWN			BIT(10)
#define	KSZPHY_INTCS_REMOTE_FAULT		BIT(9)
#define	KSZPHY_INTCS_LINK_UP			BIT(8)
C
Choi, David 已提交
49 50 51
#define	KSZPHY_INTCS_ALL			(KSZPHY_INTCS_LINK_UP |\
						KSZPHY_INTCS_LINK_DOWN)

52 53 54 55 56 57
/* PHY Control 1 */
#define	MII_KSZPHY_CTRL_1			0x1e

/* PHY Control 2 / PHY Control (if no PHY Control 1) */
#define	MII_KSZPHY_CTRL_2			0x1f
#define	MII_KSZPHY_CTRL				MII_KSZPHY_CTRL_2
C
Choi, David 已提交
58
/* bitmap of PHY register to set interrupt mode */
J
Johan Hovold 已提交
59
#define KSZPHY_CTRL_INT_ACTIVE_HIGH		BIT(9)
60
#define KSZPHY_RMII_REF_CLK_SEL			BIT(7)
C
Choi, David 已提交
61

62 63 64 65 66 67 68 69 70 71 72 73 74 75
/* Write/read to/from extended registers */
#define MII_KSZPHY_EXTREG                       0x0b
#define KSZPHY_EXTREG_WRITE                     0x8000

#define MII_KSZPHY_EXTREG_WRITE                 0x0c
#define MII_KSZPHY_EXTREG_READ                  0x0d

/* Extended registers */
#define MII_KSZPHY_CLK_CONTROL_PAD_SKEW         0x104
#define MII_KSZPHY_RX_DATA_PAD_SKEW             0x105
#define MII_KSZPHY_TX_DATA_PAD_SKEW             0x106

#define PS_TO_REG				200

76 77 78 79 80 81 82 83 84 85 86
struct kszphy_hw_stat {
	const char *string;
	u8 reg;
	u8 bits;
};

static struct kszphy_hw_stat kszphy_hw_stats[] = {
	{ "phy_receive_errors", 21, 16},
	{ "phy_idle_errors", 10, 8 },
};

87 88
struct kszphy_type {
	u32 led_mode_reg;
89
	u16 interrupt_level_mask;
90
	bool has_broadcast_disable;
91
	bool has_nand_tree_disable;
92
	bool has_rmii_ref_clk_sel;
93 94 95 96
};

struct kszphy_priv {
	const struct kszphy_type *type;
97
	int led_mode;
98 99
	bool rmii_ref_clk_sel;
	bool rmii_ref_clk_sel_val;
100
	u64 stats[ARRAY_SIZE(kszphy_hw_stats)];
101 102 103 104
};

static const struct kszphy_type ksz8021_type = {
	.led_mode_reg		= MII_KSZPHY_CTRL_2,
105
	.has_broadcast_disable	= true,
106
	.has_nand_tree_disable	= true,
107
	.has_rmii_ref_clk_sel	= true,
108 109 110 111 112 113 114 115
};

static const struct kszphy_type ksz8041_type = {
	.led_mode_reg		= MII_KSZPHY_CTRL_1,
};

static const struct kszphy_type ksz8051_type = {
	.led_mode_reg		= MII_KSZPHY_CTRL_2,
116
	.has_nand_tree_disable	= true,
117 118 119 120
};

static const struct kszphy_type ksz8081_type = {
	.led_mode_reg		= MII_KSZPHY_CTRL_2,
121
	.has_broadcast_disable	= true,
122
	.has_nand_tree_disable	= true,
123
	.has_rmii_ref_clk_sel	= true,
124 125
};

126 127 128 129 130 131 132 133
static const struct kszphy_type ks8737_type = {
	.interrupt_level_mask	= BIT(14),
};

static const struct kszphy_type ksz9021_type = {
	.interrupt_level_mask	= BIT(14),
};

134
static int kszphy_extended_write(struct phy_device *phydev,
135
				u32 regnum, u16 val)
136 137 138 139 140 141
{
	phy_write(phydev, MII_KSZPHY_EXTREG, KSZPHY_EXTREG_WRITE | regnum);
	return phy_write(phydev, MII_KSZPHY_EXTREG_WRITE, val);
}

static int kszphy_extended_read(struct phy_device *phydev,
142
				u32 regnum)
143 144 145 146 147
{
	phy_write(phydev, MII_KSZPHY_EXTREG, regnum);
	return phy_read(phydev, MII_KSZPHY_EXTREG_READ);
}

C
Choi, David 已提交
148 149 150 151 152 153 154 155 156 157 158 159
static int kszphy_ack_interrupt(struct phy_device *phydev)
{
	/* bit[7..0] int status, which is a read and clear register. */
	int rc;

	rc = phy_read(phydev, MII_KSZPHY_INTCS);

	return (rc < 0) ? rc : 0;
}

static int kszphy_config_intr(struct phy_device *phydev)
{
160 161 162
	const struct kszphy_type *type = phydev->drv->driver_data;
	int temp;
	u16 mask;
C
Choi, David 已提交
163

164 165 166 167
	if (type && type->interrupt_level_mask)
		mask = type->interrupt_level_mask;
	else
		mask = KSZPHY_CTRL_INT_ACTIVE_HIGH;
C
Choi, David 已提交
168 169 170

	/* set the interrupt pin active low */
	temp = phy_read(phydev, MII_KSZPHY_CTRL);
171 172
	if (temp < 0)
		return temp;
173
	temp &= ~mask;
C
Choi, David 已提交
174 175
	phy_write(phydev, MII_KSZPHY_CTRL, temp);

176 177 178 179 180
	/* enable / disable interrupts */
	if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
		temp = KSZPHY_INTCS_ALL;
	else
		temp = 0;
C
Choi, David 已提交
181

182
	return phy_write(phydev, MII_KSZPHY_INTCS, temp);
C
Choi, David 已提交
183
}
184

185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200
static int kszphy_rmii_clk_sel(struct phy_device *phydev, bool val)
{
	int ctrl;

	ctrl = phy_read(phydev, MII_KSZPHY_CTRL);
	if (ctrl < 0)
		return ctrl;

	if (val)
		ctrl |= KSZPHY_RMII_REF_CLK_SEL;
	else
		ctrl &= ~KSZPHY_RMII_REF_CLK_SEL;

	return phy_write(phydev, MII_KSZPHY_CTRL, ctrl);
}

201
static int kszphy_setup_led(struct phy_device *phydev, u32 reg, int val)
202
{
203
	int rc, temp, shift;
204

205 206 207 208 209 210 211 212 213 214 215
	switch (reg) {
	case MII_KSZPHY_CTRL_1:
		shift = 14;
		break;
	case MII_KSZPHY_CTRL_2:
		shift = 4;
		break;
	default:
		return -EINVAL;
	}

216
	temp = phy_read(phydev, reg);
217 218 219 220
	if (temp < 0) {
		rc = temp;
		goto out;
	}
221

222
	temp &= ~(3 << shift);
223 224
	temp |= val << shift;
	rc = phy_write(phydev, reg, temp);
225 226
out:
	if (rc < 0)
227
		phydev_err(phydev, "failed to set led mode\n");
228

229
	return rc;
230 231
}

232 233 234 235 236 237 238 239 240 241 242 243 244 245
/* Disable PHY address 0 as the broadcast address, so that it can be used as a
 * unique (non-broadcast) address on a shared bus.
 */
static int kszphy_broadcast_disable(struct phy_device *phydev)
{
	int ret;

	ret = phy_read(phydev, MII_KSZPHY_OMSO);
	if (ret < 0)
		goto out;

	ret = phy_write(phydev, MII_KSZPHY_OMSO, ret | KSZPHY_OMSO_B_CAST_OFF);
out:
	if (ret)
246
		phydev_err(phydev, "failed to disable broadcast address\n");
247 248 249 250

	return ret;
}

251 252 253 254 255 256 257 258 259 260 261 262 263 264 265
static int kszphy_nand_tree_disable(struct phy_device *phydev)
{
	int ret;

	ret = phy_read(phydev, MII_KSZPHY_OMSO);
	if (ret < 0)
		goto out;

	if (!(ret & KSZPHY_OMSO_NAND_TREE_ON))
		return 0;

	ret = phy_write(phydev, MII_KSZPHY_OMSO,
			ret & ~KSZPHY_OMSO_NAND_TREE_ON);
out:
	if (ret)
266
		phydev_err(phydev, "failed to disable NAND tree mode\n");
267 268 269 270

	return ret;
}

271 272
static int kszphy_config_init(struct phy_device *phydev)
{
273 274
	struct kszphy_priv *priv = phydev->priv;
	const struct kszphy_type *type;
275
	int ret;
276

277 278 279 280 281
	if (!priv)
		return 0;

	type = priv->type;

282 283 284
	if (type->has_broadcast_disable)
		kszphy_broadcast_disable(phydev);

285 286 287
	if (type->has_nand_tree_disable)
		kszphy_nand_tree_disable(phydev);

288 289 290
	if (priv->rmii_ref_clk_sel) {
		ret = kszphy_rmii_clk_sel(phydev, priv->rmii_ref_clk_sel_val);
		if (ret) {
291 292
			phydev_err(phydev,
				   "failed to set rmii reference clock\n");
293 294 295 296
			return ret;
		}
	}

297 298
	if (priv->led_mode >= 0)
		kszphy_setup_led(phydev, type->led_mode_reg, priv->led_mode);
299 300

	return 0;
301 302
}

303
static int ksz9021_load_values_from_of(struct phy_device *phydev,
304 305 306 307
				       const struct device_node *of_node,
				       u16 reg,
				       const char *field1, const char *field2,
				       const char *field3, const char *field4)
308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338
{
	int val1 = -1;
	int val2 = -2;
	int val3 = -3;
	int val4 = -4;
	int newval;
	int matches = 0;

	if (!of_property_read_u32(of_node, field1, &val1))
		matches++;

	if (!of_property_read_u32(of_node, field2, &val2))
		matches++;

	if (!of_property_read_u32(of_node, field3, &val3))
		matches++;

	if (!of_property_read_u32(of_node, field4, &val4))
		matches++;

	if (!matches)
		return 0;

	if (matches < 4)
		newval = kszphy_extended_read(phydev, reg);
	else
		newval = 0;

	if (val1 != -1)
		newval = ((newval & 0xfff0) | ((val1 / PS_TO_REG) & 0xf) << 0);

339
	if (val2 != -2)
340 341
		newval = ((newval & 0xff0f) | ((val2 / PS_TO_REG) & 0xf) << 4);

342
	if (val3 != -3)
343 344
		newval = ((newval & 0xf0ff) | ((val3 / PS_TO_REG) & 0xf) << 8);

345
	if (val4 != -4)
346 347 348 349 350 351 352
		newval = ((newval & 0x0fff) | ((val4 / PS_TO_REG) & 0xf) << 12);

	return kszphy_extended_write(phydev, reg, newval);
}

static int ksz9021_config_init(struct phy_device *phydev)
{
A
Andrew Lunn 已提交
353
	const struct device *dev = &phydev->mdio.dev;
354
	const struct device_node *of_node = dev->of_node;
355 356 357 358 359 360
	const struct device *dev_walker;

	/* The Micrel driver has a deprecated option to place phy OF
	 * properties in the MAC node. Walk up the tree of devices to
	 * find a device with an OF node.
	 */
A
Andrew Lunn 已提交
361
	dev_walker = &phydev->mdio.dev;
362 363 364 365 366
	do {
		of_node = dev_walker->of_node;
		dev_walker = dev_walker->parent;

	} while (!of_node && dev_walker);
367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384

	if (of_node) {
		ksz9021_load_values_from_of(phydev, of_node,
				    MII_KSZPHY_CLK_CONTROL_PAD_SKEW,
				    "txen-skew-ps", "txc-skew-ps",
				    "rxdv-skew-ps", "rxc-skew-ps");
		ksz9021_load_values_from_of(phydev, of_node,
				    MII_KSZPHY_RX_DATA_PAD_SKEW,
				    "rxd0-skew-ps", "rxd1-skew-ps",
				    "rxd2-skew-ps", "rxd3-skew-ps");
		ksz9021_load_values_from_of(phydev, of_node,
				    MII_KSZPHY_TX_DATA_PAD_SKEW,
				    "txd0-skew-ps", "txd1-skew-ps",
				    "txd2-skew-ps", "txd3-skew-ps");
	}
	return 0;
}

385 386 387 388 389 390
#define MII_KSZ9031RN_MMD_CTRL_REG	0x0d
#define MII_KSZ9031RN_MMD_REGDATA_REG	0x0e
#define OP_DATA				1
#define KSZ9031_PS_TO_REG		60

/* Extended registers */
391 392 393 394
/* MMD Address 0x0 */
#define MII_KSZ9031RN_FLP_BURST_TX_LO	3
#define MII_KSZ9031RN_FLP_BURST_TX_HI	4

395
/* MMD Address 0x2 */
396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419
#define MII_KSZ9031RN_CONTROL_PAD_SKEW	4
#define MII_KSZ9031RN_RX_DATA_PAD_SKEW	5
#define MII_KSZ9031RN_TX_DATA_PAD_SKEW	6
#define MII_KSZ9031RN_CLK_PAD_SKEW	8

static int ksz9031_extended_write(struct phy_device *phydev,
				  u8 mode, u32 dev_addr, u32 regnum, u16 val)
{
	phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, dev_addr);
	phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, regnum);
	phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, (mode << 14) | dev_addr);
	return phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, val);
}

static int ksz9031_extended_read(struct phy_device *phydev,
				 u8 mode, u32 dev_addr, u32 regnum)
{
	phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, dev_addr);
	phy_write(phydev, MII_KSZ9031RN_MMD_REGDATA_REG, regnum);
	phy_write(phydev, MII_KSZ9031RN_MMD_CTRL_REG, (mode << 14) | dev_addr);
	return phy_read(phydev, MII_KSZ9031RN_MMD_REGDATA_REG);
}

static int ksz9031_of_load_skew_values(struct phy_device *phydev,
420
				       const struct device_node *of_node,
421
				       u16 reg, size_t field_sz,
422
				       const char *field[], u8 numfields)
423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455
{
	int val[4] = {-1, -2, -3, -4};
	int matches = 0;
	u16 mask;
	u16 maxval;
	u16 newval;
	int i;

	for (i = 0; i < numfields; i++)
		if (!of_property_read_u32(of_node, field[i], val + i))
			matches++;

	if (!matches)
		return 0;

	if (matches < numfields)
		newval = ksz9031_extended_read(phydev, OP_DATA, 2, reg);
	else
		newval = 0;

	maxval = (field_sz == 4) ? 0xf : 0x1f;
	for (i = 0; i < numfields; i++)
		if (val[i] != -(i + 1)) {
			mask = 0xffff;
			mask ^= maxval << (field_sz * i);
			newval = (newval & mask) |
				(((val[i] / KSZ9031_PS_TO_REG) & maxval)
					<< (field_sz * i));
		}

	return ksz9031_extended_write(phydev, OP_DATA, 2, reg, newval);
}

456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471
static int ksz9031_center_flp_timing(struct phy_device *phydev)
{
	int result;

	/* Center KSZ9031RNX FLP timing at 16ms. */
	result = ksz9031_extended_write(phydev, OP_DATA, 0,
					MII_KSZ9031RN_FLP_BURST_TX_HI, 0x0006);
	result = ksz9031_extended_write(phydev, OP_DATA, 0,
					MII_KSZ9031RN_FLP_BURST_TX_LO, 0x1A80);

	if (result)
		return result;

	return genphy_restart_aneg(phydev);
}

472 473
static int ksz9031_config_init(struct phy_device *phydev)
{
A
Andrew Lunn 已提交
474
	const struct device *dev = &phydev->mdio.dev;
475 476 477
	const struct device_node *of_node = dev->of_node;
	static const char *clk_skews[2] = {"rxc-skew-ps", "txc-skew-ps"};
	static const char *rx_data_skews[4] = {
478 479 480
		"rxd0-skew-ps", "rxd1-skew-ps",
		"rxd2-skew-ps", "rxd3-skew-ps"
	};
481
	static const char *tx_data_skews[4] = {
482 483 484
		"txd0-skew-ps", "txd1-skew-ps",
		"txd2-skew-ps", "txd3-skew-ps"
	};
485
	static const char *control_skews[2] = {"txen-skew-ps", "rxdv-skew-ps"};
486
	const struct device *dev_walker;
487

488 489 490 491
	/* The Micrel driver has a deprecated option to place phy OF
	 * properties in the MAC node. Walk up the tree of devices to
	 * find a device with an OF node.
	 */
492
	dev_walker = &phydev->mdio.dev;
493 494 495 496
	do {
		of_node = dev_walker->of_node;
		dev_walker = dev_walker->parent;
	} while (!of_node && dev_walker);
497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514

	if (of_node) {
		ksz9031_of_load_skew_values(phydev, of_node,
				MII_KSZ9031RN_CLK_PAD_SKEW, 5,
				clk_skews, 2);

		ksz9031_of_load_skew_values(phydev, of_node,
				MII_KSZ9031RN_CONTROL_PAD_SKEW, 4,
				control_skews, 2);

		ksz9031_of_load_skew_values(phydev, of_node,
				MII_KSZ9031RN_RX_DATA_PAD_SKEW, 4,
				rx_data_skews, 4);

		ksz9031_of_load_skew_values(phydev, of_node,
				MII_KSZ9031RN_TX_DATA_PAD_SKEW, 4,
				tx_data_skews, 4);
	}
515 516

	return ksz9031_center_flp_timing(phydev);
517 518
}

519
#define KSZ8873MLL_GLOBAL_CONTROL_4	0x06
J
Johan Hovold 已提交
520 521
#define KSZ8873MLL_GLOBAL_CONTROL_4_DUPLEX	BIT(6)
#define KSZ8873MLL_GLOBAL_CONTROL_4_SPEED	BIT(4)
522
static int ksz8873mll_read_status(struct phy_device *phydev)
523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546
{
	int regval;

	/* dummy read */
	regval = phy_read(phydev, KSZ8873MLL_GLOBAL_CONTROL_4);

	regval = phy_read(phydev, KSZ8873MLL_GLOBAL_CONTROL_4);

	if (regval & KSZ8873MLL_GLOBAL_CONTROL_4_DUPLEX)
		phydev->duplex = DUPLEX_HALF;
	else
		phydev->duplex = DUPLEX_FULL;

	if (regval & KSZ8873MLL_GLOBAL_CONTROL_4_SPEED)
		phydev->speed = SPEED_10;
	else
		phydev->speed = SPEED_100;

	phydev->link = 1;
	phydev->pause = phydev->asym_pause = 0;

	return 0;
}

547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567
static int ksz9031_read_status(struct phy_device *phydev)
{
	int err;
	int regval;

	err = genphy_read_status(phydev);
	if (err)
		return err;

	/* Make sure the PHY is not broken. Read idle error count,
	 * and reset the PHY if it is maxed out.
	 */
	regval = phy_read(phydev, MII_STAT1000);
	if ((regval & 0xFF) == 0xFF) {
		phy_init_hw(phydev);
		phydev->link = 0;
	}

	return 0;
}

568 569 570 571 572
static int ksz8873mll_config_aneg(struct phy_device *phydev)
{
	return 0;
}

573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592
/* This routine returns -1 as an indication to the caller that the
 * Micrel ksz9021 10/100/1000 PHY does not support standard IEEE
 * MMD extended PHY registers.
 */
static int
ksz9021_rd_mmd_phyreg(struct phy_device *phydev, int ptrad, int devnum,
		      int regnum)
{
	return -1;
}

/* This routine does nothing since the Micrel ksz9021 does not support
 * standard IEEE MMD extended PHY registers.
 */
static void
ksz9021_wr_mmd_phyreg(struct phy_device *phydev, int ptrad, int devnum,
		      int regnum, u32 val)
{
}

593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637
static int kszphy_get_sset_count(struct phy_device *phydev)
{
	return ARRAY_SIZE(kszphy_hw_stats);
}

static void kszphy_get_strings(struct phy_device *phydev, u8 *data)
{
	int i;

	for (i = 0; i < ARRAY_SIZE(kszphy_hw_stats); i++) {
		memcpy(data + i * ETH_GSTRING_LEN,
		       kszphy_hw_stats[i].string, ETH_GSTRING_LEN);
	}
}

#ifndef UINT64_MAX
#define UINT64_MAX              (u64)(~((u64)0))
#endif
static u64 kszphy_get_stat(struct phy_device *phydev, int i)
{
	struct kszphy_hw_stat stat = kszphy_hw_stats[i];
	struct kszphy_priv *priv = phydev->priv;
	u64 val;

	val = phy_read(phydev, stat.reg);
	if (val < 0) {
		val = UINT64_MAX;
	} else {
		val = val & ((1 << stat.bits) - 1);
		priv->stats[i] += val;
		val = priv->stats[i];
	}

	return val;
}

static void kszphy_get_stats(struct phy_device *phydev,
			     struct ethtool_stats *stats, u64 *data)
{
	int i;

	for (i = 0; i < ARRAY_SIZE(kszphy_hw_stats); i++)
		data[i] = kszphy_get_stat(phydev, i);
}

638 639 640 641 642 643 644 645 646 647 648 649 650 651 652
static int kszphy_resume(struct phy_device *phydev)
{
	int value;

	mutex_lock(&phydev->lock);

	value = phy_read(phydev, MII_BMCR);
	phy_write(phydev, MII_BMCR, value & ~BMCR_PDOWN);

	kszphy_config_intr(phydev);
	mutex_unlock(&phydev->lock);

	return 0;
}

653 654 655
static int kszphy_probe(struct phy_device *phydev)
{
	const struct kszphy_type *type = phydev->drv->driver_data;
A
Andrew Lunn 已提交
656
	const struct device_node *np = phydev->mdio.dev.of_node;
657
	struct kszphy_priv *priv;
658
	struct clk *clk;
659
	int ret;
660

A
Andrew Lunn 已提交
661
	priv = devm_kzalloc(&phydev->mdio.dev, sizeof(*priv), GFP_KERNEL);
662 663 664 665 666 667 668
	if (!priv)
		return -ENOMEM;

	phydev->priv = priv;

	priv->type = type;

669 670 671 672 673 674 675
	if (type->led_mode_reg) {
		ret = of_property_read_u32(np, "micrel,led-mode",
				&priv->led_mode);
		if (ret)
			priv->led_mode = -1;

		if (priv->led_mode > 3) {
676 677
			phydev_err(phydev, "invalid led mode: 0x%02x\n",
				   priv->led_mode);
678 679 680 681 682 683
			priv->led_mode = -1;
		}
	} else {
		priv->led_mode = -1;
	}

A
Andrew Lunn 已提交
684
	clk = devm_clk_get(&phydev->mdio.dev, "rmii-ref");
685 686
	/* NOTE: clk may be NULL if building without CONFIG_HAVE_CLK */
	if (!IS_ERR_OR_NULL(clk)) {
687
		unsigned long rate = clk_get_rate(clk);
688
		bool rmii_ref_clk_sel_25_mhz;
689

690
		priv->rmii_ref_clk_sel = type->has_rmii_ref_clk_sel;
691 692
		rmii_ref_clk_sel_25_mhz = of_property_read_bool(np,
				"micrel,rmii-reference-clock-select-25-mhz");
693

694
		if (rate > 24500000 && rate < 25500000) {
695
			priv->rmii_ref_clk_sel_val = rmii_ref_clk_sel_25_mhz;
696
		} else if (rate > 49500000 && rate < 50500000) {
697
			priv->rmii_ref_clk_sel_val = !rmii_ref_clk_sel_25_mhz;
698
		} else {
699 700
			phydev_err(phydev, "Clock rate out of range: %ld\n",
				   rate);
701 702 703 704
			return -EINVAL;
		}
	}

705 706 707 708 709 710 711
	/* Support legacy board-file configuration */
	if (phydev->dev_flags & MICREL_PHY_50MHZ_CLK) {
		priv->rmii_ref_clk_sel = true;
		priv->rmii_ref_clk_sel_val = true;
	}

	return 0;
712 713
}

714 715
static struct phy_driver ksphy_driver[] = {
{
C
Choi, David 已提交
716 717 718 719 720
	.phy_id		= PHY_ID_KS8737,
	.phy_id_mask	= 0x00fffff0,
	.name		= "Micrel KS8737",
	.features	= (PHY_BASIC_FEATURES | SUPPORTED_Pause),
	.flags		= PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
721
	.driver_data	= &ks8737_type,
C
Choi, David 已提交
722 723 724 725
	.config_init	= kszphy_config_init,
	.config_aneg	= genphy_config_aneg,
	.read_status	= genphy_read_status,
	.ack_interrupt	= kszphy_ack_interrupt,
726
	.config_intr	= kszphy_config_intr,
727 728 729
	.get_sset_count = kszphy_get_sset_count,
	.get_strings	= kszphy_get_strings,
	.get_stats	= kszphy_get_stats,
730 731
	.suspend	= genphy_suspend,
	.resume		= genphy_resume,
732 733 734
}, {
	.phy_id		= PHY_ID_KSZ8021,
	.phy_id_mask	= 0x00ffffff,
735
	.name		= "Micrel KSZ8021 or KSZ8031",
736 737 738
	.features	= (PHY_BASIC_FEATURES | SUPPORTED_Pause |
			   SUPPORTED_Asym_Pause),
	.flags		= PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
739
	.driver_data	= &ksz8021_type,
740
	.probe		= kszphy_probe,
741
	.config_init	= kszphy_config_init,
742 743 744 745
	.config_aneg	= genphy_config_aneg,
	.read_status	= genphy_read_status,
	.ack_interrupt	= kszphy_ack_interrupt,
	.config_intr	= kszphy_config_intr,
746 747 748
	.get_sset_count = kszphy_get_sset_count,
	.get_strings	= kszphy_get_strings,
	.get_stats	= kszphy_get_stats,
749 750
	.suspend	= genphy_suspend,
	.resume		= genphy_resume,
751 752 753 754 755 756 757
}, {
	.phy_id		= PHY_ID_KSZ8031,
	.phy_id_mask	= 0x00ffffff,
	.name		= "Micrel KSZ8031",
	.features	= (PHY_BASIC_FEATURES | SUPPORTED_Pause |
			   SUPPORTED_Asym_Pause),
	.flags		= PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
758
	.driver_data	= &ksz8021_type,
759
	.probe		= kszphy_probe,
760
	.config_init	= kszphy_config_init,
761 762 763 764
	.config_aneg	= genphy_config_aneg,
	.read_status	= genphy_read_status,
	.ack_interrupt	= kszphy_ack_interrupt,
	.config_intr	= kszphy_config_intr,
765 766 767
	.get_sset_count = kszphy_get_sset_count,
	.get_strings	= kszphy_get_strings,
	.get_stats	= kszphy_get_stats,
768 769
	.suspend	= genphy_suspend,
	.resume		= genphy_resume,
770
}, {
771
	.phy_id		= PHY_ID_KSZ8041,
C
Choi, David 已提交
772
	.phy_id_mask	= 0x00fffff0,
773
	.name		= "Micrel KSZ8041",
C
Choi, David 已提交
774 775 776
	.features	= (PHY_BASIC_FEATURES | SUPPORTED_Pause
				| SUPPORTED_Asym_Pause),
	.flags		= PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
777 778 779
	.driver_data	= &ksz8041_type,
	.probe		= kszphy_probe,
	.config_init	= kszphy_config_init,
C
Choi, David 已提交
780 781 782 783
	.config_aneg	= genphy_config_aneg,
	.read_status	= genphy_read_status,
	.ack_interrupt	= kszphy_ack_interrupt,
	.config_intr	= kszphy_config_intr,
784 785 786
	.get_sset_count = kszphy_get_sset_count,
	.get_strings	= kszphy_get_strings,
	.get_stats	= kszphy_get_stats,
787 788
	.suspend	= genphy_suspend,
	.resume		= genphy_resume,
789 790 791 792 793 794 795
}, {
	.phy_id		= PHY_ID_KSZ8041RNLI,
	.phy_id_mask	= 0x00fffff0,
	.name		= "Micrel KSZ8041RNLI",
	.features	= PHY_BASIC_FEATURES |
			  SUPPORTED_Pause | SUPPORTED_Asym_Pause,
	.flags		= PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
796 797 798
	.driver_data	= &ksz8041_type,
	.probe		= kszphy_probe,
	.config_init	= kszphy_config_init,
799 800 801 802
	.config_aneg	= genphy_config_aneg,
	.read_status	= genphy_read_status,
	.ack_interrupt	= kszphy_ack_interrupt,
	.config_intr	= kszphy_config_intr,
803 804 805
	.get_sset_count = kszphy_get_sset_count,
	.get_strings	= kszphy_get_strings,
	.get_stats	= kszphy_get_stats,
806 807
	.suspend	= genphy_suspend,
	.resume		= genphy_resume,
808
}, {
809
	.phy_id		= PHY_ID_KSZ8051,
810
	.phy_id_mask	= 0x00fffff0,
811
	.name		= "Micrel KSZ8051",
C
Choi, David 已提交
812 813 814
	.features	= (PHY_BASIC_FEATURES | SUPPORTED_Pause
				| SUPPORTED_Asym_Pause),
	.flags		= PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
815 816
	.driver_data	= &ksz8051_type,
	.probe		= kszphy_probe,
817
	.config_init	= kszphy_config_init,
818 819
	.config_aneg	= genphy_config_aneg,
	.read_status	= genphy_read_status,
C
Choi, David 已提交
820 821
	.ack_interrupt	= kszphy_ack_interrupt,
	.config_intr	= kszphy_config_intr,
822 823 824
	.get_sset_count = kszphy_get_sset_count,
	.get_strings	= kszphy_get_strings,
	.get_stats	= kszphy_get_stats,
825 826
	.suspend	= genphy_suspend,
	.resume		= genphy_resume,
827
}, {
828 829
	.phy_id		= PHY_ID_KSZ8001,
	.name		= "Micrel KSZ8001 or KS8721",
830
	.phy_id_mask	= 0x00ffffff,
C
Choi, David 已提交
831 832
	.features	= (PHY_BASIC_FEATURES | SUPPORTED_Pause),
	.flags		= PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
833 834 835
	.driver_data	= &ksz8041_type,
	.probe		= kszphy_probe,
	.config_init	= kszphy_config_init,
836 837
	.config_aneg	= genphy_config_aneg,
	.read_status	= genphy_read_status,
C
Choi, David 已提交
838 839
	.ack_interrupt	= kszphy_ack_interrupt,
	.config_intr	= kszphy_config_intr,
840 841 842
	.get_sset_count = kszphy_get_sset_count,
	.get_strings	= kszphy_get_strings,
	.get_stats	= kszphy_get_stats,
843 844
	.suspend	= genphy_suspend,
	.resume		= genphy_resume,
845 846 847 848 849 850
}, {
	.phy_id		= PHY_ID_KSZ8081,
	.name		= "Micrel KSZ8081 or KSZ8091",
	.phy_id_mask	= 0x00fffff0,
	.features	= (PHY_BASIC_FEATURES | SUPPORTED_Pause),
	.flags		= PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
851 852
	.driver_data	= &ksz8081_type,
	.probe		= kszphy_probe,
853
	.config_init	= kszphy_config_init,
854 855 856 857
	.config_aneg	= genphy_config_aneg,
	.read_status	= genphy_read_status,
	.ack_interrupt	= kszphy_ack_interrupt,
	.config_intr	= kszphy_config_intr,
858 859 860
	.get_sset_count = kszphy_get_sset_count,
	.get_strings	= kszphy_get_strings,
	.get_stats	= kszphy_get_stats,
861
	.suspend	= genphy_suspend,
862
	.resume		= kszphy_resume,
863 864 865 866 867 868 869 870 871 872 873
}, {
	.phy_id		= PHY_ID_KSZ8061,
	.name		= "Micrel KSZ8061",
	.phy_id_mask	= 0x00fffff0,
	.features	= (PHY_BASIC_FEATURES | SUPPORTED_Pause),
	.flags		= PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
	.config_init	= kszphy_config_init,
	.config_aneg	= genphy_config_aneg,
	.read_status	= genphy_read_status,
	.ack_interrupt	= kszphy_ack_interrupt,
	.config_intr	= kszphy_config_intr,
874 875 876
	.get_sset_count = kszphy_get_sset_count,
	.get_strings	= kszphy_get_strings,
	.get_stats	= kszphy_get_stats,
877 878
	.suspend	= genphy_suspend,
	.resume		= genphy_resume,
879
}, {
880
	.phy_id		= PHY_ID_KSZ9021,
881
	.phy_id_mask	= 0x000ffffe,
882
	.name		= "Micrel KSZ9021 Gigabit PHY",
883
	.features	= (PHY_GBIT_FEATURES | SUPPORTED_Pause),
C
Choi, David 已提交
884
	.flags		= PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
885
	.driver_data	= &ksz9021_type,
886
	.config_init	= ksz9021_config_init,
887 888
	.config_aneg	= genphy_config_aneg,
	.read_status	= genphy_read_status,
C
Choi, David 已提交
889
	.ack_interrupt	= kszphy_ack_interrupt,
890
	.config_intr	= kszphy_config_intr,
891 892 893
	.get_sset_count = kszphy_get_sset_count,
	.get_strings	= kszphy_get_strings,
	.get_stats	= kszphy_get_stats,
894 895
	.suspend	= genphy_suspend,
	.resume		= genphy_resume,
896 897
	.read_mmd_indirect = ksz9021_rd_mmd_phyreg,
	.write_mmd_indirect = ksz9021_wr_mmd_phyreg,
898 899 900 901
}, {
	.phy_id		= PHY_ID_KSZ9031,
	.phy_id_mask	= 0x00fffff0,
	.name		= "Micrel KSZ9031 Gigabit PHY",
902
	.features	= (PHY_GBIT_FEATURES | SUPPORTED_Pause),
903
	.flags		= PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
904
	.driver_data	= &ksz9021_type,
905
	.config_init	= ksz9031_config_init,
906
	.config_aneg	= genphy_config_aneg,
907
	.read_status	= ksz9031_read_status,
908
	.ack_interrupt	= kszphy_ack_interrupt,
909
	.config_intr	= kszphy_config_intr,
910 911 912
	.get_sset_count = kszphy_get_sset_count,
	.get_strings	= kszphy_get_strings,
	.get_stats	= kszphy_get_stats,
913 914
	.suspend	= genphy_suspend,
	.resume		= genphy_resume,
915 916 917 918 919 920 921 922 923
}, {
	.phy_id		= PHY_ID_KSZ8873MLL,
	.phy_id_mask	= 0x00fffff0,
	.name		= "Micrel KSZ8873MLL Switch",
	.features	= (SUPPORTED_Pause | SUPPORTED_Asym_Pause),
	.flags		= PHY_HAS_MAGICANEG,
	.config_init	= kszphy_config_init,
	.config_aneg	= ksz8873mll_config_aneg,
	.read_status	= ksz8873mll_read_status,
924 925 926
	.get_sset_count = kszphy_get_sset_count,
	.get_strings	= kszphy_get_strings,
	.get_stats	= kszphy_get_stats,
927 928
	.suspend	= genphy_suspend,
	.resume		= genphy_resume,
929 930 931 932 933 934 935 936 937
}, {
	.phy_id		= PHY_ID_KSZ886X,
	.phy_id_mask	= 0x00fffff0,
	.name		= "Micrel KSZ886X Switch",
	.features	= (PHY_BASIC_FEATURES | SUPPORTED_Pause),
	.flags		= PHY_HAS_MAGICANEG | PHY_HAS_INTERRUPT,
	.config_init	= kszphy_config_init,
	.config_aneg	= genphy_config_aneg,
	.read_status	= genphy_read_status,
938 939 940
	.get_sset_count = kszphy_get_sset_count,
	.get_strings	= kszphy_get_strings,
	.get_stats	= kszphy_get_stats,
941 942
	.suspend	= genphy_suspend,
	.resume		= genphy_resume,
943
} };
944

945
module_phy_driver(ksphy_driver);
946 947 948 949

MODULE_DESCRIPTION("Micrel PHY driver");
MODULE_AUTHOR("David J. Choi");
MODULE_LICENSE("GPL");
950

951
static struct mdio_device_id __maybe_unused micrel_tbl[] = {
952
	{ PHY_ID_KSZ9021, 0x000ffffe },
953
	{ PHY_ID_KSZ9031, 0x00fffff0 },
954
	{ PHY_ID_KSZ8001, 0x00ffffff },
C
Choi, David 已提交
955
	{ PHY_ID_KS8737, 0x00fffff0 },
956
	{ PHY_ID_KSZ8021, 0x00ffffff },
957
	{ PHY_ID_KSZ8031, 0x00ffffff },
958 959
	{ PHY_ID_KSZ8041, 0x00fffff0 },
	{ PHY_ID_KSZ8051, 0x00fffff0 },
960 961
	{ PHY_ID_KSZ8061, 0x00fffff0 },
	{ PHY_ID_KSZ8081, 0x00fffff0 },
962
	{ PHY_ID_KSZ8873MLL, 0x00fffff0 },
963
	{ PHY_ID_KSZ886X, 0x00fffff0 },
964 965 966 967
	{ }
};

MODULE_DEVICE_TABLE(mdio, micrel_tbl);