123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767 |
- /*
- * Copyright (c) 2014-2017 Qualcomm Atheros, Inc.
- * Copyright (c) 2018, The Linux Foundation. All rights reserved.
- *
- * Permission to use, copy, modify, and/or distribute this software for any
- * purpose with or without fee is hereby granted, provided that the above
- * copyright notice and this permission notice appear in all copies.
- *
- * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
- * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
- * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
- * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
- * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
- * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
- * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
- */
- /* Algorithmic part of the firmware download.
- * To be included in the container file providing framework
- */
- #define wil_err_fw(wil, fmt, arg...) wil_err(wil, "ERR[ FW ]" fmt, ##arg)
- #define wil_dbg_fw(wil, fmt, arg...) wil_dbg(wil, "DBG[ FW ]" fmt, ##arg)
- #define wil_hex_dump_fw(prefix_str, prefix_type, rowsize, \
- groupsize, buf, len, ascii) \
- print_hex_dump_debug("DBG[ FW ]" prefix_str, \
- prefix_type, rowsize, \
- groupsize, buf, len, ascii)
- static bool wil_fw_addr_check(struct wil6210_priv *wil,
- void __iomem **ioaddr, __le32 val,
- u32 size, const char *msg)
- {
- *ioaddr = wmi_buffer_block(wil, val, size);
- if (!(*ioaddr)) {
- wil_err_fw(wil, "bad %s: 0x%08x\n", msg, le32_to_cpu(val));
- return false;
- }
- return true;
- }
- /**
- * wil_fw_verify - verify firmware file validity
- *
- * perform various checks for the firmware file header.
- * records are not validated.
- *
- * Return file size or negative error
- */
- static int wil_fw_verify(struct wil6210_priv *wil, const u8 *data, size_t size)
- {
- const struct wil_fw_record_head *hdr = (const void *)data;
- struct wil_fw_record_file_header fh;
- const struct wil_fw_record_file_header *fh_;
- u32 crc;
- u32 dlen;
- if (size % 4) {
- wil_err_fw(wil, "image size not aligned: %zu\n", size);
- return -EINVAL;
- }
- /* have enough data for the file header? */
- if (size < sizeof(*hdr) + sizeof(fh)) {
- wil_err_fw(wil, "file too short: %zu bytes\n", size);
- return -EINVAL;
- }
- /* start with the file header? */
- if (le16_to_cpu(hdr->type) != wil_fw_type_file_header) {
- wil_err_fw(wil, "no file header\n");
- return -EINVAL;
- }
- /* data_len */
- fh_ = (struct wil_fw_record_file_header *)&hdr[1];
- dlen = le32_to_cpu(fh_->data_len);
- if (dlen % 4) {
- wil_err_fw(wil, "data length not aligned: %lu\n", (ulong)dlen);
- return -EINVAL;
- }
- if (size < dlen) {
- wil_err_fw(wil, "file truncated at %zu/%lu\n",
- size, (ulong)dlen);
- return -EINVAL;
- }
- if (dlen < sizeof(*hdr) + sizeof(fh)) {
- wil_err_fw(wil, "data length too short: %lu\n", (ulong)dlen);
- return -EINVAL;
- }
- /* signature */
- if (le32_to_cpu(fh_->signature) != WIL_FW_SIGNATURE) {
- wil_err_fw(wil, "bad header signature: 0x%08x\n",
- le32_to_cpu(fh_->signature));
- return -EINVAL;
- }
- /* version */
- if (le32_to_cpu(fh_->version) > WIL_FW_FMT_VERSION) {
- wil_err_fw(wil, "unsupported header version: %d\n",
- le32_to_cpu(fh_->version));
- return -EINVAL;
- }
- /* checksum. ~crc32(~0, data, size) when fh.crc set to 0*/
- fh = *fh_;
- fh.crc = 0;
- crc = crc32_le(~0, (unsigned char const *)hdr, sizeof(*hdr));
- crc = crc32_le(crc, (unsigned char const *)&fh, sizeof(fh));
- crc = crc32_le(crc, (unsigned char const *)&fh_[1],
- dlen - sizeof(*hdr) - sizeof(fh));
- crc = ~crc;
- if (crc != le32_to_cpu(fh_->crc)) {
- wil_err_fw(wil, "checksum mismatch:"
- " calculated for %lu bytes 0x%08x != 0x%08x\n",
- (ulong)dlen, crc, le32_to_cpu(fh_->crc));
- return -EINVAL;
- }
- return (int)dlen;
- }
- static int fw_ignore_section(struct wil6210_priv *wil, const void *data,
- size_t size)
- {
- return 0;
- }
- static int
- fw_handle_capabilities(struct wil6210_priv *wil, const void *data,
- size_t size)
- {
- const struct wil_fw_record_capabilities *rec = data;
- size_t capa_size;
- if (size < sizeof(*rec)) {
- wil_err_fw(wil, "capabilities record too short: %zu\n", size);
- /* let the FW load anyway */
- return 0;
- }
- capa_size = size - offsetof(struct wil_fw_record_capabilities,
- capabilities);
- bitmap_zero(wil->fw_capabilities, WMI_FW_CAPABILITY_MAX);
- memcpy(wil->fw_capabilities, rec->capabilities,
- min_t(size_t, sizeof(wil->fw_capabilities), capa_size));
- wil_hex_dump_fw("CAPA", DUMP_PREFIX_OFFSET, 16, 1,
- rec->capabilities, capa_size, false);
- return 0;
- }
- static int
- fw_handle_brd_file(struct wil6210_priv *wil, const void *data,
- size_t size)
- {
- const struct wil_fw_record_brd_file *rec = data;
- if (size < sizeof(*rec)) {
- wil_err_fw(wil, "brd_file record too short: %zu\n", size);
- return 0;
- }
- wil->brd_file_addr = le32_to_cpu(rec->base_addr);
- wil->brd_file_max_size = le32_to_cpu(rec->max_size_bytes);
- wil_dbg_fw(wil, "brd_file_addr 0x%x, brd_file_max_size %d\n",
- wil->brd_file_addr, wil->brd_file_max_size);
- return 0;
- }
- static int
- fw_handle_concurrency(struct wil6210_priv *wil, const void *data,
- size_t size)
- {
- const struct wil_fw_record_concurrency *rec = data;
- const struct wil_fw_concurrency_combo *combo;
- const struct wil_fw_concurrency_limit *limit;
- size_t remain, lsize;
- int i, n_combos;
- if (size < sizeof(*rec)) {
- wil_err_fw(wil, "concurrency record too short: %zu\n", size);
- /* continue, let the FW load anyway */
- return 0;
- }
- n_combos = le16_to_cpu(rec->n_combos);
- remain = size - offsetof(struct wil_fw_record_concurrency, combos);
- combo = rec->combos;
- for (i = 0; i < n_combos; i++) {
- if (remain < sizeof(*combo))
- goto out_short;
- remain -= sizeof(*combo);
- limit = combo->limits;
- lsize = combo->n_limits * sizeof(*limit);
- if (remain < lsize)
- goto out_short;
- remain -= lsize;
- limit += combo->n_limits;
- combo = (struct wil_fw_concurrency_combo *)limit;
- }
- return wil_cfg80211_iface_combinations_from_fw(wil, rec);
- out_short:
- wil_err_fw(wil, "concurrency record truncated\n");
- return 0;
- }
- static int
- fw_handle_comment(struct wil6210_priv *wil, const void *data,
- size_t size)
- {
- const struct wil_fw_record_comment_hdr *hdr = data;
- u32 magic;
- int rc = 0;
- if (size < sizeof(*hdr))
- return 0;
- magic = le32_to_cpu(hdr->magic);
- switch (magic) {
- case WIL_FW_CAPABILITIES_MAGIC:
- wil_dbg_fw(wil, "magic is WIL_FW_CAPABILITIES_MAGIC\n");
- rc = fw_handle_capabilities(wil, data, size);
- break;
- case WIL_BRD_FILE_MAGIC:
- wil_dbg_fw(wil, "magic is WIL_BRD_FILE_MAGIC\n");
- rc = fw_handle_brd_file(wil, data, size);
- break;
- case WIL_FW_CONCURRENCY_MAGIC:
- wil_dbg_fw(wil, "magic is WIL_FW_CONCURRENCY_MAGIC\n");
- rc = fw_handle_concurrency(wil, data, size);
- break;
- default:
- wil_hex_dump_fw("", DUMP_PREFIX_OFFSET, 16, 1,
- data, size, true);
- }
- return rc;
- }
- static int __fw_handle_data(struct wil6210_priv *wil, const void *data,
- size_t size, __le32 addr)
- {
- const struct wil_fw_record_data *d = data;
- void __iomem *dst;
- size_t s = size - sizeof(*d);
- if (size < sizeof(*d) + sizeof(u32)) {
- wil_err_fw(wil, "data record too short: %zu\n", size);
- return -EINVAL;
- }
- if (!wil_fw_addr_check(wil, &dst, addr, s, "address"))
- return -EINVAL;
- wil_dbg_fw(wil, "write [0x%08x] <== %zu bytes\n", le32_to_cpu(addr), s);
- wil_memcpy_toio_32(dst, d->data, s);
- wmb(); /* finish before processing next record */
- return 0;
- }
- static int fw_handle_data(struct wil6210_priv *wil, const void *data,
- size_t size)
- {
- const struct wil_fw_record_data *d = data;
- return __fw_handle_data(wil, data, size, d->addr);
- }
- static int fw_handle_fill(struct wil6210_priv *wil, const void *data,
- size_t size)
- {
- const struct wil_fw_record_fill *d = data;
- void __iomem *dst;
- u32 v;
- size_t s = (size_t)le32_to_cpu(d->size);
- if (size != sizeof(*d)) {
- wil_err_fw(wil, "bad size for fill record: %zu\n", size);
- return -EINVAL;
- }
- if (s < sizeof(u32)) {
- wil_err_fw(wil, "fill size too short: %zu\n", s);
- return -EINVAL;
- }
- if (s % sizeof(u32)) {
- wil_err_fw(wil, "fill size not aligned: %zu\n", s);
- return -EINVAL;
- }
- if (!wil_fw_addr_check(wil, &dst, d->addr, s, "address"))
- return -EINVAL;
- v = le32_to_cpu(d->value);
- wil_dbg_fw(wil, "fill [0x%08x] <== 0x%08x, %zu bytes\n",
- le32_to_cpu(d->addr), v, s);
- wil_memset_toio_32(dst, v, s);
- wmb(); /* finish before processing next record */
- return 0;
- }
- static int fw_handle_file_header(struct wil6210_priv *wil, const void *data,
- size_t size)
- {
- const struct wil_fw_record_file_header *d = data;
- if (size != sizeof(*d)) {
- wil_err_fw(wil, "file header length incorrect: %zu\n", size);
- return -EINVAL;
- }
- wil_dbg_fw(wil, "new file, ver. %d, %i bytes\n",
- d->version, d->data_len);
- wil_hex_dump_fw("", DUMP_PREFIX_OFFSET, 16, 1, d->comment,
- sizeof(d->comment), true);
- if (!memcmp(d->comment, WIL_FW_VERSION_PREFIX,
- WIL_FW_VERSION_PREFIX_LEN))
- memcpy(wil->fw_version,
- d->comment + WIL_FW_VERSION_PREFIX_LEN,
- min(sizeof(d->comment) - WIL_FW_VERSION_PREFIX_LEN,
- sizeof(wil->fw_version) - 1));
- return 0;
- }
- static int fw_handle_direct_write(struct wil6210_priv *wil, const void *data,
- size_t size)
- {
- const struct wil_fw_record_direct_write *d = data;
- const struct wil_fw_data_dwrite *block = d->data;
- int n, i;
- if (size % sizeof(*block)) {
- wil_err_fw(wil, "record size not aligned on %zu: %zu\n",
- sizeof(*block), size);
- return -EINVAL;
- }
- n = size / sizeof(*block);
- for (i = 0; i < n; i++) {
- void __iomem *dst;
- u32 m = le32_to_cpu(block[i].mask);
- u32 v = le32_to_cpu(block[i].value);
- u32 x, y;
- if (!wil_fw_addr_check(wil, &dst, block[i].addr, 0, "address"))
- return -EINVAL;
- x = readl(dst);
- y = (x & m) | (v & ~m);
- wil_dbg_fw(wil, "write [0x%08x] <== 0x%08x "
- "(old 0x%08x val 0x%08x mask 0x%08x)\n",
- le32_to_cpu(block[i].addr), y, x, v, m);
- writel(y, dst);
- wmb(); /* finish before processing next record */
- }
- return 0;
- }
- static int gw_write(struct wil6210_priv *wil, void __iomem *gwa_addr,
- void __iomem *gwa_cmd, void __iomem *gwa_ctl, u32 gw_cmd,
- u32 a)
- {
- unsigned delay = 0;
- writel(a, gwa_addr);
- writel(gw_cmd, gwa_cmd);
- wmb(); /* finish before activate gw */
- writel(WIL_FW_GW_CTL_RUN, gwa_ctl); /* activate gw */
- do {
- udelay(1); /* typical time is few usec */
- if (delay++ > 100) {
- wil_err_fw(wil, "gw timeout\n");
- return -EINVAL;
- }
- } while (readl(gwa_ctl) & WIL_FW_GW_CTL_BUSY); /* gw done? */
- return 0;
- }
- static int fw_handle_gateway_data(struct wil6210_priv *wil, const void *data,
- size_t size)
- {
- const struct wil_fw_record_gateway_data *d = data;
- const struct wil_fw_data_gw *block = d->data;
- void __iomem *gwa_addr;
- void __iomem *gwa_val;
- void __iomem *gwa_cmd;
- void __iomem *gwa_ctl;
- u32 gw_cmd;
- int n, i;
- if (size < sizeof(*d) + sizeof(*block)) {
- wil_err_fw(wil, "gateway record too short: %zu\n", size);
- return -EINVAL;
- }
- if ((size - sizeof(*d)) % sizeof(*block)) {
- wil_err_fw(wil, "gateway record data size"
- " not aligned on %zu: %zu\n",
- sizeof(*block), size - sizeof(*d));
- return -EINVAL;
- }
- n = (size - sizeof(*d)) / sizeof(*block);
- gw_cmd = le32_to_cpu(d->command);
- wil_dbg_fw(wil, "gw write record [%3d] blocks, cmd 0x%08x\n",
- n, gw_cmd);
- if (!wil_fw_addr_check(wil, &gwa_addr, d->gateway_addr_addr, 0,
- "gateway_addr_addr") ||
- !wil_fw_addr_check(wil, &gwa_val, d->gateway_value_addr, 0,
- "gateway_value_addr") ||
- !wil_fw_addr_check(wil, &gwa_cmd, d->gateway_cmd_addr, 0,
- "gateway_cmd_addr") ||
- !wil_fw_addr_check(wil, &gwa_ctl, d->gateway_ctrl_address, 0,
- "gateway_ctrl_address"))
- return -EINVAL;
- wil_dbg_fw(wil, "gw addresses: addr 0x%08x val 0x%08x"
- " cmd 0x%08x ctl 0x%08x\n",
- le32_to_cpu(d->gateway_addr_addr),
- le32_to_cpu(d->gateway_value_addr),
- le32_to_cpu(d->gateway_cmd_addr),
- le32_to_cpu(d->gateway_ctrl_address));
- for (i = 0; i < n; i++) {
- int rc;
- u32 a = le32_to_cpu(block[i].addr);
- u32 v = le32_to_cpu(block[i].value);
- wil_dbg_fw(wil, " gw write[%3d] [0x%08x] <== 0x%08x\n",
- i, a, v);
- writel(v, gwa_val);
- rc = gw_write(wil, gwa_addr, gwa_cmd, gwa_ctl, gw_cmd, a);
- if (rc)
- return rc;
- }
- return 0;
- }
- static int fw_handle_gateway_data4(struct wil6210_priv *wil, const void *data,
- size_t size)
- {
- const struct wil_fw_record_gateway_data4 *d = data;
- const struct wil_fw_data_gw4 *block = d->data;
- void __iomem *gwa_addr;
- void __iomem *gwa_val[ARRAY_SIZE(block->value)];
- void __iomem *gwa_cmd;
- void __iomem *gwa_ctl;
- u32 gw_cmd;
- int n, i, k;
- if (size < sizeof(*d) + sizeof(*block)) {
- wil_err_fw(wil, "gateway4 record too short: %zu\n", size);
- return -EINVAL;
- }
- if ((size - sizeof(*d)) % sizeof(*block)) {
- wil_err_fw(wil, "gateway4 record data size"
- " not aligned on %zu: %zu\n",
- sizeof(*block), size - sizeof(*d));
- return -EINVAL;
- }
- n = (size - sizeof(*d)) / sizeof(*block);
- gw_cmd = le32_to_cpu(d->command);
- wil_dbg_fw(wil, "gw4 write record [%3d] blocks, cmd 0x%08x\n",
- n, gw_cmd);
- if (!wil_fw_addr_check(wil, &gwa_addr, d->gateway_addr_addr, 0,
- "gateway_addr_addr"))
- return -EINVAL;
- for (k = 0; k < ARRAY_SIZE(block->value); k++)
- if (!wil_fw_addr_check(wil, &gwa_val[k],
- d->gateway_value_addr[k],
- 0, "gateway_value_addr"))
- return -EINVAL;
- if (!wil_fw_addr_check(wil, &gwa_cmd, d->gateway_cmd_addr, 0,
- "gateway_cmd_addr") ||
- !wil_fw_addr_check(wil, &gwa_ctl, d->gateway_ctrl_address, 0,
- "gateway_ctrl_address"))
- return -EINVAL;
- wil_dbg_fw(wil, "gw4 addresses: addr 0x%08x cmd 0x%08x ctl 0x%08x\n",
- le32_to_cpu(d->gateway_addr_addr),
- le32_to_cpu(d->gateway_cmd_addr),
- le32_to_cpu(d->gateway_ctrl_address));
- wil_hex_dump_fw("val addresses: ", DUMP_PREFIX_NONE, 16, 4,
- d->gateway_value_addr, sizeof(d->gateway_value_addr),
- false);
- for (i = 0; i < n; i++) {
- int rc;
- u32 a = le32_to_cpu(block[i].addr);
- u32 v[ARRAY_SIZE(block->value)];
- for (k = 0; k < ARRAY_SIZE(block->value); k++)
- v[k] = le32_to_cpu(block[i].value[k]);
- wil_dbg_fw(wil, " gw4 write[%3d] [0x%08x] <==\n", i, a);
- wil_hex_dump_fw(" val ", DUMP_PREFIX_NONE, 16, 4, v,
- sizeof(v), false);
- for (k = 0; k < ARRAY_SIZE(block->value); k++)
- writel(v[k], gwa_val[k]);
- rc = gw_write(wil, gwa_addr, gwa_cmd, gwa_ctl, gw_cmd, a);
- if (rc)
- return rc;
- }
- return 0;
- }
- static const struct {
- int type;
- int (*load_handler)(struct wil6210_priv *wil, const void *data,
- size_t size);
- int (*parse_handler)(struct wil6210_priv *wil, const void *data,
- size_t size);
- } wil_fw_handlers[] = {
- {wil_fw_type_comment, fw_handle_comment, fw_handle_comment},
- {wil_fw_type_data, fw_handle_data, fw_ignore_section},
- {wil_fw_type_fill, fw_handle_fill, fw_ignore_section},
- /* wil_fw_type_action */
- /* wil_fw_type_verify */
- {wil_fw_type_file_header, fw_handle_file_header,
- fw_handle_file_header},
- {wil_fw_type_direct_write, fw_handle_direct_write, fw_ignore_section},
- {wil_fw_type_gateway_data, fw_handle_gateway_data, fw_ignore_section},
- {wil_fw_type_gateway_data4, fw_handle_gateway_data4,
- fw_ignore_section},
- };
- static int wil_fw_handle_record(struct wil6210_priv *wil, int type,
- const void *data, size_t size, bool load)
- {
- int i;
- for (i = 0; i < ARRAY_SIZE(wil_fw_handlers); i++)
- if (wil_fw_handlers[i].type == type)
- return load ?
- wil_fw_handlers[i].load_handler(
- wil, data, size) :
- wil_fw_handlers[i].parse_handler(
- wil, data, size);
- wil_err_fw(wil, "unknown record type: %d\n", type);
- return -EINVAL;
- }
- /**
- * wil_fw_process - process section from FW file
- * if load is true: Load the FW and uCode code and data to the
- * corresponding device memory regions,
- * otherwise only parse and look for capabilities
- *
- * Return error code
- */
- static int wil_fw_process(struct wil6210_priv *wil, const void *data,
- size_t size, bool load)
- {
- int rc = 0;
- const struct wil_fw_record_head *hdr;
- size_t s, hdr_sz;
- for (hdr = data;; hdr = (const void *)hdr + s, size -= s) {
- if (size < sizeof(*hdr))
- break;
- hdr_sz = le32_to_cpu(hdr->size);
- s = sizeof(*hdr) + hdr_sz;
- if (s > size)
- break;
- if (hdr_sz % 4) {
- wil_err_fw(wil, "unaligned record size: %zu\n",
- hdr_sz);
- return -EINVAL;
- }
- rc = wil_fw_handle_record(wil, le16_to_cpu(hdr->type),
- &hdr[1], hdr_sz, load);
- if (rc)
- return rc;
- }
- if (size) {
- wil_err_fw(wil, "unprocessed bytes: %zu\n", size);
- if (size >= sizeof(*hdr)) {
- wil_err_fw(wil, "Stop at offset %ld"
- " record type %d [%zd bytes]\n",
- (long)((const void *)hdr - data),
- le16_to_cpu(hdr->type), hdr_sz);
- }
- return -EINVAL;
- }
- return rc;
- }
- /**
- * wil_request_firmware - Request firmware
- *
- * Request firmware image from the file
- * If load is true, load firmware to device, otherwise
- * only parse and extract capabilities
- *
- * Return error code
- */
- int wil_request_firmware(struct wil6210_priv *wil, const char *name,
- bool load)
- {
- int rc, rc1;
- const struct firmware *fw;
- size_t sz;
- const void *d;
- rc = request_firmware(&fw, name, wil_to_dev(wil));
- if (rc) {
- wil_err_fw(wil, "Failed to load firmware %s rc %d\n", name, rc);
- return rc;
- }
- wil_dbg_fw(wil, "Loading <%s>, %zu bytes\n", name, fw->size);
- for (sz = fw->size, d = fw->data; sz; sz -= rc1, d += rc1) {
- rc1 = wil_fw_verify(wil, d, sz);
- if (rc1 < 0) {
- rc = rc1;
- goto out;
- }
- rc = wil_fw_process(wil, d, rc1, load);
- if (rc < 0)
- goto out;
- }
- out:
- release_firmware(fw);
- return rc;
- }
- /**
- * wil_brd_process - process section from BRD file
- *
- * Return error code
- */
- static int wil_brd_process(struct wil6210_priv *wil, const void *data,
- size_t size)
- {
- int rc = 0;
- const struct wil_fw_record_head *hdr = data;
- size_t s, hdr_sz;
- u16 type;
- /* Assuming the board file includes only one header record and one data
- * record. Each record starts with wil_fw_record_head.
- */
- if (size < sizeof(*hdr))
- return -EINVAL;
- s = sizeof(*hdr) + le32_to_cpu(hdr->size);
- if (s > size)
- return -EINVAL;
- /* Skip the header record and handle the data record */
- hdr = (const void *)hdr + s;
- size -= s;
- if (size < sizeof(*hdr))
- return -EINVAL;
- hdr_sz = le32_to_cpu(hdr->size);
- if (wil->brd_file_max_size && hdr_sz > wil->brd_file_max_size)
- return -EINVAL;
- if (sizeof(*hdr) + hdr_sz > size)
- return -EINVAL;
- if (hdr_sz % 4) {
- wil_err_fw(wil, "unaligned record size: %zu\n",
- hdr_sz);
- return -EINVAL;
- }
- type = le16_to_cpu(hdr->type);
- if (type != wil_fw_type_data) {
- wil_err_fw(wil, "invalid record type for board file: %d\n",
- type);
- return -EINVAL;
- }
- if (hdr_sz < sizeof(struct wil_fw_record_data)) {
- wil_err_fw(wil, "data record too short: %zu\n", hdr_sz);
- return -EINVAL;
- }
- wil_dbg_fw(wil, "using addr from fw file: [0x%08x]\n",
- wil->brd_file_addr);
- rc = __fw_handle_data(wil, &hdr[1], hdr_sz,
- cpu_to_le32(wil->brd_file_addr));
- return rc;
- }
- /**
- * wil_request_board - Request board file
- *
- * Request board image from the file
- * board file address and max size are read from FW file
- * during initialization.
- * brd file shall include one header and one data section.
- *
- * Return error code
- */
- int wil_request_board(struct wil6210_priv *wil, const char *name)
- {
- int rc, dlen;
- const struct firmware *brd;
- rc = request_firmware(&brd, name, wil_to_dev(wil));
- if (rc) {
- wil_err_fw(wil, "Failed to load brd %s\n", name);
- return rc;
- }
- wil_dbg_fw(wil, "Loading <%s>, %zu bytes\n", name, brd->size);
- /* Verify the header */
- dlen = wil_fw_verify(wil, brd->data, brd->size);
- if (dlen < 0) {
- rc = dlen;
- goto out;
- }
- /* Process the data record */
- rc = wil_brd_process(wil, brd->data, dlen);
- out:
- release_firmware(brd);
- return rc;
- }
- /**
- * wil_fw_verify_file_exists - checks if firmware file exist
- *
- * @wil: driver context
- * @name: firmware file name
- *
- * return value - boolean, true for success, false for failure
- */
- bool wil_fw_verify_file_exists(struct wil6210_priv *wil, const char *name)
- {
- const struct firmware *fw;
- int rc;
- rc = request_firmware(&fw, name, wil_to_dev(wil));
- if (!rc)
- release_firmware(fw);
- else
- wil_dbg_fw(wil, "<%s> not available: %d\n", name, rc);
- return !rc;
- }
|