diff options
Diffstat (limited to 'target/linux/imx6/files-4.3')
-rw-r--r-- | target/linux/imx6/files-4.3/drivers/net/phy/gw16083.c | 1046 | ||||
-rw-r--r-- | target/linux/imx6/files-4.3/drivers/net/phy/gw16083.h | 123 |
2 files changed, 0 insertions, 1169 deletions
diff --git a/target/linux/imx6/files-4.3/drivers/net/phy/gw16083.c b/target/linux/imx6/files-4.3/drivers/net/phy/gw16083.c deleted file mode 100644 index bdc7446ed3..0000000000 --- a/target/linux/imx6/files-4.3/drivers/net/phy/gw16083.c +++ /dev/null @@ -1,1046 +0,0 @@ -/* - * drivers/net/phy/gw16083.c - * - * Driver for GW16083 Ventana Ethernet Expansion Mezzanine - * - * Author: Tim Harvey - * - * Copyright (c) 2014 Tim Harvey <tharvey@gateworks.com> - * - * 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. - * - */ - -/* - * The GW16083 interfaces with a Ventana baseboard via the PCIe bus, an i2c - * bus (i2c2), and a couple of GPIO's. On the PCIe bus is an i210 GigE with - * its MAC connected to Port4 of a Marvell MV88E6176 7-port GigE switch via - * MDIO and RGMII. Ports 0-3 are standard copper RJ45 but Ports 5 and 6 - * connect to Marvell MV88E1111 dual-mode Copper/Fiber PHY's over SGMII and - * MDIO. The PHY's have both an RG45 for copper and an SFP module. - */ - -#include <linux/kernel.h> -#include <linux/string.h> -#include <linux/errno.h> -#include <linux/unistd.h> -#include <linux/i2c.h> -#include <linux/interrupt.h> -#include <linux/init.h> -#include <linux/delay.h> -#include <linux/device.h> -#include <linux/netdevice.h> -#include <linux/etherdevice.h> -#include <linux/skbuff.h> -#include <linux/spinlock.h> -#include <linux/mm.h> -#include <linux/module.h> -#include <linux/mii.h> -#include <linux/ethtool.h> -#include <linux/phy.h> -#include <linux/marvell_phy.h> -#include <linux/of_platform.h> -#include <linux/platform_device.h> - -#include <linux/io.h> -#include <asm/irq.h> -#include <net/dsa.h> -#include <linux/uaccess.h> - -#include "gw16083.h" - -#undef FAIL_ON_CHECKSUM_ERR /* fail to configure SFP if checksum bad */ -#define PORT_POWER_CONTROL /* ports can be enabled/disabled via sysfs */ -#define PORT_MODE_CONTROL /* ports 5/6 can have SFP/RJ45 mode forced */ -#define RGMII_DELAY_ON_PHY /* implement Port5/6 tx/rx delay on PHY vs sw */ - -MODULE_DESCRIPTION("GW16083 driver"); -MODULE_AUTHOR("Tim Harvey"); -MODULE_LICENSE("GPL"); - -struct mv88e1111_port_state { - int port; - bool present; - bool serdes; - bool sfp_signal; - bool sfp_present; - bool sfp_compat; - bool sfp_enabled; - char sfp_id[64]; -}; - -struct mv88e1111_priv { - struct phy_device *phydev; - struct i2c_client *client; - struct mv88e1111_port_state port5; - struct mv88e1111_port_state port6; - struct kobject *sysfs_kobj; - struct delayed_work work; - struct workqueue_struct *workq; -}; - -enum { - mode_copper = 0, - mode_serdes = 1, -}; - -#if IS_ENABLED(CONFIG_NET_DSA_MV88E6352) -static struct dsa_chip_data switch_chip_data = { - .port_names = { - "lan4", - "lan3", - "lan2", - "lan1", - "cpu", - "lan5", - "lan6", - }, -}; - -static struct dsa_platform_data switch_plat_data = { - .nr_chips = 1, - .chip = &switch_chip_data, -}; - -static struct platform_device switch_device = { - .name = "dsa", - .id = 0, - .num_resources = 0, - .dev.platform_data = &switch_plat_data, -}; -#endif - -static struct i2c_client *gw16083_client = NULL; - -static int gw16083_read_port_sfp(struct i2c_client *client, - struct mv88e1111_port_state *state); - -/* read switch port register from port0-6 */ -u16 read_switch_port(struct phy_device *pdev, int port, u8 regaddr) -{ - return pdev->bus->read(pdev->bus, MV_BASE + port, regaddr); -} - -/* write switch port register to port0-6 */ -int write_switch_port(struct phy_device *pdev, int port, u8 regaddr, u16 val) -{ - return pdev->bus->write(pdev->bus, MV_BASE + port, regaddr, val); -} - -/* - * read_switch_port_phy - write a register for a specific port on 88E6176 - * The 88E6176 PHY registers must be accessed thorugh the Global2 address - * using the SMI_PHY_COMMAND_REG and SMI_PHY_DATA_REG. - */ -int read_switch_port_phy(struct phy_device *pdev, int port, u8 regaddr) -{ - struct mv88e1111_priv *priv = dev_get_drvdata(&pdev->dev); - u16 reg; - int i; - - dev_dbg(&priv->client->dev, "read_phy: port%d reg=0x%02x\n", port, - regaddr); - reg = SMIBUSY | SMIMODE22 | SMIOP_READ; - reg |= port << DEVADDR; - reg |= regaddr << REGADDR; - pdev->bus->write(pdev->bus, MV_GLOBAL2, MV_SMI_PHY_COMMAND, reg); - for (i = 0; i < 10; i++) { - reg = pdev->bus->read(pdev->bus, MV_GLOBAL2, - MV_SMI_PHY_COMMAND); - if (!(reg & (1<<15))) - break; - mdelay(1); - } - /* timeout */ - if (i == 10) - return 0xffff; - reg = pdev->bus->read(pdev->bus, MV_GLOBAL2, MV_SMI_PHY_DATA); - return reg; -} - -/* - * write_switch_port_phy - write a register for a specific port on 88E6176 - * The 88E6176 PHY registers must be accessed thorugh the Global2 address - * using the SMI_PHY_COMMAND_REG and SMI_PHY_DATA_REG. - */ -int write_switch_port_phy(struct phy_device *pdev, int port, u8 addr, u16 reg) -{ - struct mv88e1111_priv *priv = dev_get_drvdata(&pdev->dev); - int i; - - dev_dbg(&priv->client->dev, "write_phy: port%d reg=0x%02x val=0x%04x\n", - port, addr, reg); - pdev->bus->write(pdev->bus, MV_GLOBAL2, MV_SMI_PHY_DATA, reg); - reg = SMIBUSY | SMIMODE22 | SMIOP_WRITE; - reg |= port << DEVADDR; - reg |= addr << REGADDR; - pdev->bus->write(pdev->bus, MV_GLOBAL2, MV_SMI_PHY_COMMAND, reg); - for (i = 0; i < 10; i++) { - reg = pdev->bus->read(pdev->bus, MV_GLOBAL2, - MV_SMI_PHY_COMMAND); - if (!(reg & (1<<15))) - break; - mdelay(1); - } - /* timeout */ - if (i == 10) - return -ETIMEDOUT; - - return 0; -} - -/* read a scratch register from switch */ -inline u8 read_switch_scratch(struct phy_device *pdev, u8 reg) -{ - pdev->bus->write(pdev->bus, MV_GLOBAL2, MV_SCRATCH_MISC, (reg << 8)); - return pdev->bus->read(pdev->bus, MV_GLOBAL2, MV_SCRATCH_MISC) & 0xff; -} - -/* write a scratch register to switch */ -inline void write_switch_scratch(struct phy_device *pdev, u8 reg, u8 val) -{ - pdev->bus->write(pdev->bus, MV_GLOBAL2, MV_SCRATCH_MISC, - (1 << 15) | (reg << 8) | val); -} - -/* enable or disable an SFP's TXEN signal */ -static int enable_sfp_txen(struct phy_device *pdev, int port, bool enable) -{ - struct mv88e1111_priv *priv = dev_get_drvdata(&pdev->dev); - u8 gpio; - int bit; - - if (port != 5 && port != 6) - return -EINVAL; - - /* GPIO[2:1] output low to enable TXEN */ - bit = (port == 5) ? 1 : 2; - gpio = read_switch_scratch(pdev, MV_GPIO_DATA); - if (enable) - gpio |= (1 << bit); - else - gpio &= (1 << bit); - write_switch_scratch(pdev, MV_GPIO_DATA, gpio); - dev_info(&priv->client->dev, "Port%d: SFP TX %s\n", port, enable ? - "enabled" : "disabled"); - return 0; -} - -/* configure mv88e1111 port for copper or serdes - * For Copper we set auto link/duplex/speed detection - * For SerDes/Fiber we force 1000mbps link up and auto-neg duplex - */ -static int config_mv88e1111_port_sfp(struct phy_device *pdev, int port, - bool sfp) -{ - struct mv88e1111_priv *priv = dev_get_drvdata(&pdev->dev); - u16 reg; - - if (port != 5 && port != 6) - return -EINVAL; - - dev_dbg(&priv->client->dev, "%s: Port%d %s\n", __func__, port, - sfp ? "SFP" : "copper"); - if (sfp) { - enable_sfp_txen(pdev, port, 1); - - /* configure MV88E6176 Physical Control Port Register */ - dev_info(&priv->client->dev, - "Port%d: SFP: force 1000mbps link up " - "(auto-negotiate duplex)\n", - port); - reg = read_switch_port(pdev, port, MV_PORT_PHYS_CONTROL); - reg &= ~0x3f; /* clear 5-0 */ - reg |= (1 << 4) | (1 << 5); /* force link up */ - reg |= 2; /* force 1000mbps */ - write_switch_port(pdev, port, MV_PORT_PHYS_CONTROL, reg); - reg = read_switch_port(pdev, port, MV_PORT_PHYS_CONTROL); - } - - /* copper */ - else { - enable_sfp_txen(pdev, port, 0); - - /* configure MV88E6176 Physical Control Port Register */ - dev_info(&priv->client->dev, - "Port%d: Copper: set auto-neg link/duplex/speed\n", - port); - reg = read_switch_port(pdev, port, MV_PORT_PHYS_CONTROL); - reg &= ~0x3f; /* clear 5-0 */ - reg |= 3; /* speed not forced */ - write_switch_port(pdev, port, MV_PORT_PHYS_CONTROL, reg); - reg = read_switch_port(pdev, port, MV_PORT_PHYS_CONTROL); - } - dev_dbg(&priv->client->dev, "%s: Port%d %s PORT_PHYS_CONTROL=0x%04x\n", - __func__, port, sfp ? "SFP" : "copper", - read_switch_port(pdev, port, MV_PORT_PHYS_CONTROL)); - - return 0; -} - -#if !IS_ENABLED(CONFIG_NET_DSA_MV88E6352) && defined(PORT_POWER_CONTROL) -static int enable_switch_port(struct phy_device *pdev, int port, bool enable) -{ - struct mv88e1111_priv *priv = dev_get_drvdata(&pdev->dev); - u16 reg; - - /* power up port */ - dev_info(&priv->client->dev, "Port%d: %s\n", port, - enable ? "normal operation" : "power down"); - reg = read_switch_port_phy(pdev, port, MV_PHY_CONTROL); - if (enable) - reg &= ~(1 << 11); /* Normal Operation */ - else - reg |= (1 << 11); /* power down */ - write_switch_port_phy(pdev, port, MV_PHY_CONTROL, reg); - - reg = read_switch_port_phy(pdev, port, MV_PHY_CONTROL1); - if (enable) - reg &= ~(1 << 2); /* Normal Operation */ - else - reg |= (1 << 2); /* power down */ - write_switch_port_phy(pdev, port, MV_PHY_CONTROL1, reg); - - return 0; -} -#endif - -/* - * Sysfs API - */ - -struct mv88e1111_port_state *get_port_state(struct mv88e1111_priv *priv, - int port) -{ - if (port == 5) - return &priv->port5; - if (port == 6) - return &priv->port6; - return NULL; -} - -/* - * get MV88E6176 port number for a specific GW16083 port name - * The GW16083 ports as shown on the silkscreen are not mapped according to - * the MV88E6176 ports numbers. - */ -static int gw16083_get_port(const char* name) -{ - int i; - int map[] = { 3, 2, 1, 0, 5, 6 }; - - if (strncasecmp(name, "LAN", 3) != 0) - return -1; - i = name[3] - '0'; - if (i < 1 || i > 6) - return -1; - return map[i-1]; -} - -#if !IS_ENABLED(CONFIG_NET_DSA_MV88E6352) -static ssize_t port_show(struct device *dev, struct device_attribute *attr, - char *buf) -{ - struct mv88e1111_priv *priv = dev_get_drvdata(dev); - int port = -1; - u16 reg; - - if (sscanf(attr->attr.name, "port%d", &port) != 1) - return 0; - if (port < 0 || port > 6) - return 0; - reg = read_switch_port_phy(priv->phydev, port, MV_PHY_CONTROL); - return sprintf(buf, "%s\n", (reg & (1 << 11)) ? "disabled" : "enabled"); -} - -#if defined(PORT_POWER_CONTROL) -static ssize_t port_store(struct device *dev, struct device_attribute *attr, - const char *buf, size_t count) -{ - struct mv88e1111_priv *priv = dev_get_drvdata(dev); - int port = -1; - int val; - - port = gw16083_get_port(attr->attr.name); - if (port < 0) - return 0; - if (sscanf(buf, "%d", &val) != 1) - return 0; - enable_switch_port(priv->phydev, port, val ? 1 : 0); - return count; -} - -static DEVICE_ATTR(lan1, S_IWUSR | S_IRUGO, port_show, port_store); -static DEVICE_ATTR(lan2, S_IWUSR | S_IRUGO, port_show, port_store); -static DEVICE_ATTR(lan3, S_IWUSR | S_IRUGO, port_show, port_store); -static DEVICE_ATTR(lan4, S_IWUSR | S_IRUGO, port_show, port_store); -static DEVICE_ATTR(lan5, S_IWUSR | S_IRUGO, port_show, port_store); -static DEVICE_ATTR(lan6, S_IWUSR | S_IRUGO, port_show, port_store); -#else -static DEVICE_ATTR(lan1, S_IRUGO, port_show, NULL); -static DEVICE_ATTR(lan2, S_IRUGO, port_show, NULL); -static DEVICE_ATTR(lan3, S_IRUGO, port_show, NULL); -static DEVICE_ATTR(lan4, S_IRUGO, port_show, NULL); -static DEVICE_ATTR(lan5, S_IRUGO, port_show, NULL); -static DEVICE_ATTR(lan6, S_IRUGO, port_show, NULL); -#endif -#endif /* #if IS_ENABLED(CONFIG_NET_DSA_MV88E6352) */ - -static ssize_t portmode_show(struct device *dev, struct device_attribute *attr, - char *buf) -{ - struct mv88e1111_priv *priv = dev_get_drvdata(dev); - struct mv88e1111_port_state *state; - - state = get_port_state(priv, gw16083_get_port(attr->attr.name)); - if (!state) - return 0; - - return sprintf(buf, "%s\n", state->serdes ? "SFP" : "RJ45"); -} -#ifdef PORT_MODE_CONTROL -static ssize_t portmode_store(struct device *dev, struct device_attribute *attr, - const char *buf, size_t count) -{ - struct mv88e1111_priv *priv = dev_get_drvdata(dev); - struct mv88e1111_port_state *state; - u16 reg; - int port; - - port = gw16083_get_port(attr->attr.name); - state = get_port_state(priv, port); - if (!state) - return 0; - - reg = read_switch_port_phy(priv->phydev, port, MII_M1111_PHY_EXT_SR); - if (strcasecmp(buf, "auto") == 0) { - reg &= ~(1<<15); /* enable auto-selection */ - dev_info(&priv->client->dev, "Port%d: enable auto-selection\n", - port); - } else if (strcasecmp(buf, "RJ45") == 0) { - reg |= (1<<15); /* disable auto-selection */ - reg |= 0xb; /* RGMII to Copper */ - config_mv88e1111_port_sfp(priv->phydev, port, 0); - dev_info(&priv->client->dev, "Port%d: select RJ45\n", port); - } else if (strcasecmp(buf, "SFP") == 0) { - reg |= (1<<15); /* disable auto-selection */ - reg |= 0x3; /* RGMII to Fiber */ - config_mv88e1111_port_sfp(priv->phydev, port, 1); - dev_info(&priv->client->dev, "Port%d: select SFP\n", port); - } - write_switch_port_phy(priv->phydev, port, MII_M1111_PHY_EXT_SR, reg); - - return count; -} - -static DEVICE_ATTR(lan5_mode, S_IWUSR | S_IRUGO, portmode_show, portmode_store); -static DEVICE_ATTR(lan6_mode, S_IWUSR | S_IRUGO, portmode_show, portmode_store); -#else -static DEVICE_ATTR(lan5_mode, S_IRUGO, portmode_show, NULL); -static DEVICE_ATTR(lan6_mode, S_IRUGO, portmode_show, NULL); -#endif - -static ssize_t portsfp_show(struct device *dev, struct device_attribute *attr, - char *buf) -{ - struct mv88e1111_priv *priv = dev_get_drvdata(dev); - struct mv88e1111_port_state *state; - - state = get_port_state(priv, gw16083_get_port(attr->attr.name)); - if (!state) - return 0; - - if (!state->sfp_present) - return 0; - - return sprintf(buf, "%s\n", state->sfp_id); -} - -static DEVICE_ATTR(lan5_sfp, S_IRUGO, portsfp_show, NULL); -static DEVICE_ATTR(lan6_sfp, S_IRUGO, portsfp_show, NULL); - -/* - * PHY driver - */ - -/* check MV88E1111 PHY status and MV88E6176 GPIO */ -static void -mv88e6176_work(struct work_struct *work) -{ - struct mv88e1111_priv *priv = - container_of(work, struct mv88e1111_priv, work.work); - struct phy_device *pdev = priv->phydev; - struct device *dev = &priv->client->dev; - struct mv88e1111_port_state *state; - bool serdes, sfp_present, sfp_signal; - int port; - u16 gpio; - - mutex_lock(&pdev->lock); - gpio = read_switch_scratch(pdev, MV_GPIO_DATA); - for (port = 5; port < 7; port++) { - serdes = (read_switch_port_phy(pdev, port, MII_M1111_PHY_EXT_SR) - & (1<<13)) ? 1 : 0; - dev_dbg(dev, "%s: Port%d GPIO:0x%02x SerDes:%d\n", - __func__, port, gpio, serdes); - switch(port) { - case 5: - state = &priv->port5; - sfp_present = !((gpio >> 5) & 1); - sfp_signal = !((gpio >> 6) & 1); - break; - case 6: - state = &priv->port6; - sfp_present = !((gpio >> 3) & 1); - sfp_signal = !((gpio >> 4) & 1); - break; - } - - /* - * on sfp_detect read/verify SFP MSA and set sfp_compat - * on sfp_signal issue link down? - * on serdes auto-select - */ - if (state->sfp_present != sfp_present) { - state->sfp_present = sfp_present; - dev_info(dev, "Port%d: SFP %s\n", - port, sfp_present ? "inserted" : "removed"); - if (state->sfp_present) { - if (gw16083_read_port_sfp(priv->client, state)) - state->sfp_compat = false; - else - state->sfp_compat = true; - /* trigger a re-select/enable below */ - state->serdes = !serdes; - pdev->state = PHY_RUNNING; - } else { - state->sfp_compat = false; - state->sfp_enabled = false; - pdev->state = PHY_NOLINK; - } - } - if (state->sfp_signal != sfp_signal) { - state->sfp_signal = sfp_signal; - dev_info(dev, "Port%d: SFP signal %s\n", - port, sfp_signal ? "detected" : "lost"); - } - if (state->serdes != serdes) { - state->serdes = serdes; - dev_info(dev, "Port%d: %s auto-selected\n", - port, serdes ? "SERDES" : "copper"); - - /* - * if auto-selection has switched to copper - * disable serdes - */ - if (!serdes) { - config_mv88e1111_port_sfp(pdev, port, 0); - state->sfp_enabled = false; - } - } - - /* if compatible SFP module and not yet enabled then enable */ - if (state->sfp_compat && state->sfp_signal && - !state->sfp_enabled) - { - if (!config_mv88e1111_port_sfp(pdev, port, 1)) - state->sfp_enabled = true; - } - } - mutex_unlock(&pdev->lock); - - queue_delayed_work(priv->workq, &priv->work, HZ); -} - -static int -mv88e6176_read_status(struct phy_device *pdev) -{ - return 0; -} - -static int -mv88e6176_config_aneg(struct phy_device *pdev) -{ - return 0; -} - -static int -mv88e6176_config_init(struct phy_device *pdev) -{ - pdev->state = PHY_RUNNING; - - return 0; -} - -static void -mv88e6176_remove(struct phy_device *pdev) -{ - struct mv88e1111_priv *priv = dev_get_drvdata(&pdev->dev); - - dev_dbg(&priv->client->dev, "%s", __func__); - - destroy_workqueue(priv->workq); -#if !IS_ENABLED(CONFIG_NET_DSA_MV88E6352) - device_remove_file(&pdev->dev, &dev_attr_lan1); - device_remove_file(&pdev->dev, &dev_attr_lan2); - device_remove_file(&pdev->dev, &dev_attr_lan3); - device_remove_file(&pdev->dev, &dev_attr_lan4); - device_remove_file(&pdev->dev, &dev_attr_lan5); - device_remove_file(&pdev->dev, &dev_attr_lan6); -#endif - device_remove_file(&pdev->dev, &dev_attr_lan5_sfp); - device_remove_file(&pdev->dev, &dev_attr_lan6_sfp); - device_remove_file(&pdev->dev, &dev_attr_lan5_mode); - device_remove_file(&pdev->dev, &dev_attr_lan6_mode); - sysfs_remove_link(kernel_kobj, "gw16083"); -} - -/* - * mv88e6176_probe - called any time an MV88E6176 is found on an mdio bus - * Determine if this MV88E6176 is indeed on a GW16083 and if so configure - * the port5/port6 phy and register a background procedure for monitoring - * their states to support SFP vs Copper switching. - * - * Verify this is a GW16083 by ensuring: - * - the phy address matches that of a GW16083 - * - the mdio bus is from an i210 device (igb driver) - * - there are MV881111 PHY's hanging off of Port5 and Port6 - */ -static int -mv88e6176_probe(struct phy_device *pdev) -{ - int port; - int ret = 0; - u32 id, reg; - struct mv88e1111_priv *priv; - struct device *dev; -#if IS_ENABLED(CONFIG_NET_DSA_MV88E6352) - struct net_device *netdev = NULL; -#endif - - dev_dbg(&pdev->dev, "%s: addr=0x%02x bus=%s:%s gw16083_client=%p\n", - __func__, pdev->addr, pdev->bus->name, pdev->bus->id, - gw16083_client); - - /* In single-chip addressing mode the MV88E6176 shows up on 0x10-0x16 */ - if (pdev->addr != MV_BASE) - return 0; - - /* i2c driver needs to be loaded first */ - if (!gw16083_client) - return 0; - dev = &gw16083_client->dev; - - /* gw16083 has MV88E1676 hanging off of i210 mdio bus */ - if (strcmp(pdev->bus->name, "igb_enet_mii_bus") != 0) - return 0; - - /* verify Port5/Port6 have an MV88E1111 PHY hanging off them */ - for (port = 5; port < 7; port++) { - id = read_switch_port_phy(pdev, port, - MII_M1111_PHY_IDENT0) << 16; - id |= read_switch_port_phy(pdev, port, MII_M1111_PHY_IDENT1); - if ((id & MII_M1111_PHY_ID_MASK) != MII_M1111_PHY_ID) { - dev_err(dev, "Port%d: No MV88E1111 PHY detected", port); - return 0; - } - } - -#if IS_ENABLED(CONFIG_NET_DSA_MV88E6352) - /* - * Find the netdev this bus is hanging off of and register with DSA: - * The netdev must be an Intel I210 (igb) with Gateworks MAC addr - */ - read_lock(&dev_base_lock); - for_each_netdev(&init_net, netdev) { - if (netdev->dev.parent && - !strcmp(netdev->dev.parent->driver->name, "igb") && - (netdev->perm_addr[0] == 0x00) && - (netdev->perm_addr[1] == 0xd0) && - (netdev->perm_addr[2] == 0x12)) - { - switch_plat_data.netdev = &netdev->dev; - switch_plat_data.chip[0].host_dev = &pdev->bus->dev; - break; - } - } - read_unlock(&dev_base_lock); - - if (switch_plat_data.netdev) { - platform_device_register(&switch_device); - dev_info(dev, "registered GW16083 DSA switch\n"); - } else { - dev_err(dev, "failed to find netdev for DSA switch\n"); - } -#endif - - /* - * port5/6 config: MV88E1111 PHY - * Register 20: PHY Control Register - * R20_7: add delay to RX_CLK for RXD - * R20_1: add delay to TX_CLK for TXD - * Register 24: LED Control Register - * 0x4111: - * Pulse stretch 170 to 340 ms - * Register 0: Control Register - * R0_15: phy reset - */ - dev_info(dev, "Configuring MV88E6176 7-port switch"); - for (port = 5; port < 7; port++) { -#ifdef RGMII_DELAY_ON_PHY - /* phy rx/tx delay */ - reg = read_switch_port_phy(pdev, port, MII_M1111_PHY_EXT_CR); - reg |= (1<<1) | (1<<7); - write_switch_port_phy(pdev, port, MII_M1111_PHY_EXT_CR, reg); -#else - write_switch_port(pdev, port, MV_PORT_PHYS_CONTROL, 0xC003); -#endif - - /* led config */ - write_switch_port_phy(pdev, port, MII_M1111_PHY_LED_CONTROL, - MII_M1111_PHY_LED_PULSE_STR); - /* reset phy */ - reg = read_switch_port_phy(pdev, port, MII_M1111_PHY_CONTROL); - reg |= MII_M1111_PHY_CONTROL_RESET; - write_switch_port_phy(pdev, port, MII_M1111_PHY_CONTROL, reg); - dev_info(dev, "Port%d: MV88E111 PHY configured\n", port); - } - - /* - * GPIO Configuration: - * GPIO1: FIB5_TXEN# (output) - * GPIO2: FIB6_TXEN# (output) - * GPIO3: FIB6_PRES# (input) - * GPIO4: FIB6_LOS (input) - * GPIO5: FIB5_PRES# (input) - * GPIO6: FIB5_LOS (input) - */ - write_switch_scratch(pdev, MV_GPIO_DATA, 0x06); /* GPIO[2:1] out hi */ - write_switch_scratch(pdev, MV_GPIO_DIR, 0x78); /* GPIO[6:3] inp */ - - pdev->irq = PHY_POLL; - - priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); - if (!priv) - return -ENOMEM; - memset(priv, 0, sizeof(*priv)); - priv->phydev = pdev; - priv->client = gw16083_client; - priv->port5.port = 5; - priv->port6.port = 6; - dev_set_drvdata(&pdev->dev, priv); - - /* register sysfs API */ -#if !IS_ENABLED(CONFIG_NET_DSA_MV88E6352) - ret |= device_create_file(&pdev->dev, &dev_attr_lan1); - ret |= device_create_file(&pdev->dev, &dev_attr_lan2); - ret |= device_create_file(&pdev->dev, &dev_attr_lan3); - ret |= device_create_file(&pdev->dev, &dev_attr_lan4); - ret |= device_create_file(&pdev->dev, &dev_attr_lan5); - ret |= device_create_file(&pdev->dev, &dev_attr_lan6); -#endif - ret |= device_create_file(&pdev->dev, &dev_attr_lan5_sfp); - ret |= device_create_file(&pdev->dev, &dev_attr_lan6_sfp); - ret |= device_create_file(&pdev->dev, &dev_attr_lan5_mode); - ret |= device_create_file(&pdev->dev, &dev_attr_lan6_mode); - - if (unlikely(ret)) - dev_err(&pdev->dev, "Failed creating attrs\n"); - - /* Add a nice symlink to the real device */ - ret = sysfs_create_link(kernel_kobj, &pdev->dev.kobj, "gw16083"); - - INIT_DELAYED_WORK(&priv->work, mv88e6176_work); - priv->workq = create_singlethread_workqueue("gw16083"); - if (!priv->workq) - return -ENODEV; - queue_delayed_work(priv->workq, &priv->work, 0); - - dev_dbg(dev, "initial state: GPIO=0x%02x " - "Port5_serdes=%d Port6_serdes=%d\n", - read_switch_scratch(pdev, MV_GPIO_DATA), - (read_switch_port_phy(pdev, 5, MII_M1111_PHY_EXT_SR) - & (1<<13) ? 1:0), - (read_switch_port_phy(pdev, 6, MII_M1111_PHY_EXT_SR) - & (1<<13) ? 1:0)); - - return ret; -} - -static struct phy_driver mv88e6176_phy_driver = { - .name = "gw16083", - .phy_id = MV_IDENT_VALUE, - .phy_id_mask = MV_IDENT_MASK, - .features = PHY_BASIC_FEATURES, - .probe = &mv88e6176_probe, - .remove = &mv88e6176_remove, - .config_init = &mv88e6176_config_init, - .config_aneg = &mv88e6176_config_aneg, - .read_status = &mv88e6176_read_status, - .driver = { .owner = THIS_MODULE }, -}; - -/* - * I2C driver - */ - -/* See SFF-8472 */ -struct sfp_msa { - /* Basic ID fields */ - u8 identifier; - u8 ext_identifier; - u8 connector; - u8 transceiver[8]; - u8 encoding; - u8 br_nominal; - u8 rate_identifier; - u8 length_smf_km; - u8 length_smf; - u8 length_om2; - u8 length_om1; - u8 length_om4; - u8 length_om3; - u8 vendor_name[16]; - u8 transceiver2; - u8 vendor_oui[3]; - u8 vendor_pn[16]; - u8 vendor_rev[4]; - u8 wavelength[2]; - u8 resv1; - u8 cc_base; - - /* extended id fields */ - u8 options[2]; - u8 br_max; - u8 br_min; - u8 vendor_sn[16]; - u8 date_code[8]; - u8 diags_type; - u8 enhanced_options; - u8 sff8472_compliance; - u8 cc_ext; - - /* Vendor specific ID fields */ - u8 vendor_data[32]; - u8 sff8079[128]; -}; - -enum identifier { - UNKNOWN, - GBIC, - SFF, - SFP, - XBI, - XENPACK, - XFP, - XFF, - XFP_E, - XPAK, - X2, - DWDM_SFP, - QSFP, - MAX_ID, -}; - -const char* id_names[] = { - "UNKONWN", - "GBIC", - "SFF", - "SFP", - NULL, -}; - -/* Flags for SFP modules compatible with ETH up to 1Gb */ -struct sfp_flags { - u8 e1000_base_sx:1; - u8 e1000_base_lx:1; - u8 e1000_base_cx:1; - u8 e1000_base_t:1; - u8 e100_base_lx:1; - u8 e100_base_fx:1; - u8 e10_base_bx10:1; - u8 e10_base_px:1; -}; - -#define STRING_APPEND(str, src) \ - strncat(str, src, sizeof(src)); \ - for (i = 1; i < sizeof(str); i++) \ - if (str[i-1] == ' ' && str[i] == ' ') \ - str[i] = 0; - -static int gw16083_read_port_sfp(struct i2c_client *client, - struct mv88e1111_port_state *state) -{ - int ret = 0; - u8 data[256]; - struct sfp_flags *eth_flags; - u8 crc; - int i; - u8 *str; - struct sfp_msa *sfp_msa = (struct sfp_msa *)data; - int port = state->port; - union i2c_smbus_data d; - - dev_dbg(&client->dev, "%s Port%d\n", __func__, port); - if (!i2c_check_functionality(client->adapter, - I2C_FUNC_SMBUS_READ_I2C_BLOCK)) - return -ENODEV; - d.byte = (port == 5) ? 1 : 2; - if (i2c_smbus_xfer(client->adapter, GW16083_I2C_ADDR_PCA9543, - client->flags, I2C_SMBUS_WRITE, 0, - I2C_SMBUS_BYTE_DATA, &d) < 0) - { - dev_err(&client->dev, - "Port%d: failed writing PCA9543 register\n", port); - return ret; - } - - /* read all 256 bytes of SFP EEPROM */ - for (i = 0; i < sizeof(data); i += I2C_SMBUS_BLOCK_MAX) { - d.block[0] = I2C_SMBUS_BLOCK_MAX; - if (i2c_smbus_xfer(client->adapter, GW16083_I2C_ADDR_SFP1, - client->flags, I2C_SMBUS_READ, i, - I2C_SMBUS_I2C_BLOCK_DATA, &d) < 0) - { - dev_err(&client->dev, - "Port%d: failed reading SFP data\n", port); - return ret; - } - memcpy(data + i, d.block + 1, I2C_SMBUS_BLOCK_MAX); - } - - /* Validate checksums */ - for (crc = 0, i = 0; i < 63; i++) - crc += data[i]; - if (crc != sfp_msa->cc_base) { - dev_err(&client->dev, "Port%d: " - "Checksum failure for Base ID fields: 0x%02x\n", port, - crc); -#ifdef FAIL_ON_CHECKSUM_ERR - return -EINVAL; -#endif - } - for (crc = 0, i = 64; i < 95; i++) - crc += data[i]; - if (crc != sfp_msa->cc_ext) { - dev_err(&client->dev, "Port%d: " - "Checksum failure for Extended ID fields: 0x%02x\n", - port, crc); -#ifdef FAIL_ON_CHECKSUM_ERR - return -EINVAL; -#endif - } - state->sfp_id[0] = 0; - for (i = 0; id_names[i]; i++) { - if (sfp_msa->identifier == i) { - sprintf(state->sfp_id, "%s: ", id_names[i]); - break; - } - } - STRING_APPEND(state->sfp_id, sfp_msa->vendor_oui); - STRING_APPEND(state->sfp_id, sfp_msa->vendor_name); - STRING_APPEND(state->sfp_id, sfp_msa->vendor_pn); - STRING_APPEND(state->sfp_id, sfp_msa->vendor_rev); - STRING_APPEND(state->sfp_id, sfp_msa->vendor_sn); - dev_info(&client->dev, "Port%d: %s\n", port, state->sfp_id); - - if ((sfp_msa->identifier != GBIC) && - (sfp_msa->identifier != SFF) && - (sfp_msa->identifier != SFP)) - { - dev_err(&client->dev, "Port%d: Unknown module identifier: %d\n", - port, sfp_msa->identifier); - return -EINVAL; - } - - str = ""; - eth_flags = (struct sfp_flags *)(sfp_msa->transceiver + 3); - if (eth_flags->e1000_base_sx) { - str = "1000Base-SX (Fiber)"; - } else if (eth_flags->e1000_base_lx) { - str = "1000Base-LX (Fiber)"; - } else if (eth_flags->e1000_base_t) { - str = "1000Base-T (Copper)"; - } else if (eth_flags->e100_base_fx) { - str = "100Base-FX (Fiber) - not supported"; - ret = -EINVAL; - } else { - str = "Unknown/Unsupported media type"; - ret = -EINVAL; - } - if (ret) - dev_err(&client->dev, "Port%d: %s (0x%02x)\n", port, str, - sfp_msa->transceiver[3]); - else - dev_info(&client->dev, "Port%d: %s (0x%02x)\n", port, str, - sfp_msa->transceiver[3]); - - return ret; -} - -static int gw16083_probe(struct i2c_client *client, - const struct i2c_device_id *id) -{ - int ret; - - dev_info(&client->dev, "GW16083 Ethernet Expansion Mezzanine\n"); - if (gw16083_client) { - dev_err(&client->dev, "client already registered\n"); - return -EINVAL; - } - gw16083_client = client; - - ret = phy_driver_register(&mv88e6176_phy_driver); - if (ret) - dev_err(&client->dev, - "failed to register mv88e6176 phy driver: %d\n", ret); - return ret; -} - -static int gw16083_remove(struct i2c_client *client) -{ - dev_dbg(&client->dev, "%s\n", __func__); - - phy_driver_unregister(&mv88e6176_phy_driver); - gw16083_client = NULL; - return 0; -} - -static const struct of_device_id gw16083_dt_ids[] = { - { .compatible = "gateworks,gw16083", }, - { } -}; - -MODULE_DEVICE_TABLE(of, gw16083_dt_ids); - -static const struct i2c_device_id gw16083_id[] = { - { "gw16083", 0 }, - { } -}; -MODULE_DEVICE_TABLE(i2c, gw16083_id); - -static struct i2c_driver gw16083_driver = { - .driver = { - .name = "gw16083", - .of_match_table = gw16083_dt_ids, - }, - .probe = gw16083_probe, - .remove = gw16083_remove, - .id_table = gw16083_id, -}; - -static int __init mv88e6176_init(void) -{ - return i2c_add_driver(&gw16083_driver); -} - -static void __exit mv88e6176_exit(void) -{ - i2c_del_driver(&gw16083_driver); -} - -module_init(mv88e6176_init); -module_exit(mv88e6176_exit); diff --git a/target/linux/imx6/files-4.3/drivers/net/phy/gw16083.h b/target/linux/imx6/files-4.3/drivers/net/phy/gw16083.h deleted file mode 100644 index db96f2b7b3..0000000000 --- a/target/linux/imx6/files-4.3/drivers/net/phy/gw16083.h +++ /dev/null @@ -1,123 +0,0 @@ -/* - * drivers/net/phy/mv88e6176.h - * - * Driver for Marvell Switch - * - * Author: Tim Harvey - * - * Copyright (c) 2014 Tim Harvey <tharvey@gateworks.com> - * - * 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. - * - */ - -#ifndef _GW16083_H_ -#define _GW16083_H_ - -#define MII_MARVELL_PHY_PAGE 22 - -/* - * I2C Addresses - */ -#define GW16083_I2C_ADDR_SFP1 0x50 -#define GW16083_I2C_ADDR_SFP2 0x51 -#define GW16083_I2C_ADDR_EEPROM 0x52 -#define GW16083_I2C_ADDR_PCA9543 0x70 - -/* - * MV88E1111 PHY Registers - */ -enum { - MII_M1111_PHY_CONTROL = 0, - MII_M1111_PHY_STATUS = 1, - MII_M1111_PHY_IDENT0 = 2, - MII_M1111_PHY_IDENT1 = 3, - MII_M1111_PHY_EXT_CR = 20, - MII_M1111_PHY_LED_CONTROL = 24, - MII_M1111_PHY_EXT_SR = 27, -}; - -#define MII_M1111_PHY_ID_MASK 0xfffffff0 -#define MII_M1111_PHY_ID 0x01410cc0 - -#define MII_M1111_PHY_CONTROL_RESET (1 << 15) -#define MII_M1111_PHY_LED_DIRECT 0x4100 -#define MII_M1111_PHY_LED_PULSE_STR 0x4111 -#define MII_M1111_PHY_LED_COMBINE 0x411c -#define MII_M1111_RX_DELAY 0x80 -#define MII_M1111_TX_DELAY 0x2 - -/* - * MV88E6176 Switch Registers - */ - -/* PHY Addrs */ -#define MV_BASE 0x10 -#define MV_GLOBAL1 0x1b -#define MV_GLOBAL2 0x1c -#define MV_GLOBAL3 0x1d - -/* Global2 Registers */ -enum { - MV_SMI_PHY_COMMAND = 0x18, - MV_SMI_PHY_DATA = 0x19, - MV_SCRATCH_MISC = 0x1A, -}; - -/* Scratch And Misc Reg offsets */ -enum { - MV_GPIO_MODE = 0x60, - MV_GPIO_DIR = 0x62, - MV_GPIO_DATA = 0x64, - MV_GPIO76_CNTL = 0x6B, - MV_GPIO54_CNTL = 0x6A, - MV_GPIO32_CNTL = 0x69, - MV_GPIO10_CNTL = 0x68, - MV_CONFIG0 = 0x70, - MV_CONFIG1 = 0x71, - MV_CONFIG2 = 0x72, - MV_CONFIG3 = 0x73, -}; - -/* PHY Registers */ -enum { - MV_PHY_CONTROL = 0x00, - MV_PHY_STATUS = 0x01, - MV_PHY_IDENT0 = 0x02, - MV_PHY_IDENT1 = 0x03, - MV_PHY_ANEG = 0x04, - MV_PHY_LINK_ABILITY = 0x05, - MV_PHY_ANEG_EXPAND = 0x06, - MV_PHY_XMIT_NEXTP = 0x07, - MV_PHY_LINK_NEXTP = 0x08, - MV_PHY_CONTROL1 = 0x10, - MV_PHY_STATUS1 = 0x11, - MV_PHY_INTR_EN = 0x12, -}; - -/* Port Registers */ -enum { - MV_PORT_STATUS = 0x00, - MV_PORT_PHYS_CONTROL = 0x01, - MV_PORT_IDENT = 0x03, - MV_PORT_CONTROL = 0x04, - MV_PORT_VLANMAP = 0x06, - MV_PORT_ASSOC = 0x0b, - MV_PORT_RXCOUNT = 0x10, - MV_PORT_TXCOUNT = 0x11, -}; - -#define SMIBUSY (1<<15) -#define SMIMODE22 (1<<12) -#define SMIOP_READ (2<<10) -#define SMIOP_WRITE (1<<10) -#define DEVADDR 5 -#define REGADDR 0 - -#define MV_IDENT_MASK 0x0000fff0 -#define MV_IDENT_VALUE 0x00001760 - -#endif /* _GW16083_H_ */ |