3 files changed, 56 insertions, 0 deletions

diff --git a/net/ieee802154/nl802154.c b/net/ieee802154/nl802154.c
index ccdf33ecee0b..e7224f3c1584 100644
--- a/net/ieee802154/nl802154.c
+++ b/net/ieee802154/nl802154.c
@@ -551,6 +551,32 @@ static int nl802154_get_interface(struct sk_buff *skb, struct genl_info *info)
         return genlmsg_reply(msg, info);
 }
 
+static int nl802154_new_interface(struct sk_buff *skb, struct genl_info *info)
+{
+        struct cfg802154_registered_device *rdev = info->user_ptr[0];
+        enum nl802154_iftype type = NL802154_IFTYPE_UNSPEC;
+
+        /* TODO avoid failing a new interface
+         * creation due to pending removal?
+         */
+
+        if (!info->attrs[NL802154_ATTR_IFNAME])
+                return -EINVAL;
+
+        if (info->attrs[NL802154_ATTR_IFTYPE]) {
+                type = nla_get_u32(info->attrs[NL802154_ATTR_IFTYPE]);
+                if (type > NL802154_IFTYPE_MAX)
+                        return -EINVAL;
+        }
+
+        if (!rdev->ops->add_virtual_intf)
+                return -EOPNOTSUPP;
+
+        return rdev_add_virtual_intf(rdev,
+                                     nla_data(info->attrs[NL802154_ATTR_IFNAME]),
+                                     type);
+}
+
 static int nl802154_set_channel(struct sk_buff *skb, struct genl_info *info)
 {
         struct cfg802154_registered_device *rdev = info->user_ptr[0];
@@ -819,6 +845,14 @@ static const struct genl_ops nl802154_ops[] = {
                                   NL802154_FLAG_NEED_RTNL,
         },
         {
+                .cmd = NL802154_CMD_NEW_INTERFACE,
+                .doit = nl802154_new_interface,
+                .policy = nl802154_policy,
+                .flags = GENL_ADMIN_PERM,
+                .internal_flags = NL802154_FLAG_NEED_WPAN_PHY |
+                                  NL802154_FLAG_NEED_RTNL,
+        },
+        {
                 .cmd = NL802154_CMD_SET_CHANNEL,
                 .doit = nl802154_set_channel,
                 .policy = nl802154_policy,
diff --git a/net/ieee802154/rdev-ops.h b/net/ieee802154/rdev-ops.h
index 578bc41e92d3..d3a4f94c5fdc 100644
--- a/net/ieee802154/rdev-ops.h
+++ b/net/ieee802154/rdev-ops.h
@@ -21,6 +21,13 @@ rdev_del_virtual_intf_deprecated(struct cfg802154_registered_device *rdev,
 }
 
 static inline int
+rdev_add_virtual_intf(struct cfg802154_registered_device *rdev, char *name,
+                      enum nl802154_iftype type)
+{
+        return rdev->ops->add_virtual_intf(&rdev->wpan_phy, name, type);
+}
+
+static inline int
 rdev_set_channel(struct cfg802154_registered_device *rdev, u8 page, u8 channel)
 {
         return rdev->ops->set_channel(&rdev->wpan_phy, page, channel);
diff --git a/net/mac802154/cfg.c b/net/mac802154/cfg.c
index 2abe7e5f0974..ae1a9ef2d42c 100644
--- a/net/mac802154/cfg.c
+++ b/net/mac802154/cfg.c
@@ -43,6 +43,20 @@ static void ieee802154_del_iface_deprecated(struct wpan_phy *wpan_phy,
 }
 
 static int
+ieee802154_add_iface(struct wpan_phy *phy, const char *name,
+                     enum nl802154_iftype type)
+{
+        struct ieee802154_local *local = wpan_phy_priv(phy);
+        struct net_device *err;
+
+        err = ieee802154_if_add(local, name, type);
+        if (IS_ERR(err))
+                return PTR_ERR(err);
+
+        return 0;
+}
+
+static int
 ieee802154_set_channel(struct wpan_phy *wpan_phy, u8 page, u8 channel)
 {
         struct ieee802154_local *local = wpan_phy_priv(wpan_phy);
@@ -175,6 +189,7 @@ ieee802154_set_lbt_mode(struct wpan_phy *wpan_phy, struct wpan_dev *wpan_dev,
 const struct cfg802154_ops mac802154_config_ops = {
         .add_virtual_intf_deprecated = ieee802154_add_iface_deprecated,
         .del_virtual_intf_deprecated = ieee802154_del_iface_deprecated,
+        .add_virtual_intf = ieee802154_add_iface,
         .set_channel = ieee802154_set_channel,
         .set_pan_id = ieee802154_set_pan_id,
         .set_short_addr = ieee802154_set_short_addr,