rdma/res-cmid.c

   1 // SPDX-License-Identifier: GPL-2.0 OR Linux-OpenIB
   2 /*
   3  * res-cmid.c   RDMA tool
   4  * Authors:     Leon Romanovsky <leonro@mellanox.com>
   5  */
   6
   7 #include "res.h"
   8 #include <inttypes.h>
   9
  10 static void print_qp_type(struct rd *rd, uint32_t val)
  11 {
  12         if (rd->json_output)
  13                 jsonw_string_field(rd->jw, "qp-type", qp_types_to_str(val));
  14         else
  15                 pr_out("qp-type %s ", qp_types_to_str(val));
  16 }
  17
  18 static const char *cm_id_state_to_str(uint8_t idx)
  19 {
  20         static const char *const cm_id_states_str[] = {
  21                 "IDLE",           "ADDR_QUERY",     "ADDR_RESOLVED",
  22                 "ROUTE_QUERY",    "ROUTE_RESOLVED", "CONNECT",
  23                 "DISCONNECT",     "ADDR_BOUND",     "LISTEN",
  24                 "DEVICE_REMOVAL", "DESTROYING"
  25         };
  26
  27         if (idx < ARRAY_SIZE(cm_id_states_str))
  28                 return cm_id_states_str[idx];
  29         return "UNKNOWN";
  30 }
  31
  32 static const char *cm_id_ps_to_str(uint32_t ps)
  33 {
  34         switch (ps) {
  35         case RDMA_PS_IPOIB:
  36                 return "IPoIB";
  37         case RDMA_PS_IB:
  38                 return "IPoIB";
  39         case RDMA_PS_TCP:
  40                 return "TCP";
  41         case RDMA_PS_UDP:
  42                 return "UDP";
  43         default:
  44                 return "---";
  45         }
  46 }
  47
  48 static void print_cm_id_state(struct rd *rd, uint8_t state)
  49 {
  50         if (rd->json_output) {
  51                 jsonw_string_field(rd->jw, "state", cm_id_state_to_str(state));
  52                 return;
  53         }
  54         pr_out("state %s ", cm_id_state_to_str(state));
  55 }
  56
  57 static void print_ps(struct rd *rd, uint32_t ps)
  58 {
  59         if (rd->json_output) {
  60                 jsonw_string_field(rd->jw, "ps", cm_id_ps_to_str(ps));
  61                 return;
  62         }
  63         pr_out("ps %s ", cm_id_ps_to_str(ps));
  64 }
  65
  66 static void print_ipaddr(struct rd *rd, const char *key, char *addrstr,
  67                          uint16_t port)
  68 {
  69         if (rd->json_output) {
  70                 int name_size = INET6_ADDRSTRLEN + strlen(":65535");
  71                 char json_name[name_size];
  72
  73                 snprintf(json_name, name_size, "%s:%u", addrstr, port);
  74                 jsonw_string_field(rd->jw, key, json_name);
  75                 return;
  76         }
  77         pr_out("%s %s:%u ", key, addrstr, port);
  78 }
  79
  80 static int ss_ntop(struct nlattr *nla_line, char *addr_str, uint16_t *port)
  81 {
  82         struct __kernel_sockaddr_storage *addr;
  83
  84         addr = (struct __kernel_sockaddr_storage *)mnl_attr_get_payload(
  85                 nla_line);
  86         switch (addr->ss_family) {
  87         case AF_INET: {
  88                 struct sockaddr_in *sin = (struct sockaddr_in *)addr;
  89
  90                 if (!inet_ntop(AF_INET, (const void *)&sin->sin_addr, addr_str,
  91                                INET6_ADDRSTRLEN))
  92                         return -EINVAL;
  93                 *port = ntohs(sin->sin_port);
  94                 break;
  95         }
  96         case AF_INET6: {
  97                 struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *)addr;
  98
  99                 if (!inet_ntop(AF_INET6, (const void *)&sin6->sin6_addr,
 100                                addr_str, INET6_ADDRSTRLEN))
 101                         return -EINVAL;
 102                 *port = ntohs(sin6->sin6_port);
 103                 break;
 104         }
 105         default:
 106                 return -EINVAL;
 107         }
 108         return 0;
 109 }
 110 static int res_cm_id_line(struct rd *rd, const char *name, int idx,
 111                        struct nlattr **nla_line)
 112 {
 113         char src_addr_str[INET6_ADDRSTRLEN];
 114         char dst_addr_str[INET6_ADDRSTRLEN];
 115         uint16_t src_port, dst_port;
 116         uint32_t port = 0, pid = 0;
 117         uint8_t type = 0, state;
 118         uint32_t lqpn = 0, ps;
 119         uint32_t cm_idn = 0;
 120         char *comm = NULL;
 121
 122         if (!nla_line[RDMA_NLDEV_ATTR_RES_STATE] ||
 123             !nla_line[RDMA_NLDEV_ATTR_RES_PS] ||
 124             (!nla_line[RDMA_NLDEV_ATTR_RES_PID] &&
 125              !nla_line[RDMA_NLDEV_ATTR_RES_KERN_NAME])) {
 126                 return MNL_CB_ERROR;
 127         }
 128
 129         if (nla_line[RDMA_NLDEV_ATTR_PORT_INDEX])
 130                 port = mnl_attr_get_u32(nla_line[RDMA_NLDEV_ATTR_PORT_INDEX]);
 131
 132         if (port && port != rd->port_idx)
 133                 goto out;
 134
 135         if (nla_line[RDMA_NLDEV_ATTR_RES_LQPN]) {
 136                 lqpn = mnl_attr_get_u32(nla_line[RDMA_NLDEV_ATTR_RES_LQPN]);
 137                 if (rd_check_is_filtered(rd, "lqpn", lqpn))
 138                         goto out;
 139         }
 140         if (nla_line[RDMA_NLDEV_ATTR_RES_TYPE]) {
 141                 type = mnl_attr_get_u8(nla_line[RDMA_NLDEV_ATTR_RES_TYPE]);
 142                 if (rd_check_is_string_filtered(rd, "qp-type",
 143                                                 qp_types_to_str(type)))
 144                         goto out;
 145         }
 146
 147         ps = mnl_attr_get_u32(nla_line[RDMA_NLDEV_ATTR_RES_PS]);
 148         if (rd_check_is_string_filtered(rd, "ps", cm_id_ps_to_str(ps)))
 149                 goto out;
 150
 151         state = mnl_attr_get_u8(nla_line[RDMA_NLDEV_ATTR_RES_STATE]);
 152         if (rd_check_is_string_filtered(rd, "state", cm_id_state_to_str(state)))
 153                 goto out;
 154
 155         if (nla_line[RDMA_NLDEV_ATTR_RES_SRC_ADDR]) {
 156                 if (ss_ntop(nla_line[RDMA_NLDEV_ATTR_RES_SRC_ADDR],
 157                             src_addr_str, &src_port))
 158                         goto out;
 159                 if (rd_check_is_string_filtered(rd, "src-addr", src_addr_str))
 160                         goto out;
 161                 if (rd_check_is_filtered(rd, "src-port", src_port))
 162                         goto out;
 163         }
 164
 165         if (nla_line[RDMA_NLDEV_ATTR_RES_DST_ADDR]) {
 166                 if (ss_ntop(nla_line[RDMA_NLDEV_ATTR_RES_DST_ADDR],
 167                             dst_addr_str, &dst_port))
 168                         goto out;
 169                 if (rd_check_is_string_filtered(rd, "dst-addr", dst_addr_str))
 170                         goto out;
 171                 if (rd_check_is_filtered(rd, "dst-port", dst_port))
 172                         goto out;
 173         }
 174
 175         if (nla_line[RDMA_NLDEV_ATTR_RES_PID]) {
 176                 pid = mnl_attr_get_u32(nla_line[RDMA_NLDEV_ATTR_RES_PID]);
 177                 comm = get_task_name(pid);
 178         }
 179
 180         if (rd_check_is_filtered(rd, "pid", pid))
 181                 goto out;
 182
 183         if (nla_line[RDMA_NLDEV_ATTR_RES_CM_IDN])
 184                 cm_idn = mnl_attr_get_u32(nla_line[RDMA_NLDEV_ATTR_RES_CM_IDN]);
 185         if (rd_check_is_filtered(rd, "cm-idn", cm_idn))
 186                 goto out;
 187
 188         if (nla_line[RDMA_NLDEV_ATTR_RES_KERN_NAME]) {
 189                 /* discard const from mnl_attr_get_str */
 190                 comm = (char *)mnl_attr_get_str(
 191                         nla_line[RDMA_NLDEV_ATTR_RES_KERN_NAME]);
 192         }
 193
 194         if (rd->json_output)
 195                 jsonw_start_array(rd->jw);
 196
 197         print_link(rd, idx, name, port, nla_line);
 198         res_print_uint(rd, "cm-idn", cm_idn,
 199                        nla_line[RDMA_NLDEV_ATTR_RES_CM_IDN]);
 200         res_print_uint(rd, "lqpn", lqpn, nla_line[RDMA_NLDEV_ATTR_RES_LQPN]);
 201         if (nla_line[RDMA_NLDEV_ATTR_RES_TYPE])
 202                 print_qp_type(rd, type);
 203         print_cm_id_state(rd, state);
 204         print_ps(rd, ps);
 205         res_print_uint(rd, "pid", pid, nla_line[RDMA_NLDEV_ATTR_RES_PID]);
 206         print_comm(rd, comm, nla_line);
 207
 208         if (nla_line[RDMA_NLDEV_ATTR_RES_SRC_ADDR])
 209                 print_ipaddr(rd, "src-addr", src_addr_str, src_port);
 210         if (nla_line[RDMA_NLDEV_ATTR_RES_DST_ADDR])
 211                 print_ipaddr(rd, "dst-addr", dst_addr_str, dst_port);
 212
 213         print_driver_table(rd, nla_line[RDMA_NLDEV_ATTR_DRIVER]);
 214         newline(rd);
 215
 216 out:    if (nla_line[RDMA_NLDEV_ATTR_RES_PID])
 217                 free(comm);
 218         return MNL_CB_OK;
 219 }
 220
 221 int res_cm_id_idx_parse_cb(const struct nlmsghdr *nlh, void *data)
 222 {
 223         struct nlattr *tb[RDMA_NLDEV_ATTR_MAX] = {};
 224         struct rd *rd = data;
 225         const char *name;
 226         int idx;
 227
 228         mnl_attr_parse(nlh, 0, rd_attr_cb, tb);
 229         if (!tb[RDMA_NLDEV_ATTR_DEV_INDEX] || !tb[RDMA_NLDEV_ATTR_DEV_NAME])
 230                 return MNL_CB_ERROR;
 231
 232         name = mnl_attr_get_str(tb[RDMA_NLDEV_ATTR_DEV_NAME]);
 233         idx = mnl_attr_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
 234
 235         return res_cm_id_line(rd, name, idx, tb);
 236 }
 237
 238 int res_cm_id_parse_cb(const struct nlmsghdr *nlh, void *data)
 239 {
 240         struct nlattr *tb[RDMA_NLDEV_ATTR_MAX] = {};
 241         struct nlattr *nla_table, *nla_entry;
 242         struct rd *rd = data;
 243         int ret = MNL_CB_OK;
 244         const char *name;
 245         int idx;
 246
 247         mnl_attr_parse(nlh, 0, rd_attr_cb, tb);
 248         if (!tb[RDMA_NLDEV_ATTR_DEV_INDEX] || !tb[RDMA_NLDEV_ATTR_DEV_NAME] ||
 249             !tb[RDMA_NLDEV_ATTR_RES_CM_ID])
 250                 return MNL_CB_ERROR;
 251
 252         name = mnl_attr_get_str(tb[RDMA_NLDEV_ATTR_DEV_NAME]);
 253         idx = mnl_attr_get_u32(tb[RDMA_NLDEV_ATTR_DEV_INDEX]);
 254         nla_table = tb[RDMA_NLDEV_ATTR_RES_CM_ID];
 255
 256         mnl_attr_for_each_nested(nla_entry, nla_table) {
 257                 struct nlattr *nla_line[RDMA_NLDEV_ATTR_MAX] = {};
 258
 259                 ret = mnl_attr_parse_nested(nla_entry, rd_attr_cb, nla_line);
 260                 if (ret != MNL_CB_OK)
 261                         break;
 262
 263                 ret = res_cm_id_line(rd, name, idx, nla_line);
 264                 if (ret != MNL_CB_OK)
 265                         break;
 266         }
 267         return ret;
 268 }