16591Sdsimms// SPDX-License-Identifier: GPL-2.0-only 212209Skzhaldyb/* 36591Sdsimms * This file is part of wl1251 46591Sdsimms * 56591Sdsimms * Copyright (C) 2008 Nokia Corporation 66591Sdsimms */ 76591Sdsimms 86591Sdsimms#include "reg.h" 96591Sdsimms#include "ps.h" 106591Sdsimms#include "cmd.h" 116591Sdsimms#include "io.h" 126591Sdsimms 136591Sdsimms/* in ms */ 146591Sdsimms#define WL1251_WAKEUP_TIMEOUT 100 156591Sdsimms 166591Sdsimmsvoid wl1251_elp_work(struct work_struct *work) 176591Sdsimms{ 186591Sdsimms struct delayed_work *dwork; 196591Sdsimms struct wl1251 *wl; 206591Sdsimms 216591Sdsimms dwork = to_delayed_work(work); 226591Sdsimms wl = container_of(dwork, struct wl1251, elp_work); 236591Sdsimms 246591Sdsimms wl1251_debug(DEBUG_PSM, "elp work"); 256591Sdsimms 266591Sdsimms mutex_lock(&wl->mutex); 276591Sdsimms 286591Sdsimms if (wl->elp || wl->station_mode == STATION_ACTIVE_MODE) 296591Sdsimms goto out; 306591Sdsimms 316591Sdsimms wl1251_debug(DEBUG_PSM, "chip to elp"); 326591Sdsimms wl1251_write_elp(wl, HW_ACCESS_ELP_CTRL_REG_ADDR, ELPCTRL_SLEEP); 336591Sdsimms wl->elp = true; 346591Sdsimms 356591Sdsimmsout: 366591Sdsimms mutex_unlock(&wl->mutex); 376591Sdsimms} 386591Sdsimms 396591Sdsimms#define ELP_ENTRY_DELAY 5 406591Sdsimms 416591Sdsimms/* Routines to toggle sleep mode while in ELP */ 426591Sdsimmsvoid wl1251_ps_elp_sleep(struct wl1251 *wl) 436591Sdsimms{ 446591Sdsimms unsigned long delay; 456591Sdsimms 466591Sdsimms if (wl->station_mode != STATION_ACTIVE_MODE) { 476591Sdsimms delay = msecs_to_jiffies(ELP_ENTRY_DELAY); 486591Sdsimms ieee80211_queue_delayed_work(wl->hw, &wl->elp_work, delay); 496591Sdsimms } 506591Sdsimms} 516591Sdsimms 526591Sdsimmsint wl1251_ps_elp_wakeup(struct wl1251 *wl) 536591Sdsimms{ 546591Sdsimms unsigned long timeout, start; 556591Sdsimms u32 elp_reg; 566591Sdsimms 576591Sdsimms cancel_delayed_work(&wl->elp_work); 586591Sdsimms 596591Sdsimms if (!wl->elp) 606591Sdsimms return 0; 616591Sdsimms 626591Sdsimms wl1251_debug(DEBUG_PSM, "waking up chip from elp"); 636591Sdsimms 646591Sdsimms start = jiffies; 656591Sdsimms timeout = jiffies + msecs_to_jiffies(WL1251_WAKEUP_TIMEOUT); 666591Sdsimms 676591Sdsimms wl1251_write_elp(wl, HW_ACCESS_ELP_CTRL_REG_ADDR, ELPCTRL_WAKE_UP); 686591Sdsimms 696591Sdsimms elp_reg = wl1251_read_elp(wl, HW_ACCESS_ELP_CTRL_REG_ADDR); 706591Sdsimms 716591Sdsimms /* 726591Sdsimms * FIXME: we should wait for irq from chip but, as a temporary 736591Sdsimms * solution to simplify locking, let's poll instead 746591Sdsimms */ 756591Sdsimms while (!(elp_reg & ELPCTRL_WLAN_READY)) { 766591Sdsimms if (time_after(jiffies, timeout)) { 776591Sdsimms wl1251_error("elp wakeup timeout"); 786591Sdsimms return -ETIMEDOUT; 796591Sdsimms } 806591Sdsimms msleep(1); 816591Sdsimms elp_reg = wl1251_read_elp(wl, HW_ACCESS_ELP_CTRL_REG_ADDR); 82 } 83 84 wl1251_debug(DEBUG_PSM, "wakeup time: %u ms", 85 jiffies_to_msecs(jiffies - start)); 86 87 wl->elp = false; 88 89 return 0; 90} 91 92int wl1251_ps_set_mode(struct wl1251 *wl, enum wl1251_station_mode mode) 93{ 94 int ret; 95 96 switch (mode) { 97 case STATION_POWER_SAVE_MODE: 98 wl1251_debug(DEBUG_PSM, "entering psm"); 99 100 /* enable beacon filtering */ 101 ret = wl1251_acx_beacon_filter_opt(wl, true); 102 if (ret < 0) 103 return ret; 104 105 ret = wl1251_acx_wake_up_conditions(wl, 106 WAKE_UP_EVENT_DTIM_BITMAP, 107 wl->listen_int); 108 if (ret < 0) 109 return ret; 110 111 ret = wl1251_acx_bet_enable(wl, WL1251_ACX_BET_ENABLE, 112 WL1251_DEFAULT_BET_CONSECUTIVE); 113 if (ret < 0) 114 return ret; 115 116 ret = wl1251_cmd_ps_mode(wl, CHIP_POWER_SAVE_MODE); 117 if (ret < 0) 118 return ret; 119 120 ret = wl1251_acx_sleep_auth(wl, WL1251_PSM_ELP); 121 if (ret < 0) 122 return ret; 123 break; 124 case STATION_IDLE: 125 wl1251_debug(DEBUG_PSM, "entering idle"); 126 127 ret = wl1251_acx_sleep_auth(wl, WL1251_PSM_ELP); 128 if (ret < 0) 129 return ret; 130 131 ret = wl1251_cmd_template_set(wl, CMD_DISCONNECT, NULL, 0); 132 if (ret < 0) 133 return ret; 134 break; 135 case STATION_ACTIVE_MODE: 136 default: 137 wl1251_debug(DEBUG_PSM, "leaving psm"); 138 139 ret = wl1251_acx_sleep_auth(wl, WL1251_PSM_CAM); 140 if (ret < 0) 141 return ret; 142 143 /* disable BET */ 144 ret = wl1251_acx_bet_enable(wl, WL1251_ACX_BET_DISABLE, 145 WL1251_DEFAULT_BET_CONSECUTIVE); 146 if (ret < 0) 147 return ret; 148 149 /* disable beacon filtering */ 150 ret = wl1251_acx_beacon_filter_opt(wl, false); 151 if (ret < 0) 152 return ret; 153 154 ret = wl1251_acx_wake_up_conditions(wl, 155 WAKE_UP_EVENT_DTIM_BITMAP, 156 wl->listen_int); 157 if (ret < 0) 158 return ret; 159 160 ret = wl1251_cmd_ps_mode(wl, CHIP_ACTIVE_MODE); 161 if (ret < 0) 162 return ret; 163 164 break; 165 } 166 wl->station_mode = mode; 167 168 return ret; 169} 170 171