PageRenderTime 26ms CodeModel.GetById 17ms app.highlight 7ms RepoModel.GetById 1ms app.codeStats 0ms

/drivers/net/phy/lxt.c

https://bitbucket.org/ndreys/linux-sunxi
C | 233 lines | 162 code | 45 blank | 26 comment | 12 complexity | 6b9df9c7a327d0b325f7ccc48bfcd7b3 MD5 | raw file
Possible License(s): GPL-2.0, LGPL-2.0, AGPL-1.0
  1/*
  2 * drivers/net/phy/lxt.c
  3 *
  4 * Driver for Intel LXT PHYs
  5 *
  6 * Author: Andy Fleming
  7 *
  8 * Copyright (c) 2004 Freescale Semiconductor, Inc.
  9 *
 10 * This program is free software; you can redistribute  it and/or modify it
 11 * under  the terms of  the GNU General  Public License as published by the
 12 * Free Software Foundation;  either version 2 of the  License, or (at your
 13 * option) any later version.
 14 *
 15 */
 16#include <linux/kernel.h>
 17#include <linux/string.h>
 18#include <linux/errno.h>
 19#include <linux/unistd.h>
 20#include <linux/interrupt.h>
 21#include <linux/init.h>
 22#include <linux/delay.h>
 23#include <linux/netdevice.h>
 24#include <linux/etherdevice.h>
 25#include <linux/skbuff.h>
 26#include <linux/spinlock.h>
 27#include <linux/mm.h>
 28#include <linux/module.h>
 29#include <linux/mii.h>
 30#include <linux/ethtool.h>
 31#include <linux/phy.h>
 32
 33#include <asm/io.h>
 34#include <asm/irq.h>
 35#include <asm/uaccess.h>
 36
 37/* The Level one LXT970 is used by many boards				     */
 38
 39#define MII_LXT970_IER       17  /* Interrupt Enable Register */
 40
 41#define MII_LXT970_IER_IEN	0x0002
 42
 43#define MII_LXT970_ISR       18  /* Interrupt Status Register */
 44
 45#define MII_LXT970_CONFIG    19  /* Configuration Register    */
 46
 47/* ------------------------------------------------------------------------- */
 48/* The Level one LXT971 is used on some of my custom boards                  */
 49
 50/* register definitions for the 971 */
 51#define MII_LXT971_IER		18  /* Interrupt Enable Register */
 52#define MII_LXT971_IER_IEN	0x00f2
 53
 54#define MII_LXT971_ISR		19  /* Interrupt Status Register */
 55
 56/* register definitions for the 973 */
 57#define MII_LXT973_PCR 16 /* Port Configuration Register */
 58#define PCR_FIBER_SELECT 1
 59
 60MODULE_DESCRIPTION("Intel LXT PHY driver");
 61MODULE_AUTHOR("Andy Fleming");
 62MODULE_LICENSE("GPL");
 63
 64static int lxt970_ack_interrupt(struct phy_device *phydev)
 65{
 66	int err;
 67
 68	err = phy_read(phydev, MII_BMSR);
 69
 70	if (err < 0)
 71		return err;
 72
 73	err = phy_read(phydev, MII_LXT970_ISR);
 74
 75	if (err < 0)
 76		return err;
 77
 78	return 0;
 79}
 80
 81static int lxt970_config_intr(struct phy_device *phydev)
 82{
 83	int err;
 84
 85	if(phydev->interrupts == PHY_INTERRUPT_ENABLED)
 86		err = phy_write(phydev, MII_LXT970_IER, MII_LXT970_IER_IEN);
 87	else
 88		err = phy_write(phydev, MII_LXT970_IER, 0);
 89
 90	return err;
 91}
 92
 93static int lxt970_config_init(struct phy_device *phydev)
 94{
 95	int err;
 96
 97	err = phy_write(phydev, MII_LXT970_CONFIG, 0);
 98
 99	return err;
100}
101
102
103static int lxt971_ack_interrupt(struct phy_device *phydev)
104{
105	int err = phy_read(phydev, MII_LXT971_ISR);
106
107	if (err < 0)
108		return err;
109
110	return 0;
111}
112
113static int lxt971_config_intr(struct phy_device *phydev)
114{
115	int err;
116
117	if(phydev->interrupts == PHY_INTERRUPT_ENABLED)
118		err = phy_write(phydev, MII_LXT971_IER, MII_LXT971_IER_IEN);
119	else
120		err = phy_write(phydev, MII_LXT971_IER, 0);
121
122	return err;
123}
124
125static int lxt973_probe(struct phy_device *phydev)
126{
127	int val = phy_read(phydev, MII_LXT973_PCR);
128
129	if (val & PCR_FIBER_SELECT) {
130		/*
131		 * If fiber is selected, then the only correct setting
132		 * is 100Mbps, full duplex, and auto negotiation off.
133		 */
134		val = phy_read(phydev, MII_BMCR);
135		val |= (BMCR_SPEED100 | BMCR_FULLDPLX);
136		val &= ~BMCR_ANENABLE;
137		phy_write(phydev, MII_BMCR, val);
138		/* Remember that the port is in fiber mode. */
139		phydev->priv = lxt973_probe;
140	} else {
141		phydev->priv = NULL;
142	}
143	return 0;
144}
145
146static int lxt973_config_aneg(struct phy_device *phydev)
147{
148	/* Do nothing if port is in fiber mode. */
149	return phydev->priv ? 0 : genphy_config_aneg(phydev);
150}
151
152static struct phy_driver lxt970_driver = {
153	.phy_id		= 0x78100000,
154	.name		= "LXT970",
155	.phy_id_mask	= 0xfffffff0,
156	.features	= PHY_BASIC_FEATURES,
157	.flags		= PHY_HAS_INTERRUPT,
158	.config_init	= lxt970_config_init,
159	.config_aneg	= genphy_config_aneg,
160	.read_status	= genphy_read_status,
161	.ack_interrupt	= lxt970_ack_interrupt,
162	.config_intr	= lxt970_config_intr,
163	.driver 	= { .owner = THIS_MODULE,},
164};
165
166static struct phy_driver lxt971_driver = {
167	.phy_id		= 0x001378e0,
168	.name		= "LXT971",
169	.phy_id_mask	= 0xfffffff0,
170	.features	= PHY_BASIC_FEATURES,
171	.flags		= PHY_HAS_INTERRUPT,
172	.config_aneg	= genphy_config_aneg,
173	.read_status	= genphy_read_status,
174	.ack_interrupt	= lxt971_ack_interrupt,
175	.config_intr	= lxt971_config_intr,
176	.driver 	= { .owner = THIS_MODULE,},
177};
178
179static struct phy_driver lxt973_driver = {
180	.phy_id		= 0x00137a10,
181	.name		= "LXT973",
182	.phy_id_mask	= 0xfffffff0,
183	.features	= PHY_BASIC_FEATURES,
184	.flags		= 0,
185	.probe		= lxt973_probe,
186	.config_aneg	= lxt973_config_aneg,
187	.read_status	= genphy_read_status,
188	.driver 	= { .owner = THIS_MODULE,},
189};
190
191static int __init lxt_init(void)
192{
193	int ret;
194
195	ret = phy_driver_register(&lxt970_driver);
196	if (ret)
197		goto err1;
198
199	ret = phy_driver_register(&lxt971_driver);
200	if (ret)
201		goto err2;
202
203	ret = phy_driver_register(&lxt973_driver);
204	if (ret)
205		goto err3;
206	return 0;
207
208 err3:
209	phy_driver_unregister(&lxt971_driver);
210 err2:
211	phy_driver_unregister(&lxt970_driver);
212 err1:
213	return ret;
214}
215
216static void __exit lxt_exit(void)
217{
218	phy_driver_unregister(&lxt970_driver);
219	phy_driver_unregister(&lxt971_driver);
220	phy_driver_unregister(&lxt973_driver);
221}
222
223module_init(lxt_init);
224module_exit(lxt_exit);
225
226static struct mdio_device_id __maybe_unused lxt_tbl[] = {
227	{ 0x78100000, 0xfffffff0 },
228	{ 0x001378e0, 0xfffffff0 },
229	{ 0x00137a10, 0xfffffff0 },
230	{ }
231};
232
233MODULE_DEVICE_TABLE(mdio, lxt_tbl);