| // SPDX-License-Identifier: GPL-2.0-or-later |
| /* |
| * Copyright (c) 2016 Mellanox Technologies. All rights reserved. |
| * Copyright (c) 2016 Jiri Pirko <jiri@mellanox.com> |
| */ |
| |
| #include <net/genetlink.h> |
| #include <net/sock.h> |
| |
| #include "devl_internal.h" |
| |
| #define DEVLINK_NL_FLAG_NEED_PORT BIT(0) |
| #define DEVLINK_NL_FLAG_NEED_DEVLINK_OR_PORT BIT(1) |
| #define DEVLINK_NL_FLAG_NEED_DEV_LOCK BIT(2) |
| |
| static const struct genl_multicast_group devlink_nl_mcgrps[] = { |
| [DEVLINK_MCGRP_CONFIG] = { .name = DEVLINK_GENL_MCGRP_CONFIG_NAME }, |
| }; |
| |
| struct devlink_nl_sock_priv { |
| struct devlink_obj_desc __rcu *flt; |
| spinlock_t flt_lock; /* Protects flt. */ |
| }; |
| |
| static void devlink_nl_sock_priv_init(void *priv) |
| { |
| struct devlink_nl_sock_priv *sk_priv = priv; |
| |
| spin_lock_init(&sk_priv->flt_lock); |
| } |
| |
| static void devlink_nl_sock_priv_destroy(void *priv) |
| { |
| struct devlink_nl_sock_priv *sk_priv = priv; |
| struct devlink_obj_desc *flt; |
| |
| flt = rcu_dereference_protected(sk_priv->flt, true); |
| kfree_rcu(flt, rcu); |
| } |
| |
| int devlink_nl_notify_filter_set_doit(struct sk_buff *skb, |
| struct genl_info *info) |
| { |
| struct devlink_nl_sock_priv *sk_priv; |
| struct nlattr **attrs = info->attrs; |
| struct devlink_obj_desc *flt; |
| size_t data_offset = 0; |
| size_t data_size = 0; |
| char *pos; |
| |
| if (attrs[DEVLINK_ATTR_BUS_NAME]) |
| data_size = size_add(data_size, |
| nla_len(attrs[DEVLINK_ATTR_BUS_NAME]) + 1); |
| if (attrs[DEVLINK_ATTR_DEV_NAME]) |
| data_size = size_add(data_size, |
| nla_len(attrs[DEVLINK_ATTR_DEV_NAME]) + 1); |
| |
| flt = kzalloc(size_add(sizeof(*flt), data_size), GFP_KERNEL); |
| if (!flt) |
| return -ENOMEM; |
| |
| pos = (char *) flt->data; |
| if (attrs[DEVLINK_ATTR_BUS_NAME]) { |
| data_offset += nla_strscpy(pos, |
| attrs[DEVLINK_ATTR_BUS_NAME], |
| data_size) + 1; |
| flt->bus_name = pos; |
| pos += data_offset; |
| } |
| if (attrs[DEVLINK_ATTR_DEV_NAME]) { |
| nla_strscpy(pos, attrs[DEVLINK_ATTR_DEV_NAME], |
| data_size - data_offset); |
| flt->dev_name = pos; |
| } |
| |
| if (attrs[DEVLINK_ATTR_PORT_INDEX]) { |
| flt->port_index = nla_get_u32(attrs[DEVLINK_ATTR_PORT_INDEX]); |
| flt->port_index_valid = true; |
| } |
| |
| /* Don't attach empty filter. */ |
| if (!flt->bus_name && !flt->dev_name && !flt->port_index_valid) { |
| kfree(flt); |
| flt = NULL; |
| } |
| |
| sk_priv = genl_sk_priv_get(&devlink_nl_family, NETLINK_CB(skb).sk); |
| if (IS_ERR(sk_priv)) { |
| kfree(flt); |
| return PTR_ERR(sk_priv); |
| } |
| spin_lock(&sk_priv->flt_lock); |
| flt = rcu_replace_pointer(sk_priv->flt, flt, |
| lockdep_is_held(&sk_priv->flt_lock)); |
| spin_unlock(&sk_priv->flt_lock); |
| kfree_rcu(flt, rcu); |
| return 0; |
| } |
| |
| static bool devlink_obj_desc_match(const struct devlink_obj_desc *desc, |
| const struct devlink_obj_desc *flt) |
| { |
| if (desc->bus_name && flt->bus_name && |
| strcmp(desc->bus_name, flt->bus_name)) |
| return false; |
| if (desc->dev_name && flt->dev_name && |
| strcmp(desc->dev_name, flt->dev_name)) |
| return false; |
| if (desc->port_index_valid && flt->port_index_valid && |
| desc->port_index != flt->port_index) |
| return false; |
| return true; |
| } |
| |
| int devlink_nl_notify_filter(struct sock *dsk, struct sk_buff *skb, void *data) |
| { |
| struct devlink_obj_desc *desc = data; |
| struct devlink_nl_sock_priv *sk_priv; |
| struct devlink_obj_desc *flt; |
| int ret = 0; |
| |
| rcu_read_lock(); |
| sk_priv = __genl_sk_priv_get(&devlink_nl_family, dsk); |
| if (!IS_ERR_OR_NULL(sk_priv)) { |
| flt = rcu_dereference(sk_priv->flt); |
| if (flt) |
| ret = !devlink_obj_desc_match(desc, flt); |
| } |
| rcu_read_unlock(); |
| return ret; |
| } |
| |
| int devlink_nl_put_nested_handle(struct sk_buff *msg, struct net *net, |
| struct devlink *devlink, int attrtype) |
| { |
| struct nlattr *nested_attr; |
| struct net *devl_net; |
| |
| nested_attr = nla_nest_start(msg, attrtype); |
| if (!nested_attr) |
| return -EMSGSIZE; |
| if (devlink_nl_put_handle(msg, devlink)) |
| goto nla_put_failure; |
| |
| rcu_read_lock(); |
| devl_net = read_pnet_rcu(&devlink->_net); |
| if (!net_eq(net, devl_net)) { |
| int id = peernet2id_alloc(net, devl_net, GFP_ATOMIC); |
| |
| rcu_read_unlock(); |
| if (nla_put_s32(msg, DEVLINK_ATTR_NETNS_ID, id)) |
| return -EMSGSIZE; |
| } else { |
| rcu_read_unlock(); |
| } |
| |
| nla_nest_end(msg, nested_attr); |
| return 0; |
| |
| nla_put_failure: |
| nla_nest_cancel(msg, nested_attr); |
| return -EMSGSIZE; |
| } |
| |
| int devlink_nl_msg_reply_and_new(struct sk_buff **msg, struct genl_info *info) |
| { |
| int err; |
| |
| if (*msg) { |
| err = genlmsg_reply(*msg, info); |
| if (err) |
| return err; |
| } |
| *msg = genlmsg_new(GENLMSG_DEFAULT_SIZE, GFP_KERNEL); |
| if (!*msg) |
| return -ENOMEM; |
| return 0; |
| } |
| |
| struct devlink * |
| devlink_get_from_attrs_lock(struct net *net, struct nlattr **attrs, |
| bool dev_lock) |
| { |
| struct devlink *devlink; |
| unsigned long index; |
| char *busname; |
| char *devname; |
| |
| if (!attrs[DEVLINK_ATTR_BUS_NAME] || !attrs[DEVLINK_ATTR_DEV_NAME]) |
| return ERR_PTR(-EINVAL); |
| |
| busname = nla_data(attrs[DEVLINK_ATTR_BUS_NAME]); |
| devname = nla_data(attrs[DEVLINK_ATTR_DEV_NAME]); |
| |
| devlinks_xa_for_each_registered_get(net, index, devlink) { |
| devl_dev_lock(devlink, dev_lock); |
| if (devl_is_registered(devlink) && |
| strcmp(devlink->dev->bus->name, busname) == 0 && |
| strcmp(dev_name(devlink->dev), devname) == 0) |
| return devlink; |
| devl_dev_unlock(devlink, dev_lock); |
| devlink_put(devlink); |
| } |
| |
| return ERR_PTR(-ENODEV); |
| } |
| |
| static int __devlink_nl_pre_doit(struct sk_buff *skb, struct genl_info *info, |
| u8 flags) |
| { |
| bool dev_lock = flags & DEVLINK_NL_FLAG_NEED_DEV_LOCK; |
| struct devlink_port *devlink_port; |
| struct devlink *devlink; |
| int err; |
| |
| devlink = devlink_get_from_attrs_lock(genl_info_net(info), info->attrs, |
| dev_lock); |
| if (IS_ERR(devlink)) |
| return PTR_ERR(devlink); |
| |
| info->user_ptr[0] = devlink; |
| if (flags & DEVLINK_NL_FLAG_NEED_PORT) { |
| devlink_port = devlink_port_get_from_info(devlink, info); |
| if (IS_ERR(devlink_port)) { |
| err = PTR_ERR(devlink_port); |
| goto unlock; |
| } |
| info->user_ptr[1] = devlink_port; |
| } else if (flags & DEVLINK_NL_FLAG_NEED_DEVLINK_OR_PORT) { |
| devlink_port = devlink_port_get_from_info(devlink, info); |
| if (!IS_ERR(devlink_port)) |
| info->user_ptr[1] = devlink_port; |
| } |
| return 0; |
| |
| unlock: |
| devl_dev_unlock(devlink, dev_lock); |
| devlink_put(devlink); |
| return err; |
| } |
| |
| int devlink_nl_pre_doit(const struct genl_split_ops *ops, |
| struct sk_buff *skb, struct genl_info *info) |
| { |
| return __devlink_nl_pre_doit(skb, info, 0); |
| } |
| |
| int devlink_nl_pre_doit_port(const struct genl_split_ops *ops, |
| struct sk_buff *skb, struct genl_info *info) |
| { |
| return __devlink_nl_pre_doit(skb, info, DEVLINK_NL_FLAG_NEED_PORT); |
| } |
| |
| int devlink_nl_pre_doit_dev_lock(const struct genl_split_ops *ops, |
| struct sk_buff *skb, struct genl_info *info) |
| { |
| return __devlink_nl_pre_doit(skb, info, DEVLINK_NL_FLAG_NEED_DEV_LOCK); |
| } |
| |
| int devlink_nl_pre_doit_port_optional(const struct genl_split_ops *ops, |
| struct sk_buff *skb, |
| struct genl_info *info) |
| { |
| return __devlink_nl_pre_doit(skb, info, DEVLINK_NL_FLAG_NEED_DEVLINK_OR_PORT); |
| } |
| |
| static void __devlink_nl_post_doit(struct sk_buff *skb, struct genl_info *info, |
| u8 flags) |
| { |
| bool dev_lock = flags & DEVLINK_NL_FLAG_NEED_DEV_LOCK; |
| struct devlink *devlink; |
| |
| devlink = info->user_ptr[0]; |
| devl_dev_unlock(devlink, dev_lock); |
| devlink_put(devlink); |
| } |
| |
| void devlink_nl_post_doit(const struct genl_split_ops *ops, |
| struct sk_buff *skb, struct genl_info *info) |
| { |
| __devlink_nl_post_doit(skb, info, 0); |
| } |
| |
| void |
| devlink_nl_post_doit_dev_lock(const struct genl_split_ops *ops, |
| struct sk_buff *skb, struct genl_info *info) |
| { |
| __devlink_nl_post_doit(skb, info, DEVLINK_NL_FLAG_NEED_DEV_LOCK); |
| } |
| |
| static int devlink_nl_inst_single_dumpit(struct sk_buff *msg, |
| struct netlink_callback *cb, int flags, |
| devlink_nl_dump_one_func_t *dump_one, |
| struct nlattr **attrs) |
| { |
| struct devlink *devlink; |
| int err; |
| |
| devlink = devlink_get_from_attrs_lock(sock_net(msg->sk), attrs, false); |
| if (IS_ERR(devlink)) |
| return PTR_ERR(devlink); |
| err = dump_one(msg, devlink, cb, flags | NLM_F_DUMP_FILTERED); |
| |
| devl_unlock(devlink); |
| devlink_put(devlink); |
| |
| if (err != -EMSGSIZE) |
| return err; |
| return msg->len; |
| } |
| |
| static int devlink_nl_inst_iter_dumpit(struct sk_buff *msg, |
| struct netlink_callback *cb, int flags, |
| devlink_nl_dump_one_func_t *dump_one) |
| { |
| struct devlink_nl_dump_state *state = devlink_dump_state(cb); |
| struct devlink *devlink; |
| int err = 0; |
| |
| while ((devlink = devlinks_xa_find_get(sock_net(msg->sk), |
| &state->instance))) { |
| devl_lock(devlink); |
| |
| if (devl_is_registered(devlink)) |
| err = dump_one(msg, devlink, cb, flags); |
| else |
| err = 0; |
| |
| devl_unlock(devlink); |
| devlink_put(devlink); |
| |
| if (err) |
| break; |
| |
| state->instance++; |
| |
| /* restart sub-object walk for the next instance */ |
| state->idx = 0; |
| } |
| |
| if (err != -EMSGSIZE) |
| return err; |
| return msg->len; |
| } |
| |
| int devlink_nl_dumpit(struct sk_buff *msg, struct netlink_callback *cb, |
| devlink_nl_dump_one_func_t *dump_one) |
| { |
| const struct genl_info *info = genl_info_dump(cb); |
| struct nlattr **attrs = info->attrs; |
| int flags = NLM_F_MULTI; |
| |
| if (attrs && |
| (attrs[DEVLINK_ATTR_BUS_NAME] || attrs[DEVLINK_ATTR_DEV_NAME])) |
| return devlink_nl_inst_single_dumpit(msg, cb, flags, dump_one, |
| attrs); |
| else |
| return devlink_nl_inst_iter_dumpit(msg, cb, flags, dump_one); |
| } |
| |
| struct genl_family devlink_nl_family __ro_after_init = { |
| .name = DEVLINK_GENL_NAME, |
| .version = DEVLINK_GENL_VERSION, |
| .netnsok = true, |
| .parallel_ops = true, |
| .module = THIS_MODULE, |
| .split_ops = devlink_nl_ops, |
| .n_split_ops = ARRAY_SIZE(devlink_nl_ops), |
| .resv_start_op = DEVLINK_CMD_SELFTESTS_RUN + 1, |
| .mcgrps = devlink_nl_mcgrps, |
| .n_mcgrps = ARRAY_SIZE(devlink_nl_mcgrps), |
| .sock_priv_size = sizeof(struct devlink_nl_sock_priv), |
| .sock_priv_init = devlink_nl_sock_priv_init, |
| .sock_priv_destroy = devlink_nl_sock_priv_destroy, |
| }; |