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) 2015 Intel Mobile Communications GmbH 9 * 10 * This program is free software; you can redistribute it and/or modify 11 * it under the terms of version 2 of the GNU General Public License as 12 * published by the Free Software Foundation. 13 * 14 * This program is distributed in the hope that it will be useful, but 15 * WITHOUT ANY WARRANTY; without even the implied warranty of 16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 17 * General Public License for more details. 18 * 19 * You should have received a copy of the GNU General Public License 20 * along with this program; if not, write to the Free Software 21 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110, 22 * USA 23 * 24 * The full GNU General Public License is included in this distribution 25 * in the file called COPYING. 26 * 27 * Contact Information: 28 * Intel Linux Wireless <linuxwifi@intel.com> 29 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 30 * 31 * BSD LICENSE 32 * 33 * Copyright(c) 2015 Intel Mobile Communications GmbH 34 * All rights reserved. 35 * 36 * Redistribution and use in source and binary forms, with or without 37 * modification, are permitted provided that the following conditions 38 * are met: 39 * 40 * * Redistributions of source code must retain the above copyright 41 * notice, this list of conditions and the following disclaimer. 42 * * Redistributions in binary form must reproduce the above copyright 43 * notice, this list of conditions and the following disclaimer in 44 * the documentation and/or other materials provided with the 45 * distribution. 46 * * Neither the name Intel Corporation nor the names of its 47 * contributors may be used to endorse or promote products derived 48 * from this software without specific prior written permission. 49 * 50 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 51 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 52 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 53 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 54 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 55 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 56 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 57 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 58 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 59 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 60 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 61 * 62 *****************************************************************************/ 63 #include <linux/kernel.h> 64 #include <linux/bsearch.h> 65 66 #include "iwl-trans.h" 67 #include "iwl-drv.h" 68 #include "iwl-fh.h" 69 70 struct iwl_trans *iwl_trans_alloc(unsigned int priv_size, 71 struct device *dev, 72 const struct iwl_cfg *cfg, 73 const struct iwl_trans_ops *ops) 74 { 75 struct iwl_trans *trans; 76 #ifdef CONFIG_LOCKDEP 77 static struct lock_class_key __key; 78 #endif 79 80 trans = devm_kzalloc(dev, sizeof(*trans) + priv_size, GFP_KERNEL); 81 if (!trans) 82 return NULL; 83 84 #ifdef CONFIG_LOCKDEP 85 lockdep_init_map(&trans->sync_cmd_lockdep_map, "sync_cmd_lockdep_map", 86 &__key, 0); 87 #endif 88 89 trans->dev = dev; 90 trans->cfg = cfg; 91 trans->ops = ops; 92 trans->num_rx_queues = 1; 93 94 snprintf(trans->dev_cmd_pool_name, sizeof(trans->dev_cmd_pool_name), 95 "iwl_cmd_pool:%s", dev_name(trans->dev)); 96 trans->dev_cmd_pool = 97 kmem_cache_create(trans->dev_cmd_pool_name, 98 sizeof(struct iwl_device_cmd), 99 sizeof(void *), 100 SLAB_HWCACHE_ALIGN, 101 NULL); 102 if (!trans->dev_cmd_pool) 103 return NULL; 104 105 WARN_ON(!ops->wait_txq_empty && !ops->wait_tx_queues_empty); 106 107 return trans; 108 } 109 110 void iwl_trans_free(struct iwl_trans *trans) 111 { 112 kmem_cache_destroy(trans->dev_cmd_pool); 113 } 114 115 int iwl_trans_send_cmd(struct iwl_trans *trans, struct iwl_host_cmd *cmd) 116 { 117 int ret; 118 119 if (unlikely(!(cmd->flags & CMD_SEND_IN_RFKILL) && 120 test_bit(STATUS_RFKILL_OPMODE, &trans->status))) 121 return -ERFKILL; 122 123 if (unlikely(test_bit(STATUS_FW_ERROR, &trans->status))) 124 return -EIO; 125 126 if (unlikely(trans->state != IWL_TRANS_FW_ALIVE)) { 127 IWL_ERR(trans, "%s bad state = %d\n", __func__, trans->state); 128 return -EIO; 129 } 130 131 if (WARN_ON((cmd->flags & CMD_WANT_ASYNC_CALLBACK) && 132 !(cmd->flags & CMD_ASYNC))) 133 return -EINVAL; 134 135 if (!(cmd->flags & CMD_ASYNC)) 136 lock_map_acquire_read(&trans->sync_cmd_lockdep_map); 137 138 if (trans->wide_cmd_header && !iwl_cmd_groupid(cmd->id)) 139 cmd->id = DEF_ID(cmd->id); 140 141 ret = trans->ops->send_cmd(trans, cmd); 142 143 if (!(cmd->flags & CMD_ASYNC)) 144 lock_map_release(&trans->sync_cmd_lockdep_map); 145 146 if (WARN_ON((cmd->flags & CMD_WANT_SKB) && !ret && !cmd->resp_pkt)) 147 return -EIO; 148 149 return ret; 150 } 151 IWL_EXPORT_SYMBOL(iwl_trans_send_cmd); 152 153 /* Comparator for struct iwl_hcmd_names. 154 * Used in the binary search over a list of host commands. 155 * 156 * @key: command_id that we're looking for. 157 * @elt: struct iwl_hcmd_names candidate for match. 158 * 159 * @return 0 iff equal. 160 */ 161 static int iwl_hcmd_names_cmp(const void *key, const void *elt) 162 { 163 const struct iwl_hcmd_names *name = elt; 164 u8 cmd1 = *(u8 *)key; 165 u8 cmd2 = name->cmd_id; 166 167 return (cmd1 - cmd2); 168 } 169 170 const char *iwl_get_cmd_string(struct iwl_trans *trans, u32 id) 171 { 172 u8 grp, cmd; 173 struct iwl_hcmd_names *ret; 174 const struct iwl_hcmd_arr *arr; 175 size_t size = sizeof(struct iwl_hcmd_names); 176 177 grp = iwl_cmd_groupid(id); 178 cmd = iwl_cmd_opcode(id); 179 180 if (!trans->command_groups || grp >= trans->command_groups_size || 181 !trans->command_groups[grp].arr) 182 return "UNKNOWN"; 183 184 arr = &trans->command_groups[grp]; 185 ret = bsearch(&cmd, arr->arr, arr->size, size, iwl_hcmd_names_cmp); 186 if (!ret) 187 return "UNKNOWN"; 188 return ret->cmd_name; 189 } 190 IWL_EXPORT_SYMBOL(iwl_get_cmd_string); 191 192 int iwl_cmd_groups_verify_sorted(const struct iwl_trans_config *trans) 193 { 194 int i, j; 195 const struct iwl_hcmd_arr *arr; 196 197 for (i = 0; i < trans->command_groups_size; i++) { 198 arr = &trans->command_groups[i]; 199 if (!arr->arr) 200 continue; 201 for (j = 0; j < arr->size - 1; j++) 202 if (arr->arr[j].cmd_id > arr->arr[j + 1].cmd_id) 203 return -1; 204 } 205 return 0; 206 } 207 IWL_EXPORT_SYMBOL(iwl_cmd_groups_verify_sorted); 208