404 lines
10 KiB
C
404 lines
10 KiB
C
/*
|
|
* Atheros CARL9170 driver
|
|
*
|
|
* firmware parser
|
|
*
|
|
* Copyright 2009, 2010, Christian Lamparter <chunkeey@googlemail.com>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; see the file COPYING. If not, see
|
|
* http://www.gnu.org/licenses/.
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/firmware.h>
|
|
#include <linux/crc32.h>
|
|
#include "carl9170.h"
|
|
#include "fwcmd.h"
|
|
#include "version.h"
|
|
|
|
#define MAKE_STR(symbol) #symbol
|
|
#define TO_STR(symbol) MAKE_STR(symbol)
|
|
#define CARL9170FW_API_VER_STR TO_STR(CARL9170FW_API_MAX_VER)
|
|
MODULE_VERSION(CARL9170FW_API_VER_STR ":" CARL9170FW_VERSION_GIT);
|
|
|
|
static const u8 otus_magic[4] = { OTUS_MAGIC };
|
|
|
|
static const void *carl9170_fw_find_desc(struct ar9170 *ar, const u8 descid[4],
|
|
const unsigned int len, const u8 compatible_revision)
|
|
{
|
|
const struct carl9170fw_desc_head *iter;
|
|
|
|
carl9170fw_for_each_hdr(iter, ar->fw.desc) {
|
|
if (carl9170fw_desc_cmp(iter, descid, len,
|
|
compatible_revision))
|
|
return (void *)iter;
|
|
}
|
|
|
|
/* needed to find the LAST desc */
|
|
if (carl9170fw_desc_cmp(iter, descid, len,
|
|
compatible_revision))
|
|
return (void *)iter;
|
|
|
|
return NULL;
|
|
}
|
|
|
|
static int carl9170_fw_verify_descs(struct ar9170 *ar,
|
|
const struct carl9170fw_desc_head *head, unsigned int max_len)
|
|
{
|
|
const struct carl9170fw_desc_head *pos;
|
|
unsigned long pos_addr, end_addr;
|
|
unsigned int pos_length;
|
|
|
|
if (max_len < sizeof(*pos))
|
|
return -ENODATA;
|
|
|
|
max_len = min_t(unsigned int, CARL9170FW_DESC_MAX_LENGTH, max_len);
|
|
|
|
pos = head;
|
|
pos_addr = (unsigned long) pos;
|
|
end_addr = pos_addr + max_len;
|
|
|
|
while (pos_addr < end_addr) {
|
|
if (pos_addr + sizeof(*head) > end_addr)
|
|
return -E2BIG;
|
|
|
|
pos_length = le16_to_cpu(pos->length);
|
|
|
|
if (pos_length < sizeof(*head))
|
|
return -EBADMSG;
|
|
|
|
if (pos_length > max_len)
|
|
return -EOVERFLOW;
|
|
|
|
if (pos_addr + pos_length > end_addr)
|
|
return -EMSGSIZE;
|
|
|
|
if (carl9170fw_desc_cmp(pos, LAST_MAGIC,
|
|
CARL9170FW_LAST_DESC_SIZE,
|
|
CARL9170FW_LAST_DESC_CUR_VER))
|
|
return 0;
|
|
|
|
pos_addr += pos_length;
|
|
pos = (void *)pos_addr;
|
|
max_len -= pos_length;
|
|
}
|
|
return -EINVAL;
|
|
}
|
|
|
|
static void carl9170_fw_info(struct ar9170 *ar)
|
|
{
|
|
const struct carl9170fw_motd_desc *motd_desc;
|
|
unsigned int str_ver_len;
|
|
u32 fw_date;
|
|
|
|
dev_info(&ar->udev->dev, "driver API: %s 2%03d-%02d-%02d [%d-%d]\n",
|
|
CARL9170FW_VERSION_GIT, CARL9170FW_VERSION_YEAR,
|
|
CARL9170FW_VERSION_MONTH, CARL9170FW_VERSION_DAY,
|
|
CARL9170FW_API_MIN_VER, CARL9170FW_API_MAX_VER);
|
|
|
|
motd_desc = carl9170_fw_find_desc(ar, MOTD_MAGIC,
|
|
sizeof(*motd_desc), CARL9170FW_MOTD_DESC_CUR_VER);
|
|
|
|
if (motd_desc) {
|
|
str_ver_len = strnlen(motd_desc->release,
|
|
CARL9170FW_MOTD_RELEASE_LEN);
|
|
|
|
fw_date = le32_to_cpu(motd_desc->fw_year_month_day);
|
|
|
|
dev_info(&ar->udev->dev, "firmware API: %.*s 2%03d-%02d-%02d\n",
|
|
str_ver_len, motd_desc->release,
|
|
CARL9170FW_GET_YEAR(fw_date),
|
|
CARL9170FW_GET_MONTH(fw_date),
|
|
CARL9170FW_GET_DAY(fw_date));
|
|
|
|
strlcpy(ar->hw->wiphy->fw_version, motd_desc->release,
|
|
sizeof(ar->hw->wiphy->fw_version));
|
|
}
|
|
}
|
|
|
|
static bool valid_dma_addr(const u32 address)
|
|
{
|
|
if (address >= AR9170_SRAM_OFFSET &&
|
|
address < (AR9170_SRAM_OFFSET + AR9170_SRAM_SIZE))
|
|
return true;
|
|
|
|
return false;
|
|
}
|
|
|
|
static bool valid_cpu_addr(const u32 address)
|
|
{
|
|
if (valid_dma_addr(address) || (address >= AR9170_PRAM_OFFSET &&
|
|
address < (AR9170_PRAM_OFFSET + AR9170_PRAM_SIZE)))
|
|
return true;
|
|
|
|
return false;
|
|
}
|
|
|
|
static int carl9170_fw(struct ar9170 *ar, const __u8 *data, size_t len)
|
|
{
|
|
const struct carl9170fw_otus_desc *otus_desc;
|
|
const struct carl9170fw_chk_desc *chk_desc;
|
|
const struct carl9170fw_last_desc *last_desc;
|
|
|
|
last_desc = carl9170_fw_find_desc(ar, LAST_MAGIC,
|
|
sizeof(*last_desc), CARL9170FW_LAST_DESC_CUR_VER);
|
|
if (!last_desc)
|
|
return -EINVAL;
|
|
|
|
otus_desc = carl9170_fw_find_desc(ar, OTUS_MAGIC,
|
|
sizeof(*otus_desc), CARL9170FW_OTUS_DESC_CUR_VER);
|
|
if (!otus_desc) {
|
|
dev_err(&ar->udev->dev, "failed to find compatible firmware "
|
|
"descriptor.\n");
|
|
return -ENODATA;
|
|
}
|
|
|
|
chk_desc = carl9170_fw_find_desc(ar, CHK_MAGIC,
|
|
sizeof(*chk_desc), CARL9170FW_CHK_DESC_CUR_VER);
|
|
|
|
if (chk_desc) {
|
|
unsigned long fin, diff;
|
|
unsigned int dsc_len;
|
|
u32 crc32;
|
|
|
|
dsc_len = min_t(unsigned int, len,
|
|
(unsigned long)chk_desc - (unsigned long)otus_desc);
|
|
|
|
fin = (unsigned long) last_desc + sizeof(*last_desc);
|
|
diff = fin - (unsigned long) otus_desc;
|
|
|
|
if (diff < len)
|
|
len -= diff;
|
|
|
|
if (len < 256)
|
|
return -EIO;
|
|
|
|
crc32 = crc32_le(~0, data, len);
|
|
if (cpu_to_le32(crc32) != chk_desc->fw_crc32) {
|
|
dev_err(&ar->udev->dev, "fw checksum test failed.\n");
|
|
return -ENOEXEC;
|
|
}
|
|
|
|
crc32 = crc32_le(crc32, (void *)otus_desc, dsc_len);
|
|
if (cpu_to_le32(crc32) != chk_desc->hdr_crc32) {
|
|
dev_err(&ar->udev->dev, "descriptor check failed.\n");
|
|
return -EINVAL;
|
|
}
|
|
} else {
|
|
dev_warn(&ar->udev->dev, "Unprotected firmware image.\n");
|
|
}
|
|
|
|
#define SUPP(feat) \
|
|
(carl9170fw_supports(otus_desc->feature_set, feat))
|
|
|
|
if (!SUPP(CARL9170FW_DUMMY_FEATURE)) {
|
|
dev_err(&ar->udev->dev, "invalid firmware descriptor "
|
|
"format detected.\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
ar->fw.api_version = otus_desc->api_ver;
|
|
|
|
if (ar->fw.api_version < CARL9170FW_API_MIN_VER ||
|
|
ar->fw.api_version > CARL9170FW_API_MAX_VER) {
|
|
dev_err(&ar->udev->dev, "unsupported firmware api version.\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (!SUPP(CARL9170FW_COMMAND_PHY) || SUPP(CARL9170FW_UNUSABLE) ||
|
|
!SUPP(CARL9170FW_HANDLE_BACK_REQ)) {
|
|
dev_err(&ar->udev->dev, "firmware does support "
|
|
"mandatory features.\n");
|
|
return -ECANCELED;
|
|
}
|
|
|
|
if (ilog2(le32_to_cpu(otus_desc->feature_set)) >=
|
|
__CARL9170FW_FEATURE_NUM) {
|
|
dev_warn(&ar->udev->dev, "driver does not support all "
|
|
"firmware features.\n");
|
|
}
|
|
|
|
if (!SUPP(CARL9170FW_COMMAND_CAM)) {
|
|
dev_info(&ar->udev->dev, "crypto offloading is disabled "
|
|
"by firmware.\n");
|
|
ar->disable_offload = true;
|
|
}
|
|
|
|
if (SUPP(CARL9170FW_PSM))
|
|
ar->hw->flags |= IEEE80211_HW_SUPPORTS_PS;
|
|
|
|
if (!SUPP(CARL9170FW_USB_INIT_FIRMWARE)) {
|
|
dev_err(&ar->udev->dev, "firmware does not provide "
|
|
"mandatory interfaces.\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
if (SUPP(CARL9170FW_MINIBOOT))
|
|
ar->fw.offset = le16_to_cpu(otus_desc->miniboot_size);
|
|
else
|
|
ar->fw.offset = 0;
|
|
|
|
if (SUPP(CARL9170FW_USB_DOWN_STREAM)) {
|
|
ar->hw->extra_tx_headroom += sizeof(struct ar9170_stream);
|
|
ar->fw.tx_stream = true;
|
|
}
|
|
|
|
if (SUPP(CARL9170FW_USB_UP_STREAM))
|
|
ar->fw.rx_stream = true;
|
|
|
|
if (SUPP(CARL9170FW_RX_FILTER)) {
|
|
ar->fw.rx_filter = true;
|
|
ar->rx_filter_caps = FIF_FCSFAIL | FIF_PLCPFAIL |
|
|
FIF_CONTROL | FIF_PSPOLL | FIF_OTHER_BSS |
|
|
FIF_PROMISC_IN_BSS;
|
|
}
|
|
|
|
ar->fw.vif_num = otus_desc->vif_num;
|
|
ar->fw.cmd_bufs = otus_desc->cmd_bufs;
|
|
ar->fw.address = le32_to_cpu(otus_desc->fw_address);
|
|
ar->fw.rx_size = le16_to_cpu(otus_desc->rx_max_frame_len);
|
|
ar->fw.mem_blocks = min_t(unsigned int, otus_desc->tx_descs, 0xfe);
|
|
atomic_set(&ar->mem_free_blocks, ar->fw.mem_blocks);
|
|
ar->fw.mem_block_size = le16_to_cpu(otus_desc->tx_frag_len);
|
|
|
|
if (ar->fw.vif_num >= AR9170_MAX_VIRTUAL_MAC || !ar->fw.vif_num ||
|
|
ar->fw.mem_blocks < 16 || !ar->fw.cmd_bufs ||
|
|
ar->fw.mem_block_size < 64 || ar->fw.mem_block_size > 512 ||
|
|
ar->fw.rx_size > 32768 || ar->fw.rx_size < 4096 ||
|
|
!valid_cpu_addr(ar->fw.address)) {
|
|
dev_err(&ar->udev->dev, "firmware shows obvious signs of "
|
|
"malicious tampering.\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
ar->fw.beacon_addr = le32_to_cpu(otus_desc->bcn_addr);
|
|
ar->fw.beacon_max_len = le16_to_cpu(otus_desc->bcn_len);
|
|
|
|
if (valid_dma_addr(ar->fw.beacon_addr) && ar->fw.beacon_max_len >=
|
|
AR9170_MAC_BCN_LENGTH_MAX) {
|
|
ar->hw->wiphy->interface_modes |= BIT(NL80211_IFTYPE_ADHOC);
|
|
|
|
if (SUPP(CARL9170FW_WLANTX_CAB)) {
|
|
ar->hw->wiphy->interface_modes |=
|
|
BIT(NL80211_IFTYPE_AP) |
|
|
BIT(NL80211_IFTYPE_P2P_GO);
|
|
}
|
|
}
|
|
|
|
#undef SUPPORTED
|
|
return 0;
|
|
}
|
|
|
|
static struct carl9170fw_desc_head *
|
|
carl9170_find_fw_desc(struct ar9170 *ar, const __u8 *fw_data, const size_t len)
|
|
|
|
{
|
|
int scan = 0, found = 0;
|
|
|
|
if (!carl9170fw_size_check(len)) {
|
|
dev_err(&ar->udev->dev, "firmware size is out of bound.\n");
|
|
return NULL;
|
|
}
|
|
|
|
while (scan < len - sizeof(struct carl9170fw_desc_head)) {
|
|
if (fw_data[scan++] == otus_magic[found])
|
|
found++;
|
|
else
|
|
found = 0;
|
|
|
|
if (scan >= len)
|
|
break;
|
|
|
|
if (found == sizeof(otus_magic))
|
|
break;
|
|
}
|
|
|
|
if (found != sizeof(otus_magic))
|
|
return NULL;
|
|
|
|
return (void *)&fw_data[scan - found];
|
|
}
|
|
|
|
int carl9170_fw_fix_eeprom(struct ar9170 *ar)
|
|
{
|
|
const struct carl9170fw_fix_desc *fix_desc = NULL;
|
|
unsigned int i, n, off;
|
|
u32 *data = (void *)&ar->eeprom;
|
|
|
|
fix_desc = carl9170_fw_find_desc(ar, FIX_MAGIC,
|
|
sizeof(*fix_desc), CARL9170FW_FIX_DESC_CUR_VER);
|
|
|
|
if (!fix_desc)
|
|
return 0;
|
|
|
|
n = (le16_to_cpu(fix_desc->head.length) - sizeof(*fix_desc)) /
|
|
sizeof(struct carl9170fw_fix_entry);
|
|
|
|
for (i = 0; i < n; i++) {
|
|
off = le32_to_cpu(fix_desc->data[i].address) -
|
|
AR9170_EEPROM_START;
|
|
|
|
if (off >= sizeof(struct ar9170_eeprom) || (off & 3)) {
|
|
dev_err(&ar->udev->dev, "Skip invalid entry %d\n", i);
|
|
continue;
|
|
}
|
|
|
|
data[off / sizeof(*data)] &=
|
|
le32_to_cpu(fix_desc->data[i].mask);
|
|
data[off / sizeof(*data)] |=
|
|
le32_to_cpu(fix_desc->data[i].value);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int carl9170_parse_firmware(struct ar9170 *ar)
|
|
{
|
|
const struct carl9170fw_desc_head *fw_desc = NULL;
|
|
const struct firmware *fw = ar->fw.fw;
|
|
unsigned long header_offset = 0;
|
|
int err;
|
|
|
|
if (WARN_ON(!fw))
|
|
return -EINVAL;
|
|
|
|
fw_desc = carl9170_find_fw_desc(ar, fw->data, fw->size);
|
|
|
|
if (!fw_desc) {
|
|
dev_err(&ar->udev->dev, "unsupported firmware.\n");
|
|
return -ENODATA;
|
|
}
|
|
|
|
header_offset = (unsigned long)fw_desc - (unsigned long)fw->data;
|
|
|
|
err = carl9170_fw_verify_descs(ar, fw_desc, fw->size - header_offset);
|
|
if (err) {
|
|
dev_err(&ar->udev->dev, "damaged firmware (%d).\n", err);
|
|
return err;
|
|
}
|
|
|
|
ar->fw.desc = fw_desc;
|
|
|
|
carl9170_fw_info(ar);
|
|
|
|
err = carl9170_fw(ar, fw->data, fw->size);
|
|
if (err) {
|
|
dev_err(&ar->udev->dev, "failed to parse firmware (%d).\n",
|
|
err);
|
|
return err;
|
|
}
|
|
|
|
return 0;
|
|
}
|