Commit | Line | Data |
---|---|---|
f5fc0f86 LC |
1 | /* |
2 | * This file is part of wl1271 | |
3 | * | |
4 | * Copyright (C) 2008-2009 Nokia Corporation | |
5 | * | |
6 | * Contact: Luciano Coelho <luciano.coelho@nokia.com> | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or | |
9 | * modify it under the terms of the GNU General Public License | |
10 | * version 2 as published by the Free Software Foundation. | |
11 | * | |
12 | * This program is distributed in the hope that it will be useful, but | |
13 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
15 | * General Public License for more details. | |
16 | * | |
17 | * You should have received a copy of the GNU General Public License | |
18 | * along with this program; if not, write to the Free Software | |
19 | * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA | |
20 | * 02110-1301 USA | |
21 | * | |
22 | */ | |
23 | ||
24 | #include "wl1271_reg.h" | |
25 | #include "wl1271_ps.h" | |
7b048c52 | 26 | #include "wl1271_io.h" |
f5fc0f86 LC |
27 | |
28 | #define WL1271_WAKEUP_TIMEOUT 500 | |
29 | ||
37b70a81 | 30 | void wl1271_elp_work(struct work_struct *work) |
f5fc0f86 | 31 | { |
37b70a81 JO |
32 | struct delayed_work *dwork; |
33 | struct wl1271 *wl; | |
34 | ||
35 | dwork = container_of(work, struct delayed_work, work); | |
36 | wl = container_of(dwork, struct wl1271, elp_work); | |
37 | ||
38 | wl1271_debug(DEBUG_PSM, "elp work"); | |
39 | ||
40 | mutex_lock(&wl->mutex); | |
41 | ||
8c7f4f31 JO |
42 | if (unlikely(wl->state == WL1271_STATE_OFF)) |
43 | goto out; | |
44 | ||
71449f8d | 45 | if (test_bit(WL1271_FLAG_IN_ELP, &wl->flags) || |
e1972818 JO |
46 | (!test_bit(WL1271_FLAG_PSM, &wl->flags) && |
47 | !test_bit(WL1271_FLAG_IDLE, &wl->flags))) | |
37b70a81 | 48 | goto out; |
f5fc0f86 | 49 | |
37b70a81 | 50 | wl1271_debug(DEBUG_PSM, "chip to elp"); |
74621417 | 51 | wl1271_raw_write32(wl, HW_ACCESS_ELP_CTRL_REG_ADDR, ELPCTRL_SLEEP); |
71449f8d | 52 | set_bit(WL1271_FLAG_IN_ELP, &wl->flags); |
37b70a81 JO |
53 | |
54 | out: | |
55 | mutex_unlock(&wl->mutex); | |
56 | } | |
57 | ||
58 | #define ELP_ENTRY_DELAY 5 | |
59 | ||
60 | /* Routines to toggle sleep mode while in ELP */ | |
61 | void wl1271_ps_elp_sleep(struct wl1271 *wl) | |
62 | { | |
e1972818 JO |
63 | if (test_bit(WL1271_FLAG_PSM, &wl->flags) || |
64 | test_bit(WL1271_FLAG_IDLE, &wl->flags)) { | |
37b70a81 JO |
65 | cancel_delayed_work(&wl->elp_work); |
66 | ieee80211_queue_delayed_work(wl->hw, &wl->elp_work, | |
52b0e7a6 | 67 | msecs_to_jiffies(ELP_ENTRY_DELAY)); |
f5fc0f86 LC |
68 | } |
69 | } | |
70 | ||
71 | int wl1271_ps_elp_wakeup(struct wl1271 *wl, bool chip_awake) | |
72 | { | |
73 | DECLARE_COMPLETION_ONSTACK(compl); | |
74 | unsigned long flags; | |
75 | int ret; | |
76 | u32 start_time = jiffies; | |
77 | bool pending = false; | |
78 | ||
71449f8d | 79 | if (!test_bit(WL1271_FLAG_IN_ELP, &wl->flags)) |
f5fc0f86 LC |
80 | return 0; |
81 | ||
82 | wl1271_debug(DEBUG_PSM, "waking up chip from elp"); | |
83 | ||
84 | /* | |
85 | * The spinlock is required here to synchronize both the work and | |
86 | * the completion variable in one entity. | |
87 | */ | |
88 | spin_lock_irqsave(&wl->wl_lock, flags); | |
89 | if (work_pending(&wl->irq_work) || chip_awake) | |
90 | pending = true; | |
91 | else | |
92 | wl->elp_compl = &compl; | |
93 | spin_unlock_irqrestore(&wl->wl_lock, flags); | |
94 | ||
74621417 | 95 | wl1271_raw_write32(wl, HW_ACCESS_ELP_CTRL_REG_ADDR, ELPCTRL_WAKE_UP); |
f5fc0f86 LC |
96 | |
97 | if (!pending) { | |
98 | ret = wait_for_completion_timeout( | |
99 | &compl, msecs_to_jiffies(WL1271_WAKEUP_TIMEOUT)); | |
100 | if (ret == 0) { | |
101 | wl1271_error("ELP wakeup timeout!"); | |
52b0e7a6 | 102 | ieee80211_queue_work(wl->hw, &wl->recovery_work); |
f5fc0f86 LC |
103 | ret = -ETIMEDOUT; |
104 | goto err; | |
105 | } else if (ret < 0) { | |
106 | wl1271_error("ELP wakeup completion error."); | |
107 | goto err; | |
108 | } | |
109 | } | |
110 | ||
71449f8d | 111 | clear_bit(WL1271_FLAG_IN_ELP, &wl->flags); |
f5fc0f86 LC |
112 | |
113 | wl1271_debug(DEBUG_PSM, "wakeup time: %u ms", | |
114 | jiffies_to_msecs(jiffies - start_time)); | |
115 | goto out; | |
116 | ||
117 | err: | |
118 | spin_lock_irqsave(&wl->wl_lock, flags); | |
119 | wl->elp_compl = NULL; | |
120 | spin_unlock_irqrestore(&wl->wl_lock, flags); | |
121 | return ret; | |
122 | ||
123 | out: | |
124 | return 0; | |
125 | } | |
126 | ||
d8c42c0c | 127 | int wl1271_ps_set_mode(struct wl1271 *wl, enum wl1271_cmd_ps_mode mode, |
65cddbf1 | 128 | u32 rates, bool send) |
f5fc0f86 LC |
129 | { |
130 | int ret; | |
131 | ||
132 | switch (mode) { | |
133 | case STATION_POWER_SAVE_MODE: | |
134 | wl1271_debug(DEBUG_PSM, "entering psm"); | |
1922167b | 135 | |
03f06b7e JO |
136 | ret = wl1271_acx_wake_up_conditions(wl); |
137 | if (ret < 0) { | |
138 | wl1271_error("couldn't set wake up conditions"); | |
139 | return ret; | |
140 | } | |
141 | ||
65cddbf1 JO |
142 | ret = wl1271_cmd_ps_mode(wl, STATION_POWER_SAVE_MODE, |
143 | rates, send); | |
f5fc0f86 LC |
144 | if (ret < 0) |
145 | return ret; | |
146 | ||
71449f8d | 147 | set_bit(WL1271_FLAG_PSM, &wl->flags); |
f5fc0f86 LC |
148 | break; |
149 | case STATION_ACTIVE_MODE: | |
150 | default: | |
151 | wl1271_debug(DEBUG_PSM, "leaving psm"); | |
152 | ret = wl1271_ps_elp_wakeup(wl, false); | |
153 | if (ret < 0) | |
154 | return ret; | |
155 | ||
11f70f97 JO |
156 | /* disable beacon early termination */ |
157 | ret = wl1271_acx_bet_enable(wl, false); | |
158 | if (ret < 0) | |
159 | return ret; | |
160 | ||
1922167b JO |
161 | /* disable beacon filtering */ |
162 | ret = wl1271_acx_beacon_filter_opt(wl, false); | |
163 | if (ret < 0) | |
164 | return ret; | |
165 | ||
65cddbf1 JO |
166 | ret = wl1271_cmd_ps_mode(wl, STATION_ACTIVE_MODE, |
167 | rates, send); | |
f5fc0f86 LC |
168 | if (ret < 0) |
169 | return ret; | |
170 | ||
71449f8d | 171 | clear_bit(WL1271_FLAG_PSM, &wl->flags); |
f5fc0f86 LC |
172 | break; |
173 | } | |
174 | ||
175 | return ret; | |
176 | } | |
177 | ||
178 |