release/src-rt-6.x/linux/linux-2.6/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));
 148         strlcpy(info->version, DRV_VERSION, sizeof(info->version));
 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         {"sig_comp_iv"},
 170         {"swqe_refill_th"},
 171         {"port resets"},
 172         {"Receive errors"},
 173         {"TCP cksum errors"},
 174         {"IP cksum errors"},
 175         {"Frame cksum errors"},
 176         {"num SQ stopped"},
 177         {"SQ stopped"},
 178         {"PR0 free_swqes"},
 179         {"PR1 free_swqes"},
 180         {"PR2 free_swqes"},
 181         {"PR3 free_swqes"},
 182         {"PR4 free_swqes"},
 183         {"PR5 free_swqes"},
 184         {"PR6 free_swqes"},
 185         {"PR7 free_swqes"},
 186 };
 187
 188 static void ehea_get_strings(struct net_device *dev, u32 stringset, u8 *data)
 189 {
 190         if (stringset == ETH_SS_STATS) {
 191                 memcpy(data, &ehea_ethtool_stats_keys,
 192                        sizeof(ehea_ethtool_stats_keys));
 193         }
 194 }
 195
 196 static int ehea_get_stats_count(struct net_device *dev)
 197 {
 198         return ARRAY_SIZE(ehea_ethtool_stats_keys);
 199 }
 200
 201 static void ehea_get_ethtool_stats(struct net_device *dev,
 202                                      struct ethtool_stats *stats, u64 *data)
 203 {
 204         int i, k, tmp;
 205         struct ehea_port *port = netdev_priv(dev);
 206
 207         for (i = 0; i < ehea_get_stats_count(dev); i++)
 208                 data[i] = 0;
 209         i = 0;
 210
 211         data[i++] = port->sig_comp_iv;
 212         data[i++] = port->port_res[0].swqe_refill_th;
 213         data[i++] = port->resets;
 214
 215         for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++)
 216                 tmp += port->port_res[k].p_stats.poll_receive_errors;
 217         data[i++] = tmp;
 218
 219         for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++)
 220                 tmp += port->port_res[k].p_stats.err_tcp_cksum;
 221         data[i++] = tmp;
 222
 223         for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++)
 224                 tmp += port->port_res[k].p_stats.err_ip_cksum;
 225         data[i++] = tmp;
 226
 227         for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++)
 228                 tmp += port->port_res[k].p_stats.err_frame_crc;
 229         data[i++] = tmp;
 230
 231         for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++)
 232                 tmp += port->port_res[k].p_stats.queue_stopped;
 233         data[i++] = tmp;
 234
 235         for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++)
 236                 tmp |= port->port_res[k].queue_stopped;
 237         data[i++] = tmp;
 238
 239         for (k = 0; k < 8; k++)
 240                 data[i++] = atomic_read(&port->port_res[k].swqe_avail);
 241
 242 }
 243
 244 const struct ethtool_ops ehea_ethtool_ops = {
 245         .get_settings = ehea_get_settings,
 246         .get_drvinfo = ehea_get_drvinfo,
 247         .get_msglevel = ehea_get_msglevel,
 248         .set_msglevel = ehea_set_msglevel,
 249         .get_link = ethtool_op_get_link,
 250         .get_tx_csum = ethtool_op_get_tx_csum,
 251         .get_sg = ethtool_op_get_sg,
 252         .get_tso = ethtool_op_get_tso,
 253         .set_tso = ethtool_op_set_tso,
 254         .get_strings = ehea_get_strings,
 255         .get_stats_count = ehea_get_stats_count,
 256         .get_ethtool_stats = ehea_get_ethtool_stats,
 257         .get_rx_csum = ehea_get_rx_csum,
 258         .set_settings = ehea_set_settings,
 259         .nway_reset = ehea_nway_reset,          /* Restart autonegotiation */
 260 };
 261
 262 void ehea_set_ethtool_ops(struct net_device *netdev)
 263 {
 264         SET_ETHTOOL_OPS(netdev, &ehea_ethtool_ops);
 265 }