1 /* 2 * drivers/net/phy/ste10Xp.c 3 * 4 * Driver for STMicroelectronics STe10Xp PHYs 5 * 6 * Author: Giuseppe Cavallaro <peppe.cavallaro@st.com> 7 * 8 * Copyright (c) 2008 STMicroelectronics Limited 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 17 #include <linux/module.h> 18 #include <linux/init.h> 19 #include <linux/sched.h> 20 #include <linux/kernel.h> 21 #include <linux/moduleparam.h> 22 #include <linux/interrupt.h> 23 #include <linux/netdevice.h> 24 #include <linux/ethtool.h> 25 #include <linux/mii.h> 26 #include <linux/phy.h> 27 28 #define MII_XCIIS 0x11 /* Configuration Info IRQ & Status Reg */ 29 #define MII_XIE 0x12 /* Interrupt Enable Register */ 30 #define MII_XIE_DEFAULT_MASK 0x0070 /* ANE complete, Remote Fault, Link Down */ 31 32 #define STE101P_PHY_ID 0x00061c50 33 #define STE100P_PHY_ID 0x1c040011 34 35 static int ste10Xp_config_init(struct phy_device *phydev) 36 { 37 int value, err; 38 39 /* Software Reset PHY */ 40 value = phy_read(phydev, MII_BMCR); 41 if (value < 0) 42 return value; 43 44 value |= BMCR_RESET; 45 err = phy_write(phydev, MII_BMCR, value); 46 if (err < 0) 47 return err; 48 49 do { 50 value = phy_read(phydev, MII_BMCR); 51 } while (value & BMCR_RESET); 52 53 return 0; 54 } 55 56 static int ste10Xp_config_intr(struct phy_device *phydev) 57 { 58 int err, value; 59 60 if (phydev->interrupts == PHY_INTERRUPT_ENABLED) { 61 /* Enable all STe101P interrupts (PR12) */ 62 err = phy_write(phydev, MII_XIE, MII_XIE_DEFAULT_MASK); 63 /* clear any pending interrupts */ 64 if (err == 0) { 65 value = phy_read(phydev, MII_XCIIS); 66 if (value < 0) 67 err = value; 68 } 69 } else 70 err = phy_write(phydev, MII_XIE, 0); 71 72 return err; 73 } 74 75 static int ste10Xp_ack_interrupt(struct phy_device *phydev) 76 { 77 int err = phy_read(phydev, MII_XCIIS); 78 if (err < 0) 79 return err; 80 81 return 0; 82 } 83 84 static struct phy_driver ste10xp_pdriver[] = { 85 { 86 .phy_id = STE101P_PHY_ID, 87 .phy_id_mask = 0xfffffff0, 88 .name = "STe101p", 89 .features = PHY_BASIC_FEATURES | SUPPORTED_Pause, 90 .flags = PHY_HAS_INTERRUPT, 91 .config_init = ste10Xp_config_init, 92 .ack_interrupt = ste10Xp_ack_interrupt, 93 .config_intr = ste10Xp_config_intr, 94 .suspend = genphy_suspend, 95 .resume = genphy_resume, 96 }, { 97 .phy_id = STE100P_PHY_ID, 98 .phy_id_mask = 0xffffffff, 99 .name = "STe100p", 100 .features = PHY_BASIC_FEATURES | SUPPORTED_Pause, 101 .flags = PHY_HAS_INTERRUPT, 102 .config_init = ste10Xp_config_init, 103 .ack_interrupt = ste10Xp_ack_interrupt, 104 .config_intr = ste10Xp_config_intr, 105 .suspend = genphy_suspend, 106 .resume = genphy_resume, 107 } }; 108 109 module_phy_driver(ste10xp_pdriver); 110 111 static struct mdio_device_id __maybe_unused ste10Xp_tbl[] = { 112 { STE101P_PHY_ID, 0xfffffff0 }, 113 { STE100P_PHY_ID, 0xffffffff }, 114 { } 115 }; 116 117 MODULE_DEVICE_TABLE(mdio, ste10Xp_tbl); 118 119 MODULE_DESCRIPTION("STMicroelectronics STe10Xp PHY driver"); 120 MODULE_AUTHOR("Giuseppe Cavallaro <peppe.cavallaro@st.com>"); 121 MODULE_LICENSE("GPL"); 122