{
        u16 mode = P2P_MODE_DISABLE;
 
-       if (GET_BSS_ROLE(priv) != MWIFIEX_BSS_ROLE_STA)
-               mwifiex_set_bss_role(priv, MWIFIEX_BSS_ROLE_STA);
-
        if (mwifiex_send_cmd(priv, HostCmd_CMD_P2P_MODE_CFG,
                             HostCmd_ACT_GEN_SET, 0, &mode, true))
                return -1;
                             HostCmd_ACT_GEN_SET, 0, &mode, true))
                return -1;
 
-       if (GET_BSS_ROLE(priv) != MWIFIEX_BSS_ROLE_UAP)
-               mwifiex_set_bss_role(priv, MWIFIEX_BSS_ROLE_UAP);
+       return 0;
+}
+
+static int mwifiex_deinit_priv_params(struct mwifiex_private *priv)
+{
+       priv->mgmt_frame_mask = 0;
+       if (mwifiex_send_cmd(priv, HostCmd_CMD_MGMT_FRAME_REG,
+                            HostCmd_ACT_GEN_SET, 0,
+                            &priv->mgmt_frame_mask, false)) {
+               dev_warn(priv->adapter->dev,
+                        "could not unregister mgmt frame rx\n");
+               return -1;
+       }
+
+       mwifiex_deauthenticate(priv, NULL);
+       mwifiex_free_priv(priv);
+       priv->wdev.iftype = NL80211_IFTYPE_UNSPECIFIED;
+       priv->bss_mode = NL80211_IFTYPE_UNSPECIFIED;
+       priv->sec_info.authentication_mode = NL80211_AUTHTYPE_OPEN_SYSTEM;
+
+       return 0;
+}
+
+static int
+mwifiex_init_new_priv_params(struct mwifiex_private *priv,
+                            struct net_device *dev,
+                            enum nl80211_iftype type)
+{
+       mwifiex_init_priv(priv);
+
+       priv->bss_mode = type;
+       priv->wdev.iftype = type;
+
+       mwifiex_init_priv_params(priv, priv->netdev);
+       priv->bss_started = 0;
+
+       switch (type) {
+       case NL80211_IFTYPE_STATION:
+       case NL80211_IFTYPE_ADHOC:
+               priv->bss_role =  MWIFIEX_BSS_ROLE_STA;
+               priv->bss_type = MWIFIEX_BSS_TYPE_STA;
+               break;
+       case NL80211_IFTYPE_P2P_CLIENT:
+       case NL80211_IFTYPE_P2P_GO:
+               priv->bss_role =  MWIFIEX_BSS_ROLE_STA;
+               priv->bss_type = MWIFIEX_BSS_TYPE_P2P;
+               break;
+       case NL80211_IFTYPE_AP:
+               priv->bss_type = MWIFIEX_BSS_TYPE_UAP;
+               priv->bss_role = MWIFIEX_BSS_ROLE_UAP;
+               break;
+       default:
+               dev_err(priv->adapter->dev,
+                       "%s: changing to %d not supported\n",
+                       dev->name, type);
+               return -EOPNOTSUPP;
+       }
+
+       return 0;
+}
+
+static int
+mwifiex_change_vif_to_p2p(struct net_device *dev,
+                         enum nl80211_iftype curr_iftype,
+                         enum nl80211_iftype type, u32 *flags,
+                         struct vif_params *params)
+{
+       struct mwifiex_private *priv;
+       struct mwifiex_adapter *adapter;
+
+       priv = mwifiex_netdev_get_priv(dev);
+
+       if (!priv)
+               return -1;
+
+       adapter = priv->adapter;
+
+       if (adapter->curr_iface_comb.p2p_intf ==
+           adapter->iface_limit.p2p_intf) {
+               dev_err(adapter->dev,
+                       "cannot create multiple P2P ifaces\n");
+               return -1;
+       }
+
+       dev_dbg(priv->adapter->dev, "%s: changing role to p2p\n", dev->name);
+
+       if (mwifiex_deinit_priv_params(priv))
+               return -1;
+       if (mwifiex_init_new_priv_params(priv, dev, type))
+               return -1;
+
+       switch (type) {
+       case NL80211_IFTYPE_P2P_CLIENT:
+               if (mwifiex_cfg80211_init_p2p_client(priv))
+                       return -EFAULT;
+               break;
+       case NL80211_IFTYPE_P2P_GO:
+               if (mwifiex_cfg80211_init_p2p_go(priv))
+                       return -EFAULT;
+               break;
+       default:
+               dev_err(priv->adapter->dev,
+                       "%s: changing to %d not supported\n",
+                       dev->name, type);
+               return -EOPNOTSUPP;
+       }
+
+       if (mwifiex_send_cmd(priv, HostCmd_CMD_SET_BSS_MODE,
+                            HostCmd_ACT_GEN_SET, 0, NULL, true))
+               return -1;
+
+       if (mwifiex_sta_init_cmd(priv, false, false))
+               return -1;
+
+       switch (curr_iftype) {
+       case NL80211_IFTYPE_STATION:
+       case NL80211_IFTYPE_ADHOC:
+               adapter->curr_iface_comb.sta_intf--;
+               break;
+       case NL80211_IFTYPE_AP:
+               adapter->curr_iface_comb.uap_intf--;
+               break;
+       default:
+               break;
+       }
+
+       adapter->curr_iface_comb.p2p_intf++;
+       dev->ieee80211_ptr->iftype = type;
 
        return 0;
 }
 
+static int
+mwifiex_change_vif_to_sta_adhoc(struct net_device *dev,
+                               enum nl80211_iftype curr_iftype,
+                               enum nl80211_iftype type, u32 *flags,
+                               struct vif_params *params)
+{
+       struct mwifiex_private *priv;
+       struct mwifiex_adapter *adapter;
+
+       priv = mwifiex_netdev_get_priv(dev);
+
+       if (!priv)
+               return -1;
+
+       adapter = priv->adapter;
+
+       if ((curr_iftype != NL80211_IFTYPE_P2P_CLIENT &&
+            curr_iftype != NL80211_IFTYPE_P2P_GO) &&
+           (adapter->curr_iface_comb.sta_intf ==
+            adapter->iface_limit.sta_intf)) {
+               dev_err(adapter->dev,
+                       "cannot create multiple station/adhoc ifaces\n");
+               return -1;
+       }
+
+       if (type == NL80211_IFTYPE_STATION)
+               dev_notice(adapter->dev,
+                          "%s: changing role to station\n", dev->name);
+       else
+               dev_notice(adapter->dev,
+                          "%s: changing role to adhoc\n", dev->name);
+
+       if (mwifiex_deinit_priv_params(priv))
+               return -1;
+       if (mwifiex_init_new_priv_params(priv, dev, type))
+               return -1;
+       if (mwifiex_send_cmd(priv, HostCmd_CMD_SET_BSS_MODE,
+                            HostCmd_ACT_GEN_SET, 0, NULL, true))
+               return -1;
+       if (mwifiex_sta_init_cmd(priv, false, false))
+               return -1;
+
+       switch (curr_iftype) {
+       case NL80211_IFTYPE_P2P_CLIENT:
+       case NL80211_IFTYPE_P2P_GO:
+               adapter->curr_iface_comb.p2p_intf--;
+               break;
+       case NL80211_IFTYPE_AP:
+               adapter->curr_iface_comb.uap_intf--;
+               break;
+       default:
+               break;
+       }
+
+       adapter->curr_iface_comb.sta_intf++;
+       dev->ieee80211_ptr->iftype = type;
+       return 0;
+}
+
+static int
+mwifiex_change_vif_to_ap(struct net_device *dev,
+                        enum nl80211_iftype curr_iftype,
+                        enum nl80211_iftype type, u32 *flags,
+                        struct vif_params *params)
+{
+       struct mwifiex_private *priv;
+       struct mwifiex_adapter *adapter;
+
+       priv = mwifiex_netdev_get_priv(dev);
+
+       if (!priv)
+               return -1;
+
+       adapter = priv->adapter;
+
+       if (adapter->curr_iface_comb.uap_intf ==
+           adapter->iface_limit.uap_intf) {
+               dev_err(adapter->dev,
+                       "cannot create multiple AP ifaces\n");
+               return -1;
+       }
+
+       dev_notice(adapter->dev, "%s: changing role to AP\n", dev->name);
+
+       if (mwifiex_deinit_priv_params(priv))
+               return -1;
+       if (mwifiex_init_new_priv_params(priv, dev, type))
+               return -1;
+       if (mwifiex_send_cmd(priv, HostCmd_CMD_SET_BSS_MODE,
+                            HostCmd_ACT_GEN_SET, 0, NULL, true))
+               return -1;
+       if (mwifiex_sta_init_cmd(priv, false, false))
+               return -1;
+
+       switch (curr_iftype) {
+       case NL80211_IFTYPE_P2P_CLIENT:
+       case NL80211_IFTYPE_P2P_GO:
+               adapter->curr_iface_comb.p2p_intf--;
+               break;
+       case NL80211_IFTYPE_STATION:
+       case NL80211_IFTYPE_ADHOC:
+               adapter->curr_iface_comb.sta_intf--;
+               break;
+       default:
+               break;
+       }
+
+       adapter->curr_iface_comb.uap_intf++;
+       dev->ieee80211_ptr->iftype = type;
+       return 0;
+}
 /*
  * CFG802.11 operation handler to change interface type.
  */
                                     enum nl80211_iftype type, u32 *flags,
                                     struct vif_params *params)
 {
-       int ret;
        struct mwifiex_private *priv = mwifiex_netdev_get_priv(dev);
+       enum nl80211_iftype curr_iftype = dev->ieee80211_ptr->iftype;
 
-       switch (dev->ieee80211_ptr->iftype) {
+       switch (curr_iftype) {
        case NL80211_IFTYPE_ADHOC:
                switch (type) {
                case NL80211_IFTYPE_STATION:
-                       break;
+                       priv->bss_mode = type;
+                       priv->sec_info.authentication_mode =
+                                                  NL80211_AUTHTYPE_OPEN_SYSTEM;
+                       dev->ieee80211_ptr->iftype = type;
+                       mwifiex_deauthenticate(priv, NULL);
+                       return mwifiex_send_cmd(priv, HostCmd_CMD_SET_BSS_MODE,
+                                               HostCmd_ACT_GEN_SET, 0, NULL,
+                                               true);
+               case NL80211_IFTYPE_P2P_CLIENT:
+               case NL80211_IFTYPE_P2P_GO:
+                       return mwifiex_change_vif_to_p2p(dev, curr_iftype,
+                                                        type, flags, params);
+               case NL80211_IFTYPE_AP:
+                       return mwifiex_change_vif_to_ap(dev, curr_iftype, type,
+                                                       flags, params);
                case NL80211_IFTYPE_UNSPECIFIED:
                        wiphy_warn(wiphy, "%s: kept type as IBSS\n", dev->name);
                case NL80211_IFTYPE_ADHOC:      /* This shouldn't happen */
                        return 0;
-               case NL80211_IFTYPE_AP:
                default:
                        wiphy_err(wiphy, "%s: changing to %d not supported\n",
                                  dev->name, type);
        case NL80211_IFTYPE_STATION:
                switch (type) {
                case NL80211_IFTYPE_ADHOC:
-                       break;
-               case NL80211_IFTYPE_P2P_CLIENT:
-                       if (mwifiex_cfg80211_init_p2p_client(priv))
-                               return -EFAULT;
+                       priv->bss_mode = type;
+                       priv->sec_info.authentication_mode =
+                                                  NL80211_AUTHTYPE_OPEN_SYSTEM;
                        dev->ieee80211_ptr->iftype = type;
-                       return 0;
+                       mwifiex_deauthenticate(priv, NULL);
+                       return mwifiex_send_cmd(priv, HostCmd_CMD_SET_BSS_MODE,
+                                               HostCmd_ACT_GEN_SET, 0, NULL,
+                                               true);
+               case NL80211_IFTYPE_P2P_CLIENT:
                case NL80211_IFTYPE_P2P_GO:
-                       if (mwifiex_cfg80211_init_p2p_go(priv))
-                               return -EFAULT;
-                       dev->ieee80211_ptr->iftype = type;
-                       return 0;
+                       return mwifiex_change_vif_to_p2p(dev, curr_iftype,
+                                                        type, flags, params);
+               case NL80211_IFTYPE_AP:
+                       return mwifiex_change_vif_to_ap(dev, curr_iftype, type,
+                                                       flags, params);
                case NL80211_IFTYPE_UNSPECIFIED:
                        wiphy_warn(wiphy, "%s: kept type as STA\n", dev->name);
                case NL80211_IFTYPE_STATION:    /* This shouldn't happen */
                        return 0;
-               case NL80211_IFTYPE_AP:
                default:
                        wiphy_err(wiphy, "%s: changing to %d not supported\n",
                                  dev->name, type);
                break;
        case NL80211_IFTYPE_AP:
                switch (type) {
+               case NL80211_IFTYPE_ADHOC:
+               case NL80211_IFTYPE_STATION:
+                       return mwifiex_change_vif_to_sta_adhoc(dev, curr_iftype,
+                                                              type, flags,
+                                                              params);
+                       break;
+               case NL80211_IFTYPE_P2P_CLIENT:
+               case NL80211_IFTYPE_P2P_GO:
+                       return mwifiex_change_vif_to_p2p(dev, curr_iftype,
+                                                        type, flags, params);
                case NL80211_IFTYPE_UNSPECIFIED:
                        wiphy_warn(wiphy, "%s: kept type as AP\n", dev->name);
                case NL80211_IFTYPE_AP:         /* This shouldn't happen */
                        return 0;
-               case NL80211_IFTYPE_ADHOC:
-               case NL80211_IFTYPE_STATION:
                default:
                        wiphy_err(wiphy, "%s: changing to %d not supported\n",
                                  dev->name, type);
        case NL80211_IFTYPE_P2P_GO:
                switch (type) {
                case NL80211_IFTYPE_STATION:
-                       if (mwifiex_cfg80211_deinit_p2p(priv))
+                       if (mwifiex_cfg80211_init_p2p_client(priv))
                                return -EFAULT;
                        dev->ieee80211_ptr->iftype = type;
+                       break;
+               case NL80211_IFTYPE_ADHOC:
+                       if (mwifiex_cfg80211_deinit_p2p(priv))
+                               return -EFAULT;
+                       return mwifiex_change_vif_to_sta_adhoc(dev, curr_iftype,
+                                                              type, flags,
+                                                              params);
+                       break;
+               case NL80211_IFTYPE_AP:
+                       if (mwifiex_cfg80211_deinit_p2p(priv))
+                               return -EFAULT;
+                       return mwifiex_change_vif_to_ap(dev, curr_iftype, type,
+                                                       flags, params);
+               case NL80211_IFTYPE_UNSPECIFIED:
+                       wiphy_warn(wiphy, "%s: kept type as P2P\n", dev->name);
+               case NL80211_IFTYPE_P2P_CLIENT:
+               case NL80211_IFTYPE_P2P_GO:
                        return 0;
                default:
+                       wiphy_err(wiphy, "%s: changing to %d not supported\n",
+                                 dev->name, type);
                        return -EOPNOTSUPP;
                }
                break;
                return -EOPNOTSUPP;
        }
 
-       dev->ieee80211_ptr->iftype = type;
-       priv->bss_mode = type;
-       mwifiex_deauthenticate(priv, NULL);
-
-       priv->sec_info.authentication_mode = NL80211_AUTHTYPE_OPEN_SYSTEM;
-
-       ret = mwifiex_send_cmd(priv, HostCmd_CMD_SET_BSS_MODE,
-                              HostCmd_ACT_GEN_SET, 0, NULL, true);
 
-       return ret;
+       return 0;
 }
 
 static void