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 ieee80211_scan_completed(wl->hw, false); 40 wl1251_debug(DEBUG_MAC80211, "mac80211 hw scan completed"); 41 wl->scanning = false; 42 if (wl->hw->conf.flags & IEEE80211_CONF_IDLE) 43 ret = wl1251_ps_set_mode(wl, STATION_IDLE); 44 } 45 46 return ret; 47 } 48 49 #define WL1251_PSM_ENTRY_RETRIES 3 50 static int wl1251_event_ps_report(struct wl1251 *wl, 51 struct event_mailbox *mbox) 52 { 53 int ret = 0; 54 55 wl1251_debug(DEBUG_EVENT, "ps status: %x", mbox->ps_status); 56 57 switch (mbox->ps_status) { 58 case EVENT_ENTER_POWER_SAVE_FAIL: 59 wl1251_debug(DEBUG_PSM, "PSM entry failed"); 60 61 if (wl->station_mode != STATION_POWER_SAVE_MODE) { 62 /* remain in active mode */ 63 wl->psm_entry_retry = 0; 64 break; 65 } 66 67 if (wl->psm_entry_retry < WL1251_PSM_ENTRY_RETRIES) { 68 wl->psm_entry_retry++; 69 ret = wl1251_ps_set_mode(wl, STATION_POWER_SAVE_MODE); 70 } else { 71 wl1251_error("Power save entry failed, giving up"); 72 wl->psm_entry_retry = 0; 73 } 74 break; 75 case EVENT_ENTER_POWER_SAVE_SUCCESS: 76 case EVENT_EXIT_POWER_SAVE_FAIL: 77 case EVENT_EXIT_POWER_SAVE_SUCCESS: 78 default: 79 wl->psm_entry_retry = 0; 80 break; 81 } 82 83 return 0; 84 } 85 86 static void wl1251_event_mbox_dump(struct event_mailbox *mbox) 87 { 88 wl1251_debug(DEBUG_EVENT, "MBOX DUMP:"); 89 wl1251_debug(DEBUG_EVENT, "\tvector: 0x%x", mbox->events_vector); 90 wl1251_debug(DEBUG_EVENT, "\tmask: 0x%x", mbox->events_mask); 91 } 92 93 static int wl1251_event_process(struct wl1251 *wl, struct event_mailbox *mbox) 94 { 95 int ret; 96 u32 vector; 97 98 wl1251_event_mbox_dump(mbox); 99 100 vector = mbox->events_vector & ~(mbox->events_mask); 101 wl1251_debug(DEBUG_EVENT, "vector: 0x%x", vector); 102 103 if (vector & SCAN_COMPLETE_EVENT_ID) { 104 ret = wl1251_event_scan_complete(wl, mbox); 105 if (ret < 0) 106 return ret; 107 } 108 109 if (vector & BSS_LOSE_EVENT_ID) { 110 wl1251_debug(DEBUG_EVENT, "BSS_LOSE_EVENT"); 111 112 if (wl->psm_requested && 113 wl->station_mode != STATION_ACTIVE_MODE) { 114 ret = wl1251_ps_set_mode(wl, STATION_ACTIVE_MODE); 115 if (ret < 0) 116 return ret; 117 } 118 } 119 120 if (vector & PS_REPORT_EVENT_ID) { 121 wl1251_debug(DEBUG_EVENT, "PS_REPORT_EVENT"); 122 ret = wl1251_event_ps_report(wl, mbox); 123 if (ret < 0) 124 return ret; 125 } 126 127 if (wl->vif && vector & SYNCHRONIZATION_TIMEOUT_EVENT_ID) { 128 wl1251_debug(DEBUG_EVENT, "SYNCHRONIZATION_TIMEOUT_EVENT"); 129 130 /* indicate to the stack, that beacons have been lost */ 131 ieee80211_beacon_loss(wl->vif); 132 } 133 134 if (vector & REGAINED_BSS_EVENT_ID) { 135 if (wl->psm_requested) { 136 ret = wl1251_ps_set_mode(wl, STATION_POWER_SAVE_MODE); 137 if (ret < 0) 138 return ret; 139 } 140 } 141 142 if (wl->vif && wl->rssi_thold) { 143 if (vector & ROAMING_TRIGGER_LOW_RSSI_EVENT_ID) { 144 wl1251_debug(DEBUG_EVENT, 145 "ROAMING_TRIGGER_LOW_RSSI_EVENT"); 146 ieee80211_cqm_rssi_notify(wl->vif, 147 NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW, 148 GFP_KERNEL); 149 } 150 151 if (vector & ROAMING_TRIGGER_REGAINED_RSSI_EVENT_ID) { 152 wl1251_debug(DEBUG_EVENT, 153 "ROAMING_TRIGGER_REGAINED_RSSI_EVENT"); 154 ieee80211_cqm_rssi_notify(wl->vif, 155 NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH, 156 GFP_KERNEL); 157 } 158 } 159 160 return 0; 161 } 162 163 /* 164 * Poll the mailbox event field until any of the bits in the mask is set or a 165 * timeout occurs (WL1251_EVENT_TIMEOUT in msecs) 166 */ 167 int wl1251_event_wait(struct wl1251 *wl, u32 mask, int timeout_ms) 168 { 169 u32 events_vector, event; 170 unsigned long timeout; 171 172 timeout = jiffies + msecs_to_jiffies(timeout_ms); 173 174 do { 175 if (time_after(jiffies, timeout)) 176 return -ETIMEDOUT; 177 178 msleep(1); 179 180 /* read from both event fields */ 181 wl1251_mem_read(wl, wl->mbox_ptr[0], &events_vector, 182 sizeof(events_vector)); 183 event = events_vector & mask; 184 wl1251_mem_read(wl, wl->mbox_ptr[1], &events_vector, 185 sizeof(events_vector)); 186 event |= events_vector & mask; 187 } while (!event); 188 189 return 0; 190 } 191 192 int wl1251_event_unmask(struct wl1251 *wl) 193 { 194 int ret; 195 196 ret = wl1251_acx_event_mbox_mask(wl, ~(wl->event_mask)); 197 if (ret < 0) 198 return ret; 199 200 return 0; 201 } 202 203 void wl1251_event_mbox_config(struct wl1251 *wl) 204 { 205 wl->mbox_ptr[0] = wl1251_reg_read32(wl, REG_EVENT_MAILBOX_PTR); 206 wl->mbox_ptr[1] = wl->mbox_ptr[0] + sizeof(struct event_mailbox); 207 208 wl1251_debug(DEBUG_EVENT, "MBOX ptrs: 0x%x 0x%x", 209 wl->mbox_ptr[0], wl->mbox_ptr[1]); 210 } 211 212 int wl1251_event_handle(struct wl1251 *wl, u8 mbox_num) 213 { 214 struct event_mailbox mbox; 215 int ret; 216 217 wl1251_debug(DEBUG_EVENT, "EVENT on mbox %d", mbox_num); 218 219 if (mbox_num > 1) 220 return -EINVAL; 221 222 /* first we read the mbox descriptor */ 223 wl1251_mem_read(wl, wl->mbox_ptr[mbox_num], &mbox, 224 sizeof(struct event_mailbox)); 225 226 /* process the descriptor */ 227 ret = wl1251_event_process(wl, &mbox); 228 if (ret < 0) 229 return ret; 230 231 /* then we let the firmware know it can go on...*/ 232 wl1251_reg_write32(wl, ACX_REG_INTERRUPT_TRIG, INTR_TRIG_EVENT_ACK); 233 234 return 0; 235 } 236