rtw89: implement ieee80211_ops::start_ap and stop_ap

Configure firmware and hardware to run AP mode. The start_ap() setup
bssid, mac port, mac_id entry, and does RFK. The stop_ap() reset the
state.

Signed-off-by: Ping-Ke Shih <pkshih@realtek.com>
Signed-off-by: Kalle Valo <kvalo@kernel.org>
Link: https://lore.kernel.org/r/20220207063900.43643-6-pkshih@realtek.com

diff --git a/drivers/net/wireless/realtek/rtw89/mac80211.c b/drivers/net/wireless/realtek/rtw89/mac80211.c
index 295d54c0fc94a0e73983ae96369566d8538464f0..5df7aceabdf5ecfae9ceec42075306ebd135aa6b 100644 (file)
--- a/drivers/net/wireless/realtek/rtw89/mac80211.c
+++ b/drivers/net/wireless/realtek/rtw89/mac80211.c
@@ -371,6 +371,37 @@ static void rtw89_ops_bss_info_changed(struct ieee80211_hw *hw,
        mutex_unlock(&rtwdev->mutex);
 }
 
+static int rtw89_ops_start_ap(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
+{
+       struct rtw89_dev *rtwdev = hw->priv;
+       struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv;
+
+       mutex_lock(&rtwdev->mutex);
+       ether_addr_copy(rtwvif->bssid, vif->bss_conf.bssid);
+       rtw89_cam_bssid_changed(rtwdev, rtwvif);
+       rtw89_mac_port_update(rtwdev, rtwvif);
+       rtw89_fw_h2c_assoc_cmac_tbl(rtwdev, vif, NULL);
+       rtw89_fw_h2c_role_maintain(rtwdev, rtwvif, NULL, RTW89_ROLE_TYPE_CHANGE);
+       rtw89_fw_h2c_join_info(rtwdev, rtwvif, NULL, true);
+       rtw89_fw_h2c_cam(rtwdev, rtwvif, NULL, NULL);
+       rtw89_chip_rfk_channel(rtwdev);
+       mutex_unlock(&rtwdev->mutex);
+
+       return 0;
+}
+
+static
+void rtw89_ops_stop_ap(struct ieee80211_hw *hw, struct ieee80211_vif *vif)
+{
+       struct rtw89_dev *rtwdev = hw->priv;
+       struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv;
+
+       mutex_lock(&rtwdev->mutex);
+       rtw89_fw_h2c_assoc_cmac_tbl(rtwdev, vif, NULL);
+       rtw89_fw_h2c_join_info(rtwdev, rtwvif, NULL, true);
+       mutex_unlock(&rtwdev->mutex);
+}
+
 static int rtw89_ops_set_tim(struct ieee80211_hw *hw, struct ieee80211_sta *sta,
                             bool set)
 {
@@ -699,6 +730,8 @@ const struct ieee80211_ops rtw89_ops = {
        .remove_interface       = rtw89_ops_remove_interface,
        .configure_filter       = rtw89_ops_configure_filter,
        .bss_info_changed       = rtw89_ops_bss_info_changed,
+       .start_ap               = rtw89_ops_start_ap,
+       .stop_ap                = rtw89_ops_stop_ap,
        .set_tim                = rtw89_ops_set_tim,
        .conf_tx                = rtw89_ops_conf_tx,
        .sta_state              = rtw89_ops_sta_state,