| // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause |
| /* Copyright(c) 2018-2019 Realtek Corporation |
| */ |
| |
| #include "main.h" |
| #include "fw.h" |
| #include "ps.h" |
| #include "mac.h" |
| #include "debug.h" |
| |
| static int rtw_ips_pwr_up(struct rtw_dev *rtwdev) |
| { |
| int ret; |
| |
| ret = rtw_core_start(rtwdev); |
| if (ret) |
| rtw_err(rtwdev, "leave idle state failed\n"); |
| |
| rtw_set_channel(rtwdev); |
| rtw_flag_clear(rtwdev, RTW_FLAG_INACTIVE_PS); |
| |
| return ret; |
| } |
| |
| int rtw_enter_ips(struct rtw_dev *rtwdev) |
| { |
| rtw_flag_set(rtwdev, RTW_FLAG_INACTIVE_PS); |
| |
| rtw_core_stop(rtwdev); |
| |
| return 0; |
| } |
| |
| static void rtw_restore_port_cfg_iter(void *data, u8 *mac, |
| struct ieee80211_vif *vif) |
| { |
| struct rtw_dev *rtwdev = data; |
| struct rtw_vif *rtwvif = (struct rtw_vif *)vif->drv_priv; |
| u32 config = ~0; |
| |
| rtw_vif_port_config(rtwdev, rtwvif, config); |
| } |
| |
| int rtw_leave_ips(struct rtw_dev *rtwdev) |
| { |
| int ret; |
| |
| ret = rtw_ips_pwr_up(rtwdev); |
| if (ret) { |
| rtw_err(rtwdev, "failed to leave ips state\n"); |
| return ret; |
| } |
| |
| rtw_iterate_vifs_atomic(rtwdev, rtw_restore_port_cfg_iter, rtwdev); |
| |
| return 0; |
| } |
| |
| static void rtw_leave_lps_core(struct rtw_dev *rtwdev) |
| { |
| struct rtw_lps_conf *conf = &rtwdev->lps_conf; |
| |
| conf->state = RTW_ALL_ON; |
| conf->awake_interval = 1; |
| conf->rlbm = 0; |
| conf->smart_ps = 0; |
| |
| rtw_fw_set_pwr_mode(rtwdev); |
| rtw_flag_clear(rtwdev, RTW_FLAG_LEISURE_PS); |
| } |
| |
| static void rtw_enter_lps_core(struct rtw_dev *rtwdev) |
| { |
| struct rtw_lps_conf *conf = &rtwdev->lps_conf; |
| |
| conf->state = RTW_RF_OFF; |
| conf->awake_interval = 1; |
| conf->rlbm = 1; |
| conf->smart_ps = 2; |
| |
| rtw_fw_set_pwr_mode(rtwdev); |
| rtw_flag_set(rtwdev, RTW_FLAG_LEISURE_PS); |
| } |
| |
| void rtw_lps_work(struct work_struct *work) |
| { |
| struct rtw_dev *rtwdev = container_of(work, struct rtw_dev, |
| lps_work.work); |
| struct rtw_lps_conf *conf = &rtwdev->lps_conf; |
| struct rtw_vif *rtwvif = conf->rtwvif; |
| |
| if (WARN_ON(!rtwvif)) |
| return; |
| |
| if (conf->mode == RTW_MODE_LPS) |
| rtw_enter_lps_core(rtwdev); |
| else |
| rtw_leave_lps_core(rtwdev); |
| } |
| |
| void rtw_enter_lps_irqsafe(struct rtw_dev *rtwdev, struct rtw_vif *rtwvif) |
| { |
| struct rtw_lps_conf *conf = &rtwdev->lps_conf; |
| |
| if (rtwvif->in_lps) |
| return; |
| |
| conf->mode = RTW_MODE_LPS; |
| conf->rtwvif = rtwvif; |
| rtwvif->in_lps = true; |
| |
| ieee80211_queue_delayed_work(rtwdev->hw, &rtwdev->lps_work, 0); |
| } |
| |
| void rtw_leave_lps_irqsafe(struct rtw_dev *rtwdev, struct rtw_vif *rtwvif) |
| { |
| struct rtw_lps_conf *conf = &rtwdev->lps_conf; |
| |
| if (!rtwvif->in_lps) |
| return; |
| |
| conf->mode = RTW_MODE_ACTIVE; |
| conf->rtwvif = rtwvif; |
| rtwvif->in_lps = false; |
| |
| ieee80211_queue_delayed_work(rtwdev->hw, &rtwdev->lps_work, 0); |
| } |
| |
| bool rtw_in_lps(struct rtw_dev *rtwdev) |
| { |
| return rtw_flag_check(rtwdev, RTW_FLAG_LEISURE_PS); |
| } |
| |
| void rtw_enter_lps(struct rtw_dev *rtwdev, struct rtw_vif *rtwvif) |
| { |
| struct rtw_lps_conf *conf = &rtwdev->lps_conf; |
| |
| if (WARN_ON(!rtwvif)) |
| return; |
| |
| if (rtwvif->in_lps) |
| return; |
| |
| conf->mode = RTW_MODE_LPS; |
| conf->rtwvif = rtwvif; |
| rtwvif->in_lps = true; |
| |
| rtw_enter_lps_core(rtwdev); |
| } |
| |
| void rtw_leave_lps(struct rtw_dev *rtwdev, struct rtw_vif *rtwvif) |
| { |
| struct rtw_lps_conf *conf = &rtwdev->lps_conf; |
| |
| if (WARN_ON(!rtwvif)) |
| return; |
| |
| if (!rtwvif->in_lps) |
| return; |
| |
| conf->mode = RTW_MODE_ACTIVE; |
| conf->rtwvif = rtwvif; |
| rtwvif->in_lps = false; |
| |
| rtw_leave_lps_core(rtwdev); |
| } |