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 return trans; 106 } 107 108 void iwl_trans_free(struct iwl_trans *trans) 109 { 110 kmem_cache_destroy(trans->dev_cmd_pool); 111 } 112 113 int iwl_trans_send_cmd(struct iwl_trans *trans, struct iwl_host_cmd *cmd) 114 { 115 int ret; 116 117 if (unlikely(!(cmd->flags & CMD_SEND_IN_RFKILL) && 118 test_bit(STATUS_RFKILL, &trans->status))) 119 return -ERFKILL; 120 121 if (unlikely(test_bit(STATUS_FW_ERROR, &trans->status))) 122 return -EIO; 123 124 if (unlikely(trans->state != IWL_TRANS_FW_ALIVE)) { 125 IWL_ERR(trans, "%s bad state = %d\n", __func__, trans->state); 126 return -EIO; 127 } 128 129 if (WARN_ON((cmd->flags & CMD_WANT_ASYNC_CALLBACK) && 130 !(cmd->flags & CMD_ASYNC))) 131 return -EINVAL; 132 133 if (!(cmd->flags & CMD_ASYNC)) 134 lock_map_acquire_read(&trans->sync_cmd_lockdep_map); 135 136 if (trans->wide_cmd_header && !iwl_cmd_groupid(cmd->id)) 137 cmd->id = DEF_ID(cmd->id); 138 139 ret = trans->ops->send_cmd(trans, cmd); 140 141 if (!(cmd->flags & CMD_ASYNC)) 142 lock_map_release(&trans->sync_cmd_lockdep_map); 143 144 return ret; 145 } 146 IWL_EXPORT_SYMBOL(iwl_trans_send_cmd); 147 148 /* Comparator for struct iwl_hcmd_names. 149 * Used in the binary search over a list of host commands. 150 * 151 * @key: command_id that we're looking for. 152 * @elt: struct iwl_hcmd_names candidate for match. 153 * 154 * @return 0 iff equal. 155 */ 156 static int iwl_hcmd_names_cmp(const void *key, const void *elt) 157 { 158 const struct iwl_hcmd_names *name = elt; 159 u8 cmd1 = *(u8 *)key; 160 u8 cmd2 = name->cmd_id; 161 162 return (cmd1 - cmd2); 163 } 164 165 const char *iwl_get_cmd_string(struct iwl_trans *trans, u32 id) 166 { 167 u8 grp, cmd; 168 struct iwl_hcmd_names *ret; 169 const struct iwl_hcmd_arr *arr; 170 size_t size = sizeof(struct iwl_hcmd_names); 171 172 grp = iwl_cmd_groupid(id); 173 cmd = iwl_cmd_opcode(id); 174 175 if (!trans->command_groups || grp >= trans->command_groups_size || 176 !trans->command_groups[grp].arr) 177 return "UNKNOWN"; 178 179 arr = &trans->command_groups[grp]; 180 ret = bsearch(&cmd, arr->arr, arr->size, size, iwl_hcmd_names_cmp); 181 if (!ret) 182 return "UNKNOWN"; 183 return ret->cmd_name; 184 } 185 IWL_EXPORT_SYMBOL(iwl_get_cmd_string); 186 187 int iwl_cmd_groups_verify_sorted(const struct iwl_trans_config *trans) 188 { 189 int i, j; 190 const struct iwl_hcmd_arr *arr; 191 192 for (i = 0; i < trans->command_groups_size; i++) { 193 arr = &trans->command_groups[i]; 194 if (!arr->arr) 195 continue; 196 for (j = 0; j < arr->size - 1; j++) 197 if (arr->arr[j].cmd_id > arr->arr[j + 1].cmd_id) 198 return -1; 199 } 200 return 0; 201 } 202 IWL_EXPORT_SYMBOL(iwl_cmd_groups_verify_sorted); 203