|
|
@@ -1,950 +0,0 @@
|
|
|
-/*
|
|
|
- * drivers/net/phy/gw16083.c
|
|
|
- *
|
|
|
- * Driver for GW16083 Ventana Ethernet Expansion Mezzanine
|
|
|
- *
|
|
|
- * Author: Tim Harvey
|
|
|
- *
|
|
|
- * Copyright (c) 2014 Tim Harvey <[email protected]>
|
|
|
- *
|
|
|
- * 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/io.h>
|
|
|
-#include <asm/irq.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 */
|
|
|
-
|
|
|
-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;
|
|
|
-};
|
|
|
-
|
|
|
-enum {
|
|
|
- mode_copper = 0,
|
|
|
- mode_serdes = 1,
|
|
|
-};
|
|
|
-
|
|
|
-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)
|
|
|
-{
|
|
|
- u16 reg;
|
|
|
- int i;
|
|
|
-
|
|
|
- dev_dbg(&pdev->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)
|
|
|
-{
|
|
|
- int i;
|
|
|
-
|
|
|
- dev_dbg(&pdev->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)
|
|
|
-{
|
|
|
- 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(&pdev->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)
|
|
|
-{
|
|
|
- u16 reg;
|
|
|
-
|
|
|
- if (port != 5 && port != 6)
|
|
|
- return -EINVAL;
|
|
|
-
|
|
|
- dev_dbg(&pdev->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(&pdev->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(&pdev->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(&pdev->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 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, "ETHERNET", 8) != 0 || strlen(name) != 9)
|
|
|
- return -1;
|
|
|
- i = name[8] - '0';
|
|
|
- if (i < 1 || i > 6)
|
|
|
- return -1;
|
|
|
- return map[i-1];
|
|
|
-}
|
|
|
-
|
|
|
-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(ethernet1, S_IWUSR | S_IRUGO, port_show, port_store);
|
|
|
-static DEVICE_ATTR(ethernet2, S_IWUSR | S_IRUGO, port_show, port_store);
|
|
|
-static DEVICE_ATTR(ethernet3, S_IWUSR | S_IRUGO, port_show, port_store);
|
|
|
-static DEVICE_ATTR(ethernet4, S_IWUSR | S_IRUGO, port_show, port_store);
|
|
|
-static DEVICE_ATTR(ethernet5, S_IWUSR | S_IRUGO, port_show, port_store);
|
|
|
-static DEVICE_ATTR(ethernet6, S_IWUSR | S_IRUGO, port_show, port_store);
|
|
|
-#else
|
|
|
-static DEVICE_ATTR(ethernet1, S_IRUGO, port_show, NULL);
|
|
|
-static DEVICE_ATTR(ethernet2, S_IRUGO, port_show, NULL);
|
|
|
-static DEVICE_ATTR(ethernet3, S_IRUGO, port_show, NULL);
|
|
|
-static DEVICE_ATTR(ethernet4, S_IRUGO, port_show, NULL);
|
|
|
-static DEVICE_ATTR(ethernet5, S_IRUGO, port_show, NULL);
|
|
|
-static DEVICE_ATTR(ethernet6, S_IRUGO, port_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 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");
|
|
|
-}
|
|
|
-static DEVICE_ATTR(ethernet5_sfp, S_IRUGO, portsfp_show, NULL);
|
|
|
-static DEVICE_ATTR(ethernet6_sfp, S_IRUGO, portsfp_show, NULL);
|
|
|
-
|
|
|
-#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(ethernet5_mode, S_IWUSR | S_IRUGO, portmode_show,
|
|
|
- portmode_store);
|
|
|
-static DEVICE_ATTR(ethernet6_mode, S_IWUSR | S_IRUGO, portmode_show,
|
|
|
- portmode_store);
|
|
|
-#else
|
|
|
-static DEVICE_ATTR(ethernet5_mode, S_IRUGO, portmode_show, NULL);
|
|
|
-static DEVICE_ATTR(ethernet6_mode, S_IRUGO, portmode_show, NULL);
|
|
|
-#endif
|
|
|
-
|
|
|
-
|
|
|
-/*
|
|
|
- * PHY driver
|
|
|
- */
|
|
|
-
|
|
|
-static int
|
|
|
-mv88e6176_config_init(struct phy_device *pdev)
|
|
|
-{
|
|
|
- dev_dbg(&pdev->dev, "%s\n", __func__);
|
|
|
- pdev->state = PHY_RUNNING;
|
|
|
-
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-/* check MV88E1111 PHY status and MV88E6176 GPIO */
|
|
|
-static int
|
|
|
-mv88e6176_read_status(struct phy_device *pdev)
|
|
|
-{
|
|
|
- struct mv88e1111_priv *priv = dev_get_drvdata(&pdev->dev);
|
|
|
- struct mv88e1111_port_state *state;
|
|
|
- bool serdes, sfp_present, sfp_signal;
|
|
|
- int port;
|
|
|
- int ret = 0;
|
|
|
- u16 gpio;
|
|
|
-
|
|
|
- dev_dbg(&pdev->dev, "%s", __func__);
|
|
|
- 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(&pdev->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(&pdev->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(&pdev->dev, "Port%d: SFP signal %s\n",
|
|
|
- port, sfp_signal ? "detected" : "lost");
|
|
|
- }
|
|
|
- if (state->serdes != serdes) {
|
|
|
- state->serdes = serdes;
|
|
|
- dev_info(&pdev->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;
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- return ret;
|
|
|
-}
|
|
|
-
|
|
|
-static int
|
|
|
-mv88e6176_config_aneg(struct phy_device *pdev)
|
|
|
-{
|
|
|
- dev_dbg(&pdev->dev, "%s", __func__);
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-static void
|
|
|
-mv88e6176_remove(struct phy_device *pdev)
|
|
|
-{
|
|
|
- dev_dbg(&pdev->dev, "%s", __func__);
|
|
|
-
|
|
|
- device_remove_file(&pdev->dev, &dev_attr_ethernet1);
|
|
|
- device_remove_file(&pdev->dev, &dev_attr_ethernet2);
|
|
|
- device_remove_file(&pdev->dev, &dev_attr_ethernet3);
|
|
|
- device_remove_file(&pdev->dev, &dev_attr_ethernet4);
|
|
|
- device_remove_file(&pdev->dev, &dev_attr_ethernet5);
|
|
|
- device_remove_file(&pdev->dev, &dev_attr_ethernet6);
|
|
|
- device_remove_file(&pdev->dev, &dev_attr_ethernet5_sfp);
|
|
|
- device_remove_file(&pdev->dev, &dev_attr_ethernet6_sfp);
|
|
|
- device_remove_file(&pdev->dev, &dev_attr_ethernet5_mode);
|
|
|
- device_remove_file(&pdev->dev, &dev_attr_ethernet6_mode);
|
|
|
- sysfs_remove_link(kernel_kobj, "gw16083");
|
|
|
-}
|
|
|
-
|
|
|
-static int
|
|
|
-mv88e6176_probe(struct phy_device *pdev)
|
|
|
-{
|
|
|
- int port;
|
|
|
- int ret = 0;
|
|
|
- u32 id, reg;
|
|
|
- struct mv88e1111_priv *priv;
|
|
|
-
|
|
|
- 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;
|
|
|
-
|
|
|
- /* gw16083 has MV88E1676 hanging off of i210 mdio bus */
|
|
|
- if (strcmp(pdev->bus->name, "igb_enet_mii_bus") != 0)
|
|
|
- return 0;
|
|
|
-
|
|
|
- //dev_info(&pdev->dev, "Detected");
|
|
|
- dev_info(&gw16083_client->dev, "%s: MV88E6176 7-port switch detected",
|
|
|
- pdev->bus->id);
|
|
|
-
|
|
|
- /*
|
|
|
- * 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
|
|
|
- */
|
|
|
- for (port = 5; port < 7; port++) {
|
|
|
-#ifndef RGMII_DELAY_ON_PHY
|
|
|
- write_switch_port(pdev, port, MV_PORT_PHYS_CONTROL, 0xC003);
|
|
|
-#endif
|
|
|
-
|
|
|
- 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(&gw16083_client->dev,
|
|
|
- "Port%d: No MV88E1111 PHY detected", port);
|
|
|
- return 0;
|
|
|
- //continue;
|
|
|
- }
|
|
|
-
|
|
|
-#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);
|
|
|
-#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(&gw16083_client->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);
|
|
|
-
|
|
|
- ret |= device_create_file(&pdev->dev, &dev_attr_ethernet1);
|
|
|
- ret |= device_create_file(&pdev->dev, &dev_attr_ethernet2);
|
|
|
- ret |= device_create_file(&pdev->dev, &dev_attr_ethernet3);
|
|
|
- ret |= device_create_file(&pdev->dev, &dev_attr_ethernet4);
|
|
|
- ret |= device_create_file(&pdev->dev, &dev_attr_ethernet5);
|
|
|
- ret |= device_create_file(&pdev->dev, &dev_attr_ethernet6);
|
|
|
- ret |= device_create_file(&pdev->dev, &dev_attr_ethernet5_sfp);
|
|
|
- ret |= device_create_file(&pdev->dev, &dev_attr_ethernet6_sfp);
|
|
|
- ret |= device_create_file(&pdev->dev, &dev_attr_ethernet5_mode);
|
|
|
- ret |= device_create_file(&pdev->dev, &dev_attr_ethernet6_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");
|
|
|
-
|
|
|
- dev_dbg(&pdev->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 = "MV88E6176",
|
|
|
- .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);
|
Luka Perkov