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