Linux Audio

Check our new training course

Loading...
v6.13.7
  1// SPDX-License-Identifier: GPL-2.0+
  2/*
  3 * drivers/net/phy/lxt.c
  4 *
  5 * Driver for Intel LXT PHYs
  6 *
  7 * Author: Andy Fleming
  8 *
  9 * Copyright (c) 2004 Freescale Semiconductor, Inc.
 10 */
 11#include <linux/kernel.h>
 12#include <linux/string.h>
 13#include <linux/errno.h>
 14#include <linux/unistd.h>
 15#include <linux/interrupt.h>
 16#include <linux/init.h>
 17#include <linux/delay.h>
 18#include <linux/netdevice.h>
 19#include <linux/etherdevice.h>
 20#include <linux/skbuff.h>
 21#include <linux/spinlock.h>
 22#include <linux/mm.h>
 23#include <linux/module.h>
 24#include <linux/mii.h>
 25#include <linux/ethtool.h>
 26#include <linux/phy.h>
 27
 28#include <asm/io.h>
 29#include <asm/irq.h>
 30#include <linux/uaccess.h>
 31
 32/* The Level one LXT970 is used by many boards				     */
 33
 34#define MII_LXT970_IER       17  /* Interrupt Enable Register */
 35
 36#define MII_LXT970_IER_IEN	0x0002
 37
 38#define MII_LXT970_ISR       18  /* Interrupt Status Register */
 39
 40#define MII_LXT970_IRS_MINT  BIT(15)
 41
 42#define MII_LXT970_CONFIG    19  /* Configuration Register    */
 43
 44/* ------------------------------------------------------------------------- */
 45/* The Level one LXT971 is used on some of my custom boards                  */
 46
 47/* register definitions for the 971 */
 48#define MII_LXT971_IER		18  /* Interrupt Enable Register */
 49#define MII_LXT971_IER_IEN	0x00f2
 50
 51#define MII_LXT971_ISR		19  /* Interrupt Status Register */
 52#define MII_LXT971_ISR_MASK	0x00f0
 53
 54/* register definitions for the 973 */
 55#define MII_LXT973_PCR 16 /* Port Configuration Register */
 56#define PCR_FIBER_SELECT 1
 57
 58MODULE_DESCRIPTION("Intel LXT PHY driver");
 59MODULE_AUTHOR("Andy Fleming");
 60MODULE_LICENSE("GPL");
 61
 62static int lxt970_ack_interrupt(struct phy_device *phydev)
 63{
 64	int err;
 65
 66	err = phy_read(phydev, MII_BMSR);
 67
 68	if (err < 0)
 69		return err;
 70
 71	err = phy_read(phydev, MII_LXT970_ISR);
 72
 73	if (err < 0)
 74		return err;
 75
 76	return 0;
 77}
 78
 79static int lxt970_config_intr(struct phy_device *phydev)
 80{
 81	int err;
 82
 83	if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
 84		err = lxt970_ack_interrupt(phydev);
 85		if (err)
 86			return err;
 87
 88		err = phy_write(phydev, MII_LXT970_IER, MII_LXT970_IER_IEN);
 89	} else {
 90		err = phy_write(phydev, MII_LXT970_IER, 0);
 91		if (err)
 92			return err;
 93
 94		err = lxt970_ack_interrupt(phydev);
 95	}
 96
 97	return err;
 98}
 99
100static irqreturn_t lxt970_handle_interrupt(struct phy_device *phydev)
101{
102	int irq_status;
103
104	/* The interrupt status register is cleared by reading BMSR
105	 * followed by MII_LXT970_ISR
106	 */
107	irq_status = phy_read(phydev, MII_BMSR);
108	if (irq_status < 0) {
109		phy_error(phydev);
110		return IRQ_NONE;
111	}
112
113	irq_status = phy_read(phydev, MII_LXT970_ISR);
114	if (irq_status < 0) {
115		phy_error(phydev);
116		return IRQ_NONE;
117	}
118
119	if (!(irq_status & MII_LXT970_IRS_MINT))
120		return IRQ_NONE;
121
122	phy_trigger_machine(phydev);
123
124	return IRQ_HANDLED;
125}
126
127static int lxt970_config_init(struct phy_device *phydev)
128{
129	return phy_write(phydev, MII_LXT970_CONFIG, 0);
130}
131
132
133static int lxt971_ack_interrupt(struct phy_device *phydev)
134{
135	int err = phy_read(phydev, MII_LXT971_ISR);
136
137	if (err < 0)
138		return err;
139
140	return 0;
141}
142
143static int lxt971_config_intr(struct phy_device *phydev)
144{
145	int err;
146
147	if (phydev->interrupts == PHY_INTERRUPT_ENABLED) {
148		err = lxt971_ack_interrupt(phydev);
149		if (err)
150			return err;
151
152		err = phy_write(phydev, MII_LXT971_IER, MII_LXT971_IER_IEN);
153	} else {
154		err = phy_write(phydev, MII_LXT971_IER, 0);
155		if (err)
156			return err;
157
158		err = lxt971_ack_interrupt(phydev);
159	}
160
161	return err;
162}
163
164static irqreturn_t lxt971_handle_interrupt(struct phy_device *phydev)
165{
166	int irq_status;
167
168	irq_status = phy_read(phydev, MII_LXT971_ISR);
169	if (irq_status < 0) {
170		phy_error(phydev);
171		return IRQ_NONE;
172	}
173
174	if (!(irq_status & MII_LXT971_ISR_MASK))
175		return IRQ_NONE;
176
177	phy_trigger_machine(phydev);
178
179	return IRQ_HANDLED;
180}
181
182/*
183 * A2 version of LXT973 chip has an ERRATA: it randomly return the contents
184 * of the previous even register when you read a odd register regularly
185 */
186
187static int lxt973a2_update_link(struct phy_device *phydev)
188{
189	int status;
190	int control;
191	int retry = 8; /* we try 8 times */
192
193	/* Do a fake read */
194	status = phy_read(phydev, MII_BMSR);
195
196	if (status < 0)
197		return status;
198
199	control = phy_read(phydev, MII_BMCR);
200	if (control < 0)
201		return control;
202
203	do {
204		/* Read link and autonegotiation status */
205		status = phy_read(phydev, MII_BMSR);
206	} while (status >= 0 && retry-- && status == control);
207
208	if (status < 0)
209		return status;
210
211	if ((status & BMSR_LSTATUS) == 0)
212		phydev->link = 0;
213	else
214		phydev->link = 1;
215
216	return 0;
217}
218
219static int lxt973a2_read_status(struct phy_device *phydev)
220{
221	int adv;
222	int err;
223	int lpa;
224
225	/* Update the link, but return if there was an error */
226	err = lxt973a2_update_link(phydev);
227	if (err)
228		return err;
229
230	if (AUTONEG_ENABLE == phydev->autoneg) {
231		int retry = 1;
232
233		adv = phy_read(phydev, MII_ADVERTISE);
234
235		if (adv < 0)
236			return adv;
237
238		do {
239			lpa = phy_read(phydev, MII_LPA);
240
241			if (lpa < 0)
242				return lpa;
243
244			/* If both registers are equal, it is suspect but not
245			 * impossible, hence a new try
246			 */
247		} while (lpa == adv && retry--);
248
249		mii_lpa_to_linkmode_lpa_t(phydev->lp_advertising, lpa);
250
251		lpa &= adv;
252
253		phydev->speed = SPEED_10;
254		phydev->duplex = DUPLEX_HALF;
255		phydev->pause = phydev->asym_pause = 0;
256
257		if (lpa & (LPA_100FULL | LPA_100HALF)) {
258			phydev->speed = SPEED_100;
259
260			if (lpa & LPA_100FULL)
261				phydev->duplex = DUPLEX_FULL;
262		} else {
263			if (lpa & LPA_10FULL)
264				phydev->duplex = DUPLEX_FULL;
265		}
266
267		phy_resolve_aneg_pause(phydev);
 
 
 
268	} else {
269		err = genphy_read_status_fixed(phydev);
270		if (err < 0)
271			return err;
 
 
 
 
 
 
 
 
 
 
 
 
 
272
273		phydev->pause = phydev->asym_pause = 0;
274		linkmode_zero(phydev->lp_advertising);
275	}
276
277	return 0;
278}
279
280static int lxt973_probe(struct phy_device *phydev)
281{
282	int val = phy_read(phydev, MII_LXT973_PCR);
283
284	if (val & PCR_FIBER_SELECT) {
285		/*
286		 * If fiber is selected, then the only correct setting
287		 * is 100Mbps, full duplex, and auto negotiation off.
288		 */
289		val = phy_read(phydev, MII_BMCR);
290		val |= (BMCR_SPEED100 | BMCR_FULLDPLX);
291		val &= ~BMCR_ANENABLE;
292		phy_write(phydev, MII_BMCR, val);
293		/* Remember that the port is in fiber mode. */
294		phydev->priv = lxt973_probe;
295		phydev->port = PORT_FIBRE;
296	} else {
297		phydev->priv = NULL;
298	}
299	return 0;
300}
301
302static int lxt973_config_aneg(struct phy_device *phydev)
303{
304	/* Do nothing if port is in fiber mode. */
305	return phydev->priv ? 0 : genphy_config_aneg(phydev);
306}
307
308static struct phy_driver lxt97x_driver[] = {
309{
310	.phy_id		= 0x78100000,
311	.name		= "LXT970",
312	.phy_id_mask	= 0xfffffff0,
313	/* PHY_BASIC_FEATURES */
314	.config_init	= lxt970_config_init,
 
315	.config_intr	= lxt970_config_intr,
316	.handle_interrupt = lxt970_handle_interrupt,
317}, {
318	.phy_id		= 0x001378e0,
319	.name		= "LXT971",
320	.phy_id_mask	= 0xfffffff0,
321	/* PHY_BASIC_FEATURES */
 
322	.config_intr	= lxt971_config_intr,
323	.handle_interrupt = lxt971_handle_interrupt,
324	.suspend	= genphy_suspend,
325	.resume		= genphy_resume,
326}, {
327	.phy_id		= 0x00137a10,
328	.name		= "LXT973-A2",
329	.phy_id_mask	= 0xffffffff,
330	/* PHY_BASIC_FEATURES */
331	.flags		= 0,
332	.probe		= lxt973_probe,
333	.config_aneg	= lxt973_config_aneg,
334	.read_status	= lxt973a2_read_status,
335	.suspend	= genphy_suspend,
336	.resume		= genphy_resume,
337}, {
338	.phy_id		= 0x00137a10,
339	.name		= "LXT973",
340	.phy_id_mask	= 0xfffffff0,
341	/* PHY_BASIC_FEATURES */
342	.flags		= 0,
343	.probe		= lxt973_probe,
344	.config_aneg	= lxt973_config_aneg,
345	.suspend	= genphy_suspend,
346	.resume		= genphy_resume,
347} };
348
349module_phy_driver(lxt97x_driver);
350
351static struct mdio_device_id __maybe_unused lxt_tbl[] = {
352	{ 0x78100000, 0xfffffff0 },
353	{ 0x001378e0, 0xfffffff0 },
354	{ 0x00137a10, 0xfffffff0 },
355	{ }
356};
357
358MODULE_DEVICE_TABLE(mdio, lxt_tbl);
v5.4
  1// SPDX-License-Identifier: GPL-2.0+
  2/*
  3 * drivers/net/phy/lxt.c
  4 *
  5 * Driver for Intel LXT PHYs
  6 *
  7 * Author: Andy Fleming
  8 *
  9 * Copyright (c) 2004 Freescale Semiconductor, Inc.
 10 */
 11#include <linux/kernel.h>
 12#include <linux/string.h>
 13#include <linux/errno.h>
 14#include <linux/unistd.h>
 15#include <linux/interrupt.h>
 16#include <linux/init.h>
 17#include <linux/delay.h>
 18#include <linux/netdevice.h>
 19#include <linux/etherdevice.h>
 20#include <linux/skbuff.h>
 21#include <linux/spinlock.h>
 22#include <linux/mm.h>
 23#include <linux/module.h>
 24#include <linux/mii.h>
 25#include <linux/ethtool.h>
 26#include <linux/phy.h>
 27
 28#include <asm/io.h>
 29#include <asm/irq.h>
 30#include <linux/uaccess.h>
 31
 32/* The Level one LXT970 is used by many boards				     */
 33
 34#define MII_LXT970_IER       17  /* Interrupt Enable Register */
 35
 36#define MII_LXT970_IER_IEN	0x0002
 37
 38#define MII_LXT970_ISR       18  /* Interrupt Status Register */
 39
 
 
 40#define MII_LXT970_CONFIG    19  /* Configuration Register    */
 41
 42/* ------------------------------------------------------------------------- */
 43/* The Level one LXT971 is used on some of my custom boards                  */
 44
 45/* register definitions for the 971 */
 46#define MII_LXT971_IER		18  /* Interrupt Enable Register */
 47#define MII_LXT971_IER_IEN	0x00f2
 48
 49#define MII_LXT971_ISR		19  /* Interrupt Status Register */
 
 50
 51/* register definitions for the 973 */
 52#define MII_LXT973_PCR 16 /* Port Configuration Register */
 53#define PCR_FIBER_SELECT 1
 54
 55MODULE_DESCRIPTION("Intel LXT PHY driver");
 56MODULE_AUTHOR("Andy Fleming");
 57MODULE_LICENSE("GPL");
 58
 59static int lxt970_ack_interrupt(struct phy_device *phydev)
 60{
 61	int err;
 62
 63	err = phy_read(phydev, MII_BMSR);
 64
 65	if (err < 0)
 66		return err;
 67
 68	err = phy_read(phydev, MII_LXT970_ISR);
 69
 70	if (err < 0)
 71		return err;
 72
 73	return 0;
 74}
 75
 76static int lxt970_config_intr(struct phy_device *phydev)
 77{
 78	if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
 79		return phy_write(phydev, MII_LXT970_IER, MII_LXT970_IER_IEN);
 80	else
 81		return phy_write(phydev, MII_LXT970_IER, 0);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 82}
 83
 84static int lxt970_config_init(struct phy_device *phydev)
 85{
 86	return phy_write(phydev, MII_LXT970_CONFIG, 0);
 87}
 88
 89
 90static int lxt971_ack_interrupt(struct phy_device *phydev)
 91{
 92	int err = phy_read(phydev, MII_LXT971_ISR);
 93
 94	if (err < 0)
 95		return err;
 96
 97	return 0;
 98}
 99
100static int lxt971_config_intr(struct phy_device *phydev)
101{
102	if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
103		return phy_write(phydev, MII_LXT971_IER, MII_LXT971_IER_IEN);
104	else
105		return phy_write(phydev, MII_LXT971_IER, 0);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
106}
107
108/*
109 * A2 version of LXT973 chip has an ERRATA: it randomly return the contents
110 * of the previous even register when you read a odd register regularly
111 */
112
113static int lxt973a2_update_link(struct phy_device *phydev)
114{
115	int status;
116	int control;
117	int retry = 8; /* we try 8 times */
118
119	/* Do a fake read */
120	status = phy_read(phydev, MII_BMSR);
121
122	if (status < 0)
123		return status;
124
125	control = phy_read(phydev, MII_BMCR);
126	if (control < 0)
127		return control;
128
129	do {
130		/* Read link and autonegotiation status */
131		status = phy_read(phydev, MII_BMSR);
132	} while (status >= 0 && retry-- && status == control);
133
134	if (status < 0)
135		return status;
136
137	if ((status & BMSR_LSTATUS) == 0)
138		phydev->link = 0;
139	else
140		phydev->link = 1;
141
142	return 0;
143}
144
145static int lxt973a2_read_status(struct phy_device *phydev)
146{
147	int adv;
148	int err;
149	int lpa;
150
151	/* Update the link, but return if there was an error */
152	err = lxt973a2_update_link(phydev);
153	if (err)
154		return err;
155
156	if (AUTONEG_ENABLE == phydev->autoneg) {
157		int retry = 1;
158
159		adv = phy_read(phydev, MII_ADVERTISE);
160
161		if (adv < 0)
162			return adv;
163
164		do {
165			lpa = phy_read(phydev, MII_LPA);
166
167			if (lpa < 0)
168				return lpa;
169
170			/* If both registers are equal, it is suspect but not
171			* impossible, hence a new try
172			*/
173		} while (lpa == adv && retry--);
174
175		mii_lpa_to_linkmode_lpa_t(phydev->lp_advertising, lpa);
176
177		lpa &= adv;
178
179		phydev->speed = SPEED_10;
180		phydev->duplex = DUPLEX_HALF;
181		phydev->pause = phydev->asym_pause = 0;
182
183		if (lpa & (LPA_100FULL | LPA_100HALF)) {
184			phydev->speed = SPEED_100;
185
186			if (lpa & LPA_100FULL)
187				phydev->duplex = DUPLEX_FULL;
188		} else {
189			if (lpa & LPA_10FULL)
190				phydev->duplex = DUPLEX_FULL;
191		}
192
193		if (phydev->duplex == DUPLEX_FULL) {
194			phydev->pause = lpa & LPA_PAUSE_CAP ? 1 : 0;
195			phydev->asym_pause = lpa & LPA_PAUSE_ASYM ? 1 : 0;
196		}
197	} else {
198		int bmcr = phy_read(phydev, MII_BMCR);
199
200		if (bmcr < 0)
201			return bmcr;
202
203		if (bmcr & BMCR_FULLDPLX)
204			phydev->duplex = DUPLEX_FULL;
205		else
206			phydev->duplex = DUPLEX_HALF;
207
208		if (bmcr & BMCR_SPEED1000)
209			phydev->speed = SPEED_1000;
210		else if (bmcr & BMCR_SPEED100)
211			phydev->speed = SPEED_100;
212		else
213			phydev->speed = SPEED_10;
214
215		phydev->pause = phydev->asym_pause = 0;
216		linkmode_zero(phydev->lp_advertising);
217	}
218
219	return 0;
220}
221
222static int lxt973_probe(struct phy_device *phydev)
223{
224	int val = phy_read(phydev, MII_LXT973_PCR);
225
226	if (val & PCR_FIBER_SELECT) {
227		/*
228		 * If fiber is selected, then the only correct setting
229		 * is 100Mbps, full duplex, and auto negotiation off.
230		 */
231		val = phy_read(phydev, MII_BMCR);
232		val |= (BMCR_SPEED100 | BMCR_FULLDPLX);
233		val &= ~BMCR_ANENABLE;
234		phy_write(phydev, MII_BMCR, val);
235		/* Remember that the port is in fiber mode. */
236		phydev->priv = lxt973_probe;
 
237	} else {
238		phydev->priv = NULL;
239	}
240	return 0;
241}
242
243static int lxt973_config_aneg(struct phy_device *phydev)
244{
245	/* Do nothing if port is in fiber mode. */
246	return phydev->priv ? 0 : genphy_config_aneg(phydev);
247}
248
249static struct phy_driver lxt97x_driver[] = {
250{
251	.phy_id		= 0x78100000,
252	.name		= "LXT970",
253	.phy_id_mask	= 0xfffffff0,
254	/* PHY_BASIC_FEATURES */
255	.config_init	= lxt970_config_init,
256	.ack_interrupt	= lxt970_ack_interrupt,
257	.config_intr	= lxt970_config_intr,
 
258}, {
259	.phy_id		= 0x001378e0,
260	.name		= "LXT971",
261	.phy_id_mask	= 0xfffffff0,
262	/* PHY_BASIC_FEATURES */
263	.ack_interrupt	= lxt971_ack_interrupt,
264	.config_intr	= lxt971_config_intr,
 
265	.suspend	= genphy_suspend,
266	.resume		= genphy_resume,
267}, {
268	.phy_id		= 0x00137a10,
269	.name		= "LXT973-A2",
270	.phy_id_mask	= 0xffffffff,
271	/* PHY_BASIC_FEATURES */
272	.flags		= 0,
273	.probe		= lxt973_probe,
274	.config_aneg	= lxt973_config_aneg,
275	.read_status	= lxt973a2_read_status,
276	.suspend	= genphy_suspend,
277	.resume		= genphy_resume,
278}, {
279	.phy_id		= 0x00137a10,
280	.name		= "LXT973",
281	.phy_id_mask	= 0xfffffff0,
282	/* PHY_BASIC_FEATURES */
283	.flags		= 0,
284	.probe		= lxt973_probe,
285	.config_aneg	= lxt973_config_aneg,
286	.suspend	= genphy_suspend,
287	.resume		= genphy_resume,
288} };
289
290module_phy_driver(lxt97x_driver);
291
292static struct mdio_device_id __maybe_unused lxt_tbl[] = {
293	{ 0x78100000, 0xfffffff0 },
294	{ 0x001378e0, 0xfffffff0 },
295	{ 0x00137a10, 0xfffffff0 },
296	{ }
297};
298
299MODULE_DEVICE_TABLE(mdio, lxt_tbl);