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 35static 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 56static int ste10Xp_config_intr(struct phy_device *phydev) 57{ 58 int err, value; 59 60 if (phydev->interrupts == PHY_INTERRUPT_ENABLED) { 61 err = phy_write(phydev, MII_XIE, MII_XIE_DEFAULT_MASK); 62 /* clear any pending interrupts */ 63 if (err == 0) { 64 value = phy_read(phydev, MII_XCIIS); 65 if (value < 0) 66 err = value; 67 } 68 } else 69 err = phy_write(phydev, MII_XIE, 0); 70 71 return err; 72} 73 74static int ste10Xp_ack_interrupt(struct phy_device *phydev) 75{ 76 int err = phy_read(phydev, MII_XCIIS); 77 if (err < 0) 78 return err; 79 80 return 0; 81} 82 83static struct phy_driver ste101p_pdriver = { 84 .phy_id = STE101P_PHY_ID, 85 .phy_id_mask = 0xfffffff0, 86 .name = "STe101p", 87 .features = PHY_BASIC_FEATURES | SUPPORTED_Pause, 88 .flags = PHY_HAS_INTERRUPT, 89 .config_init = ste10Xp_config_init, 90 .config_aneg = genphy_config_aneg, 91 .read_status = genphy_read_status, 92 .ack_interrupt = ste10Xp_ack_interrupt, 93 .config_intr = ste10Xp_config_intr, 94 .suspend = genphy_suspend, 95 .resume = genphy_resume, 96 .driver = {.owner = THIS_MODULE,} 97}; 98 99static struct phy_driver ste100p_pdriver = { 100 .phy_id = STE100P_PHY_ID, 101 .phy_id_mask = 0xffffffff, 102 .name = "STe100p", 103 .features = PHY_BASIC_FEATURES | SUPPORTED_Pause, 104 .flags = PHY_HAS_INTERRUPT, 105 .config_init = ste10Xp_config_init, 106 .config_aneg = genphy_config_aneg, 107 .read_status = genphy_read_status, 108 .ack_interrupt = ste10Xp_ack_interrupt, 109 .config_intr = ste10Xp_config_intr, 110 .suspend = genphy_suspend, 111 .resume = genphy_resume, 112 .driver = {.owner = THIS_MODULE,} 113}; 114 115static int __init ste10Xp_init(void) 116{ 117 int retval; 118 119 retval = phy_driver_register(&ste100p_pdriver); 120 if (retval < 0) 121 return retval; 122 return phy_driver_register(&ste101p_pdriver); 123} 124 125static void __exit ste10Xp_exit(void) 126{ 127 phy_driver_unregister(&ste100p_pdriver); 128 phy_driver_unregister(&ste101p_pdriver); 129} 130 131module_init(ste10Xp_init); 132module_exit(ste10Xp_exit); 133 134static struct mdio_device_id ste10Xp_tbl[] = { 135 { STE101P_PHY_ID, 0xfffffff0 }, 136 { STE100P_PHY_ID, 0xffffffff }, 137 { } 138}; 139 140MODULE_DEVICE_TABLE(mdio, ste10Xp_tbl); 141 142MODULE_DESCRIPTION("STMicroelectronics STe10Xp PHY driver"); 143MODULE_AUTHOR("Giuseppe Cavallaro <peppe.cavallaro@st.com>"); 144MODULE_LICENSE("GPL"); 145