/* * drivers/net/phy/davicom.c * * Driver for Davicom PHYs * * Author: Andy Fleming * * Copyright (c) 2004 Freescale Semiconductor, Inc. * * 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. * */ #include <linux/config.h> #include <linux/kernel.h> #include <linux/sched.h> #include <linux/string.h> #include <linux/errno.h> #include <linux/unistd.h> #include <linux/slab.h> #include <linux/interrupt.h> #include <linux/init.h> #include <linux/delay.h> #include <linux/netdevice.h> #include <linux/etherdevice.h> #include <linux/skbuff.h> #include <linux/spinlock.h> #include <linux/mm.h> #include <linux/module.h> #include <linux/mii.h> #include <linux/ethtool.h> #include <linux/phy.h> #include <asm/io.h> #include <asm/irq.h> #include <asm/uaccess.h> #define MII_DM9161_SCR 0x10 #define MII_DM9161_SCR_INIT 0x0610 /* DM9161 Interrupt Register */ #define MII_DM9161_INTR 0x15 #define MII_DM9161_INTR_PEND 0x8000 #define MII_DM9161_INTR_DPLX_MASK 0x0800 #define MII_DM9161_INTR_SPD_MASK 0x0400 #define MII_DM9161_INTR_LINK_MASK 0x0200 #define MII_DM9161_INTR_MASK 0x0100 #define MII_DM9161_INTR_DPLX_CHANGE 0x0010 #define MII_DM9161_INTR_SPD_CHANGE 0x0008 #define MII_DM9161_INTR_LINK_CHANGE 0x0004 #define MII_DM9161_INTR_INIT 0x0000 #define MII_DM9161_INTR_STOP \ (MII_DM9161_INTR_DPLX_MASK | MII_DM9161_INTR_SPD_MASK \ | MII_DM9161_INTR_LINK_MASK | MII_DM9161_INTR_MASK) /* DM9161 10BT Configuration/Status */ #define MII_DM9161_10BTCSR 0x12 #define MII_DM9161_10BTCSR_INIT 0x7800 MODULE_DESCRIPTION("Davicom PHY driver"); MODULE_AUTHOR("Andy Fleming"); MODULE_LICENSE("GPL"); #define DM9161_DELAY 1 static int dm9161_config_intr(struct phy_device *phydev) { int temp; temp = phy_read(phydev, MII_DM9161_INTR); if (temp < 0) return temp; if(PHY_INTERRUPT_ENABLED == phydev->interrupts ) temp &= ~(MII_DM9161_INTR_STOP); else temp |= MII_DM9161_INTR_STOP; temp = phy_write(phydev, MII_DM9161_INTR, temp); return temp; } static int dm9161_config_aneg(struct phy_device *phydev) { int err; /* Isolate the PHY */ err = phy_write(phydev, MII_BMCR, BMCR_ISOLATE); if (err < 0) return err; /* Configure the new settings */ err = genphy_config_aneg(phydev); if (err < 0) return err; return 0; } static int dm9161_config_init(struct phy_device *phydev) { int err; /* Isolate the PHY */ err = phy_write(phydev, MII_BMCR, BMCR_ISOLATE); if (err < 0) return err; /* Do not bypass the scrambler/descrambler */ err = phy_write(phydev, MII_DM9161_SCR, MII_DM9161_SCR_INIT); if (err < 0) return err; /* Clear 10BTCSR to default */ err = phy_write(phydev, MII_DM9161_10BTCSR, MII_DM9161_10BTCSR_INIT); if (err < 0) return err; /* Reconnect the PHY, and enable Autonegotiation */ err = phy_write(phydev, MII_BMCR, BMCR_ANENABLE); if (err < 0) return err; return 0; } static int dm9161_ack_interrupt(struct phy_device *phydev) { int err = phy_read(phydev, MII_DM9161_INTR); return (err < 0) ? err : 0; } static struct phy_driver dm9161_driver = { .phy_id = 0x0181b880, .name = "Davicom DM9161E", .phy_id_mask = 0x0ffffff0, .features = PHY_BASIC_FEATURES, .config_init = dm9161_config_init, .config_aneg = dm9161_config_aneg, .read_status = genphy_read_status, .driver = { .owner = THIS_MODULE,}, }; static struct phy_driver dm9131_driver = { .phy_id = 0x00181b80, .name = "Davicom DM9131", .phy_id_mask = 0x0ffffff0, .features = PHY_BASIC_FEATURES, .flags = PHY_HAS_INTERRUPT, .config_aneg = genphy_config_aneg, .read_status = genphy_read_status, .ack_interrupt = dm9161_ack_interrupt, .config_intr = dm9161_config_intr, .driver = { .owner = THIS_MODULE,}, }; static int __init davicom_init(void) { int ret; ret = phy_driver_register(&dm9161_driver); if (ret) goto err1; ret = phy_driver_register(&dm9131_driver); if (ret) goto err2; return 0; err2: phy_driver_unregister(&dm9161_driver); err1: return ret; } static void __exit davicom_exit(void) { phy_driver_unregister(&dm9161_driver); phy_driver_unregister(&dm9131_driver); } module_init(davicom_init); module_exit(davicom_exit);