1 /* 2 * This file is part of wl1251 3 * 4 * Copyright (c) 1998-2007 Texas Instruments Incorporated 5 * Copyright (C) 2008 Nokia Corporation 6 * 7 * This program is free software; you can redistribute it and/or 8 * modify it under the terms of the GNU General Public License 9 * version 2 as published by the Free Software Foundation. 10 * 11 * This program is distributed in the hope that it will be useful, but 12 * WITHOUT ANY WARRANTY; without even the implied warranty of 13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 14 * General Public License for more details. 15 * 16 * You should have received a copy of the GNU General Public License 17 * along with this program; if not, write to the Free Software 18 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 19 * 02110-1301 USA 20 * 21 */ 22 23 #include "wl1251.h" 24 #include "reg.h" 25 #include "io.h" 26 #include "event.h" 27 #include "ps.h" 28 29 static int wl1251_event_scan_complete(struct wl1251 *wl, 30 struct event_mailbox *mbox) 31 { 32 int ret = 0; 33 34 wl1251_debug(DEBUG_EVENT, "status: 0x%x, channels: %d", 35 mbox->scheduled_scan_status, 36 mbox->scheduled_scan_channels); 37 38 if (wl->scanning) { 39 struct cfg80211_scan_info info = { 40 .aborted = false, 41 }; 42 43 ieee80211_scan_completed(wl->hw, &info); 44 wl1251_debug(DEBUG_MAC80211, "mac80211 hw scan completed"); 45 wl->scanning = false; 46 if (wl->hw->conf.flags & IEEE80211_CONF_IDLE) 47 ret = wl1251_ps_set_mode(wl, STATION_IDLE); 48 } 49 50 return ret; 51 } 52 53 #define WL1251_PSM_ENTRY_RETRIES 3 54 static int wl1251_event_ps_report(struct wl1251 *wl, 55 struct event_mailbox *mbox) 56 { 57 int ret = 0; 58 59 wl1251_debug(DEBUG_EVENT, "ps status: %x", mbox->ps_status); 60 61 switch (mbox->ps_status) { 62 case EVENT_ENTER_POWER_SAVE_FAIL: 63 wl1251_debug(DEBUG_PSM, "PSM entry failed"); 64 65 if (wl->station_mode != STATION_POWER_SAVE_MODE) { 66 /* remain in active mode */ 67 wl->psm_entry_retry = 0; 68 break; 69 } 70 71 if (wl->psm_entry_retry < WL1251_PSM_ENTRY_RETRIES) { 72 wl->psm_entry_retry++; 73 ret = wl1251_ps_set_mode(wl, STATION_POWER_SAVE_MODE); 74 } else { 75 wl1251_error("Power save entry failed, giving up"); 76 wl->psm_entry_retry = 0; 77 } 78 break; 79 case EVENT_ENTER_POWER_SAVE_SUCCESS: 80 case EVENT_EXIT_POWER_SAVE_FAIL: 81 case EVENT_EXIT_POWER_SAVE_SUCCESS: 82 default: 83 wl->psm_entry_retry = 0; 84 break; 85 } 86 87 return 0; 88 } 89 90 static void wl1251_event_mbox_dump(struct event_mailbox *mbox) 91 { 92 wl1251_debug(DEBUG_EVENT, "MBOX DUMP:"); 93 wl1251_debug(DEBUG_EVENT, "\tvector: 0x%x", mbox->events_vector); 94 wl1251_debug(DEBUG_EVENT, "\tmask: 0x%x", mbox->events_mask); 95 } 96 97 static int wl1251_event_process(struct wl1251 *wl, struct event_mailbox *mbox) 98 { 99 int ret; 100 u32 vector; 101 102 wl1251_event_mbox_dump(mbox); 103 104 vector = mbox->events_vector & ~(mbox->events_mask); 105 wl1251_debug(DEBUG_EVENT, "vector: 0x%x", vector); 106 107 if (vector & SCAN_COMPLETE_EVENT_ID) { 108 ret = wl1251_event_scan_complete(wl, mbox); 109 if (ret < 0) 110 return ret; 111 } 112 113 if (vector & BSS_LOSE_EVENT_ID) { 114 wl1251_debug(DEBUG_EVENT, "BSS_LOSE_EVENT"); 115 116 if (wl->psm_requested && 117 wl->station_mode != STATION_ACTIVE_MODE) { 118 ret = wl1251_ps_set_mode(wl, STATION_ACTIVE_MODE); 119 if (ret < 0) 120 return ret; 121 } 122 } 123 124 if (vector & PS_REPORT_EVENT_ID) { 125 wl1251_debug(DEBUG_EVENT, "PS_REPORT_EVENT"); 126 ret = wl1251_event_ps_report(wl, mbox); 127 if (ret < 0) 128 return ret; 129 } 130 131 if (vector & SYNCHRONIZATION_TIMEOUT_EVENT_ID) { 132 wl1251_debug(DEBUG_EVENT, "SYNCHRONIZATION_TIMEOUT_EVENT"); 133 134 /* indicate to the stack, that beacons have been lost */ 135 if (wl->vif && wl->vif->type == NL80211_IFTYPE_STATION) 136 ieee80211_beacon_loss(wl->vif); 137 } 138 139 if (vector & REGAINED_BSS_EVENT_ID) { 140 if (wl->psm_requested) { 141 ret = wl1251_ps_set_mode(wl, STATION_POWER_SAVE_MODE); 142 if (ret < 0) 143 return ret; 144 } 145 } 146 147 if (wl->vif && wl->rssi_thold) { 148 if (vector & ROAMING_TRIGGER_LOW_RSSI_EVENT_ID) { 149 wl1251_debug(DEBUG_EVENT, 150 "ROAMING_TRIGGER_LOW_RSSI_EVENT"); 151 ieee80211_cqm_rssi_notify(wl->vif, 152 NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW, 153 0, GFP_KERNEL); 154 } 155 156 if (vector & ROAMING_TRIGGER_REGAINED_RSSI_EVENT_ID) { 157 wl1251_debug(DEBUG_EVENT, 158 "ROAMING_TRIGGER_REGAINED_RSSI_EVENT"); 159 ieee80211_cqm_rssi_notify(wl->vif, 160 NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH, 161 0, GFP_KERNEL); 162 } 163 } 164 165 return 0; 166 } 167 168 /* 169 * Poll the mailbox event field until any of the bits in the mask is set or a 170 * timeout occurs (WL1251_EVENT_TIMEOUT in msecs) 171 */ 172 int wl1251_event_wait(struct wl1251 *wl, u32 mask, int timeout_ms) 173 { 174 u32 events_vector, event; 175 unsigned long timeout; 176 177 timeout = jiffies + msecs_to_jiffies(timeout_ms); 178 179 do { 180 if (time_after(jiffies, timeout)) 181 return -ETIMEDOUT; 182 183 msleep(1); 184 185 /* read from both event fields */ 186 wl1251_mem_read(wl, wl->mbox_ptr[0], &events_vector, 187 sizeof(events_vector)); 188 event = events_vector & mask; 189 wl1251_mem_read(wl, wl->mbox_ptr[1], &events_vector, 190 sizeof(events_vector)); 191 event |= events_vector & mask; 192 } while (!event); 193 194 return 0; 195 } 196 197 int wl1251_event_unmask(struct wl1251 *wl) 198 { 199 int ret; 200 201 ret = wl1251_acx_event_mbox_mask(wl, ~(wl->event_mask)); 202 if (ret < 0) 203 return ret; 204 205 return 0; 206 } 207 208 void wl1251_event_mbox_config(struct wl1251 *wl) 209 { 210 wl->mbox_ptr[0] = wl1251_reg_read32(wl, REG_EVENT_MAILBOX_PTR); 211 wl->mbox_ptr[1] = wl->mbox_ptr[0] + sizeof(struct event_mailbox); 212 213 wl1251_debug(DEBUG_EVENT, "MBOX ptrs: 0x%x 0x%x", 214 wl->mbox_ptr[0], wl->mbox_ptr[1]); 215 } 216 217 int wl1251_event_handle(struct wl1251 *wl, u8 mbox_num) 218 { 219 struct event_mailbox mbox; 220 int ret; 221 222 wl1251_debug(DEBUG_EVENT, "EVENT on mbox %d", mbox_num); 223 224 if (mbox_num > 1) 225 return -EINVAL; 226 227 /* first we read the mbox descriptor */ 228 wl1251_mem_read(wl, wl->mbox_ptr[mbox_num], &mbox, 229 sizeof(struct event_mailbox)); 230 231 /* process the descriptor */ 232 ret = wl1251_event_process(wl, &mbox); 233 if (ret < 0) 234 return ret; 235 236 /* then we let the firmware know it can go on...*/ 237 wl1251_reg_write32(wl, ACX_REG_INTERRUPT_TRIG, INTR_TRIG_EVENT_ACK); 238 239 return 0; 240 } 241