10cefeebaSMichael Barkowski /* 20cefeebaSMichael Barkowski * Driver for ICPlus PHYs 30cefeebaSMichael Barkowski * 40cefeebaSMichael Barkowski * Copyright (c) 2007 Freescale Semiconductor, Inc. 50cefeebaSMichael Barkowski * 60cefeebaSMichael Barkowski * This program is free software; you can redistribute it and/or modify it 70cefeebaSMichael Barkowski * under the terms of the GNU General Public License as published by the 80cefeebaSMichael Barkowski * Free Software Foundation; either version 2 of the License, or (at your 90cefeebaSMichael Barkowski * option) any later version. 100cefeebaSMichael Barkowski * 110cefeebaSMichael Barkowski */ 120cefeebaSMichael Barkowski #include <linux/kernel.h> 130cefeebaSMichael Barkowski #include <linux/string.h> 140cefeebaSMichael Barkowski #include <linux/errno.h> 150cefeebaSMichael Barkowski #include <linux/unistd.h> 160cefeebaSMichael Barkowski #include <linux/interrupt.h> 170cefeebaSMichael Barkowski #include <linux/init.h> 180cefeebaSMichael Barkowski #include <linux/delay.h> 190cefeebaSMichael Barkowski #include <linux/netdevice.h> 200cefeebaSMichael Barkowski #include <linux/etherdevice.h> 210cefeebaSMichael Barkowski #include <linux/skbuff.h> 220cefeebaSMichael Barkowski #include <linux/spinlock.h> 230cefeebaSMichael Barkowski #include <linux/mm.h> 240cefeebaSMichael Barkowski #include <linux/module.h> 250cefeebaSMichael Barkowski #include <linux/mii.h> 260cefeebaSMichael Barkowski #include <linux/ethtool.h> 270cefeebaSMichael Barkowski #include <linux/phy.h> 280cefeebaSMichael Barkowski 290cefeebaSMichael Barkowski #include <asm/io.h> 300cefeebaSMichael Barkowski #include <asm/irq.h> 310cefeebaSMichael Barkowski #include <asm/uaccess.h> 320cefeebaSMichael Barkowski 330cefeebaSMichael Barkowski MODULE_DESCRIPTION("ICPlus IP175C PHY driver"); 340cefeebaSMichael Barkowski MODULE_AUTHOR("Michael Barkowski"); 350cefeebaSMichael Barkowski MODULE_LICENSE("GPL"); 360cefeebaSMichael Barkowski 370cefeebaSMichael Barkowski static int ip175c_config_init(struct phy_device *phydev) 380cefeebaSMichael Barkowski { 390cefeebaSMichael Barkowski int err, i; 400cefeebaSMichael Barkowski static int full_reset_performed = 0; 410cefeebaSMichael Barkowski 420cefeebaSMichael Barkowski if (full_reset_performed == 0) { 430cefeebaSMichael Barkowski 440cefeebaSMichael Barkowski /* master reset */ 450cefeebaSMichael Barkowski err = phydev->bus->write(phydev->bus, 30, 0, 0x175c); 460cefeebaSMichael Barkowski if (err < 0) 470cefeebaSMichael Barkowski return err; 480cefeebaSMichael Barkowski 490cefeebaSMichael Barkowski /* ensure no bus delays overlap reset period */ 500cefeebaSMichael Barkowski err = phydev->bus->read(phydev->bus, 30, 0); 510cefeebaSMichael Barkowski 520cefeebaSMichael Barkowski /* data sheet specifies reset period is 2 msec */ 530cefeebaSMichael Barkowski mdelay(2); 540cefeebaSMichael Barkowski 550cefeebaSMichael Barkowski /* enable IP175C mode */ 560cefeebaSMichael Barkowski err = phydev->bus->write(phydev->bus, 29, 31, 0x175c); 570cefeebaSMichael Barkowski if (err < 0) 580cefeebaSMichael Barkowski return err; 590cefeebaSMichael Barkowski 600cefeebaSMichael Barkowski /* Set MII0 speed and duplex (in PHY mode) */ 610cefeebaSMichael Barkowski err = phydev->bus->write(phydev->bus, 29, 22, 0x420); 620cefeebaSMichael Barkowski if (err < 0) 630cefeebaSMichael Barkowski return err; 640cefeebaSMichael Barkowski 650cefeebaSMichael Barkowski /* reset switch ports */ 660cefeebaSMichael Barkowski for (i = 0; i < 5; i++) { 670cefeebaSMichael Barkowski err = phydev->bus->write(phydev->bus, i, 680cefeebaSMichael Barkowski MII_BMCR, BMCR_RESET); 690cefeebaSMichael Barkowski if (err < 0) 700cefeebaSMichael Barkowski return err; 710cefeebaSMichael Barkowski } 720cefeebaSMichael Barkowski 730cefeebaSMichael Barkowski for (i = 0; i < 5; i++) 740cefeebaSMichael Barkowski err = phydev->bus->read(phydev->bus, i, MII_BMCR); 750cefeebaSMichael Barkowski 760cefeebaSMichael Barkowski mdelay(2); 770cefeebaSMichael Barkowski 780cefeebaSMichael Barkowski full_reset_performed = 1; 790cefeebaSMichael Barkowski } 800cefeebaSMichael Barkowski 810cefeebaSMichael Barkowski if (phydev->addr != 4) { 820cefeebaSMichael Barkowski phydev->state = PHY_RUNNING; 830cefeebaSMichael Barkowski phydev->speed = SPEED_100; 840cefeebaSMichael Barkowski phydev->duplex = DUPLEX_FULL; 850cefeebaSMichael Barkowski phydev->link = 1; 860cefeebaSMichael Barkowski netif_carrier_on(phydev->attached_dev); 870cefeebaSMichael Barkowski } 880cefeebaSMichael Barkowski 890cefeebaSMichael Barkowski return 0; 900cefeebaSMichael Barkowski } 910cefeebaSMichael Barkowski 920cefeebaSMichael Barkowski static int ip175c_read_status(struct phy_device *phydev) 930cefeebaSMichael Barkowski { 940cefeebaSMichael Barkowski if (phydev->addr == 4) /* WAN port */ 950cefeebaSMichael Barkowski genphy_read_status(phydev); 960cefeebaSMichael Barkowski else 970cefeebaSMichael Barkowski /* Don't need to read status for switch ports */ 980cefeebaSMichael Barkowski phydev->irq = PHY_IGNORE_INTERRUPT; 990cefeebaSMichael Barkowski 1000cefeebaSMichael Barkowski return 0; 1010cefeebaSMichael Barkowski } 1020cefeebaSMichael Barkowski 1030cefeebaSMichael Barkowski static int ip175c_config_aneg(struct phy_device *phydev) 1040cefeebaSMichael Barkowski { 1050cefeebaSMichael Barkowski if (phydev->addr == 4) /* WAN port */ 1060cefeebaSMichael Barkowski genphy_config_aneg(phydev); 1070cefeebaSMichael Barkowski 1080cefeebaSMichael Barkowski return 0; 1090cefeebaSMichael Barkowski } 1100cefeebaSMichael Barkowski 1110cefeebaSMichael Barkowski static struct phy_driver ip175c_driver = { 1120cefeebaSMichael Barkowski .phy_id = 0x02430d80, 1130cefeebaSMichael Barkowski .name = "ICPlus IP175C", 1140cefeebaSMichael Barkowski .phy_id_mask = 0x0ffffff0, 1150cefeebaSMichael Barkowski .features = PHY_BASIC_FEATURES, 1160cefeebaSMichael Barkowski .config_init = &ip175c_config_init, 1170cefeebaSMichael Barkowski .config_aneg = &ip175c_config_aneg, 1180cefeebaSMichael Barkowski .read_status = &ip175c_read_status, 119*dab10863SGiuseppe Cavallaro .suspend = genphy_suspend, 120*dab10863SGiuseppe Cavallaro .resume = genphy_resume, 1210cefeebaSMichael Barkowski .driver = { .owner = THIS_MODULE,}, 1220cefeebaSMichael Barkowski }; 1230cefeebaSMichael Barkowski 1240cefeebaSMichael Barkowski static int __init ip175c_init(void) 1250cefeebaSMichael Barkowski { 1260cefeebaSMichael Barkowski return phy_driver_register(&ip175c_driver); 1270cefeebaSMichael Barkowski } 1280cefeebaSMichael Barkowski 1290cefeebaSMichael Barkowski static void __exit ip175c_exit(void) 1300cefeebaSMichael Barkowski { 1310cefeebaSMichael Barkowski phy_driver_unregister(&ip175c_driver); 1320cefeebaSMichael Barkowski } 1330cefeebaSMichael Barkowski 1340cefeebaSMichael Barkowski module_init(ip175c_init); 1350cefeebaSMichael Barkowski module_exit(ip175c_exit); 1364e4f10f6SDavid Woodhouse 1374e4f10f6SDavid Woodhouse static struct mdio_device_id icplus_tbl[] = { 1384e4f10f6SDavid Woodhouse { 0x02430d80, 0x0ffffff0 }, 1394e4f10f6SDavid Woodhouse { } 1404e4f10f6SDavid Woodhouse }; 1414e4f10f6SDavid Woodhouse 1424e4f10f6SDavid Woodhouse MODULE_DEVICE_TABLE(mdio, icplus_tbl); 143