Linux Audio

Check our new training course

Loading...
v4.17
  1/*
  2 * Driver for Vitesse PHYs
  3 *
  4 * Author: Kriston Carson
  5 *
  6 * Copyright (c) 2005, 2009, 2011 Freescale Semiconductor, Inc.
  7 *
  8 * This program is free software; you can redistribute  it and/or modify it
  9 * under  the terms of  the GNU General  Public License as published by the
 10 * Free Software Foundation;  either version 2 of the  License, or (at your
 11 * option) any later version.
 12 *
 13 */
 14
 15#include <linux/kernel.h>
 16#include <linux/module.h>
 17#include <linux/mii.h>
 18#include <linux/ethtool.h>
 19#include <linux/phy.h>
 20
 21/* Vitesse Extended Page Magic Register(s) */
 22#define MII_VSC82X4_EXT_PAGE_16E	0x10
 23#define MII_VSC82X4_EXT_PAGE_17E	0x11
 24#define MII_VSC82X4_EXT_PAGE_18E	0x12
 25
 26/* Vitesse Extended Control Register 1 */
 27#define MII_VSC8244_EXT_CON1           0x17
 28#define MII_VSC8244_EXTCON1_INIT       0x0000
 29#define MII_VSC8244_EXTCON1_TX_SKEW_MASK	0x0c00
 30#define MII_VSC8244_EXTCON1_RX_SKEW_MASK	0x0300
 31#define MII_VSC8244_EXTCON1_TX_SKEW	0x0800
 32#define MII_VSC8244_EXTCON1_RX_SKEW	0x0200
 33
 34/* Vitesse Interrupt Mask Register */
 35#define MII_VSC8244_IMASK		0x19
 36#define MII_VSC8244_IMASK_IEN		0x8000
 37#define MII_VSC8244_IMASK_SPEED		0x4000
 38#define MII_VSC8244_IMASK_LINK		0x2000
 39#define MII_VSC8244_IMASK_DUPLEX	0x1000
 40#define MII_VSC8244_IMASK_MASK		0xf000
 41
 42#define MII_VSC8221_IMASK_MASK		0xa000
 43
 44/* Vitesse Interrupt Status Register */
 45#define MII_VSC8244_ISTAT		0x1a
 46#define MII_VSC8244_ISTAT_STATUS	0x8000
 47#define MII_VSC8244_ISTAT_SPEED		0x4000
 48#define MII_VSC8244_ISTAT_LINK		0x2000
 49#define MII_VSC8244_ISTAT_DUPLEX	0x1000
 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 VSC8601 Extended PHY Control Register 1 */
 66#define MII_VSC8601_EPHY_CTL		0x17
 67#define MII_VSC8601_EPHY_CTL_RGMII_SKEW	(1 << 8)
 68
 69#define PHY_ID_VSC8234			0x000fc620
 70#define PHY_ID_VSC8244			0x000fc6c0
 71#define PHY_ID_VSC8514			0x00070670
 72#define PHY_ID_VSC8572			0x000704d0
 73#define PHY_ID_VSC8574			0x000704a0
 74#define PHY_ID_VSC8601			0x00070420
 75#define PHY_ID_VSC8662			0x00070660
 76#define PHY_ID_VSC8221			0x000fc550
 77#define PHY_ID_VSC8211			0x000fc4b0
 78
 79MODULE_DESCRIPTION("Vitesse PHY driver");
 80MODULE_AUTHOR("Kriston Carson");
 81MODULE_LICENSE("GPL");
 82
 83static int vsc824x_add_skew(struct phy_device *phydev)
 84{
 85	int err;
 86	int extcon;
 87
 88	extcon = phy_read(phydev, MII_VSC8244_EXT_CON1);
 89
 90	if (extcon < 0)
 91		return extcon;
 92
 93	extcon &= ~(MII_VSC8244_EXTCON1_TX_SKEW_MASK |
 94			MII_VSC8244_EXTCON1_RX_SKEW_MASK);
 95
 96	extcon |= (MII_VSC8244_EXTCON1_TX_SKEW |
 97			MII_VSC8244_EXTCON1_RX_SKEW);
 98
 99	err = phy_write(phydev, MII_VSC8244_EXT_CON1, extcon);
100
101	return err;
102}
103
104static int vsc824x_config_init(struct phy_device *phydev)
105{
106	int err;
107
108	err = phy_write(phydev, MII_VSC8244_AUX_CONSTAT,
109			MII_VSC8244_AUXCONSTAT_INIT);
110	if (err < 0)
111		return err;
112
113	if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID)
114		err = vsc824x_add_skew(phydev);
115
116	return err;
117}
118
119/* This adds a skew for both TX and RX clocks, so the skew should only be
120 * applied to "rgmii-id" interfaces. It may not work as expected
121 * on "rgmii-txid", "rgmii-rxid" or "rgmii" interfaces. */
122static int vsc8601_add_skew(struct phy_device *phydev)
123{
124	int ret;
125
126	ret = phy_read(phydev, MII_VSC8601_EPHY_CTL);
127	if (ret < 0)
128		return ret;
129
130	ret |= MII_VSC8601_EPHY_CTL_RGMII_SKEW;
131	return phy_write(phydev, MII_VSC8601_EPHY_CTL, ret);
132}
133
134static int vsc8601_config_init(struct phy_device *phydev)
135{
136	int ret = 0;
137
138	if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID)
139		ret = vsc8601_add_skew(phydev);
140
141	if (ret < 0)
142		return ret;
143
144	return genphy_config_init(phydev);
145}
146
147static int vsc824x_ack_interrupt(struct phy_device *phydev)
148{
149	int err = 0;
150
151	/* Don't bother to ACK the interrupts if interrupts
152	 * are disabled.  The 824x cannot clear the interrupts
153	 * if they are disabled.
154	 */
155	if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
156		err = phy_read(phydev, MII_VSC8244_ISTAT);
157
158	return (err < 0) ? err : 0;
159}
160
161static int vsc82xx_config_intr(struct phy_device *phydev)
162{
163	int err;
164
165	if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
166		err = phy_write(phydev, MII_VSC8244_IMASK,
167			(phydev->drv->phy_id == PHY_ID_VSC8234 ||
168			 phydev->drv->phy_id == PHY_ID_VSC8244 ||
169			 phydev->drv->phy_id == PHY_ID_VSC8514 ||
170			 phydev->drv->phy_id == PHY_ID_VSC8572 ||
171			 phydev->drv->phy_id == PHY_ID_VSC8574 ||
172			 phydev->drv->phy_id == PHY_ID_VSC8601) ?
173				MII_VSC8244_IMASK_MASK :
174				MII_VSC8221_IMASK_MASK);
175	else {
176		/* The Vitesse PHY cannot clear the interrupt
177		 * once it has disabled them, so we clear them first
178		 */
179		err = phy_read(phydev, MII_VSC8244_ISTAT);
180
181		if (err < 0)
182			return err;
183
184		err = phy_write(phydev, MII_VSC8244_IMASK, 0);
185	}
186
187	return err;
188}
189
190static int vsc8221_config_init(struct phy_device *phydev)
191{
192	int err;
193
194	err = phy_write(phydev, MII_VSC8244_AUX_CONSTAT,
195			MII_VSC8221_AUXCONSTAT_INIT);
196	return err;
197
198	/* Perhaps we should set EXT_CON1 based on the interface?
199	 * Options are 802.3Z SerDes or SGMII
200	 */
201}
202
203/* vsc82x4_config_autocross_enable - Enable auto MDI/MDI-X for forced links
204 * @phydev: target phy_device struct
205 *
206 * Enable auto MDI/MDI-X when in 10/100 forced link speeds by writing
207 * special values in the VSC8234/VSC8244 extended reserved registers
208 */
209static int vsc82x4_config_autocross_enable(struct phy_device *phydev)
210{
211	int ret;
212
213	if (phydev->autoneg == AUTONEG_ENABLE || phydev->speed > SPEED_100)
214		return 0;
215
216	/* map extended registers set 0x10 - 0x1e */
217	ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_ACCESS, 0x52b5);
218	if (ret >= 0)
219		ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_18E, 0x0012);
220	if (ret >= 0)
221		ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_17E, 0x2803);
222	if (ret >= 0)
223		ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_16E, 0x87fa);
224	/* map standard registers set 0x10 - 0x1e */
225	if (ret >= 0)
226		ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_ACCESS, 0x0000);
227	else
228		phy_write(phydev, MII_VSC82X4_EXT_PAGE_ACCESS, 0x0000);
229
230	return ret;
231}
232
233/* vsc82x4_config_aneg - restart auto-negotiation or write BMCR
234 * @phydev: target phy_device struct
235 *
236 * Description: If auto-negotiation is enabled, we configure the
237 *   advertising, and then restart auto-negotiation.  If it is not
238 *   enabled, then we write the BMCR and also start the auto
239 *   MDI/MDI-X feature
240 */
241static int vsc82x4_config_aneg(struct phy_device *phydev)
242{
243	int ret;
244
245	/* Enable auto MDI/MDI-X when in 10/100 forced link speeds by
246	 * writing special values in the VSC8234 extended reserved registers
247	 */
248	if (phydev->autoneg != AUTONEG_ENABLE && phydev->speed <= SPEED_100) {
249		ret = genphy_setup_forced(phydev);
250
251		if (ret < 0) /* error */
252			return ret;
253
254		return vsc82x4_config_autocross_enable(phydev);
255	}
256
257	return genphy_config_aneg(phydev);
258}
259
260/* Vitesse 82xx */
261static struct phy_driver vsc82xx_driver[] = {
262{
263	.phy_id         = PHY_ID_VSC8234,
264	.name           = "Vitesse VSC8234",
265	.phy_id_mask    = 0x000ffff0,
266	.features       = PHY_GBIT_FEATURES,
267	.flags          = PHY_HAS_INTERRUPT,
268	.config_init    = &vsc824x_config_init,
269	.config_aneg    = &vsc82x4_config_aneg,
 
270	.ack_interrupt  = &vsc824x_ack_interrupt,
271	.config_intr    = &vsc82xx_config_intr,
272}, {
273	.phy_id		= PHY_ID_VSC8244,
274	.name		= "Vitesse VSC8244",
275	.phy_id_mask	= 0x000fffc0,
276	.features	= PHY_GBIT_FEATURES,
277	.flags		= PHY_HAS_INTERRUPT,
278	.config_init	= &vsc824x_config_init,
279	.config_aneg	= &vsc82x4_config_aneg,
 
280	.ack_interrupt	= &vsc824x_ack_interrupt,
281	.config_intr	= &vsc82xx_config_intr,
282}, {
283	.phy_id		= PHY_ID_VSC8514,
284	.name		= "Vitesse VSC8514",
285	.phy_id_mask	= 0x000ffff0,
286	.features	= PHY_GBIT_FEATURES,
287	.flags		= PHY_HAS_INTERRUPT,
288	.config_init	= &vsc824x_config_init,
289	.config_aneg	= &vsc82x4_config_aneg,
 
290	.ack_interrupt	= &vsc824x_ack_interrupt,
291	.config_intr	= &vsc82xx_config_intr,
292}, {
293	.phy_id         = PHY_ID_VSC8572,
294	.name           = "Vitesse VSC8572",
295	.phy_id_mask    = 0x000ffff0,
296	.features       = PHY_GBIT_FEATURES,
297	.flags          = PHY_HAS_INTERRUPT,
298	.config_init    = &vsc824x_config_init,
299	.config_aneg    = &vsc82x4_config_aneg,
300	.ack_interrupt  = &vsc824x_ack_interrupt,
301	.config_intr    = &vsc82xx_config_intr,
302}, {
303	.phy_id         = PHY_ID_VSC8574,
304	.name           = "Vitesse VSC8574",
305	.phy_id_mask    = 0x000ffff0,
306	.features       = PHY_GBIT_FEATURES,
307	.flags          = PHY_HAS_INTERRUPT,
308	.config_init    = &vsc824x_config_init,
309	.config_aneg    = &vsc82x4_config_aneg,
 
310	.ack_interrupt  = &vsc824x_ack_interrupt,
311	.config_intr    = &vsc82xx_config_intr,
312}, {
313	.phy_id         = PHY_ID_VSC8601,
314	.name           = "Vitesse VSC8601",
315	.phy_id_mask    = 0x000ffff0,
316	.features       = PHY_GBIT_FEATURES,
317	.flags          = PHY_HAS_INTERRUPT,
318	.config_init    = &vsc8601_config_init,
 
 
319	.ack_interrupt  = &vsc824x_ack_interrupt,
320	.config_intr    = &vsc82xx_config_intr,
321}, {
322	.phy_id         = PHY_ID_VSC8662,
323	.name           = "Vitesse VSC8662",
324	.phy_id_mask    = 0x000ffff0,
325	.features       = PHY_GBIT_FEATURES,
326	.flags          = PHY_HAS_INTERRUPT,
327	.config_init    = &vsc824x_config_init,
328	.config_aneg    = &vsc82x4_config_aneg,
 
329	.ack_interrupt  = &vsc824x_ack_interrupt,
330	.config_intr    = &vsc82xx_config_intr,
331}, {
332	/* Vitesse 8221 */
333	.phy_id		= PHY_ID_VSC8221,
334	.phy_id_mask	= 0x000ffff0,
335	.name		= "Vitesse VSC8221",
336	.features	= PHY_GBIT_FEATURES,
337	.flags		= PHY_HAS_INTERRUPT,
338	.config_init	= &vsc8221_config_init,
 
 
339	.ack_interrupt	= &vsc824x_ack_interrupt,
340	.config_intr	= &vsc82xx_config_intr,
341}, {
342	/* Vitesse 8211 */
343	.phy_id		= PHY_ID_VSC8211,
344	.phy_id_mask	= 0x000ffff0,
345	.name		= "Vitesse VSC8211",
346	.features	= PHY_GBIT_FEATURES,
347	.flags		= PHY_HAS_INTERRUPT,
348	.config_init	= &vsc8221_config_init,
 
 
349	.ack_interrupt	= &vsc824x_ack_interrupt,
350	.config_intr	= &vsc82xx_config_intr,
351} };
352
353module_phy_driver(vsc82xx_driver);
354
355static struct mdio_device_id __maybe_unused vitesse_tbl[] = {
356	{ PHY_ID_VSC8234, 0x000ffff0 },
357	{ PHY_ID_VSC8244, 0x000fffc0 },
358	{ PHY_ID_VSC8514, 0x000ffff0 },
359	{ PHY_ID_VSC8572, 0x000ffff0 },
360	{ PHY_ID_VSC8574, 0x000ffff0 },
361	{ PHY_ID_VSC8662, 0x000ffff0 },
362	{ PHY_ID_VSC8221, 0x000ffff0 },
363	{ PHY_ID_VSC8211, 0x000ffff0 },
364	{ }
365};
366
367MODULE_DEVICE_TABLE(mdio, vitesse_tbl);
v4.6
  1/*
  2 * Driver for Vitesse PHYs
  3 *
  4 * Author: Kriston Carson
  5 *
  6 * Copyright (c) 2005, 2009, 2011 Freescale Semiconductor, Inc.
  7 *
  8 * This program is free software; you can redistribute  it and/or modify it
  9 * under  the terms of  the GNU General  Public License as published by the
 10 * Free Software Foundation;  either version 2 of the  License, or (at your
 11 * option) any later version.
 12 *
 13 */
 14
 15#include <linux/kernel.h>
 16#include <linux/module.h>
 17#include <linux/mii.h>
 18#include <linux/ethtool.h>
 19#include <linux/phy.h>
 20
 21/* Vitesse Extended Page Magic Register(s) */
 22#define MII_VSC82X4_EXT_PAGE_16E	0x10
 23#define MII_VSC82X4_EXT_PAGE_17E	0x11
 24#define MII_VSC82X4_EXT_PAGE_18E	0x12
 25
 26/* Vitesse Extended Control Register 1 */
 27#define MII_VSC8244_EXT_CON1           0x17
 28#define MII_VSC8244_EXTCON1_INIT       0x0000
 29#define MII_VSC8244_EXTCON1_TX_SKEW_MASK	0x0c00
 30#define MII_VSC8244_EXTCON1_RX_SKEW_MASK	0x0300
 31#define MII_VSC8244_EXTCON1_TX_SKEW	0x0800
 32#define MII_VSC8244_EXTCON1_RX_SKEW	0x0200
 33
 34/* Vitesse Interrupt Mask Register */
 35#define MII_VSC8244_IMASK		0x19
 36#define MII_VSC8244_IMASK_IEN		0x8000
 37#define MII_VSC8244_IMASK_SPEED		0x4000
 38#define MII_VSC8244_IMASK_LINK		0x2000
 39#define MII_VSC8244_IMASK_DUPLEX	0x1000
 40#define MII_VSC8244_IMASK_MASK		0xf000
 41
 42#define MII_VSC8221_IMASK_MASK		0xa000
 43
 44/* Vitesse Interrupt Status Register */
 45#define MII_VSC8244_ISTAT		0x1a
 46#define MII_VSC8244_ISTAT_STATUS	0x8000
 47#define MII_VSC8244_ISTAT_SPEED		0x4000
 48#define MII_VSC8244_ISTAT_LINK		0x2000
 49#define MII_VSC8244_ISTAT_DUPLEX	0x1000
 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#define PHY_ID_VSC8234			0x000fc620
 66#define PHY_ID_VSC8244			0x000fc6c0
 67#define PHY_ID_VSC8514			0x00070670
 
 68#define PHY_ID_VSC8574			0x000704a0
 69#define PHY_ID_VSC8601			0x00070420
 70#define PHY_ID_VSC8662			0x00070660
 71#define PHY_ID_VSC8221			0x000fc550
 72#define PHY_ID_VSC8211			0x000fc4b0
 73
 74MODULE_DESCRIPTION("Vitesse PHY driver");
 75MODULE_AUTHOR("Kriston Carson");
 76MODULE_LICENSE("GPL");
 77
 78static int vsc824x_add_skew(struct phy_device *phydev)
 79{
 80	int err;
 81	int extcon;
 82
 83	extcon = phy_read(phydev, MII_VSC8244_EXT_CON1);
 84
 85	if (extcon < 0)
 86		return extcon;
 87
 88	extcon &= ~(MII_VSC8244_EXTCON1_TX_SKEW_MASK |
 89			MII_VSC8244_EXTCON1_RX_SKEW_MASK);
 90
 91	extcon |= (MII_VSC8244_EXTCON1_TX_SKEW |
 92			MII_VSC8244_EXTCON1_RX_SKEW);
 93
 94	err = phy_write(phydev, MII_VSC8244_EXT_CON1, extcon);
 95
 96	return err;
 97}
 98
 99static int vsc824x_config_init(struct phy_device *phydev)
100{
101	int err;
102
103	err = phy_write(phydev, MII_VSC8244_AUX_CONSTAT,
104			MII_VSC8244_AUXCONSTAT_INIT);
105	if (err < 0)
106		return err;
107
108	if (phydev->interface == PHY_INTERFACE_MODE_RGMII_ID)
109		err = vsc824x_add_skew(phydev);
110
111	return err;
112}
113
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
114static int vsc824x_ack_interrupt(struct phy_device *phydev)
115{
116	int err = 0;
117
118	/* Don't bother to ACK the interrupts if interrupts
119	 * are disabled.  The 824x cannot clear the interrupts
120	 * if they are disabled.
121	 */
122	if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
123		err = phy_read(phydev, MII_VSC8244_ISTAT);
124
125	return (err < 0) ? err : 0;
126}
127
128static int vsc82xx_config_intr(struct phy_device *phydev)
129{
130	int err;
131
132	if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
133		err = phy_write(phydev, MII_VSC8244_IMASK,
134			(phydev->drv->phy_id == PHY_ID_VSC8234 ||
135			 phydev->drv->phy_id == PHY_ID_VSC8244 ||
136			 phydev->drv->phy_id == PHY_ID_VSC8514 ||
 
137			 phydev->drv->phy_id == PHY_ID_VSC8574 ||
138			 phydev->drv->phy_id == PHY_ID_VSC8601) ?
139				MII_VSC8244_IMASK_MASK :
140				MII_VSC8221_IMASK_MASK);
141	else {
142		/* The Vitesse PHY cannot clear the interrupt
143		 * once it has disabled them, so we clear them first
144		 */
145		err = phy_read(phydev, MII_VSC8244_ISTAT);
146
147		if (err < 0)
148			return err;
149
150		err = phy_write(phydev, MII_VSC8244_IMASK, 0);
151	}
152
153	return err;
154}
155
156static int vsc8221_config_init(struct phy_device *phydev)
157{
158	int err;
159
160	err = phy_write(phydev, MII_VSC8244_AUX_CONSTAT,
161			MII_VSC8221_AUXCONSTAT_INIT);
162	return err;
163
164	/* Perhaps we should set EXT_CON1 based on the interface?
165	 * Options are 802.3Z SerDes or SGMII
166	 */
167}
168
169/* vsc82x4_config_autocross_enable - Enable auto MDI/MDI-X for forced links
170 * @phydev: target phy_device struct
171 *
172 * Enable auto MDI/MDI-X when in 10/100 forced link speeds by writing
173 * special values in the VSC8234/VSC8244 extended reserved registers
174 */
175static int vsc82x4_config_autocross_enable(struct phy_device *phydev)
176{
177	int ret;
178
179	if (phydev->autoneg == AUTONEG_ENABLE || phydev->speed > SPEED_100)
180		return 0;
181
182	/* map extended registers set 0x10 - 0x1e */
183	ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_ACCESS, 0x52b5);
184	if (ret >= 0)
185		ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_18E, 0x0012);
186	if (ret >= 0)
187		ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_17E, 0x2803);
188	if (ret >= 0)
189		ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_16E, 0x87fa);
190	/* map standard registers set 0x10 - 0x1e */
191	if (ret >= 0)
192		ret = phy_write(phydev, MII_VSC82X4_EXT_PAGE_ACCESS, 0x0000);
193	else
194		phy_write(phydev, MII_VSC82X4_EXT_PAGE_ACCESS, 0x0000);
195
196	return ret;
197}
198
199/* vsc82x4_config_aneg - restart auto-negotiation or write BMCR
200 * @phydev: target phy_device struct
201 *
202 * Description: If auto-negotiation is enabled, we configure the
203 *   advertising, and then restart auto-negotiation.  If it is not
204 *   enabled, then we write the BMCR and also start the auto
205 *   MDI/MDI-X feature
206 */
207static int vsc82x4_config_aneg(struct phy_device *phydev)
208{
209	int ret;
210
211	/* Enable auto MDI/MDI-X when in 10/100 forced link speeds by
212	 * writing special values in the VSC8234 extended reserved registers
213	 */
214	if (phydev->autoneg != AUTONEG_ENABLE && phydev->speed <= SPEED_100) {
215		ret = genphy_setup_forced(phydev);
216
217		if (ret < 0) /* error */
218			return ret;
219
220		return vsc82x4_config_autocross_enable(phydev);
221	}
222
223	return genphy_config_aneg(phydev);
224}
225
226/* Vitesse 82xx */
227static struct phy_driver vsc82xx_driver[] = {
228{
229	.phy_id         = PHY_ID_VSC8234,
230	.name           = "Vitesse VSC8234",
231	.phy_id_mask    = 0x000ffff0,
232	.features       = PHY_GBIT_FEATURES,
233	.flags          = PHY_HAS_INTERRUPT,
234	.config_init    = &vsc824x_config_init,
235	.config_aneg    = &vsc82x4_config_aneg,
236	.read_status    = &genphy_read_status,
237	.ack_interrupt  = &vsc824x_ack_interrupt,
238	.config_intr    = &vsc82xx_config_intr,
239}, {
240	.phy_id		= PHY_ID_VSC8244,
241	.name		= "Vitesse VSC8244",
242	.phy_id_mask	= 0x000fffc0,
243	.features	= PHY_GBIT_FEATURES,
244	.flags		= PHY_HAS_INTERRUPT,
245	.config_init	= &vsc824x_config_init,
246	.config_aneg	= &vsc82x4_config_aneg,
247	.read_status	= &genphy_read_status,
248	.ack_interrupt	= &vsc824x_ack_interrupt,
249	.config_intr	= &vsc82xx_config_intr,
250}, {
251	.phy_id		= PHY_ID_VSC8514,
252	.name		= "Vitesse VSC8514",
253	.phy_id_mask	= 0x000ffff0,
254	.features	= PHY_GBIT_FEATURES,
255	.flags		= PHY_HAS_INTERRUPT,
256	.config_init	= &vsc824x_config_init,
257	.config_aneg	= &vsc82x4_config_aneg,
258	.read_status	= &genphy_read_status,
259	.ack_interrupt	= &vsc824x_ack_interrupt,
260	.config_intr	= &vsc82xx_config_intr,
261}, {
 
 
 
 
 
 
 
 
 
 
262	.phy_id         = PHY_ID_VSC8574,
263	.name           = "Vitesse VSC8574",
264	.phy_id_mask    = 0x000ffff0,
265	.features       = PHY_GBIT_FEATURES,
266	.flags          = PHY_HAS_INTERRUPT,
267	.config_init    = &vsc824x_config_init,
268	.config_aneg    = &vsc82x4_config_aneg,
269	.read_status    = &genphy_read_status,
270	.ack_interrupt  = &vsc824x_ack_interrupt,
271	.config_intr    = &vsc82xx_config_intr,
272}, {
273	.phy_id         = PHY_ID_VSC8601,
274	.name           = "Vitesse VSC8601",
275	.phy_id_mask    = 0x000ffff0,
276	.features       = PHY_GBIT_FEATURES,
277	.flags          = PHY_HAS_INTERRUPT,
278	.config_init    = &genphy_config_init,
279	.config_aneg    = &genphy_config_aneg,
280	.read_status    = &genphy_read_status,
281	.ack_interrupt  = &vsc824x_ack_interrupt,
282	.config_intr    = &vsc82xx_config_intr,
283}, {
284	.phy_id         = PHY_ID_VSC8662,
285	.name           = "Vitesse VSC8662",
286	.phy_id_mask    = 0x000ffff0,
287	.features       = PHY_GBIT_FEATURES,
288	.flags          = PHY_HAS_INTERRUPT,
289	.config_init    = &vsc824x_config_init,
290	.config_aneg    = &vsc82x4_config_aneg,
291	.read_status    = &genphy_read_status,
292	.ack_interrupt  = &vsc824x_ack_interrupt,
293	.config_intr    = &vsc82xx_config_intr,
294}, {
295	/* Vitesse 8221 */
296	.phy_id		= PHY_ID_VSC8221,
297	.phy_id_mask	= 0x000ffff0,
298	.name		= "Vitesse VSC8221",
299	.features	= PHY_GBIT_FEATURES,
300	.flags		= PHY_HAS_INTERRUPT,
301	.config_init	= &vsc8221_config_init,
302	.config_aneg	= &genphy_config_aneg,
303	.read_status	= &genphy_read_status,
304	.ack_interrupt	= &vsc824x_ack_interrupt,
305	.config_intr	= &vsc82xx_config_intr,
306}, {
307	/* Vitesse 8211 */
308	.phy_id		= PHY_ID_VSC8211,
309	.phy_id_mask	= 0x000ffff0,
310	.name		= "Vitesse VSC8211",
311	.features	= PHY_GBIT_FEATURES,
312	.flags		= PHY_HAS_INTERRUPT,
313	.config_init	= &vsc8221_config_init,
314	.config_aneg	= &genphy_config_aneg,
315	.read_status	= &genphy_read_status,
316	.ack_interrupt	= &vsc824x_ack_interrupt,
317	.config_intr	= &vsc82xx_config_intr,
318} };
319
320module_phy_driver(vsc82xx_driver);
321
322static struct mdio_device_id __maybe_unused vitesse_tbl[] = {
323	{ PHY_ID_VSC8234, 0x000ffff0 },
324	{ PHY_ID_VSC8244, 0x000fffc0 },
325	{ PHY_ID_VSC8514, 0x000ffff0 },
 
326	{ PHY_ID_VSC8574, 0x000ffff0 },
327	{ PHY_ID_VSC8662, 0x000ffff0 },
328	{ PHY_ID_VSC8221, 0x000ffff0 },
329	{ PHY_ID_VSC8211, 0x000ffff0 },
330	{ }
331};
332
333MODULE_DEVICE_TABLE(mdio, vitesse_tbl);