1 /****************************************************************************** 2 * 3 * This file is provided under a dual BSD/GPLv2 license. When using or 4 * redistributing this file, you may do so under either license. 5 * 6 * GPL LICENSE SUMMARY 7 * 8 * Copyright(c) 2007 - 2014 Intel Corporation. All rights reserved. 9 * Copyright(c) 2015 Intel Deutschland GmbH 10 * 11 * This program is free software; you can redistribute it and/or modify 12 * it under the terms of version 2 of the GNU General Public License as 13 * published by the Free Software Foundation. 14 * 15 * This program is distributed in the hope that it will be useful, but 16 * WITHOUT ANY WARRANTY; without even the implied warranty of 17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 18 * General Public License for more details. 19 * 20 * You should have received a copy of the GNU General Public License 21 * along with this program; if not, write to the Free Software 22 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110, 23 * USA 24 * 25 * The full GNU General Public License is included in this distribution 26 * in the file called COPYING. 27 * 28 * Contact Information: 29 * Intel Linux Wireless <linuxwifi@intel.com> 30 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 31 * 32 * BSD LICENSE 33 * 34 * Copyright(c) 2005 - 2014 Intel Corporation. All rights reserved. 35 * All rights reserved. 36 * 37 * Redistribution and use in source and binary forms, with or without 38 * modification, are permitted provided that the following conditions 39 * are met: 40 * 41 * * Redistributions of source code must retain the above copyright 42 * notice, this list of conditions and the following disclaimer. 43 * * Redistributions in binary form must reproduce the above copyright 44 * notice, this list of conditions and the following disclaimer in 45 * the documentation and/or other materials provided with the 46 * distribution. 47 * * Neither the name Intel Corporation nor the names of its 48 * contributors may be used to endorse or promote products derived 49 * from this software without specific prior written permission. 50 * 51 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 52 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 53 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 54 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 55 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 56 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 57 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 58 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 59 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 60 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 61 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 62 * 63 *****************************************************************************/ 64 #include <linux/sched.h> 65 #include <linux/export.h> 66 67 #include "iwl-drv.h" 68 #include "notif-wait.h" 69 70 71 void iwl_notification_wait_init(struct iwl_notif_wait_data *notif_wait) 72 { 73 spin_lock_init(¬if_wait->notif_wait_lock); 74 INIT_LIST_HEAD(¬if_wait->notif_waits); 75 init_waitqueue_head(¬if_wait->notif_waitq); 76 } 77 IWL_EXPORT_SYMBOL(iwl_notification_wait_init); 78 79 bool iwl_notification_wait(struct iwl_notif_wait_data *notif_wait, 80 struct iwl_rx_packet *pkt) 81 { 82 bool triggered = false; 83 84 if (!list_empty(¬if_wait->notif_waits)) { 85 struct iwl_notification_wait *w; 86 87 spin_lock(¬if_wait->notif_wait_lock); 88 list_for_each_entry(w, ¬if_wait->notif_waits, list) { 89 int i; 90 bool found = false; 91 92 /* 93 * If it already finished (triggered) or has been 94 * aborted then don't evaluate it again to avoid races, 95 * Otherwise the function could be called again even 96 * though it returned true before 97 */ 98 if (w->triggered || w->aborted) 99 continue; 100 101 for (i = 0; i < w->n_cmds; i++) { 102 u16 rec_id = WIDE_ID(pkt->hdr.group_id, 103 pkt->hdr.cmd); 104 105 if (w->cmds[i] == rec_id || 106 (!iwl_cmd_groupid(w->cmds[i]) && 107 DEF_ID(w->cmds[i]) == rec_id)) { 108 found = true; 109 break; 110 } 111 } 112 if (!found) 113 continue; 114 115 if (!w->fn || w->fn(notif_wait, pkt, w->fn_data)) { 116 w->triggered = true; 117 triggered = true; 118 } 119 } 120 spin_unlock(¬if_wait->notif_wait_lock); 121 } 122 123 return triggered; 124 } 125 IWL_EXPORT_SYMBOL(iwl_notification_wait); 126 127 void iwl_abort_notification_waits(struct iwl_notif_wait_data *notif_wait) 128 { 129 struct iwl_notification_wait *wait_entry; 130 131 spin_lock(¬if_wait->notif_wait_lock); 132 list_for_each_entry(wait_entry, ¬if_wait->notif_waits, list) 133 wait_entry->aborted = true; 134 spin_unlock(¬if_wait->notif_wait_lock); 135 136 wake_up_all(¬if_wait->notif_waitq); 137 } 138 IWL_EXPORT_SYMBOL(iwl_abort_notification_waits); 139 140 void 141 iwl_init_notification_wait(struct iwl_notif_wait_data *notif_wait, 142 struct iwl_notification_wait *wait_entry, 143 const u16 *cmds, int n_cmds, 144 bool (*fn)(struct iwl_notif_wait_data *notif_wait, 145 struct iwl_rx_packet *pkt, void *data), 146 void *fn_data) 147 { 148 if (WARN_ON(n_cmds > MAX_NOTIF_CMDS)) 149 n_cmds = MAX_NOTIF_CMDS; 150 151 wait_entry->fn = fn; 152 wait_entry->fn_data = fn_data; 153 wait_entry->n_cmds = n_cmds; 154 memcpy(wait_entry->cmds, cmds, n_cmds * sizeof(u16)); 155 wait_entry->triggered = false; 156 wait_entry->aborted = false; 157 158 spin_lock_bh(¬if_wait->notif_wait_lock); 159 list_add(&wait_entry->list, ¬if_wait->notif_waits); 160 spin_unlock_bh(¬if_wait->notif_wait_lock); 161 } 162 IWL_EXPORT_SYMBOL(iwl_init_notification_wait); 163 164 int iwl_wait_notification(struct iwl_notif_wait_data *notif_wait, 165 struct iwl_notification_wait *wait_entry, 166 unsigned long timeout) 167 { 168 int ret; 169 170 ret = wait_event_timeout(notif_wait->notif_waitq, 171 wait_entry->triggered || wait_entry->aborted, 172 timeout); 173 174 spin_lock_bh(¬if_wait->notif_wait_lock); 175 list_del(&wait_entry->list); 176 spin_unlock_bh(¬if_wait->notif_wait_lock); 177 178 if (wait_entry->aborted) 179 return -EIO; 180 181 /* return value is always >= 0 */ 182 if (ret <= 0) 183 return -ETIMEDOUT; 184 return 0; 185 } 186 IWL_EXPORT_SYMBOL(iwl_wait_notification); 187 188 void iwl_remove_notification(struct iwl_notif_wait_data *notif_wait, 189 struct iwl_notification_wait *wait_entry) 190 { 191 spin_lock_bh(¬if_wait->notif_wait_lock); 192 list_del(&wait_entry->list); 193 spin_unlock_bh(¬if_wait->notif_wait_lock); 194 } 195 IWL_EXPORT_SYMBOL(iwl_remove_notification); 196