Loading...
1// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2/*
3 * Copyright (C) 2015 Intel Mobile Communications GmbH
4 * Copyright (C) 2016-2017 Intel Deutschland GmbH
5 * Copyright (C) 2019-2021, 2023 Intel Corporation
6 */
7#include <linux/kernel.h>
8#include <linux/bsearch.h>
9
10#include "fw/api/tx.h"
11#include "iwl-trans.h"
12#include "iwl-drv.h"
13#include "iwl-fh.h"
14#include "queue/tx.h"
15#include <linux/dmapool.h>
16#include "fw/api/commands.h"
17
18struct iwl_trans *iwl_trans_alloc(unsigned int priv_size,
19 struct device *dev,
20 const struct iwl_trans_ops *ops,
21 const struct iwl_cfg_trans_params *cfg_trans)
22{
23 struct iwl_trans *trans;
24#ifdef CONFIG_LOCKDEP
25 static struct lock_class_key __key;
26#endif
27
28 trans = devm_kzalloc(dev, sizeof(*trans) + priv_size, GFP_KERNEL);
29 if (!trans)
30 return NULL;
31
32 trans->trans_cfg = cfg_trans;
33
34#ifdef CONFIG_LOCKDEP
35 lockdep_init_map(&trans->sync_cmd_lockdep_map, "sync_cmd_lockdep_map",
36 &__key, 0);
37#endif
38
39 trans->dev = dev;
40 trans->ops = ops;
41 trans->num_rx_queues = 1;
42
43 WARN_ON(!ops->wait_txq_empty && !ops->wait_tx_queues_empty);
44
45 if (trans->trans_cfg->gen2) {
46 trans->txqs.tfd.addr_size = 64;
47 trans->txqs.tfd.max_tbs = IWL_TFH_NUM_TBS;
48 trans->txqs.tfd.size = sizeof(struct iwl_tfh_tfd);
49 } else {
50 trans->txqs.tfd.addr_size = 36;
51 trans->txqs.tfd.max_tbs = IWL_NUM_OF_TBS;
52 trans->txqs.tfd.size = sizeof(struct iwl_tfd);
53 }
54 trans->max_skb_frags = IWL_TRANS_MAX_FRAGS(trans);
55
56 return trans;
57}
58
59int iwl_trans_init(struct iwl_trans *trans)
60{
61 int txcmd_size, txcmd_align;
62
63 if (!trans->trans_cfg->gen2) {
64 txcmd_size = sizeof(struct iwl_tx_cmd);
65 txcmd_align = sizeof(void *);
66 } else if (trans->trans_cfg->device_family < IWL_DEVICE_FAMILY_AX210) {
67 txcmd_size = sizeof(struct iwl_tx_cmd_gen2);
68 txcmd_align = 64;
69 } else {
70 txcmd_size = sizeof(struct iwl_tx_cmd_gen3);
71 txcmd_align = 128;
72 }
73
74 txcmd_size += sizeof(struct iwl_cmd_header);
75 txcmd_size += 36; /* biggest possible 802.11 header */
76
77 /* Ensure device TX cmd cannot reach/cross a page boundary in gen2 */
78 if (WARN_ON(trans->trans_cfg->gen2 && txcmd_size >= txcmd_align))
79 return -EINVAL;
80
81 if (trans->trans_cfg->device_family >= IWL_DEVICE_FAMILY_BZ)
82 trans->txqs.bc_tbl_size =
83 sizeof(struct iwl_gen3_bc_tbl_entry) * TFD_QUEUE_BC_SIZE_GEN3_BZ;
84 else if (trans->trans_cfg->device_family >= IWL_DEVICE_FAMILY_AX210)
85 trans->txqs.bc_tbl_size =
86 sizeof(struct iwl_gen3_bc_tbl_entry) * TFD_QUEUE_BC_SIZE_GEN3_AX210;
87 else
88 trans->txqs.bc_tbl_size = sizeof(struct iwlagn_scd_bc_tbl);
89 /*
90 * For gen2 devices, we use a single allocation for each byte-count
91 * table, but they're pretty small (1k) so use a DMA pool that we
92 * allocate here.
93 */
94 if (trans->trans_cfg->gen2) {
95 trans->txqs.bc_pool = dmam_pool_create("iwlwifi:bc", trans->dev,
96 trans->txqs.bc_tbl_size,
97 256, 0);
98 if (!trans->txqs.bc_pool)
99 return -ENOMEM;
100 }
101
102 /* Some things must not change even if the config does */
103 WARN_ON(trans->txqs.tfd.addr_size !=
104 (trans->trans_cfg->gen2 ? 64 : 36));
105
106 snprintf(trans->dev_cmd_pool_name, sizeof(trans->dev_cmd_pool_name),
107 "iwl_cmd_pool:%s", dev_name(trans->dev));
108 trans->dev_cmd_pool =
109 kmem_cache_create(trans->dev_cmd_pool_name,
110 txcmd_size, txcmd_align,
111 SLAB_HWCACHE_ALIGN, NULL);
112 if (!trans->dev_cmd_pool)
113 return -ENOMEM;
114
115 trans->txqs.tso_hdr_page = alloc_percpu(struct iwl_tso_hdr_page);
116 if (!trans->txqs.tso_hdr_page) {
117 kmem_cache_destroy(trans->dev_cmd_pool);
118 return -ENOMEM;
119 }
120
121 /* Initialize the wait queue for commands */
122 init_waitqueue_head(&trans->wait_command_queue);
123
124 return 0;
125}
126
127void iwl_trans_free(struct iwl_trans *trans)
128{
129 int i;
130
131 if (trans->txqs.tso_hdr_page) {
132 for_each_possible_cpu(i) {
133 struct iwl_tso_hdr_page *p =
134 per_cpu_ptr(trans->txqs.tso_hdr_page, i);
135
136 if (p && p->page)
137 __free_page(p->page);
138 }
139
140 free_percpu(trans->txqs.tso_hdr_page);
141 }
142
143 kmem_cache_destroy(trans->dev_cmd_pool);
144}
145
146int iwl_trans_send_cmd(struct iwl_trans *trans, struct iwl_host_cmd *cmd)
147{
148 int ret;
149
150 if (unlikely(!(cmd->flags & CMD_SEND_IN_RFKILL) &&
151 test_bit(STATUS_RFKILL_OPMODE, &trans->status)))
152 return -ERFKILL;
153
154 /*
155 * We can't test IWL_MVM_STATUS_IN_D3 in mvm->status because this
156 * bit is set early in the D3 flow, before we send all the commands
157 * that configure the firmware for D3 operation (power, patterns, ...)
158 * and we don't want to flag all those with CMD_SEND_IN_D3.
159 * So use the system_pm_mode instead. The only command sent after
160 * we set system_pm_mode is D3_CONFIG_CMD, which we now flag with
161 * CMD_SEND_IN_D3.
162 */
163 if (unlikely(trans->system_pm_mode == IWL_PLAT_PM_MODE_D3 &&
164 !(cmd->flags & CMD_SEND_IN_D3)))
165 return -EHOSTDOWN;
166
167 if (unlikely(test_bit(STATUS_FW_ERROR, &trans->status)))
168 return -EIO;
169
170 if (unlikely(trans->state != IWL_TRANS_FW_ALIVE)) {
171 IWL_ERR(trans, "%s bad state = %d\n", __func__, trans->state);
172 return -EIO;
173 }
174
175 if (!(cmd->flags & CMD_ASYNC))
176 lock_map_acquire_read(&trans->sync_cmd_lockdep_map);
177
178 if (trans->wide_cmd_header && !iwl_cmd_groupid(cmd->id)) {
179 if (cmd->id != REPLY_ERROR)
180 cmd->id = DEF_ID(cmd->id);
181 }
182
183 ret = iwl_trans_txq_send_hcmd(trans, cmd);
184
185 if (!(cmd->flags & CMD_ASYNC))
186 lock_map_release(&trans->sync_cmd_lockdep_map);
187
188 if (WARN_ON((cmd->flags & CMD_WANT_SKB) && !ret && !cmd->resp_pkt))
189 return -EIO;
190
191 return ret;
192}
193IWL_EXPORT_SYMBOL(iwl_trans_send_cmd);
194
195/* Comparator for struct iwl_hcmd_names.
196 * Used in the binary search over a list of host commands.
197 *
198 * @key: command_id that we're looking for.
199 * @elt: struct iwl_hcmd_names candidate for match.
200 *
201 * @return 0 iff equal.
202 */
203static int iwl_hcmd_names_cmp(const void *key, const void *elt)
204{
205 const struct iwl_hcmd_names *name = elt;
206 const u8 *cmd1 = key;
207 u8 cmd2 = name->cmd_id;
208
209 return (*cmd1 - cmd2);
210}
211
212const char *iwl_get_cmd_string(struct iwl_trans *trans, u32 id)
213{
214 u8 grp, cmd;
215 struct iwl_hcmd_names *ret;
216 const struct iwl_hcmd_arr *arr;
217 size_t size = sizeof(struct iwl_hcmd_names);
218
219 grp = iwl_cmd_groupid(id);
220 cmd = iwl_cmd_opcode(id);
221
222 if (!trans->command_groups || grp >= trans->command_groups_size ||
223 !trans->command_groups[grp].arr)
224 return "UNKNOWN";
225
226 arr = &trans->command_groups[grp];
227 ret = bsearch(&cmd, arr->arr, arr->size, size, iwl_hcmd_names_cmp);
228 if (!ret)
229 return "UNKNOWN";
230 return ret->cmd_name;
231}
232IWL_EXPORT_SYMBOL(iwl_get_cmd_string);
233
234int iwl_cmd_groups_verify_sorted(const struct iwl_trans_config *trans)
235{
236 int i, j;
237 const struct iwl_hcmd_arr *arr;
238
239 for (i = 0; i < trans->command_groups_size; i++) {
240 arr = &trans->command_groups[i];
241 if (!arr->arr)
242 continue;
243 for (j = 0; j < arr->size - 1; j++)
244 if (arr->arr[j].cmd_id > arr->arr[j + 1].cmd_id)
245 return -1;
246 }
247 return 0;
248}
249IWL_EXPORT_SYMBOL(iwl_cmd_groups_verify_sorted);
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
69struct iwl_trans *iwl_trans_alloc(unsigned int priv_size,
70 struct device *dev,
71 const struct iwl_cfg *cfg,
72 const struct iwl_trans_ops *ops,
73 size_t dev_cmd_headroom)
74{
75 struct iwl_trans *trans;
76#ifdef CONFIG_LOCKDEP
77 static struct lock_class_key __key;
78#endif
79
80 trans = kzalloc(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->dev_cmd_headroom = dev_cmd_headroom;
93 trans->num_rx_queues = 1;
94
95 snprintf(trans->dev_cmd_pool_name, sizeof(trans->dev_cmd_pool_name),
96 "iwl_cmd_pool:%s", dev_name(trans->dev));
97 trans->dev_cmd_pool =
98 kmem_cache_create(trans->dev_cmd_pool_name,
99 sizeof(struct iwl_device_cmd)
100 + trans->dev_cmd_headroom,
101 sizeof(void *),
102 SLAB_HWCACHE_ALIGN,
103 NULL);
104 if (!trans->dev_cmd_pool)
105 goto free;
106
107 return trans;
108 free:
109 kfree(trans);
110 return NULL;
111}
112
113void iwl_trans_free(struct iwl_trans *trans)
114{
115 kmem_cache_destroy(trans->dev_cmd_pool);
116 kfree(trans);
117}
118
119int iwl_trans_send_cmd(struct iwl_trans *trans, struct iwl_host_cmd *cmd)
120{
121 int ret;
122
123 if (unlikely(!(cmd->flags & CMD_SEND_IN_RFKILL) &&
124 test_bit(STATUS_RFKILL, &trans->status)))
125 return -ERFKILL;
126
127 if (unlikely(test_bit(STATUS_FW_ERROR, &trans->status)))
128 return -EIO;
129
130 if (unlikely(trans->state != IWL_TRANS_FW_ALIVE)) {
131 IWL_ERR(trans, "%s bad state = %d\n", __func__, trans->state);
132 return -EIO;
133 }
134
135 if (WARN_ON((cmd->flags & CMD_WANT_ASYNC_CALLBACK) &&
136 !(cmd->flags & CMD_ASYNC)))
137 return -EINVAL;
138
139 if (!(cmd->flags & CMD_ASYNC))
140 lock_map_acquire_read(&trans->sync_cmd_lockdep_map);
141
142 ret = trans->ops->send_cmd(trans, cmd);
143
144 if (!(cmd->flags & CMD_ASYNC))
145 lock_map_release(&trans->sync_cmd_lockdep_map);
146
147 return ret;
148}
149IWL_EXPORT_SYMBOL(iwl_trans_send_cmd);
150
151/* Comparator for struct iwl_hcmd_names.
152 * Used in the binary search over a list of host commands.
153 *
154 * @key: command_id that we're looking for.
155 * @elt: struct iwl_hcmd_names candidate for match.
156 *
157 * @return 0 iff equal.
158 */
159static int iwl_hcmd_names_cmp(const void *key, const void *elt)
160{
161 const struct iwl_hcmd_names *name = elt;
162 u8 cmd1 = *(u8 *)key;
163 u8 cmd2 = name->cmd_id;
164
165 return (cmd1 - cmd2);
166}
167
168const char *iwl_get_cmd_string(struct iwl_trans *trans, u32 id)
169{
170 u8 grp, cmd;
171 struct iwl_hcmd_names *ret;
172 const struct iwl_hcmd_arr *arr;
173 size_t size = sizeof(struct iwl_hcmd_names);
174
175 grp = iwl_cmd_groupid(id);
176 cmd = iwl_cmd_opcode(id);
177
178 if (!trans->command_groups || grp >= trans->command_groups_size ||
179 !trans->command_groups[grp].arr)
180 return "UNKNOWN";
181
182 arr = &trans->command_groups[grp];
183 ret = bsearch(&cmd, arr->arr, arr->size, size, iwl_hcmd_names_cmp);
184 if (!ret)
185 return "UNKNOWN";
186 return ret->cmd_name;
187}
188IWL_EXPORT_SYMBOL(iwl_get_cmd_string);
189
190int iwl_cmd_groups_verify_sorted(const struct iwl_trans_config *trans)
191{
192 int i, j;
193 const struct iwl_hcmd_arr *arr;
194
195 for (i = 0; i < trans->command_groups_size; i++) {
196 arr = &trans->command_groups[i];
197 if (!arr->arr)
198 continue;
199 for (j = 0; j < arr->size - 1; j++)
200 if (arr->arr[j].cmd_id > arr->arr[j + 1].cmd_id)
201 return -1;
202 }
203 return 0;
204}
205IWL_EXPORT_SYMBOL(iwl_cmd_groups_verify_sorted);