1 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause 2 /* 3 * Copyright (C) 2005-2014, 2021 Intel Corporation 4 * Copyright (C) 2015-2017 Intel Deutschland GmbH 5 */ 6 #include <linux/sched.h> 7 #include <linux/export.h> 8 9 #include "iwl-drv.h" 10 #include "notif-wait.h" 11 12 13 void iwl_notification_wait_init(struct iwl_notif_wait_data *notif_wait) 14 { 15 spin_lock_init(¬if_wait->notif_wait_lock); 16 INIT_LIST_HEAD(¬if_wait->notif_waits); 17 init_waitqueue_head(¬if_wait->notif_waitq); 18 } 19 IWL_EXPORT_SYMBOL(iwl_notification_wait_init); 20 21 bool iwl_notification_wait(struct iwl_notif_wait_data *notif_wait, 22 struct iwl_rx_packet *pkt) 23 { 24 bool triggered = false; 25 26 if (!list_empty(¬if_wait->notif_waits)) { 27 struct iwl_notification_wait *w; 28 29 spin_lock_bh(¬if_wait->notif_wait_lock); 30 list_for_each_entry(w, ¬if_wait->notif_waits, list) { 31 int i; 32 bool found = false; 33 34 /* 35 * If it already finished (triggered) or has been 36 * aborted then don't evaluate it again to avoid races, 37 * Otherwise the function could be called again even 38 * though it returned true before 39 */ 40 if (w->triggered || w->aborted) 41 continue; 42 43 for (i = 0; i < w->n_cmds; i++) { 44 u16 rec_id = WIDE_ID(pkt->hdr.group_id, 45 pkt->hdr.cmd); 46 47 if (w->cmds[i] == rec_id || 48 (!iwl_cmd_groupid(w->cmds[i]) && 49 DEF_ID(w->cmds[i]) == rec_id)) { 50 found = true; 51 break; 52 } 53 } 54 if (!found) 55 continue; 56 57 if (!w->fn || w->fn(notif_wait, pkt, w->fn_data)) { 58 w->triggered = true; 59 triggered = true; 60 } 61 } 62 spin_unlock_bh(¬if_wait->notif_wait_lock); 63 } 64 65 return triggered; 66 } 67 IWL_EXPORT_SYMBOL(iwl_notification_wait); 68 69 void iwl_abort_notification_waits(struct iwl_notif_wait_data *notif_wait) 70 { 71 struct iwl_notification_wait *wait_entry; 72 73 spin_lock_bh(¬if_wait->notif_wait_lock); 74 list_for_each_entry(wait_entry, ¬if_wait->notif_waits, list) 75 wait_entry->aborted = true; 76 spin_unlock_bh(¬if_wait->notif_wait_lock); 77 78 wake_up_all(¬if_wait->notif_waitq); 79 } 80 IWL_EXPORT_SYMBOL(iwl_abort_notification_waits); 81 82 void 83 iwl_init_notification_wait(struct iwl_notif_wait_data *notif_wait, 84 struct iwl_notification_wait *wait_entry, 85 const u16 *cmds, int n_cmds, 86 bool (*fn)(struct iwl_notif_wait_data *notif_wait, 87 struct iwl_rx_packet *pkt, void *data), 88 void *fn_data) 89 { 90 if (WARN_ON(n_cmds > MAX_NOTIF_CMDS)) 91 n_cmds = MAX_NOTIF_CMDS; 92 93 wait_entry->fn = fn; 94 wait_entry->fn_data = fn_data; 95 wait_entry->n_cmds = n_cmds; 96 memcpy(wait_entry->cmds, cmds, n_cmds * sizeof(u16)); 97 wait_entry->triggered = false; 98 wait_entry->aborted = false; 99 100 spin_lock_bh(¬if_wait->notif_wait_lock); 101 list_add(&wait_entry->list, ¬if_wait->notif_waits); 102 spin_unlock_bh(¬if_wait->notif_wait_lock); 103 } 104 IWL_EXPORT_SYMBOL(iwl_init_notification_wait); 105 106 void iwl_remove_notification(struct iwl_notif_wait_data *notif_wait, 107 struct iwl_notification_wait *wait_entry) 108 { 109 spin_lock_bh(¬if_wait->notif_wait_lock); 110 list_del(&wait_entry->list); 111 spin_unlock_bh(¬if_wait->notif_wait_lock); 112 } 113 IWL_EXPORT_SYMBOL(iwl_remove_notification); 114 115 int iwl_wait_notification(struct iwl_notif_wait_data *notif_wait, 116 struct iwl_notification_wait *wait_entry, 117 unsigned long timeout) 118 { 119 int ret; 120 121 ret = wait_event_timeout(notif_wait->notif_waitq, 122 wait_entry->triggered || wait_entry->aborted, 123 timeout); 124 125 iwl_remove_notification(notif_wait, wait_entry); 126 127 if (wait_entry->aborted) 128 return -EIO; 129 130 /* return value is always >= 0 */ 131 if (ret <= 0) 132 return -ETIMEDOUT; 133 return 0; 134 } 135 IWL_EXPORT_SYMBOL(iwl_wait_notification); 136