drivers/net/ehea/ehea_ethtool.c

   1 /*
   2  *  linux/drivers/net/ehea/ehea_ethtool.c
   3  *
   4  *  eHEA ethernet device driver for IBM eServer System p
   5  *
   6  *  (C) Copyright IBM Corp. 2006
   7  *
   8  *  Authors:
   9  *       Christoph Raisch <raisch@de.ibm.com>
  10  *       Jan-Bernd Themann <themann@de.ibm.com>
  11  *       Thomas Klein <tklein@de.ibm.com>
  12  *
  13  *
  14  * This program is free software; you can redistribute it and/or modify
  15  * it under the terms of the GNU General Public License as published by
  16  * the Free Software Foundation; either version 2, or (at your option)
  17  * any later version.
  18  *
  19  * This program is distributed in the hope that it will be useful,
  20  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  21  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  22  * GNU General Public License for more details.
  23  *
  24  * You should have received a copy of the GNU General Public License
  25  * along with this program; if not, write to the Free Software
  26  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  27  */
  28
  29 #include "ehea.h"
  30 #include "ehea_phyp.h"
  31
  32 static int ehea_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
  33 {
  34         struct ehea_port *port = netdev_priv(dev);
  35         int ret;
  36
  37         ret = ehea_sense_port_attr(port);
  38
  39         if (ret)
  40                 return ret;
  41
  42         if (netif_carrier_ok(dev)) {
  43                 switch(port->port_speed) {
  44                 case EHEA_SPEED_10M: cmd->speed = SPEED_10; break;
  45                 case EHEA_SPEED_100M: cmd->speed = SPEED_100; break;
  46                 case EHEA_SPEED_1G: cmd->speed = SPEED_1000; break;
  47                 case EHEA_SPEED_10G: cmd->speed = SPEED_10000; break;
  48                 }
  49                 cmd->duplex = port->full_duplex == 1 ?
  50                                                      DUPLEX_FULL : DUPLEX_HALF;
  51         } else {
  52                 cmd->speed = -1;
  53                 cmd->duplex = -1;
  54         }
  55
  56         cmd->supported = (SUPPORTED_10000baseT_Full | SUPPORTED_1000baseT_Full
  57                        | SUPPORTED_100baseT_Full |  SUPPORTED_100baseT_Half
  58                        | SUPPORTED_10baseT_Full | SUPPORTED_10baseT_Half
  59                        | SUPPORTED_Autoneg | SUPPORTED_FIBRE);
  60
  61         cmd->advertising = (ADVERTISED_10000baseT_Full | ADVERTISED_Autoneg
  62                          | ADVERTISED_FIBRE);
  63
  64         cmd->port = PORT_FIBRE;
  65         cmd->autoneg = port->autoneg == 1 ? AUTONEG_ENABLE : AUTONEG_DISABLE;
  66
  67         return 0;
  68 }
  69
  70 static int ehea_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
  71 {
  72         struct ehea_port *port = netdev_priv(dev);
  73         int ret = 0;
  74         u32 sp;
  75
  76         if (cmd->autoneg == AUTONEG_ENABLE) {
  77                 sp = EHEA_SPEED_AUTONEG;
  78                 goto doit;
  79         }
  80
  81         switch(cmd->speed) {
  82         case SPEED_10:
  83                 if (cmd->duplex == DUPLEX_FULL)
  84                         sp = H_SPEED_10M_F;
  85                 else
  86                         sp = H_SPEED_10M_H;
  87                 break;
  88
  89         case SPEED_100:
  90                 if (cmd->duplex == DUPLEX_FULL)
  91                         sp = H_SPEED_100M_F;
  92                 else
  93                         sp = H_SPEED_100M_H;
  94                 break;
  95
  96         case SPEED_1000:
  97                 if (cmd->duplex == DUPLEX_FULL)
  98                         sp = H_SPEED_1G_F;
  99                 else
 100                         ret = -EINVAL;
 101                 break;
 102
 103         case SPEED_10000:
 104                 if (cmd->duplex == DUPLEX_FULL)
 105                         sp = H_SPEED_10G_F;
 106                 else
 107                         ret = -EINVAL;
 108                 break;
 109
 110         default:
 111                         ret = -EINVAL;
 112                 break;
 113         }
 114
 115         if (ret)
 116                 goto out;
 117 doit:
 118         ret = ehea_set_portspeed(port, sp);
 119
 120         if (!ret)
 121                 ehea_info("%s: Port speed succesfully set: %dMbps "
 122                           "%s Duplex",
 123                           port->netdev->name, port->port_speed,
 124                           port->full_duplex == 1 ? "Full" : "Half");
 125 out:
 126         return ret;
 127 }
 128
 129 static int ehea_nway_reset(struct net_device *dev)
 130 {
 131         struct ehea_port *port = netdev_priv(dev);
 132         int ret;
 133
 134         ret = ehea_set_portspeed(port, EHEA_SPEED_AUTONEG);
 135
 136         if (!ret)
 137                 ehea_info("%s: Port speed succesfully set: %dMbps "
 138                           "%s Duplex",
 139                           port->netdev->name, port->port_speed,
 140                           port->full_duplex == 1 ? "Full" : "Half");
 141         return ret;
 142 }
 143
 144 static void ehea_get_drvinfo(struct net_device *dev,
 145                                struct ethtool_drvinfo *info)
 146 {
 147         strlcpy(info->driver, DRV_NAME, sizeof(info->driver) - 1);
 148         strlcpy(info->version, DRV_VERSION, sizeof(info->version) - 1);
 149 }
 150
 151 static u32 ehea_get_msglevel(struct net_device *dev)
 152 {
 153         struct ehea_port *port = netdev_priv(dev);
 154         return port->msg_enable;
 155 }
 156
 157 static void ehea_set_msglevel(struct net_device *dev, u32 value)
 158 {
 159         struct ehea_port *port = netdev_priv(dev);
 160         port->msg_enable = value;
 161 }
 162
 163 static u32 ehea_get_rx_csum(struct net_device *dev)
 164 {
 165         return 1;
 166 }
 167
 168 static char ehea_ethtool_stats_keys[][ETH_GSTRING_LEN] = {
 169         {"poll_max_processed"},
 170         {"queue_stopped"},
 171         {"min_swqe_avail"},
 172         {"poll_receive_err"},
 173         {"pkt_send"},
 174         {"pkt_xmit"},
 175         {"send_tasklet"},
 176         {"ehea_poll"},
 177         {"nwqe"},
 178         {"swqe_available_0"},
 179         {"sig_comp_iv"},
 180         {"swqe_refill_th"},
 181         {"port resets"},
 182         {"rxo"},
 183         {"rx64"},
 184         {"rx65"},
 185         {"rx128"},
 186         {"rx256"},
 187         {"rx512"},
 188         {"rx1024"},
 189         {"txo"},
 190         {"tx64"},
 191         {"tx65"},
 192         {"tx128"},
 193         {"tx256"},
 194         {"tx512"},
 195         {"tx1024"},
 196 };
 197
 198 static void ehea_get_strings(struct net_device *dev, u32 stringset, u8 *data)
 199 {
 200         if (stringset == ETH_SS_STATS) {
 201                 memcpy(data, &ehea_ethtool_stats_keys,
 202                        sizeof(ehea_ethtool_stats_keys));
 203         }
 204 }
 205
 206 static int ehea_get_stats_count(struct net_device *dev)
 207 {
 208         return ARRAY_SIZE(ehea_ethtool_stats_keys);
 209 }
 210
 211 static void ehea_get_ethtool_stats(struct net_device *dev,
 212                                      struct ethtool_stats *stats, u64 *data)
 213 {
 214         u64 hret;
 215         int i;
 216         struct ehea_port *port = netdev_priv(dev);
 217         struct ehea_adapter *adapter = port->adapter;
 218         struct ehea_port_res *pr = &port->port_res[0];
 219         struct port_state *p_state = &pr->p_state;
 220         struct hcp_ehea_port_cb6 *cb6;
 221
 222         for (i = 0; i < ehea_get_stats_count(dev); i++)
 223                 data[i] = 0;
 224
 225         i = 0;
 226
 227         data[i++] = p_state->poll_max_processed;
 228         data[i++] = p_state->queue_stopped;
 229         data[i++] = p_state->min_swqe_avail;
 230         data[i++] = p_state->poll_receive_errors;
 231         data[i++] = p_state->pkt_send;
 232         data[i++] = p_state->pkt_xmit;
 233         data[i++] = p_state->send_tasklet;
 234         data[i++] = p_state->ehea_poll;
 235         data[i++] = p_state->nwqe;
 236         data[i++] = atomic_read(&port->port_res[0].swqe_avail);
 237         data[i++] = port->sig_comp_iv;
 238         data[i++] = port->port_res[0].swqe_refill_th;
 239         data[i++] = port->resets;
 240
 241         cb6 = kzalloc(H_CB_ALIGNMENT, GFP_KERNEL);
 242         if (!cb6) {
 243                 ehea_error("no mem for cb6");
 244                 return;
 245         }
 246
 247         hret = ehea_h_query_ehea_port(adapter->handle, port->logical_port_id,
 248                                       H_PORT_CB6, H_PORT_CB6_ALL, cb6);
 249         if (netif_msg_hw(port))
 250                 ehea_dump(cb6, sizeof(*cb6), "ehea_get_ethtool_stats");
 251
 252         if (hret == H_SUCCESS) {
 253                 data[i++] = cb6->rxo;
 254                 data[i++] = cb6->rx64;
 255                 data[i++] = cb6->rx65;
 256                 data[i++] = cb6->rx128;
 257                 data[i++] = cb6->rx256;
 258                 data[i++] = cb6->rx512;
 259                 data[i++] = cb6->rx1024;
 260                 data[i++] = cb6->txo;
 261                 data[i++] = cb6->tx64;
 262                 data[i++] = cb6->tx65;
 263                 data[i++] = cb6->tx128;
 264                 data[i++] = cb6->tx256;
 265                 data[i++] = cb6->tx512;
 266                 data[i++] = cb6->tx1024;
 267         } else
 268                 ehea_error("query_ehea_port failed");
 269
 270         kfree(cb6);
 271 }
 272
 273 const struct ethtool_ops ehea_ethtool_ops = {
 274         .get_settings = ehea_get_settings,
 275         .get_drvinfo = ehea_get_drvinfo,
 276         .get_msglevel = ehea_get_msglevel,
 277         .set_msglevel = ehea_set_msglevel,
 278         .get_link = ethtool_op_get_link,
 279         .get_tx_csum = ethtool_op_get_tx_csum,
 280         .get_sg = ethtool_op_get_sg,
 281         .get_tso = ethtool_op_get_tso,
 282         .set_tso = ethtool_op_set_tso,
 283         .get_strings = ehea_get_strings,
 284         .get_stats_count = ehea_get_stats_count,
 285         .get_ethtool_stats = ehea_get_ethtool_stats,
 286         .get_rx_csum = ehea_get_rx_csum,
 287         .set_settings = ehea_set_settings,
 288         .nway_reset = ehea_nway_reset,          /* Restart autonegotiation */
 289 };
 290
 291 void ehea_set_ethtool_ops(struct net_device *netdev)
 292 {
 293         SET_ETHTOOL_OPS(netdev, &ehea_ethtool_ops);
 294 }