phy: add am79c874 PHY support

Signed-off-by: Heiko Schocher <hs@denx.de>
Signed-off-by: Anatolij Gustschin <agust@denx.de>
Signed-off-by: David S. Miller <davem@davemloft.net>

3 files changed, 108 insertions, 0 deletions

diff --git a/drivers/net/phy/Kconfig b/drivers/net/phy/Kconfig
index fbdcdf83cbfd..0e01f4e5cd64 100644
--- a/drivers/net/phy/Kconfig
+++ b/drivers/net/phy/Kconfig
@@ -15,6 +15,11 @@ if PHYLIB
 
 comment "MII PHY device drivers"
 
+config AMD_PHY
+        tristate "Drivers for the AMD PHYs"
+        ---help---
+          Currently supports the am79c874
+
 config MARVELL_PHY
         tristate "Drivers for Marvell PHYs"
         ---help---
diff --git a/drivers/net/phy/Makefile b/drivers/net/phy/Makefile
index e15c83fecbe0..b7438b1b94b9 100644
--- a/drivers/net/phy/Makefile
+++ b/drivers/net/phy/Makefile
@@ -24,3 +24,4 @@ obj-$(CONFIG_STE10XP)		+= ste10Xp.o
 obj-$(CONFIG_MICREL_PHY)        += micrel.o
 obj-$(CONFIG_MDIO_OCTEON)       += mdio-octeon.o
 obj-$(CONFIG_MICREL_KS8995MA)   += spi_ks8995.o
+obj-$(CONFIG_AMD_PHY)           += amd.o
diff --git a/drivers/net/phy/amd.c b/drivers/net/phy/amd.c
new file mode 100644
index 000000000000..cfabd5fe5372
--- /dev/null
+++ b/drivers/net/phy/amd.c
@@ -0,0 +1,102 @@
+/*
+ * Driver for AMD am79c PHYs
+ *
+ * Author: Heiko Schocher <hs@denx.de>
+ *
+ * Copyright (c) 2011 DENX Software Engineering GmbH
+ *
+ * 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/kernel.h>
+#include <linux/errno.h>
+#include <linux/init.h>
+#include <linux/module.h>
+#include <linux/mii.h>
+#include <linux/phy.h>
+
+#define PHY_ID_AM79C874         0x0022561b
+
+#define MII_AM79C_IR            17      /* Interrupt Status/Control Register */
+#define MII_AM79C_IR_EN_LINK    0x0400  /* IR enable Linkstate */
+#define MII_AM79C_IR_EN_ANEG    0x0100  /* IR enable Aneg Complete */
+#define MII_AM79C_IR_IMASK_INIT (MII_AM79C_IR_EN_LINK | MII_AM79C_IR_EN_ANEG)
+
+MODULE_DESCRIPTION("AMD PHY driver");
+MODULE_AUTHOR("Heiko Schocher <hs@denx.de>");
+MODULE_LICENSE("GPL");
+
+static int am79c_ack_interrupt(struct phy_device *phydev)
+{
+        int err;
+
+        err = phy_read(phydev, MII_BMSR);
+        if (err < 0)
+                return err;
+
+        err = phy_read(phydev, MII_AM79C_IR);
+        if (err < 0)
+                return err;
+
+        return 0;
+}
+
+static int am79c_config_init(struct phy_device *phydev)
+{
+        return 0;
+}
+
+static int am79c_config_intr(struct phy_device *phydev)
+{
+        int err;
+
+        if (phydev->interrupts == PHY_INTERRUPT_ENABLED)
+                err = phy_write(phydev, MII_AM79C_IR, MII_AM79C_IR_IMASK_INIT);
+        else
+                err = phy_write(phydev, MII_AM79C_IR, 0);
+
+        return err;
+}
+
+static struct phy_driver am79c_driver = {
+        .phy_id         = PHY_ID_AM79C874,
+        .name           = "AM79C874",
+        .phy_id_mask    = 0xfffffff0,
+        .features       = PHY_BASIC_FEATURES,
+        .flags          = PHY_HAS_INTERRUPT,
+        .config_init    = am79c_config_init,
+        .config_aneg    = genphy_config_aneg,
+        .read_status    = genphy_read_status,
+        .ack_interrupt  = am79c_ack_interrupt,
+        .config_intr    = am79c_config_intr,
+        .driver         = { .owner = THIS_MODULE,},
+};
+
+static int __init am79c_init(void)
+{
+        int ret;
+
+        ret = phy_driver_register(&am79c_driver);
+        if (ret)
+                return ret;
+
+        return 0;
+}
+
+static void __exit am79c_exit(void)
+{
+        phy_driver_unregister(&am79c_driver);
+}
+
+module_init(am79c_init);
+module_exit(am79c_exit);
+
+static struct mdio_device_id __maybe_unused amd_tbl[] = {
+        { PHY_ID_AM79C874, 0xfffffff0 },
+        { }
+};
+
+MODULE_DEVICE_TABLE(mdio, amd_tbl);