Vladimir Kondratiev | 151a970 | 2014-09-10 16:34:30 +0300 | [diff] [blame] | 1 | /* |
Vladimir Kondratiev | 2cd0f02 | 2015-02-15 14:02:30 +0200 | [diff] [blame] | 2 | * Copyright (c) 2014-2015 Qualcomm Atheros, Inc. |
Vladimir Kondratiev | 151a970 | 2014-09-10 16:34:30 +0300 | [diff] [blame] | 3 | * |
| 4 | * Permission to use, copy, modify, and/or distribute this software for any |
| 5 | * purpose with or without fee is hereby granted, provided that the above |
| 6 | * copyright notice and this permission notice appear in all copies. |
| 7 | * |
| 8 | * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES |
| 9 | * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF |
| 10 | * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR |
| 11 | * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES |
| 12 | * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN |
| 13 | * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF |
| 14 | * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. |
| 15 | */ |
| 16 | |
| 17 | /* Algorithmic part of the firmware download. |
| 18 | * To be included in the container file providing framework |
| 19 | */ |
| 20 | |
| 21 | #define wil_err_fw(wil, fmt, arg...) wil_err(wil, "ERR[ FW ]" fmt, ##arg) |
| 22 | #define wil_dbg_fw(wil, fmt, arg...) wil_dbg(wil, "DBG[ FW ]" fmt, ##arg) |
| 23 | #define wil_hex_dump_fw(prefix_str, prefix_type, rowsize, \ |
| 24 | groupsize, buf, len, ascii) \ |
| 25 | print_hex_dump_debug("DBG[ FW ]" prefix_str, \ |
| 26 | prefix_type, rowsize, \ |
| 27 | groupsize, buf, len, ascii) |
| 28 | |
| 29 | #define FW_ADDR_CHECK(ioaddr, val, msg) do { \ |
| 30 | ioaddr = wmi_buffer(wil, val); \ |
| 31 | if (!ioaddr) { \ |
| 32 | wil_err_fw(wil, "bad " msg ": 0x%08x\n", \ |
| 33 | le32_to_cpu(val)); \ |
| 34 | return -EINVAL; \ |
| 35 | } \ |
| 36 | } while (0) |
| 37 | |
| 38 | /** |
| 39 | * wil_fw_verify - verify firmware file validity |
| 40 | * |
| 41 | * perform various checks for the firmware file header. |
| 42 | * records are not validated. |
| 43 | * |
| 44 | * Return file size or negative error |
| 45 | */ |
| 46 | static int wil_fw_verify(struct wil6210_priv *wil, const u8 *data, size_t size) |
| 47 | { |
| 48 | const struct wil_fw_record_head *hdr = (const void *)data; |
| 49 | struct wil_fw_record_file_header fh; |
| 50 | const struct wil_fw_record_file_header *fh_; |
| 51 | u32 crc; |
| 52 | u32 dlen; |
| 53 | |
| 54 | if (size % 4) { |
| 55 | wil_err_fw(wil, "image size not aligned: %zu\n", size); |
| 56 | return -EINVAL; |
| 57 | } |
| 58 | /* have enough data for the file header? */ |
| 59 | if (size < sizeof(*hdr) + sizeof(fh)) { |
| 60 | wil_err_fw(wil, "file too short: %zu bytes\n", size); |
| 61 | return -EINVAL; |
| 62 | } |
| 63 | |
| 64 | /* start with the file header? */ |
| 65 | if (le16_to_cpu(hdr->type) != wil_fw_type_file_header) { |
| 66 | wil_err_fw(wil, "no file header\n"); |
| 67 | return -EINVAL; |
| 68 | } |
| 69 | |
| 70 | /* data_len */ |
| 71 | fh_ = (struct wil_fw_record_file_header *)&hdr[1]; |
| 72 | dlen = le32_to_cpu(fh_->data_len); |
| 73 | if (dlen % 4) { |
| 74 | wil_err_fw(wil, "data length not aligned: %lu\n", (ulong)dlen); |
| 75 | return -EINVAL; |
| 76 | } |
| 77 | if (size < dlen) { |
| 78 | wil_err_fw(wil, "file truncated at %zu/%lu\n", |
| 79 | size, (ulong)dlen); |
| 80 | return -EINVAL; |
| 81 | } |
| 82 | if (dlen < sizeof(*hdr) + sizeof(fh)) { |
| 83 | wil_err_fw(wil, "data length too short: %lu\n", (ulong)dlen); |
| 84 | return -EINVAL; |
| 85 | } |
| 86 | |
| 87 | /* signature */ |
| 88 | if (le32_to_cpu(fh_->signature) != WIL_FW_SIGNATURE) { |
| 89 | wil_err_fw(wil, "bad header signature: 0x%08x\n", |
| 90 | le32_to_cpu(fh_->signature)); |
| 91 | return -EINVAL; |
| 92 | } |
| 93 | |
| 94 | /* version */ |
| 95 | if (le32_to_cpu(fh_->version) > WIL_FW_FMT_VERSION) { |
| 96 | wil_err_fw(wil, "unsupported header version: %d\n", |
| 97 | le32_to_cpu(fh_->version)); |
| 98 | return -EINVAL; |
| 99 | } |
| 100 | |
| 101 | /* checksum. ~crc32(~0, data, size) when fh.crc set to 0*/ |
| 102 | fh = *fh_; |
| 103 | fh.crc = 0; |
| 104 | |
| 105 | crc = crc32_le(~0, (unsigned char const *)hdr, sizeof(*hdr)); |
| 106 | crc = crc32_le(crc, (unsigned char const *)&fh, sizeof(fh)); |
| 107 | crc = crc32_le(crc, (unsigned char const *)&fh_[1], |
| 108 | dlen - sizeof(*hdr) - sizeof(fh)); |
| 109 | crc = ~crc; |
| 110 | |
| 111 | if (crc != le32_to_cpu(fh_->crc)) { |
| 112 | wil_err_fw(wil, "checksum mismatch:" |
| 113 | " calculated for %lu bytes 0x%08x != 0x%08x\n", |
| 114 | (ulong)dlen, crc, le32_to_cpu(fh_->crc)); |
| 115 | return -EINVAL; |
| 116 | } |
| 117 | |
| 118 | return (int)dlen; |
| 119 | } |
| 120 | |
| 121 | static int fw_handle_comment(struct wil6210_priv *wil, const void *data, |
| 122 | size_t size) |
| 123 | { |
| 124 | wil_hex_dump_fw("", DUMP_PREFIX_OFFSET, 16, 1, data, size, true); |
| 125 | |
| 126 | return 0; |
| 127 | } |
| 128 | |
| 129 | static int fw_handle_data(struct wil6210_priv *wil, const void *data, |
| 130 | size_t size) |
| 131 | { |
| 132 | const struct wil_fw_record_data *d = data; |
| 133 | void __iomem *dst; |
| 134 | size_t s = size - sizeof(*d); |
| 135 | |
| 136 | if (size < sizeof(*d) + sizeof(u32)) { |
| 137 | wil_err_fw(wil, "data record too short: %zu\n", size); |
| 138 | return -EINVAL; |
| 139 | } |
| 140 | |
| 141 | FW_ADDR_CHECK(dst, d->addr, "address"); |
| 142 | wil_dbg_fw(wil, "write [0x%08x] <== %zu bytes\n", le32_to_cpu(d->addr), |
| 143 | s); |
| 144 | wil_memcpy_toio_32(dst, d->data, s); |
| 145 | wmb(); /* finish before processing next record */ |
| 146 | |
| 147 | return 0; |
| 148 | } |
| 149 | |
| 150 | static int fw_handle_fill(struct wil6210_priv *wil, const void *data, |
| 151 | size_t size) |
| 152 | { |
| 153 | const struct wil_fw_record_fill *d = data; |
| 154 | void __iomem *dst; |
| 155 | u32 v; |
| 156 | size_t s = (size_t)le32_to_cpu(d->size); |
| 157 | |
| 158 | if (size != sizeof(*d)) { |
| 159 | wil_err_fw(wil, "bad size for fill record: %zu\n", size); |
| 160 | return -EINVAL; |
| 161 | } |
| 162 | |
| 163 | if (s < sizeof(u32)) { |
| 164 | wil_err_fw(wil, "fill size too short: %zu\n", s); |
| 165 | return -EINVAL; |
| 166 | } |
| 167 | |
| 168 | if (s % sizeof(u32)) { |
| 169 | wil_err_fw(wil, "fill size not aligned: %zu\n", s); |
| 170 | return -EINVAL; |
| 171 | } |
| 172 | |
| 173 | FW_ADDR_CHECK(dst, d->addr, "address"); |
| 174 | |
| 175 | v = le32_to_cpu(d->value); |
| 176 | wil_dbg_fw(wil, "fill [0x%08x] <== 0x%08x, %zu bytes\n", |
| 177 | le32_to_cpu(d->addr), v, s); |
| 178 | wil_memset_toio_32(dst, v, s); |
| 179 | wmb(); /* finish before processing next record */ |
| 180 | |
| 181 | return 0; |
| 182 | } |
| 183 | |
| 184 | static int fw_handle_file_header(struct wil6210_priv *wil, const void *data, |
| 185 | size_t size) |
| 186 | { |
| 187 | const struct wil_fw_record_file_header *d = data; |
| 188 | |
| 189 | if (size != sizeof(*d)) { |
| 190 | wil_err_fw(wil, "file header length incorrect: %zu\n", size); |
| 191 | return -EINVAL; |
| 192 | } |
| 193 | |
| 194 | wil_dbg_fw(wil, "new file, ver. %d, %i bytes\n", |
| 195 | d->version, d->data_len); |
| 196 | wil_hex_dump_fw("", DUMP_PREFIX_OFFSET, 16, 1, d->comment, |
| 197 | sizeof(d->comment), true); |
| 198 | |
| 199 | return 0; |
| 200 | } |
| 201 | |
| 202 | static int fw_handle_direct_write(struct wil6210_priv *wil, const void *data, |
| 203 | size_t size) |
| 204 | { |
| 205 | const struct wil_fw_record_direct_write *d = data; |
| 206 | const struct wil_fw_data_dwrite *block = d->data; |
| 207 | int n, i; |
| 208 | |
| 209 | if (size % sizeof(*block)) { |
| 210 | wil_err_fw(wil, "record size not aligned on %zu: %zu\n", |
| 211 | sizeof(*block), size); |
| 212 | return -EINVAL; |
| 213 | } |
| 214 | n = size / sizeof(*block); |
| 215 | |
| 216 | for (i = 0; i < n; i++) { |
| 217 | void __iomem *dst; |
| 218 | u32 m = le32_to_cpu(block[i].mask); |
| 219 | u32 v = le32_to_cpu(block[i].value); |
| 220 | u32 x, y; |
| 221 | |
| 222 | FW_ADDR_CHECK(dst, block[i].addr, "address"); |
| 223 | |
Vladimir Kondratiev | b9eeb51 | 2015-07-30 13:52:03 +0300 | [diff] [blame] | 224 | x = readl(dst); |
Vladimir Kondratiev | 151a970 | 2014-09-10 16:34:30 +0300 | [diff] [blame] | 225 | y = (x & m) | (v & ~m); |
| 226 | wil_dbg_fw(wil, "write [0x%08x] <== 0x%08x " |
| 227 | "(old 0x%08x val 0x%08x mask 0x%08x)\n", |
| 228 | le32_to_cpu(block[i].addr), y, x, v, m); |
Vladimir Kondratiev | b9eeb51 | 2015-07-30 13:52:03 +0300 | [diff] [blame] | 229 | writel(y, dst); |
Vladimir Kondratiev | 151a970 | 2014-09-10 16:34:30 +0300 | [diff] [blame] | 230 | wmb(); /* finish before processing next record */ |
| 231 | } |
| 232 | |
| 233 | return 0; |
| 234 | } |
| 235 | |
| 236 | static int gw_write(struct wil6210_priv *wil, void __iomem *gwa_addr, |
| 237 | void __iomem *gwa_cmd, void __iomem *gwa_ctl, u32 gw_cmd, |
| 238 | u32 a) |
| 239 | { |
| 240 | unsigned delay = 0; |
| 241 | |
Vladimir Kondratiev | b9eeb51 | 2015-07-30 13:52:03 +0300 | [diff] [blame] | 242 | writel(a, gwa_addr); |
| 243 | writel(gw_cmd, gwa_cmd); |
Vladimir Kondratiev | 151a970 | 2014-09-10 16:34:30 +0300 | [diff] [blame] | 244 | wmb(); /* finish before activate gw */ |
| 245 | |
Vladimir Kondratiev | b9eeb51 | 2015-07-30 13:52:03 +0300 | [diff] [blame] | 246 | writel(WIL_FW_GW_CTL_RUN, gwa_ctl); /* activate gw */ |
Vladimir Kondratiev | 151a970 | 2014-09-10 16:34:30 +0300 | [diff] [blame] | 247 | do { |
| 248 | udelay(1); /* typical time is few usec */ |
| 249 | if (delay++ > 100) { |
| 250 | wil_err_fw(wil, "gw timeout\n"); |
| 251 | return -EINVAL; |
| 252 | } |
Vladimir Kondratiev | b9eeb51 | 2015-07-30 13:52:03 +0300 | [diff] [blame] | 253 | } while (readl(gwa_ctl) & WIL_FW_GW_CTL_BUSY); /* gw done? */ |
Vladimir Kondratiev | 151a970 | 2014-09-10 16:34:30 +0300 | [diff] [blame] | 254 | |
| 255 | return 0; |
| 256 | } |
| 257 | |
| 258 | static int fw_handle_gateway_data(struct wil6210_priv *wil, const void *data, |
| 259 | size_t size) |
| 260 | { |
| 261 | const struct wil_fw_record_gateway_data *d = data; |
| 262 | const struct wil_fw_data_gw *block = d->data; |
| 263 | void __iomem *gwa_addr; |
| 264 | void __iomem *gwa_val; |
| 265 | void __iomem *gwa_cmd; |
| 266 | void __iomem *gwa_ctl; |
| 267 | u32 gw_cmd; |
| 268 | int n, i; |
| 269 | |
| 270 | if (size < sizeof(*d) + sizeof(*block)) { |
| 271 | wil_err_fw(wil, "gateway record too short: %zu\n", size); |
| 272 | return -EINVAL; |
| 273 | } |
| 274 | |
| 275 | if ((size - sizeof(*d)) % sizeof(*block)) { |
| 276 | wil_err_fw(wil, "gateway record data size" |
| 277 | " not aligned on %zu: %zu\n", |
| 278 | sizeof(*block), size - sizeof(*d)); |
| 279 | return -EINVAL; |
| 280 | } |
| 281 | n = (size - sizeof(*d)) / sizeof(*block); |
| 282 | |
| 283 | gw_cmd = le32_to_cpu(d->command); |
| 284 | |
| 285 | wil_dbg_fw(wil, "gw write record [%3d] blocks, cmd 0x%08x\n", |
| 286 | n, gw_cmd); |
| 287 | |
| 288 | FW_ADDR_CHECK(gwa_addr, d->gateway_addr_addr, "gateway_addr_addr"); |
| 289 | FW_ADDR_CHECK(gwa_val, d->gateway_value_addr, "gateway_value_addr"); |
| 290 | FW_ADDR_CHECK(gwa_cmd, d->gateway_cmd_addr, "gateway_cmd_addr"); |
| 291 | FW_ADDR_CHECK(gwa_ctl, d->gateway_ctrl_address, "gateway_ctrl_address"); |
| 292 | |
| 293 | wil_dbg_fw(wil, "gw addresses: addr 0x%08x val 0x%08x" |
| 294 | " cmd 0x%08x ctl 0x%08x\n", |
| 295 | le32_to_cpu(d->gateway_addr_addr), |
| 296 | le32_to_cpu(d->gateway_value_addr), |
| 297 | le32_to_cpu(d->gateway_cmd_addr), |
| 298 | le32_to_cpu(d->gateway_ctrl_address)); |
| 299 | |
| 300 | for (i = 0; i < n; i++) { |
| 301 | int rc; |
| 302 | u32 a = le32_to_cpu(block[i].addr); |
| 303 | u32 v = le32_to_cpu(block[i].value); |
| 304 | |
| 305 | wil_dbg_fw(wil, " gw write[%3d] [0x%08x] <== 0x%08x\n", |
| 306 | i, a, v); |
| 307 | |
Vladimir Kondratiev | b9eeb51 | 2015-07-30 13:52:03 +0300 | [diff] [blame] | 308 | writel(v, gwa_val); |
Vladimir Kondratiev | 151a970 | 2014-09-10 16:34:30 +0300 | [diff] [blame] | 309 | rc = gw_write(wil, gwa_addr, gwa_cmd, gwa_ctl, gw_cmd, a); |
| 310 | if (rc) |
| 311 | return rc; |
| 312 | } |
| 313 | |
| 314 | return 0; |
| 315 | } |
| 316 | |
| 317 | static int fw_handle_gateway_data4(struct wil6210_priv *wil, const void *data, |
| 318 | size_t size) |
| 319 | { |
| 320 | const struct wil_fw_record_gateway_data4 *d = data; |
| 321 | const struct wil_fw_data_gw4 *block = d->data; |
| 322 | void __iomem *gwa_addr; |
| 323 | void __iomem *gwa_val[ARRAY_SIZE(block->value)]; |
| 324 | void __iomem *gwa_cmd; |
| 325 | void __iomem *gwa_ctl; |
| 326 | u32 gw_cmd; |
| 327 | int n, i, k; |
| 328 | |
| 329 | if (size < sizeof(*d) + sizeof(*block)) { |
| 330 | wil_err_fw(wil, "gateway4 record too short: %zu\n", size); |
| 331 | return -EINVAL; |
| 332 | } |
| 333 | |
| 334 | if ((size - sizeof(*d)) % sizeof(*block)) { |
| 335 | wil_err_fw(wil, "gateway4 record data size" |
| 336 | " not aligned on %zu: %zu\n", |
| 337 | sizeof(*block), size - sizeof(*d)); |
| 338 | return -EINVAL; |
| 339 | } |
| 340 | n = (size - sizeof(*d)) / sizeof(*block); |
| 341 | |
| 342 | gw_cmd = le32_to_cpu(d->command); |
| 343 | |
| 344 | wil_dbg_fw(wil, "gw4 write record [%3d] blocks, cmd 0x%08x\n", |
| 345 | n, gw_cmd); |
| 346 | |
| 347 | FW_ADDR_CHECK(gwa_addr, d->gateway_addr_addr, "gateway_addr_addr"); |
| 348 | for (k = 0; k < ARRAY_SIZE(block->value); k++) |
| 349 | FW_ADDR_CHECK(gwa_val[k], d->gateway_value_addr[k], |
| 350 | "gateway_value_addr"); |
| 351 | FW_ADDR_CHECK(gwa_cmd, d->gateway_cmd_addr, "gateway_cmd_addr"); |
| 352 | FW_ADDR_CHECK(gwa_ctl, d->gateway_ctrl_address, "gateway_ctrl_address"); |
| 353 | |
| 354 | wil_dbg_fw(wil, "gw4 addresses: addr 0x%08x cmd 0x%08x ctl 0x%08x\n", |
| 355 | le32_to_cpu(d->gateway_addr_addr), |
| 356 | le32_to_cpu(d->gateway_cmd_addr), |
| 357 | le32_to_cpu(d->gateway_ctrl_address)); |
| 358 | wil_hex_dump_fw("val addresses: ", DUMP_PREFIX_NONE, 16, 4, |
| 359 | d->gateway_value_addr, sizeof(d->gateway_value_addr), |
| 360 | false); |
| 361 | |
| 362 | for (i = 0; i < n; i++) { |
| 363 | int rc; |
| 364 | u32 a = le32_to_cpu(block[i].addr); |
| 365 | u32 v[ARRAY_SIZE(block->value)]; |
| 366 | |
| 367 | for (k = 0; k < ARRAY_SIZE(block->value); k++) |
| 368 | v[k] = le32_to_cpu(block[i].value[k]); |
| 369 | |
| 370 | wil_dbg_fw(wil, " gw4 write[%3d] [0x%08x] <==\n", i, a); |
| 371 | wil_hex_dump_fw(" val ", DUMP_PREFIX_NONE, 16, 4, v, |
| 372 | sizeof(v), false); |
| 373 | |
| 374 | for (k = 0; k < ARRAY_SIZE(block->value); k++) |
Vladimir Kondratiev | b9eeb51 | 2015-07-30 13:52:03 +0300 | [diff] [blame] | 375 | writel(v[k], gwa_val[k]); |
Vladimir Kondratiev | 151a970 | 2014-09-10 16:34:30 +0300 | [diff] [blame] | 376 | rc = gw_write(wil, gwa_addr, gwa_cmd, gwa_ctl, gw_cmd, a); |
| 377 | if (rc) |
| 378 | return rc; |
| 379 | } |
| 380 | |
| 381 | return 0; |
| 382 | } |
| 383 | |
| 384 | static const struct { |
| 385 | int type; |
| 386 | int (*handler)(struct wil6210_priv *wil, const void *data, size_t size); |
| 387 | } wil_fw_handlers[] = { |
| 388 | {wil_fw_type_comment, fw_handle_comment}, |
| 389 | {wil_fw_type_data, fw_handle_data}, |
| 390 | {wil_fw_type_fill, fw_handle_fill}, |
| 391 | /* wil_fw_type_action */ |
| 392 | /* wil_fw_type_verify */ |
| 393 | {wil_fw_type_file_header, fw_handle_file_header}, |
| 394 | {wil_fw_type_direct_write, fw_handle_direct_write}, |
| 395 | {wil_fw_type_gateway_data, fw_handle_gateway_data}, |
| 396 | {wil_fw_type_gateway_data4, fw_handle_gateway_data4}, |
| 397 | }; |
| 398 | |
| 399 | static int wil_fw_handle_record(struct wil6210_priv *wil, int type, |
| 400 | const void *data, size_t size) |
| 401 | { |
| 402 | int i; |
| 403 | |
| 404 | for (i = 0; i < ARRAY_SIZE(wil_fw_handlers); i++) { |
| 405 | if (wil_fw_handlers[i].type == type) |
| 406 | return wil_fw_handlers[i].handler(wil, data, size); |
| 407 | } |
| 408 | |
| 409 | wil_err_fw(wil, "unknown record type: %d\n", type); |
| 410 | return -EINVAL; |
| 411 | } |
| 412 | |
| 413 | /** |
| 414 | * wil_fw_load - load FW into device |
| 415 | * |
| 416 | * Load the FW and uCode code and data to the corresponding device |
| 417 | * memory regions |
| 418 | * |
| 419 | * Return error code |
| 420 | */ |
| 421 | static int wil_fw_load(struct wil6210_priv *wil, const void *data, size_t size) |
| 422 | { |
| 423 | int rc = 0; |
| 424 | const struct wil_fw_record_head *hdr; |
| 425 | size_t s, hdr_sz; |
| 426 | |
| 427 | for (hdr = data;; hdr = (const void *)hdr + s, size -= s) { |
| 428 | if (size < sizeof(*hdr)) |
| 429 | break; |
| 430 | hdr_sz = le32_to_cpu(hdr->size); |
| 431 | s = sizeof(*hdr) + hdr_sz; |
| 432 | if (s > size) |
| 433 | break; |
| 434 | if (hdr_sz % 4) { |
| 435 | wil_err_fw(wil, "unaligned record size: %zu\n", |
| 436 | hdr_sz); |
| 437 | return -EINVAL; |
| 438 | } |
| 439 | rc = wil_fw_handle_record(wil, le16_to_cpu(hdr->type), |
| 440 | &hdr[1], hdr_sz); |
| 441 | if (rc) |
| 442 | return rc; |
| 443 | } |
| 444 | if (size) { |
| 445 | wil_err_fw(wil, "unprocessed bytes: %zu\n", size); |
| 446 | if (size >= sizeof(*hdr)) { |
| 447 | wil_err_fw(wil, "Stop at offset %ld" |
| 448 | " record type %d [%zd bytes]\n", |
Vladimir Kondratiev | 7cd4ec5 | 2014-12-01 15:35:27 +0200 | [diff] [blame] | 449 | (long)((const void *)hdr - data), |
Vladimir Kondratiev | 151a970 | 2014-09-10 16:34:30 +0300 | [diff] [blame] | 450 | le16_to_cpu(hdr->type), hdr_sz); |
| 451 | } |
| 452 | return -EINVAL; |
| 453 | } |
Vladimir Kondratiev | 151a970 | 2014-09-10 16:34:30 +0300 | [diff] [blame] | 454 | |
| 455 | return rc; |
| 456 | } |
| 457 | |
| 458 | /** |
| 459 | * wil_request_firmware - Request firmware and load to device |
| 460 | * |
| 461 | * Request firmware image from the file and load it to device |
| 462 | * |
| 463 | * Return error code |
| 464 | */ |
| 465 | int wil_request_firmware(struct wil6210_priv *wil, const char *name) |
| 466 | { |
| 467 | int rc, rc1; |
| 468 | const struct firmware *fw; |
| 469 | size_t sz; |
| 470 | const void *d; |
| 471 | |
Vladimir Kondratiev | 6992991 | 2014-12-01 15:33:18 +0200 | [diff] [blame] | 472 | rc = request_firmware(&fw, name, wil_to_dev(wil)); |
Vladimir Kondratiev | 151a970 | 2014-09-10 16:34:30 +0300 | [diff] [blame] | 473 | if (rc) { |
| 474 | wil_err_fw(wil, "Failed to load firmware %s\n", name); |
| 475 | return rc; |
| 476 | } |
| 477 | wil_dbg_fw(wil, "Loading <%s>, %zu bytes\n", name, fw->size); |
| 478 | |
| 479 | for (sz = fw->size, d = fw->data; sz; sz -= rc1, d += rc1) { |
| 480 | rc1 = wil_fw_verify(wil, d, sz); |
| 481 | if (rc1 < 0) { |
| 482 | rc = rc1; |
| 483 | goto out; |
| 484 | } |
| 485 | rc = wil_fw_load(wil, d, rc1); |
| 486 | if (rc < 0) |
| 487 | goto out; |
| 488 | } |
| 489 | |
| 490 | out: |
| 491 | release_firmware(fw); |
| 492 | return rc; |
| 493 | } |