target/linux/ixp4xx/patches-4.4/207-npe_driver_multiphy_support.patch

   1 TODO: take care of additional PHYs through the PHY abstraction layer
   2
   3 --- a/arch/arm/mach-ixp4xx/include/mach/platform.h
   4 +++ b/arch/arm/mach-ixp4xx/include/mach/platform.h
   5 @@ -95,12 +95,23 @@ struct ixp4xx_pata_data {
   6  #define IXP4XX_ETH_NPEB                0x10
   7  #define IXP4XX_ETH_NPEC                0x20
   8
   9 +#define IXP4XX_ETH_PHY_MAX_ADDR        32
  10 +
  11  /* Information about built-in Ethernet MAC interfaces */
  12  struct eth_plat_info {
  13         u8 phy;         /* MII PHY ID, 0 - 31 */
  14         u8 rxq;         /* configurable, currently 0 - 31 only */
  15         u8 txreadyq;
  16         u8 hwaddr[6];
  17 +
  18 +       u32 phy_mask;
  19 +#if 0
  20 +       int speed;
  21 +       int duplex;
  22 +#else
  23 +       int speed_10;
  24 +       int half_duplex;
  25 +#endif
  26  };
  27
  28  /* Information about built-in HSS (synchronous serial) interfaces */
  29 --- a/drivers/net/ethernet/xscale/ixp4xx_eth.c
  30 +++ b/drivers/net/ethernet/xscale/ixp4xx_eth.c
  31 @@ -610,6 +610,37 @@ static int ixp4xx_phy_connect(struct net
  32         struct eth_plat_info *plat = port->plat;
  33         char phy_id[MII_BUS_ID_SIZE + 3];
  34
  35 +       if (plat->phy == IXP4XX_ETH_PHY_MAX_ADDR) {
  36 +#if 0
  37 +               switch (plat->speed) {
  38 +               case SPEED_10:
  39 +               case SPEED_100:
  40 +                       break;
  41 +               default:
  42 +                       printk(KERN_ERR "%s: invalid speed (%d)\n",
  43 +                                       dev->name, plat->speed);
  44 +                       return -EINVAL;
  45 +               }
  46 +
  47 +               switch (plat->duplex) {
  48 +               case DUPLEX_HALF:
  49 +               case DUPLEX_FULL:
  50 +                       break;
  51 +               default:
  52 +                       printk(KERN_ERR "%s: invalid duplex mode (%d)\n",
  53 +                                       dev->name, plat->duplex);
  54 +                       return -EINVAL;
  55 +               }
  56 +               port->speed = plat->speed;
  57 +               port->duplex = plat->duplex;
  58 +#else
  59 +               port->speed = plat->speed_10 ? SPEED_10 : SPEED_100;
  60 +               port->duplex = plat->half_duplex ? DUPLEX_HALF : DUPLEX_FULL;
  61 +#endif
  62 +
  63 +               return 0;
  64 +       }
  65 +
  66         snprintf(phy_id, MII_BUS_ID_SIZE + 3, PHY_ID_FMT,
  67                 mdio_bus->id, plat->phy);
  68         port->phydev = phy_connect(dev, phy_id, &ixp4xx_adjust_link,
  69 @@ -632,21 +663,32 @@ static void ixp4xx_phy_disconnect(struct
  70  {
  71         struct port *port = netdev_priv(dev);
  72
  73 -       phy_disconnect(port->phydev);
  74 +       if (port->phydev)
  75 +               phy_disconnect(port->phydev);
  76  }
  77
  78  static void ixp4xx_phy_start(struct net_device *dev)
  79  {
  80         struct port *port = netdev_priv(dev);
  81
  82 -       phy_start(port->phydev);
  83 +       if (port->phydev) {
  84 +               phy_start(port->phydev);
  85 +       } else {
  86 +               port->link = 1;
  87 +               ixp4xx_update_link(dev);
  88 +       }
  89  }
  90
  91  static void ixp4xx_phy_stop(struct net_device *dev)
  92  {
  93         struct port *port = netdev_priv(dev);
  94
  95 -       phy_stop(port->phydev);
  96 +       if (port->phydev) {
  97 +               phy_stop(port->phydev);
  98 +       } else {
  99 +               port->link = 0;
 100 +               ixp4xx_update_link(dev);
 101 +       }
 102  }
 103
 104  static inline void debug_pkt(struct net_device *dev, const char *func,
 105 @@ -1048,6 +1090,9 @@ static int eth_ioctl(struct net_device *
 106                         return hwtstamp_get(dev, req);
 107         }
 108
 109 +       if (!port->phydev)
 110 +               return -EOPNOTSUPP;
 111 +
 112         return phy_mii_ioctl(port->phydev, req, cmd);
 113  }
 114
 115 @@ -1068,18 +1113,30 @@ static void ixp4xx_get_drvinfo(struct ne
 116  static int ixp4xx_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
 117  {
 118         struct port *port = netdev_priv(dev);
 119 +
 120 +       if (!port->phydev)
 121 +               return -EOPNOTSUPP;
 122 +
 123         return phy_ethtool_gset(port->phydev, cmd);
 124  }
 125
 126  static int ixp4xx_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
 127  {
 128         struct port *port = netdev_priv(dev);
 129 +
 130 +       if (!port->phydev)
 131 +               return -EOPNOTSUPP;
 132 +
 133         return phy_ethtool_sset(port->phydev, cmd);
 134  }
 135
 136  static int ixp4xx_nway_reset(struct net_device *dev)
 137  {
 138         struct port *port = netdev_priv(dev);
 139 +
 140 +       if (!port->phydev)
 141 +               return -EOPNOTSUPP;
 142 +
 143         return phy_start_aneg(port->phydev);
 144  }
 145