net/ethtool/debug.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2
   3 #include "netlink.h"
   4 #include "common.h"
   5 #include "bitset.h"
   6
   7 struct debug_req_info {
   8         struct ethnl_req_info           base;
   9 };
  10
  11 struct debug_reply_data {
  12         struct ethnl_reply_data         base;
  13         u32                             msg_mask;
  14 };
  15
  16 #define DEBUG_REPDATA(__reply_base) \
  17         container_of(__reply_base, struct debug_reply_data, base)
  18
  19 static const struct nla_policy
  20 debug_get_policy[ETHTOOL_A_DEBUG_MAX + 1] = {
  21         [ETHTOOL_A_DEBUG_UNSPEC]        = { .type = NLA_REJECT },
  22         [ETHTOOL_A_DEBUG_HEADER]        = { .type = NLA_NESTED },
  23         [ETHTOOL_A_DEBUG_MSGMASK]       = { .type = NLA_REJECT },
  24 };
  25
  26 static int debug_prepare_data(const struct ethnl_req_info *req_base,
  27                               struct ethnl_reply_data *reply_base,
  28                               struct genl_info *info)
  29 {
  30         struct debug_reply_data *data = DEBUG_REPDATA(reply_base);
  31         struct net_device *dev = reply_base->dev;
  32         int ret;
  33
  34         if (!dev->ethtool_ops->get_msglevel)
  35                 return -EOPNOTSUPP;
  36
  37         ret = ethnl_ops_begin(dev);
  38         if (ret < 0)
  39                 return ret;
  40         data->msg_mask = dev->ethtool_ops->get_msglevel(dev);
  41         ethnl_ops_complete(dev);
  42
  43         return 0;
  44 }
  45
  46 static int debug_reply_size(const struct ethnl_req_info *req_base,
  47                             const struct ethnl_reply_data *reply_base)
  48 {
  49         const struct debug_reply_data *data = DEBUG_REPDATA(reply_base);
  50         bool compact = req_base->flags & ETHTOOL_FLAG_COMPACT_BITSETS;
  51
  52         return ethnl_bitset32_size(&data->msg_mask, NULL, NETIF_MSG_CLASS_COUNT,
  53                                    netif_msg_class_names, compact);
  54 }
  55
  56 static int debug_fill_reply(struct sk_buff *skb,
  57                             const struct ethnl_req_info *req_base,
  58                             const struct ethnl_reply_data *reply_base)
  59 {
  60         const struct debug_reply_data *data = DEBUG_REPDATA(reply_base);
  61         bool compact = req_base->flags & ETHTOOL_FLAG_COMPACT_BITSETS;
  62
  63         return ethnl_put_bitset32(skb, ETHTOOL_A_DEBUG_MSGMASK, &data->msg_mask,
  64                                   NULL, NETIF_MSG_CLASS_COUNT,
  65                                   netif_msg_class_names, compact);
  66 }
  67
  68 const struct ethnl_request_ops ethnl_debug_request_ops = {
  69         .request_cmd            = ETHTOOL_MSG_DEBUG_GET,
  70         .reply_cmd              = ETHTOOL_MSG_DEBUG_GET_REPLY,
  71         .hdr_attr               = ETHTOOL_A_DEBUG_HEADER,
  72         .max_attr               = ETHTOOL_A_DEBUG_MAX,
  73         .req_info_size          = sizeof(struct debug_req_info),
  74         .reply_data_size        = sizeof(struct debug_reply_data),
  75         .request_policy         = debug_get_policy,
  76
  77         .prepare_data           = debug_prepare_data,
  78         .reply_size             = debug_reply_size,
  79         .fill_reply             = debug_fill_reply,
  80 };
  81
  82 /* DEBUG_SET */
  83
  84 static const struct nla_policy
  85 debug_set_policy[ETHTOOL_A_DEBUG_MAX + 1] = {
  86         [ETHTOOL_A_DEBUG_UNSPEC]        = { .type = NLA_REJECT },
  87         [ETHTOOL_A_DEBUG_HEADER]        = { .type = NLA_NESTED },
  88         [ETHTOOL_A_DEBUG_MSGMASK]       = { .type = NLA_NESTED },
  89 };
  90
  91 int ethnl_set_debug(struct sk_buff *skb, struct genl_info *info)
  92 {
  93         struct nlattr *tb[ETHTOOL_A_DEBUG_MAX + 1];
  94         struct ethnl_req_info req_info = {};
  95         struct net_device *dev;
  96         bool mod = false;
  97         u32 msg_mask;
  98         int ret;
  99
 100         ret = nlmsg_parse(info->nlhdr, GENL_HDRLEN, tb,
 101                           ETHTOOL_A_DEBUG_MAX, debug_set_policy,
 102                           info->extack);
 103         if (ret < 0)
 104                 return ret;
 105         ret = ethnl_parse_header_dev_get(&req_info,
 106                                          tb[ETHTOOL_A_DEBUG_HEADER],
 107                                          genl_info_net(info), info->extack,
 108                                          true);
 109         if (ret < 0)
 110                 return ret;
 111         dev = req_info.dev;
 112         ret = -EOPNOTSUPP;
 113         if (!dev->ethtool_ops->get_msglevel || !dev->ethtool_ops->set_msglevel)
 114                 goto out_dev;
 115
 116         rtnl_lock();
 117         ret = ethnl_ops_begin(dev);
 118         if (ret < 0)
 119                 goto out_rtnl;
 120
 121         msg_mask = dev->ethtool_ops->get_msglevel(dev);
 122         ret = ethnl_update_bitset32(&msg_mask, NETIF_MSG_CLASS_COUNT,
 123                                     tb[ETHTOOL_A_DEBUG_MSGMASK],
 124                                     netif_msg_class_names, info->extack, &mod);
 125         if (ret < 0 || !mod)
 126                 goto out_ops;
 127
 128         dev->ethtool_ops->set_msglevel(dev, msg_mask);
 129         ethtool_notify(dev, ETHTOOL_MSG_DEBUG_NTF, NULL);
 130
 131 out_ops:
 132         ethnl_ops_complete(dev);
 133 out_rtnl:
 134         rtnl_unlock();
 135 out_dev:
 136         dev_put(dev);
 137         return ret;
 138 }