Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 1 | /* |
Kalle Valo | 80301cd | 2009-06-12 14:17:39 +0300 | [diff] [blame] | 2 | * This file is part of wl1251 |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 3 | * |
| 4 | * Copyright (c) 1998-2007 Texas Instruments Incorporated |
| 5 | * Copyright (C) 2008 Nokia Corporation |
| 6 | * |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 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 | |
Kalle Valo | 1367411 | 2009-06-12 14:17:25 +0300 | [diff] [blame] | 23 | #include "wl1251.h" |
Kalle Valo | 9bc6772 | 2010-10-10 11:28:32 +0300 | [diff] [blame] | 24 | #include "reg.h" |
| 25 | #include "io.h" |
| 26 | #include "event.h" |
| 27 | #include "ps.h" |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 28 | |
Kalle Valo | 80301cd | 2009-06-12 14:17:39 +0300 | [diff] [blame] | 29 | static int wl1251_event_scan_complete(struct wl1251 *wl, |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 30 | struct event_mailbox *mbox) |
| 31 | { |
Kalle Valo | 80301cd | 2009-06-12 14:17:39 +0300 | [diff] [blame] | 32 | wl1251_debug(DEBUG_EVENT, "status: 0x%x, channels: %d", |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 33 | mbox->scheduled_scan_status, |
| 34 | mbox->scheduled_scan_channels); |
| 35 | |
| 36 | if (wl->scanning) { |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 37 | ieee80211_scan_completed(wl->hw, false); |
Kalle Valo | 2789da9 | 2009-08-07 13:35:26 +0300 | [diff] [blame] | 38 | wl1251_debug(DEBUG_MAC80211, "mac80211 hw scan completed"); |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 39 | wl->scanning = false; |
| 40 | } |
| 41 | |
| 42 | return 0; |
| 43 | } |
| 44 | |
Kalle Valo | 80301cd | 2009-06-12 14:17:39 +0300 | [diff] [blame] | 45 | static void wl1251_event_mbox_dump(struct event_mailbox *mbox) |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 46 | { |
Kalle Valo | 80301cd | 2009-06-12 14:17:39 +0300 | [diff] [blame] | 47 | wl1251_debug(DEBUG_EVENT, "MBOX DUMP:"); |
| 48 | wl1251_debug(DEBUG_EVENT, "\tvector: 0x%x", mbox->events_vector); |
| 49 | wl1251_debug(DEBUG_EVENT, "\tmask: 0x%x", mbox->events_mask); |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 50 | } |
| 51 | |
Kalle Valo | 80301cd | 2009-06-12 14:17:39 +0300 | [diff] [blame] | 52 | static int wl1251_event_process(struct wl1251 *wl, struct event_mailbox *mbox) |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 53 | { |
| 54 | int ret; |
| 55 | u32 vector; |
| 56 | |
Kalle Valo | 80301cd | 2009-06-12 14:17:39 +0300 | [diff] [blame] | 57 | wl1251_event_mbox_dump(mbox); |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 58 | |
| 59 | vector = mbox->events_vector & ~(mbox->events_mask); |
Kalle Valo | 80301cd | 2009-06-12 14:17:39 +0300 | [diff] [blame] | 60 | wl1251_debug(DEBUG_EVENT, "vector: 0x%x", vector); |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 61 | |
| 62 | if (vector & SCAN_COMPLETE_EVENT_ID) { |
Kalle Valo | 80301cd | 2009-06-12 14:17:39 +0300 | [diff] [blame] | 63 | ret = wl1251_event_scan_complete(wl, mbox); |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 64 | if (ret < 0) |
| 65 | return ret; |
| 66 | } |
| 67 | |
| 68 | if (vector & BSS_LOSE_EVENT_ID) { |
Kalle Valo | 80301cd | 2009-06-12 14:17:39 +0300 | [diff] [blame] | 69 | wl1251_debug(DEBUG_EVENT, "BSS_LOSE_EVENT"); |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 70 | |
Jarkko Nikula | a0bbb58 | 2011-04-04 11:04:57 +0300 | [diff] [blame] | 71 | if (wl->psm_requested && |
| 72 | wl->station_mode != STATION_ACTIVE_MODE) { |
Kalle Valo | 80301cd | 2009-06-12 14:17:39 +0300 | [diff] [blame] | 73 | ret = wl1251_ps_set_mode(wl, STATION_ACTIVE_MODE); |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 74 | if (ret < 0) |
| 75 | return ret; |
| 76 | } |
| 77 | } |
| 78 | |
Jarkko Nikula | a0bbb58 | 2011-04-04 11:04:57 +0300 | [diff] [blame] | 79 | if (vector & SYNCHRONIZATION_TIMEOUT_EVENT_ID && |
| 80 | wl->station_mode != STATION_ACTIVE_MODE) { |
Juuso Oikarinen | 287f6f9 | 2009-11-17 18:48:23 +0200 | [diff] [blame] | 81 | wl1251_debug(DEBUG_EVENT, "SYNCHRONIZATION_TIMEOUT_EVENT"); |
| 82 | |
| 83 | /* indicate to the stack, that beacons have been lost */ |
| 84 | ieee80211_beacon_loss(wl->vif); |
| 85 | } |
| 86 | |
Vidhya Govindan | 33d51fa | 2009-11-17 18:49:23 +0200 | [diff] [blame] | 87 | if (vector & REGAINED_BSS_EVENT_ID) { |
| 88 | if (wl->psm_requested) { |
| 89 | ret = wl1251_ps_set_mode(wl, STATION_POWER_SAVE_MODE); |
| 90 | if (ret < 0) |
| 91 | return ret; |
| 92 | } |
| 93 | } |
| 94 | |
David Gnedt | 8964e49 | 2011-01-30 20:11:00 +0100 | [diff] [blame] | 95 | if (wl->vif && wl->rssi_thold) { |
| 96 | if (vector & ROAMING_TRIGGER_LOW_RSSI_EVENT_ID) { |
| 97 | wl1251_debug(DEBUG_EVENT, |
| 98 | "ROAMING_TRIGGER_LOW_RSSI_EVENT"); |
| 99 | ieee80211_cqm_rssi_notify(wl->vif, |
| 100 | NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW, |
| 101 | GFP_KERNEL); |
| 102 | } |
| 103 | |
| 104 | if (vector & ROAMING_TRIGGER_REGAINED_RSSI_EVENT_ID) { |
| 105 | wl1251_debug(DEBUG_EVENT, |
| 106 | "ROAMING_TRIGGER_REGAINED_RSSI_EVENT"); |
| 107 | ieee80211_cqm_rssi_notify(wl->vif, |
| 108 | NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH, |
| 109 | GFP_KERNEL); |
| 110 | } |
| 111 | } |
| 112 | |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 113 | return 0; |
| 114 | } |
| 115 | |
Grazvydas Ignotas | 7273b97 | 2010-08-17 22:46:55 +0300 | [diff] [blame] | 116 | /* |
| 117 | * Poll the mailbox event field until any of the bits in the mask is set or a |
| 118 | * timeout occurs (WL1251_EVENT_TIMEOUT in msecs) |
| 119 | */ |
| 120 | int wl1251_event_wait(struct wl1251 *wl, u32 mask, int timeout_ms) |
| 121 | { |
| 122 | u32 events_vector, event; |
| 123 | unsigned long timeout; |
| 124 | |
| 125 | timeout = jiffies + msecs_to_jiffies(timeout_ms); |
| 126 | |
| 127 | do { |
| 128 | if (time_after(jiffies, timeout)) |
| 129 | return -ETIMEDOUT; |
| 130 | |
| 131 | msleep(1); |
| 132 | |
| 133 | /* read from both event fields */ |
| 134 | wl1251_mem_read(wl, wl->mbox_ptr[0], &events_vector, |
| 135 | sizeof(events_vector)); |
| 136 | event = events_vector & mask; |
| 137 | wl1251_mem_read(wl, wl->mbox_ptr[1], &events_vector, |
| 138 | sizeof(events_vector)); |
| 139 | event |= events_vector & mask; |
| 140 | } while (!event); |
| 141 | |
| 142 | return 0; |
| 143 | } |
| 144 | |
Kalle Valo | 80301cd | 2009-06-12 14:17:39 +0300 | [diff] [blame] | 145 | int wl1251_event_unmask(struct wl1251 *wl) |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 146 | { |
| 147 | int ret; |
| 148 | |
Kalle Valo | 80301cd | 2009-06-12 14:17:39 +0300 | [diff] [blame] | 149 | ret = wl1251_acx_event_mbox_mask(wl, ~(wl->event_mask)); |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 150 | if (ret < 0) |
| 151 | return ret; |
| 152 | |
| 153 | return 0; |
| 154 | } |
| 155 | |
Kalle Valo | 80301cd | 2009-06-12 14:17:39 +0300 | [diff] [blame] | 156 | void wl1251_event_mbox_config(struct wl1251 *wl) |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 157 | { |
Kalle Valo | 80301cd | 2009-06-12 14:17:39 +0300 | [diff] [blame] | 158 | wl->mbox_ptr[0] = wl1251_reg_read32(wl, REG_EVENT_MAILBOX_PTR); |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 159 | wl->mbox_ptr[1] = wl->mbox_ptr[0] + sizeof(struct event_mailbox); |
| 160 | |
Kalle Valo | 80301cd | 2009-06-12 14:17:39 +0300 | [diff] [blame] | 161 | wl1251_debug(DEBUG_EVENT, "MBOX ptrs: 0x%x 0x%x", |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 162 | wl->mbox_ptr[0], wl->mbox_ptr[1]); |
| 163 | } |
| 164 | |
Kalle Valo | 80301cd | 2009-06-12 14:17:39 +0300 | [diff] [blame] | 165 | int wl1251_event_handle(struct wl1251 *wl, u8 mbox_num) |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 166 | { |
| 167 | struct event_mailbox mbox; |
| 168 | int ret; |
| 169 | |
Kalle Valo | 80301cd | 2009-06-12 14:17:39 +0300 | [diff] [blame] | 170 | wl1251_debug(DEBUG_EVENT, "EVENT on mbox %d", mbox_num); |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 171 | |
| 172 | if (mbox_num > 1) |
| 173 | return -EINVAL; |
| 174 | |
| 175 | /* first we read the mbox descriptor */ |
Bob Copeland | 0764de6 | 2009-08-07 13:32:56 +0300 | [diff] [blame] | 176 | wl1251_mem_read(wl, wl->mbox_ptr[mbox_num], &mbox, |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 177 | sizeof(struct event_mailbox)); |
| 178 | |
| 179 | /* process the descriptor */ |
Kalle Valo | 80301cd | 2009-06-12 14:17:39 +0300 | [diff] [blame] | 180 | ret = wl1251_event_process(wl, &mbox); |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 181 | if (ret < 0) |
| 182 | return ret; |
| 183 | |
| 184 | /* then we let the firmware know it can go on...*/ |
Kalle Valo | 80301cd | 2009-06-12 14:17:39 +0300 | [diff] [blame] | 185 | wl1251_reg_write32(wl, ACX_REG_INTERRUPT_TRIG, INTR_TRIG_EVENT_ACK); |
Kalle Valo | 2f01a1f | 2009-04-29 23:33:31 +0300 | [diff] [blame] | 186 | |
| 187 | return 0; |
| 188 | } |