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/slab.h> 170cefeebaSMichael Barkowski #include <linux/interrupt.h> 180cefeebaSMichael Barkowski #include <linux/init.h> 190cefeebaSMichael Barkowski #include <linux/delay.h> 200cefeebaSMichael Barkowski #include <linux/netdevice.h> 210cefeebaSMichael Barkowski #include <linux/etherdevice.h> 220cefeebaSMichael Barkowski #include <linux/skbuff.h> 230cefeebaSMichael Barkowski #include <linux/spinlock.h> 240cefeebaSMichael Barkowski #include <linux/mm.h> 250cefeebaSMichael Barkowski #include <linux/module.h> 260cefeebaSMichael Barkowski #include <linux/mii.h> 270cefeebaSMichael Barkowski #include <linux/ethtool.h> 280cefeebaSMichael Barkowski #include <linux/phy.h> 290cefeebaSMichael Barkowski 300cefeebaSMichael Barkowski #include <asm/io.h> 310cefeebaSMichael Barkowski #include <asm/irq.h> 320cefeebaSMichael Barkowski #include <asm/uaccess.h> 330cefeebaSMichael Barkowski 340cefeebaSMichael Barkowski MODULE_DESCRIPTION("ICPlus IP175C PHY driver"); 350cefeebaSMichael Barkowski MODULE_AUTHOR("Michael Barkowski"); 360cefeebaSMichael Barkowski MODULE_LICENSE("GPL"); 370cefeebaSMichael Barkowski 380cefeebaSMichael Barkowski static int ip175c_config_init(struct phy_device *phydev) 390cefeebaSMichael Barkowski { 400cefeebaSMichael Barkowski int err, i; 410cefeebaSMichael Barkowski static int full_reset_performed = 0; 420cefeebaSMichael Barkowski 430cefeebaSMichael Barkowski if (full_reset_performed == 0) { 440cefeebaSMichael Barkowski 450cefeebaSMichael Barkowski /* master reset */ 460cefeebaSMichael Barkowski err = phydev->bus->write(phydev->bus, 30, 0, 0x175c); 470cefeebaSMichael Barkowski if (err < 0) 480cefeebaSMichael Barkowski return err; 490cefeebaSMichael Barkowski 500cefeebaSMichael Barkowski /* ensure no bus delays overlap reset period */ 510cefeebaSMichael Barkowski err = phydev->bus->read(phydev->bus, 30, 0); 520cefeebaSMichael Barkowski 530cefeebaSMichael Barkowski /* data sheet specifies reset period is 2 msec */ 540cefeebaSMichael Barkowski mdelay(2); 550cefeebaSMichael Barkowski 560cefeebaSMichael Barkowski /* enable IP175C mode */ 570cefeebaSMichael Barkowski err = phydev->bus->write(phydev->bus, 29, 31, 0x175c); 580cefeebaSMichael Barkowski if (err < 0) 590cefeebaSMichael Barkowski return err; 600cefeebaSMichael Barkowski 610cefeebaSMichael Barkowski /* Set MII0 speed and duplex (in PHY mode) */ 620cefeebaSMichael Barkowski err = phydev->bus->write(phydev->bus, 29, 22, 0x420); 630cefeebaSMichael Barkowski if (err < 0) 640cefeebaSMichael Barkowski return err; 650cefeebaSMichael Barkowski 660cefeebaSMichael Barkowski /* reset switch ports */ 670cefeebaSMichael Barkowski for (i = 0; i < 5; i++) { 680cefeebaSMichael Barkowski err = phydev->bus->write(phydev->bus, i, 690cefeebaSMichael Barkowski MII_BMCR, BMCR_RESET); 700cefeebaSMichael Barkowski if (err < 0) 710cefeebaSMichael Barkowski return err; 720cefeebaSMichael Barkowski } 730cefeebaSMichael Barkowski 740cefeebaSMichael Barkowski for (i = 0; i < 5; i++) 750cefeebaSMichael Barkowski err = phydev->bus->read(phydev->bus, i, MII_BMCR); 760cefeebaSMichael Barkowski 770cefeebaSMichael Barkowski mdelay(2); 780cefeebaSMichael Barkowski 790cefeebaSMichael Barkowski full_reset_performed = 1; 800cefeebaSMichael Barkowski } 810cefeebaSMichael Barkowski 820cefeebaSMichael Barkowski if (phydev->addr != 4) { 830cefeebaSMichael Barkowski phydev->state = PHY_RUNNING; 840cefeebaSMichael Barkowski phydev->speed = SPEED_100; 850cefeebaSMichael Barkowski phydev->duplex = DUPLEX_FULL; 860cefeebaSMichael Barkowski phydev->link = 1; 870cefeebaSMichael Barkowski netif_carrier_on(phydev->attached_dev); 880cefeebaSMichael Barkowski } 890cefeebaSMichael Barkowski 900cefeebaSMichael Barkowski return 0; 910cefeebaSMichael Barkowski } 920cefeebaSMichael Barkowski 930cefeebaSMichael Barkowski static int ip175c_read_status(struct phy_device *phydev) 940cefeebaSMichael Barkowski { 950cefeebaSMichael Barkowski if (phydev->addr == 4) /* WAN port */ 960cefeebaSMichael Barkowski genphy_read_status(phydev); 970cefeebaSMichael Barkowski else 980cefeebaSMichael Barkowski /* Don't need to read status for switch ports */ 990cefeebaSMichael Barkowski phydev->irq = PHY_IGNORE_INTERRUPT; 1000cefeebaSMichael Barkowski 1010cefeebaSMichael Barkowski return 0; 1020cefeebaSMichael Barkowski } 1030cefeebaSMichael Barkowski 1040cefeebaSMichael Barkowski static int ip175c_config_aneg(struct phy_device *phydev) 1050cefeebaSMichael Barkowski { 1060cefeebaSMichael Barkowski if (phydev->addr == 4) /* WAN port */ 1070cefeebaSMichael Barkowski genphy_config_aneg(phydev); 1080cefeebaSMichael Barkowski 1090cefeebaSMichael Barkowski return 0; 1100cefeebaSMichael Barkowski } 1110cefeebaSMichael Barkowski 1120cefeebaSMichael Barkowski static struct phy_driver ip175c_driver = { 1130cefeebaSMichael Barkowski .phy_id = 0x02430d80, 1140cefeebaSMichael Barkowski .name = "ICPlus IP175C", 1150cefeebaSMichael Barkowski .phy_id_mask = 0x0ffffff0, 1160cefeebaSMichael Barkowski .features = PHY_BASIC_FEATURES, 1170cefeebaSMichael Barkowski .config_init = &ip175c_config_init, 1180cefeebaSMichael Barkowski .config_aneg = &ip175c_config_aneg, 1190cefeebaSMichael Barkowski .read_status = &ip175c_read_status, 1200cefeebaSMichael Barkowski .driver = { .owner = THIS_MODULE,}, 1210cefeebaSMichael Barkowski }; 1220cefeebaSMichael Barkowski 1230cefeebaSMichael Barkowski static int __init ip175c_init(void) 1240cefeebaSMichael Barkowski { 1250cefeebaSMichael Barkowski return phy_driver_register(&ip175c_driver); 1260cefeebaSMichael Barkowski } 1270cefeebaSMichael Barkowski 1280cefeebaSMichael Barkowski static void __exit ip175c_exit(void) 1290cefeebaSMichael Barkowski { 1300cefeebaSMichael Barkowski phy_driver_unregister(&ip175c_driver); 1310cefeebaSMichael Barkowski } 1320cefeebaSMichael Barkowski 1330cefeebaSMichael Barkowski module_init(ip175c_init); 1340cefeebaSMichael Barkowski module_exit(ip175c_exit); 135*4e4f10f6SDavid Woodhouse 136*4e4f10f6SDavid Woodhouse static struct mdio_device_id icplus_tbl[] = { 137*4e4f10f6SDavid Woodhouse { 0x02430d80, 0x0ffffff0 }, 138*4e4f10f6SDavid Woodhouse { } 139*4e4f10f6SDavid Woodhouse }; 140*4e4f10f6SDavid Woodhouse 141*4e4f10f6SDavid Woodhouse MODULE_DEVICE_TABLE(mdio, icplus_tbl); 142