Commit | Line | Data |
---|---|---|
f14cda6f SS |
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) 2018 Intel Corporation | |
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. | |
21 | * | |
22 | * The full GNU General Public License is included in this distribution | |
23 | * in the file called COPYING. | |
24 | * | |
25 | * Contact Information: | |
26 | * Intel Linux Wireless <linuxwifi@intel.com> | |
27 | * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 | |
28 | * | |
29 | * BSD LICENSE | |
30 | * | |
31 | * Copyright (C) 2018 Intel Corporation | |
32 | * All rights reserved. | |
33 | * | |
34 | * Redistribution and use in source and binary forms, with or without | |
35 | * modification, are permitted provided that the following conditions | |
36 | * are met: | |
37 | * | |
38 | * * Redistributions of source code must retain the above copyright | |
39 | * notice, this list of conditions and the following disclaimer. | |
40 | * * Redistributions in binary form must reproduce the above copyright | |
41 | * notice, this list of conditions and the following disclaimer in | |
42 | * the documentation and/or other materials provided with the | |
43 | * distribution. | |
44 | * * Neither the name Intel Corporation nor the names of its | |
45 | * contributors may be used to endorse or promote products derived | |
46 | * from this software without specific prior written permission. | |
47 | * | |
48 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS | |
49 | * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT | |
50 | * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR | |
51 | * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT | |
52 | * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, | |
53 | * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT | |
54 | * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, | |
55 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY | |
56 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT | |
57 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE | |
58 | * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | |
59 | * | |
60 | *****************************************************************************/ | |
61 | ||
62 | #include <linux/firmware.h> | |
63 | #include "iwl-trans.h" | |
64 | #include "iwl-dbg-tlv.h" | |
65 | ||
68f6f492 SS |
66 | void iwl_fw_dbg_copy_tlv(struct iwl_trans *trans, struct iwl_ucode_tlv *tlv, |
67 | bool ext) | |
f14cda6f SS |
68 | { |
69 | struct iwl_apply_point_data *data; | |
70 | struct iwl_fw_ini_header *header = (void *)&tlv->data[0]; | |
71 | u32 apply_point = le32_to_cpu(header->apply_point); | |
72 | ||
73 | int copy_size = le32_to_cpu(tlv->length) + sizeof(*tlv); | |
74 | ||
75 | if (WARN_ONCE(apply_point >= IWL_FW_INI_APPLY_NUM, | |
76 | "Invalid apply point id %d\n", apply_point)) | |
77 | return; | |
78 | ||
68f6f492 SS |
79 | if (ext) |
80 | data = &trans->apply_points_ext[apply_point]; | |
81 | else | |
82 | data = &trans->apply_points[apply_point]; | |
f14cda6f SS |
83 | |
84 | /* | |
85 | * Make sure we still have room to copy this TLV. Offset points to the | |
86 | * location the last copy ended. | |
87 | */ | |
88 | if (WARN_ONCE(data->offset + copy_size > data->size, | |
89 | "Not enough memory for apply point %d\n", | |
90 | apply_point)) | |
91 | return; | |
92 | ||
93 | memcpy(data->data + data->offset, (void *)tlv, copy_size); | |
94 | data->offset += copy_size; | |
95 | } | |
96 | ||
68f6f492 SS |
97 | void iwl_alloc_dbg_tlv(struct iwl_trans *trans, size_t len, const u8 *data, |
98 | bool ext) | |
f14cda6f SS |
99 | { |
100 | struct iwl_ucode_tlv *tlv; | |
101 | u32 size[IWL_FW_INI_APPLY_NUM] = {0}; | |
102 | int i; | |
103 | ||
104 | while (len >= sizeof(*tlv)) { | |
105 | u32 tlv_len, tlv_type, apply; | |
106 | struct iwl_fw_ini_header *hdr; | |
107 | ||
108 | len -= sizeof(*tlv); | |
109 | tlv = (void *)data; | |
110 | ||
111 | tlv_len = le32_to_cpu(tlv->length); | |
112 | tlv_type = le32_to_cpu(tlv->type); | |
113 | ||
114 | if (len < tlv_len) | |
115 | return; | |
116 | ||
117 | len -= ALIGN(tlv_len, 4); | |
118 | data += sizeof(*tlv) + ALIGN(tlv_len, 4); | |
119 | ||
120 | if (!(tlv_type & IWL_UCODE_INI_TLV_GROUP)) | |
121 | continue; | |
122 | ||
123 | hdr = (void *)&tlv->data[0]; | |
124 | apply = le32_to_cpu(hdr->apply_point); | |
125 | ||
d47902f9 SS |
126 | IWL_DEBUG_FW(trans, "Read TLV %x, apply point %d\n", |
127 | le32_to_cpu(tlv->type), apply); | |
128 | ||
f14cda6f SS |
129 | if (WARN_ON(apply >= IWL_FW_INI_APPLY_NUM)) |
130 | continue; | |
131 | ||
132 | size[apply] += sizeof(*tlv) + tlv_len; | |
133 | } | |
134 | ||
135 | for (i = 0; i < ARRAY_SIZE(size); i++) { | |
136 | void *mem; | |
137 | ||
138 | if (!size[i]) | |
139 | continue; | |
140 | ||
141 | mem = kzalloc(size[i], GFP_KERNEL); | |
142 | ||
143 | if (!mem) { | |
144 | IWL_ERR(trans, "No memory for apply point %d\n", i); | |
145 | return; | |
146 | } | |
147 | ||
68f6f492 SS |
148 | if (ext) { |
149 | trans->apply_points_ext[i].data = mem; | |
150 | trans->apply_points_ext[i].size = size[i]; | |
151 | } else { | |
152 | trans->apply_points[i].data = mem; | |
153 | trans->apply_points[i].size = size[i]; | |
154 | } | |
74374223 SS |
155 | |
156 | trans->ini_valid = true; | |
f14cda6f SS |
157 | } |
158 | } | |
159 | ||
160 | void iwl_fw_dbg_free(struct iwl_trans *trans) | |
161 | { | |
162 | int i; | |
163 | ||
164 | for (i = 0; i < ARRAY_SIZE(trans->apply_points); i++) { | |
165 | kfree(trans->apply_points[i].data); | |
166 | trans->apply_points[i].size = 0; | |
167 | trans->apply_points[i].offset = 0; | |
68f6f492 SS |
168 | |
169 | kfree(trans->apply_points_ext[i].data); | |
170 | trans->apply_points_ext[i].size = 0; | |
171 | trans->apply_points_ext[i].offset = 0; | |
172 | } | |
173 | } | |
174 | ||
175 | static int iwl_parse_fw_dbg_tlv(struct iwl_trans *trans, const u8 *data, | |
176 | size_t len) | |
177 | { | |
178 | struct iwl_ucode_tlv *tlv; | |
179 | enum iwl_ucode_tlv_type tlv_type; | |
180 | u32 tlv_len; | |
181 | ||
182 | while (len >= sizeof(*tlv)) { | |
183 | len -= sizeof(*tlv); | |
184 | tlv = (void *)data; | |
185 | ||
186 | tlv_len = le32_to_cpu(tlv->length); | |
187 | tlv_type = le32_to_cpu(tlv->type); | |
188 | ||
189 | if (len < tlv_len) { | |
190 | IWL_ERR(trans, "invalid TLV len: %zd/%u\n", | |
191 | len, tlv_len); | |
192 | return -EINVAL; | |
193 | } | |
194 | len -= ALIGN(tlv_len, 4); | |
195 | data += sizeof(*tlv) + ALIGN(tlv_len, 4); | |
196 | ||
197 | switch (tlv_type) { | |
198 | case IWL_UCODE_TLV_TYPE_BUFFER_ALLOCATION: | |
199 | case IWL_UCODE_TLV_TYPE_HCMD: | |
200 | case IWL_UCODE_TLV_TYPE_REGIONS: | |
201 | case IWL_UCODE_TLV_TYPE_TRIGGERS: | |
202 | case IWL_UCODE_TLV_TYPE_DEBUG_FLOW: | |
203 | iwl_fw_dbg_copy_tlv(trans, tlv, true); | |
19de2fa8 | 204 | break; |
68f6f492 SS |
205 | default: |
206 | WARN_ONCE(1, "Invalid TLV %x\n", tlv_type); | |
207 | break; | |
208 | } | |
f14cda6f | 209 | } |
68f6f492 SS |
210 | |
211 | return 0; | |
212 | } | |
213 | ||
214 | void iwl_load_fw_dbg_tlv(struct device *dev, struct iwl_trans *trans) | |
215 | { | |
216 | const struct firmware *fw; | |
217 | int res; | |
218 | ||
219 | if (trans->external_ini_loaded || !iwlwifi_mod_params.enable_ini) | |
220 | return; | |
221 | ||
222 | res = request_firmware(&fw, "iwl-dbg-tlv.ini", dev); | |
223 | if (res) | |
224 | return; | |
225 | ||
226 | iwl_alloc_dbg_tlv(trans, fw->size, fw->data, true); | |
227 | iwl_parse_fw_dbg_tlv(trans, fw->data, fw->size); | |
228 | ||
229 | trans->external_ini_loaded = true; | |
230 | release_firmware(fw); | |
f14cda6f | 231 | } |