Lines Matching refs:rtwdev

13 static void rtw_wow_show_wakeup_reason(struct rtw_dev *rtwdev)
21 reason = rtw_read8(rtwdev, REG_WOWLAN_WAKE_REASON);
26 rtw_dbg(rtwdev, RTW_DBG_WOW, "WOW: Rx deauth\n");
30 rtw_dbg(rtwdev, RTW_DBG_WOW, "WOW: AP is off\n");
34 rtw_dbg(rtwdev, RTW_DBG_WOW, "WOW: Rx magic packet\n");
38 rtw_dbg(rtwdev, RTW_DBG_WOW, "WOW: Rx gtk rekey\n");
45 rtw_dbg(rtwdev, RTW_DBG_WOW, "WOW: Rx pattern match packet\n");
53 rtw_dbg(rtwdev, RTW_DBG_WOW, "Rx NLO\n");
56 rtw_warn(rtwdev, "Unknown wakeup reason %x\n", reason);
57 ieee80211_report_wowlan_wakeup(rtwdev->wow.wow_vif, NULL,
61 ieee80211_report_wowlan_wakeup(rtwdev->wow.wow_vif, &wakeup,
65 static void rtw_wow_pattern_write_cam(struct rtw_dev *rtwdev, u8 addr,
68 rtw_write32(rtwdev, REG_WKFMCAM_RWD, wdata);
69 rtw_write32(rtwdev, REG_WKFMCAM_CMD, BIT_WKFCAM_POLLING_V1 |
72 if (!check_hw_ready(rtwdev, REG_WKFMCAM_CMD, BIT_WKFCAM_POLLING_V1, 0))
73 rtw_err(rtwdev, "failed to write pattern cam\n");
76 static void rtw_wow_pattern_write_cam_ent(struct rtw_dev *rtwdev, u8 id,
89 rtw_wow_pattern_write_cam(rtwdev, addr, wdata);
108 rtw_wow_pattern_write_cam(rtwdev, addr, wdata);
162 static void rtw_wow_pattern_generate(struct rtw_dev *rtwdev,
241 static void rtw_wow_pattern_clear_cam(struct rtw_dev *rtwdev)
245 rtw_write32(rtwdev, REG_WKFMCAM_CMD, BIT_WKFCAM_POLLING_V1 |
248 ret = check_hw_ready(rtwdev, REG_WKFMCAM_CMD, BIT_WKFCAM_POLLING_V1, 0);
250 rtw_err(rtwdev, "failed to clean pattern cam\n");
253 static void rtw_wow_pattern_write(struct rtw_dev *rtwdev)
255 struct rtw_wow_param *rtw_wow = &rtwdev->wow;
260 rtw_wow_pattern_write_cam_ent(rtwdev, i, rtw_pattern + i);
263 static void rtw_wow_pattern_clear(struct rtw_dev *rtwdev)
265 struct rtw_wow_param *rtw_wow = &rtwdev->wow;
267 rtw_wow_pattern_clear_cam(rtwdev);
273 static void rtw_wow_bb_stop(struct rtw_dev *rtwdev)
275 struct rtw_wow_param *rtw_wow = &rtwdev->wow;
280 if (!rtw_read32_mask(rtwdev, REG_BCNQ_INFO, BIT_MGQ_CPU_EMPTY))
281 rtw_warn(rtwdev, "Wrong status of MGQ_CPU empty!\n");
283 rtw_wow->txpause = rtw_read8(rtwdev, REG_TXPAUSE);
284 rtw_write8(rtwdev, REG_TXPAUSE, 0xff);
285 rtw_write8_clr(rtwdev, REG_SYS_FUNC_EN, BIT_FEN_BB_RSTB);
288 static void rtw_wow_bb_start(struct rtw_dev *rtwdev)
290 struct rtw_wow_param *rtw_wow = &rtwdev->wow;
292 rtw_write8_set(rtwdev, REG_SYS_FUNC_EN, BIT_FEN_BB_RSTB);
293 rtw_write8(rtwdev, REG_TXPAUSE, rtw_wow->txpause);
296 static void rtw_wow_rx_dma_stop(struct rtw_dev *rtwdev)
301 rtw_write32_set(rtwdev, REG_RXPKT_NUM, BIT_RW_RELEASE);
303 if (!check_hw_ready(rtwdev, REG_RXPKT_NUM, BIT_RXDMA_IDLE, 1))
304 rtw_err(rtwdev, "failed to stop rx dma\n");
307 static void rtw_wow_rx_dma_start(struct rtw_dev *rtwdev)
309 rtw_write32_clr(rtwdev, REG_RXPKT_NUM, BIT_RW_RELEASE);
312 static int rtw_wow_check_fw_status(struct rtw_dev *rtwdev, bool wow_enable)
320 100000, true, rtwdev,
326 !check_dis, 1000, 100000, true, rtwdev,
331 !check_dis, 1000, 100000, false, rtwdev,
340 rtw_err(rtwdev, "failed to check wow status %s\n",
352 struct rtw_dev *rtwdev = hw->priv;
355 if (vif != rtwdev->wow.wow_vif)
374 rtw_err(rtwdev, "Unsupported key type for wowlan mode: %#x\n",
386 static void rtw_wow_fw_security_type(struct rtw_dev *rtwdev)
389 struct ieee80211_vif *wow_vif = rtwdev->wow.wow_vif;
391 data.rtwdev = rtwdev;
392 rtw_iterate_keys(rtwdev, wow_vif,
394 rtw_fw_set_aoac_global_info_cmd(rtwdev, data.pairwise_key_type,
398 static int rtw_wow_fw_start(struct rtw_dev *rtwdev)
400 if (rtw_wow_mgd_linked(rtwdev)) {
401 rtw_send_rsvd_page_h2c(rtwdev);
402 rtw_wow_pattern_write(rtwdev);
403 rtw_wow_fw_security_type(rtwdev);
404 rtw_fw_set_disconnect_decision_cmd(rtwdev, true);
405 rtw_fw_set_keep_alive_cmd(rtwdev, true);
406 } else if (rtw_wow_no_link(rtwdev)) {
407 rtw_fw_set_nlo_info(rtwdev, true);
408 rtw_fw_update_pkt_probe_req(rtwdev, NULL);
409 rtw_fw_channel_switch(rtwdev, true);
412 rtw_fw_set_wowlan_ctrl_cmd(rtwdev, true);
413 rtw_fw_set_remote_wake_ctrl_cmd(rtwdev, true);
415 return rtw_wow_check_fw_status(rtwdev, true);
418 static int rtw_wow_fw_stop(struct rtw_dev *rtwdev)
420 if (rtw_wow_mgd_linked(rtwdev)) {
421 rtw_fw_set_disconnect_decision_cmd(rtwdev, false);
422 rtw_fw_set_keep_alive_cmd(rtwdev, false);
423 rtw_wow_pattern_clear(rtwdev);
424 } else if (rtw_wow_no_link(rtwdev)) {
425 rtw_fw_channel_switch(rtwdev, false);
426 rtw_fw_set_nlo_info(rtwdev, false);
429 rtw_fw_set_wowlan_ctrl_cmd(rtwdev, false);
430 rtw_fw_set_remote_wake_ctrl_cmd(rtwdev, false);
432 return rtw_wow_check_fw_status(rtwdev, false);
435 static void rtw_wow_avoid_reset_mac(struct rtw_dev *rtwdev)
442 switch (rtw_hci_type(rtwdev)) {
445 rtw_write8(rtwdev, REG_RSV_CTRL, BIT_WLOCK_1C_B6);
446 rtw_write8(rtwdev, REG_RSV_CTRL,
450 rtw_warn(rtwdev, "Unsupported hci type to disable reset MAC\n");
459 struct rtw_dev *rtwdev = iter_data->rtwdev;
461 rtw_fw_media_status_report(rtwdev, si->mac_id, iter_data->connect);
464 static void rtw_wow_fw_media_status(struct rtw_dev *rtwdev, bool connect)
468 data.rtwdev = rtwdev;
471 rtw_iterate_stas_atomic(rtwdev, rtw_wow_fw_media_status_iter, &data);
474 static int rtw_wow_config_wow_fw_rsvd_page(struct rtw_dev *rtwdev)
476 struct ieee80211_vif *wow_vif = rtwdev->wow.wow_vif;
479 rtw_remove_rsvd_page(rtwdev, rtwvif);
481 if (rtw_wow_no_link(rtwdev))
482 rtw_add_rsvd_page_pno(rtwdev, rtwvif);
484 rtw_add_rsvd_page_sta(rtwdev, rtwvif);
486 return rtw_fw_download_rsvd_page(rtwdev);
489 static int rtw_wow_config_normal_fw_rsvd_page(struct rtw_dev *rtwdev)
491 struct ieee80211_vif *wow_vif = rtwdev->wow.wow_vif;
494 rtw_remove_rsvd_page(rtwdev, rtwvif);
495 rtw_add_rsvd_page_sta(rtwdev, rtwvif);
497 if (rtw_wow_no_link(rtwdev))
500 return rtw_fw_download_rsvd_page(rtwdev);
503 static int rtw_wow_swap_fw(struct rtw_dev *rtwdev, enum rtw_fw_type type)
510 fw = &rtwdev->wow_fw;
514 fw = &rtwdev->fw;
518 rtw_warn(rtwdev, "unsupported firmware type to swap\n");
522 ret = rtw_download_firmware(rtwdev, fw);
526 rtw_fw_send_general_info(rtwdev);
527 rtw_fw_send_phydm_info(rtwdev);
528 rtw_wow_fw_media_status(rtwdev, true);
534 static void rtw_wow_check_pno(struct rtw_dev *rtwdev,
537 struct rtw_wow_param *rtw_wow = &rtwdev->wow;
565 rtw_dbg(rtwdev, RTW_DBG_WOW, "WOW: net-detect is enabled\n");
573 rtw_dbg(rtwdev, RTW_DBG_WOW, "WOW: net-detect is disabled\n");
576 static int rtw_wow_leave_linked_ps(struct rtw_dev *rtwdev)
578 if (!test_bit(RTW_FLAG_WOWLAN, rtwdev->flags))
579 cancel_delayed_work_sync(&rtwdev->watch_dog_work);
581 rtw_leave_lps(rtwdev);
586 static int rtw_wow_leave_no_link_ps(struct rtw_dev *rtwdev)
588 struct rtw_wow_param *rtw_wow = &rtwdev->wow;
591 if (test_bit(RTW_FLAG_WOWLAN, rtwdev->flags)) {
592 if (rtw_get_lps_deep_mode(rtwdev) != LPS_DEEP_MODE_NONE)
593 rtw_leave_lps_deep(rtwdev);
595 if (!test_bit(RTW_FLAG_POWERON, rtwdev->flags)) {
597 ret = rtw_leave_ips(rtwdev);
606 static int rtw_wow_leave_ps(struct rtw_dev *rtwdev)
610 if (rtw_wow_mgd_linked(rtwdev))
611 ret = rtw_wow_leave_linked_ps(rtwdev);
612 else if (rtw_wow_no_link(rtwdev))
613 ret = rtw_wow_leave_no_link_ps(rtwdev);
618 static int rtw_wow_restore_ps(struct rtw_dev *rtwdev)
622 if (rtw_wow_no_link(rtwdev) && rtwdev->wow.ips_enabled)
623 ret = rtw_enter_ips(rtwdev);
628 static int rtw_wow_enter_linked_ps(struct rtw_dev *rtwdev)
630 struct rtw_wow_param *rtw_wow = &rtwdev->wow;
634 rtw_enter_lps(rtwdev, rtwvif->port);
639 static int rtw_wow_enter_no_link_ps(struct rtw_dev *rtwdev)
642 set_bit(RTW_FLAG_LEISURE_PS_DEEP, rtwdev->flags);
647 static int rtw_wow_enter_ps(struct rtw_dev *rtwdev)
651 if (rtw_wow_mgd_linked(rtwdev))
652 ret = rtw_wow_enter_linked_ps(rtwdev);
653 else if (rtw_wow_no_link(rtwdev) &&
654 rtw_get_lps_deep_mode(rtwdev) != LPS_DEEP_MODE_NONE)
655 ret = rtw_wow_enter_no_link_ps(rtwdev);
660 static void rtw_wow_stop_trx(struct rtw_dev *rtwdev)
662 rtw_wow_bb_stop(rtwdev);
663 rtw_wow_rx_dma_stop(rtwdev);
666 static int rtw_wow_start(struct rtw_dev *rtwdev)
670 ret = rtw_wow_fw_start(rtwdev);
674 rtw_hci_stop(rtwdev);
675 rtw_wow_bb_start(rtwdev);
676 rtw_wow_avoid_reset_mac(rtwdev);
682 static int rtw_wow_enable(struct rtw_dev *rtwdev)
686 rtw_wow_stop_trx(rtwdev);
688 ret = rtw_wow_swap_fw(rtwdev, RTW_WOWLAN_FW);
690 rtw_err(rtwdev, "failed to swap wow fw\n");
694 set_bit(RTW_FLAG_WOWLAN, rtwdev->flags);
696 ret = rtw_wow_config_wow_fw_rsvd_page(rtwdev);
698 rtw_err(rtwdev, "failed to download wowlan rsvd page\n");
702 ret = rtw_wow_start(rtwdev);
704 rtw_err(rtwdev, "failed to start wow\n");
711 clear_bit(RTW_FLAG_WOWLAN, rtwdev->flags);
715 static int rtw_wow_stop(struct rtw_dev *rtwdev)
722 ret = rtw_hci_setup(rtwdev);
724 rtw_err(rtwdev, "failed to setup hci\n");
728 ret = rtw_hci_start(rtwdev);
730 rtw_err(rtwdev, "failed to start hci\n");
734 ret = rtw_wow_fw_stop(rtwdev);
736 rtw_err(rtwdev, "failed to stop wowlan fw\n");
738 rtw_wow_bb_stop(rtwdev);
743 static void rtw_wow_resume_trx(struct rtw_dev *rtwdev)
745 rtw_wow_rx_dma_start(rtwdev);
746 rtw_wow_bb_start(rtwdev);
747 ieee80211_queue_delayed_work(rtwdev->hw, &rtwdev->watch_dog_work,
751 static int rtw_wow_disable(struct rtw_dev *rtwdev)
755 clear_bit(RTW_FLAG_WOWLAN, rtwdev->flags);
757 ret = rtw_wow_stop(rtwdev);
759 rtw_err(rtwdev, "failed to stop wow\n");
763 ret = rtw_wow_swap_fw(rtwdev, RTW_NORMAL_FW);
765 rtw_err(rtwdev, "failed to swap normal fw\n");
769 ret = rtw_wow_config_normal_fw_rsvd_page(rtwdev);
771 rtw_err(rtwdev, "failed to download normal rsvd page\n");
774 rtw_wow_resume_trx(rtwdev);
780 struct rtw_dev *rtwdev = data;
782 struct rtw_wow_param *rtw_wow = &rtwdev->wow;
796 rtwdev->wow.wow_vif = vif;
803 static int rtw_wow_set_wakeups(struct rtw_dev *rtwdev,
806 struct rtw_wow_param *rtw_wow = &rtwdev->wow;
819 rtw_wow_check_pno(rtwdev, wowlan->nd_config);
821 rtw_iterate_vifs_atomic(rtwdev, rtw_wow_vif_iter, rtwdev);
829 rtw_wow_pattern_generate(rtwdev, rtwvif,
837 static void rtw_wow_clear_wakeups(struct rtw_dev *rtwdev)
839 struct rtw_wow_param *rtw_wow = &rtwdev->wow;
847 memset(rtw_wow, 0, sizeof(rtwdev->wow));
850 int rtw_wow_suspend(struct rtw_dev *rtwdev, struct cfg80211_wowlan *wowlan)
854 ret = rtw_wow_set_wakeups(rtwdev, wowlan);
856 rtw_err(rtwdev, "failed to set wakeup event\n");
860 ret = rtw_wow_leave_ps(rtwdev);
862 rtw_err(rtwdev, "failed to leave ps from normal mode\n");
866 ret = rtw_wow_enable(rtwdev);
868 rtw_err(rtwdev, "failed to enable wow\n");
869 rtw_wow_restore_ps(rtwdev);
873 ret = rtw_wow_enter_ps(rtwdev);
875 rtw_err(rtwdev, "failed to enter ps for wow\n");
881 int rtw_wow_resume(struct rtw_dev *rtwdev)
886 if (!test_bit(RTW_FLAG_WOWLAN, rtwdev->flags)) {
887 rtw_err(rtwdev, "wow is not enabled\n");
892 ret = rtw_wow_leave_ps(rtwdev);
894 rtw_err(rtwdev, "failed to leave ps from wowlan mode\n");
898 rtw_wow_show_wakeup_reason(rtwdev);
900 ret = rtw_wow_disable(rtwdev);
902 rtw_err(rtwdev, "failed to disable wow\n");
906 ret = rtw_wow_restore_ps(rtwdev);
908 rtw_err(rtwdev, "failed to restore ps to normal mode\n");
911 rtw_wow_clear_wakeups(rtwdev);