Linux kernel mirror (for testing) git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel os linux
at v2.6.14 195 lines 4.3 kB view raw
1/* 2 * drivers/net/phy/davicom.c 3 * 4 * Driver for Davicom 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/config.h> 17#include <linux/kernel.h> 18#include <linux/sched.h> 19#include <linux/string.h> 20#include <linux/errno.h> 21#include <linux/unistd.h> 22#include <linux/slab.h> 23#include <linux/interrupt.h> 24#include <linux/init.h> 25#include <linux/delay.h> 26#include <linux/netdevice.h> 27#include <linux/etherdevice.h> 28#include <linux/skbuff.h> 29#include <linux/spinlock.h> 30#include <linux/mm.h> 31#include <linux/module.h> 32#include <linux/version.h> 33#include <linux/mii.h> 34#include <linux/ethtool.h> 35#include <linux/phy.h> 36 37#include <asm/io.h> 38#include <asm/irq.h> 39#include <asm/uaccess.h> 40 41#define MII_DM9161_SCR 0x10 42#define MII_DM9161_SCR_INIT 0x0610 43 44/* DM9161 Interrupt Register */ 45#define MII_DM9161_INTR 0x15 46#define MII_DM9161_INTR_PEND 0x8000 47#define MII_DM9161_INTR_DPLX_MASK 0x0800 48#define MII_DM9161_INTR_SPD_MASK 0x0400 49#define MII_DM9161_INTR_LINK_MASK 0x0200 50#define MII_DM9161_INTR_MASK 0x0100 51#define MII_DM9161_INTR_DPLX_CHANGE 0x0010 52#define MII_DM9161_INTR_SPD_CHANGE 0x0008 53#define MII_DM9161_INTR_LINK_CHANGE 0x0004 54#define MII_DM9161_INTR_INIT 0x0000 55#define MII_DM9161_INTR_STOP \ 56(MII_DM9161_INTR_DPLX_MASK | MII_DM9161_INTR_SPD_MASK \ 57 | MII_DM9161_INTR_LINK_MASK | MII_DM9161_INTR_MASK) 58 59/* DM9161 10BT Configuration/Status */ 60#define MII_DM9161_10BTCSR 0x12 61#define MII_DM9161_10BTCSR_INIT 0x7800 62 63MODULE_DESCRIPTION("Davicom PHY driver"); 64MODULE_AUTHOR("Andy Fleming"); 65MODULE_LICENSE("GPL"); 66 67 68#define DM9161_DELAY 1 69static int dm9161_config_intr(struct phy_device *phydev) 70{ 71 int temp; 72 73 temp = phy_read(phydev, MII_DM9161_INTR); 74 75 if (temp < 0) 76 return temp; 77 78 if(PHY_INTERRUPT_ENABLED == phydev->interrupts ) 79 temp &= ~(MII_DM9161_INTR_STOP); 80 else 81 temp |= MII_DM9161_INTR_STOP; 82 83 temp = phy_write(phydev, MII_DM9161_INTR, temp); 84 85 return temp; 86} 87 88static int dm9161_config_aneg(struct phy_device *phydev) 89{ 90 int err; 91 92 /* Isolate the PHY */ 93 err = phy_write(phydev, MII_BMCR, BMCR_ISOLATE); 94 95 if (err < 0) 96 return err; 97 98 /* Configure the new settings */ 99 err = genphy_config_aneg(phydev); 100 101 if (err < 0) 102 return err; 103 104 return 0; 105} 106 107static int dm9161_config_init(struct phy_device *phydev) 108{ 109 int err; 110 111 /* Isolate the PHY */ 112 err = phy_write(phydev, MII_BMCR, BMCR_ISOLATE); 113 114 if (err < 0) 115 return err; 116 117 /* Do not bypass the scrambler/descrambler */ 118 err = phy_write(phydev, MII_DM9161_SCR, MII_DM9161_SCR_INIT); 119 120 if (err < 0) 121 return err; 122 123 /* Clear 10BTCSR to default */ 124 err = phy_write(phydev, MII_DM9161_10BTCSR, MII_DM9161_10BTCSR_INIT); 125 126 if (err < 0) 127 return err; 128 129 /* Reconnect the PHY, and enable Autonegotiation */ 130 err = phy_write(phydev, MII_BMCR, BMCR_ANENABLE); 131 132 if (err < 0) 133 return err; 134 135 return 0; 136} 137 138static int dm9161_ack_interrupt(struct phy_device *phydev) 139{ 140 int err = phy_read(phydev, MII_DM9161_INTR); 141 142 return (err < 0) ? err : 0; 143} 144 145static struct phy_driver dm9161_driver = { 146 .phy_id = 0x0181b880, 147 .name = "Davicom DM9161E", 148 .phy_id_mask = 0x0ffffff0, 149 .features = PHY_BASIC_FEATURES, 150 .config_init = dm9161_config_init, 151 .config_aneg = dm9161_config_aneg, 152 .read_status = genphy_read_status, 153 .driver = { .owner = THIS_MODULE,}, 154}; 155 156static struct phy_driver dm9131_driver = { 157 .phy_id = 0x00181b80, 158 .name = "Davicom DM9131", 159 .phy_id_mask = 0x0ffffff0, 160 .features = PHY_BASIC_FEATURES, 161 .flags = PHY_HAS_INTERRUPT, 162 .config_aneg = genphy_config_aneg, 163 .read_status = genphy_read_status, 164 .ack_interrupt = dm9161_ack_interrupt, 165 .config_intr = dm9161_config_intr, 166 .driver = { .owner = THIS_MODULE,}, 167}; 168 169static int __init davicom_init(void) 170{ 171 int ret; 172 173 ret = phy_driver_register(&dm9161_driver); 174 if (ret) 175 goto err1; 176 177 ret = phy_driver_register(&dm9131_driver); 178 if (ret) 179 goto err2; 180 return 0; 181 182 err2: 183 phy_driver_unregister(&dm9161_driver); 184 err1: 185 return ret; 186} 187 188static void __exit davicom_exit(void) 189{ 190 phy_driver_unregister(&dm9161_driver); 191 phy_driver_unregister(&dm9131_driver); 192} 193 194module_init(davicom_init); 195module_exit(davicom_exit);