drivers/infiniband/core/nldev.c

   1 /*
   2  * Copyright (c) 2017 Mellanox Technologies. All rights reserved.
   3  *
   4  * Redistribution and use in source and binary forms, with or without
   5  * modification, are permitted provided that the following conditions are met:
   6  *
   7  * 1. Redistributions of source code must retain the above copyright
   8  *    notice, this list of conditions and the following disclaimer.
   9  * 2. Redistributions in binary form must reproduce the above copyright
  10  *    notice, this list of conditions and the following disclaimer in the
  11  *    documentation and/or other materials provided with the distribution.
  12  * 3. Neither the names of the copyright holders nor the names of its
  13  *    contributors may be used to endorse or promote products derived from
  14  *    this software without specific prior written permission.
  15  *
  16  * Alternatively, this software may be distributed under the terms of the
  17  * GNU General Public License ("GPL") version 2 as published by the Free
  18  * Software Foundation.
  19  *
  20  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  21  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  22  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  23  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
  24  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  25  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  26  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  27  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  28  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  29  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  30  * POSSIBILITY OF SUCH DAMAGE.
  31  */
  32
  33 #include <linux/module.h>
  34 #include <net/netlink.h>
  35 #include <rdma/rdma_netlink.h>
  36
  37 #include "core_priv.h"
  38
  39 static const struct nla_policy nldev_policy[RDMA_NLDEV_ATTR_MAX] = {
  40         [RDMA_NLDEV_ATTR_DEV_INDEX]     = { .type = NLA_U32 },
  41         [RDMA_NLDEV_ATTR_DEV_NAME]      = { .type = NLA_NUL_STRING,
  42                                             .len = IB_DEVICE_NAME_MAX - 1},
  43         [RDMA_NLDEV_ATTR_PORT_INDEX]    = { .type = NLA_U32 },
  44         [RDMA_NLDEV_ATTR_FW_VERSION]    = { .type = NLA_NUL_STRING,
  45                                             .len = IB_FW_VERSION_NAME_MAX - 1},
  46         [RDMA_NLDEV_ATTR_NODE_GUID]     = { .type = NLA_U64 },
  47         [RDMA_NLDEV_ATTR_SYS_IMAGE_GUID] = { .type = NLA_U64 },
  48         [RDMA_NLDEV_ATTR_SUBNET_PREFIX] = { .type = NLA_U64 },
  49         [RDMA_NLDEV_ATTR_LID]           = { .type = NLA_U32 },
  50         [RDMA_NLDEV_ATTR_SM_LID]        = { .type = NLA_U32 },
  51         [RDMA_NLDEV_ATTR_LMC]           = { .type = NLA_U8 },
  52         [RDMA_NLDEV_ATTR_PORT_STATE]    = { .type = NLA_U8 },
  53         [RDMA_NLDEV_ATTR_PORT_PHYS_STATE] = { .type = NLA_U8 },
  54         [RDMA_NLDEV_ATTR_DEV_NODE_TYPE] = { .type = NLA_U8 },
  55 };
  56
  57 static int fill_dev_info(struct sk_buff *msg, struct ib_device *device)
  58 {
  59         char fw[IB_FW_VERSION_NAME_MAX];
  60
  61         if (nla_put_u32(msg, RDMA_NLDEV_ATTR_DEV_INDEX, device->index))
  62                 return -EMSGSIZE;
  63         if (nla_put_string(msg, RDMA_NLDEV_ATTR_DEV_NAME, device->name))
  64                 return -EMSGSIZE;
  65         if (nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, rdma_end_port(device)))
  66                 return -EMSGSIZE;
  67
  68         BUILD_BUG_ON(sizeof(device->attrs.device_cap_flags) != sizeof(u64));
  69         if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_CAP_FLAGS,
  70                               device->attrs.device_cap_flags, 0))
  71                 return -EMSGSIZE;
  72
  73         ib_get_device_fw_str(device, fw);
  74         /* Device without FW has strlen(fw) */
  75         if (strlen(fw) && nla_put_string(msg, RDMA_NLDEV_ATTR_FW_VERSION, fw))
  76                 return -EMSGSIZE;
  77
  78         if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_NODE_GUID,
  79                               be64_to_cpu(device->node_guid), 0))
  80                 return -EMSGSIZE;
  81         if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_SYS_IMAGE_GUID,
  82                               be64_to_cpu(device->attrs.sys_image_guid), 0))
  83                 return -EMSGSIZE;
  84         if (nla_put_u8(msg, RDMA_NLDEV_ATTR_DEV_NODE_TYPE, device->node_type))
  85                 return -EMSGSIZE;
  86         return 0;
  87 }
  88
  89 static int fill_port_info(struct sk_buff *msg,
  90                           struct ib_device *device, u32 port)
  91 {
  92         struct ib_port_attr attr;
  93         int ret;
  94
  95         if (nla_put_u32(msg, RDMA_NLDEV_ATTR_DEV_INDEX, device->index))
  96                 return -EMSGSIZE;
  97         if (nla_put_string(msg, RDMA_NLDEV_ATTR_DEV_NAME, device->name))
  98                 return -EMSGSIZE;
  99         if (nla_put_u32(msg, RDMA_NLDEV_ATTR_PORT_INDEX, port))
 100                 return -EMSGSIZE;
 101
 102         ret = ib_query_port(device, port, &attr);
 103         if (ret)
 104                 return ret;
 105
 106         BUILD_BUG_ON(sizeof(attr.port_cap_flags) > sizeof(u64));
 107         if (nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_CAP_FLAGS,
 108                               (u64)attr.port_cap_flags, 0))
 109                 return -EMSGSIZE;
 110         if (rdma_protocol_ib(device, port) &&
 111             nla_put_u64_64bit(msg, RDMA_NLDEV_ATTR_SUBNET_PREFIX,
 112                               attr.subnet_prefix, 0))
 113                 return -EMSGSIZE;
 114         if (rdma_protocol_ib(device, port)) {
 115                 if (nla_put_u32(msg, RDMA_NLDEV_ATTR_LID, attr.lid))
 116                         return -EMSGSIZE;
 117                 if (nla_put_u32(msg, RDMA_NLDEV_ATTR_SM_LID, attr.sm_lid))
 118                         return -EMSGSIZE;
 119                 if (nla_put_u8(msg, RDMA_NLDEV_ATTR_LMC, attr.lmc))
 120                         return -EMSGSIZE;
 121         }
 122         if (nla_put_u8(msg, RDMA_NLDEV_ATTR_PORT_STATE, attr.state))
 123                 return -EMSGSIZE;
 124         if (nla_put_u8(msg, RDMA_NLDEV_ATTR_PORT_PHYS_STATE, attr.phys_state))
 125                 return -EMSGSIZE;
 126         return 0;
 127 }
 128
 129 static int nldev_get_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
 130                           struct netlink_ext_ack *extack)
 131 {
 132         struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
 133         struct ib_device *device;
 134         struct sk_buff *msg;
 135         u32 index;
 136         int err;
 137
 138         err = nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
 139                           nldev_policy, extack);
 140         if (err || !tb[RDMA_NLDEV_ATTR_DEV_INDEX])
 141                 return -EINVAL;
 142
 143         index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
 144
 145         device = __ib_device_get_by_index(index);
 146         if (!device)
 147                 return -EINVAL;
 148
 149         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
 150         if (!msg)
 151                 return -ENOMEM;
 152
 153         nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
 154                         RDMA_NL_GET_TYPE(RDMA_NL_NLDEV, RDMA_NLDEV_CMD_GET),
 155                         0, 0);
 156
 157         err = fill_dev_info(msg, device);
 158         if (err) {
 159                 nlmsg_free(msg);
 160                 return err;
 161         }
 162
 163         nlmsg_end(msg, nlh);
 164
 165         return rdma_nl_unicast(msg, NETLINK_CB(skb).portid);
 166 }
 167
 168 static int _nldev_get_dumpit(struct ib_device *device,
 169                              struct sk_buff *skb,
 170                              struct netlink_callback *cb,
 171                              unsigned int idx)
 172 {
 173         int start = cb->args[0];
 174         struct nlmsghdr *nlh;
 175
 176         if (idx < start)
 177                 return 0;
 178
 179         nlh = nlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,
 180                         RDMA_NL_GET_TYPE(RDMA_NL_NLDEV, RDMA_NLDEV_CMD_GET),
 181                         0, NLM_F_MULTI);
 182
 183         if (fill_dev_info(skb, device)) {
 184                 nlmsg_cancel(skb, nlh);
 185                 goto out;
 186         }
 187
 188         nlmsg_end(skb, nlh);
 189
 190         idx++;
 191
 192 out:    cb->args[0] = idx;
 193         return skb->len;
 194 }
 195
 196 static int nldev_get_dumpit(struct sk_buff *skb, struct netlink_callback *cb)
 197 {
 198         /*
 199          * There is no need to take lock, because
 200          * we are relying on ib_core's lists_rwsem
 201          */
 202         return ib_enum_all_devs(_nldev_get_dumpit, skb, cb);
 203 }
 204
 205 static int nldev_port_get_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
 206                                struct netlink_ext_ack *extack)
 207 {
 208         struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
 209         struct ib_device *device;
 210         struct sk_buff *msg;
 211         u32 index;
 212         u32 port;
 213         int err;
 214
 215         err = nlmsg_parse(nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
 216                           nldev_policy, extack);
 217         if (err || !tb[RDMA_NLDEV_ATTR_PORT_INDEX])
 218                 return -EINVAL;
 219
 220         index = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
 221         device = __ib_device_get_by_index(index);
 222         if (!device)
 223                 return -EINVAL;
 224
 225         port = nla_get_u32(tb[RDMA_NLDEV_ATTR_PORT_INDEX]);
 226         if (!rdma_is_port_valid(device, port))
 227                 return -EINVAL;
 228
 229         msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
 230         if (!msg)
 231                 return -ENOMEM;
 232
 233         nlh = nlmsg_put(msg, NETLINK_CB(skb).portid, nlh->nlmsg_seq,
 234                         RDMA_NL_GET_TYPE(RDMA_NL_NLDEV, RDMA_NLDEV_CMD_GET),
 235                         0, 0);
 236
 237         err = fill_port_info(msg, device, port);
 238         if (err) {
 239                 nlmsg_free(msg);
 240                 return err;
 241         }
 242
 243         nlmsg_end(msg, nlh);
 244
 245         return rdma_nl_unicast(msg, NETLINK_CB(skb).portid);
 246 }
 247
 248 static int nldev_port_get_dumpit(struct sk_buff *skb,
 249                                  struct netlink_callback *cb)
 250 {
 251         struct nlattr *tb[RDMA_NLDEV_ATTR_MAX];
 252         struct ib_device *device;
 253         int start = cb->args[0];
 254         struct nlmsghdr *nlh;
 255         u32 idx = 0;
 256         u32 ifindex;
 257         int err;
 258         u32 p;
 259
 260         err = nlmsg_parse(cb->nlh, 0, tb, RDMA_NLDEV_ATTR_MAX - 1,
 261                           nldev_policy, NULL);
 262         if (err || !tb[RDMA_NLDEV_ATTR_DEV_INDEX])
 263                 return -EINVAL;
 264
 265         ifindex = nla_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
 266         device = __ib_device_get_by_index(ifindex);
 267         if (!device)
 268                 return -EINVAL;
 269
 270         for (p = rdma_start_port(device); p <= rdma_end_port(device); ++p) {
 271                 /*
 272                  * The dumpit function returns all information from specific
 273                  * index. This specific index is taken from the netlink
 274                  * messages request sent by user and it is available
 275                  * in cb->args[0].
 276                  *
 277                  * Usually, the user doesn't fill this field and it causes
 278                  * to return everything.
 279                  *
 280                  */
 281                 if (idx < start) {
 282                         idx++;
 283                         continue;
 284                 }
 285
 286                 nlh = nlmsg_put(skb, NETLINK_CB(cb->skb).portid,
 287                                 cb->nlh->nlmsg_seq,
 288                                 RDMA_NL_GET_TYPE(RDMA_NL_NLDEV,
 289                                                  RDMA_NLDEV_CMD_PORT_GET),
 290                                 0, NLM_F_MULTI);
 291
 292                 if (fill_port_info(skb, device, p)) {
 293                         nlmsg_cancel(skb, nlh);
 294                         goto out;
 295                 }
 296                 idx++;
 297                 nlmsg_end(skb, nlh);
 298         }
 299
 300 out:    cb->args[0] = idx;
 301         return skb->len;
 302 }
 303
 304 static const struct rdma_nl_cbs nldev_cb_table[] = {
 305         [RDMA_NLDEV_CMD_GET] = {
 306                 .doit = nldev_get_doit,
 307                 .dump = nldev_get_dumpit,
 308         },
 309         [RDMA_NLDEV_CMD_PORT_GET] = {
 310                 .doit = nldev_port_get_doit,
 311                 .dump = nldev_port_get_dumpit,
 312         },
 313 };
 314
 315 void __init nldev_init(void)
 316 {
 317         rdma_nl_register(RDMA_NL_NLDEV, nldev_cb_table);
 318 }
 319
 320 void __exit nldev_exit(void)
 321 {
 322         rdma_nl_unregister(RDMA_NL_NLDEV);
 323 }
 324
 325 MODULE_ALIAS_RDMA_NETLINK(RDMA_NL_NLDEV, 5);