cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

ps.c (3602B)


      1// SPDX-License-Identifier: GPL-2.0-only
      2/*
      3 * This file is part of wl1251
      4 *
      5 * Copyright (C) 2008 Nokia Corporation
      6 */
      7
      8#include "reg.h"
      9#include "ps.h"
     10#include "cmd.h"
     11#include "io.h"
     12
     13/* in ms */
     14#define WL1251_WAKEUP_TIMEOUT 100
     15
     16void wl1251_elp_work(struct work_struct *work)
     17{
     18	struct delayed_work *dwork;
     19	struct wl1251 *wl;
     20
     21	dwork = to_delayed_work(work);
     22	wl = container_of(dwork, struct wl1251, elp_work);
     23
     24	wl1251_debug(DEBUG_PSM, "elp work");
     25
     26	mutex_lock(&wl->mutex);
     27
     28	if (wl->elp || wl->station_mode == STATION_ACTIVE_MODE)
     29		goto out;
     30
     31	wl1251_debug(DEBUG_PSM, "chip to elp");
     32	wl1251_write_elp(wl, HW_ACCESS_ELP_CTRL_REG_ADDR, ELPCTRL_SLEEP);
     33	wl->elp = true;
     34
     35out:
     36	mutex_unlock(&wl->mutex);
     37}
     38
     39#define ELP_ENTRY_DELAY  5
     40
     41/* Routines to toggle sleep mode while in ELP */
     42void wl1251_ps_elp_sleep(struct wl1251 *wl)
     43{
     44	unsigned long delay;
     45
     46	if (wl->station_mode != STATION_ACTIVE_MODE) {
     47		delay = msecs_to_jiffies(ELP_ENTRY_DELAY);
     48		ieee80211_queue_delayed_work(wl->hw, &wl->elp_work, delay);
     49	}
     50}
     51
     52int wl1251_ps_elp_wakeup(struct wl1251 *wl)
     53{
     54	unsigned long timeout, start;
     55	u32 elp_reg;
     56
     57	cancel_delayed_work(&wl->elp_work);
     58
     59	if (!wl->elp)
     60		return 0;
     61
     62	wl1251_debug(DEBUG_PSM, "waking up chip from elp");
     63
     64	start = jiffies;
     65	timeout = jiffies + msecs_to_jiffies(WL1251_WAKEUP_TIMEOUT);
     66
     67	wl1251_write_elp(wl, HW_ACCESS_ELP_CTRL_REG_ADDR, ELPCTRL_WAKE_UP);
     68
     69	elp_reg = wl1251_read_elp(wl, HW_ACCESS_ELP_CTRL_REG_ADDR);
     70
     71	/*
     72	 * FIXME: we should wait for irq from chip but, as a temporary
     73	 * solution to simplify locking, let's poll instead
     74	 */
     75	while (!(elp_reg & ELPCTRL_WLAN_READY)) {
     76		if (time_after(jiffies, timeout)) {
     77			wl1251_error("elp wakeup timeout");
     78			return -ETIMEDOUT;
     79		}
     80		msleep(1);
     81		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