eeprom.c revision 6dac3447425d932fa76a4e69d32eead9dd090b27
14c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter/* 24c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter * EEPROM parser code for mac80211 Prism54 drivers 34c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter * 44c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter * Copyright (c) 2006, Michael Wu <flamingice@sourmilk.net> 54c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter * Copyright (c) 2007-2009, Christian Lamparter <chunkeey@web.de> 64c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter * Copyright 2008, Johannes Berg <johannes@sipsolutions.net> 74c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter * 84c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter * Based on: 94c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter * - the islsm (softmac prism54) driver, which is: 104c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter * Copyright 2004-2006 Jean-Baptiste Note <jbnote@gmail.com>, et al. 114c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter * - stlc45xx driver 124c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter * Copyright (C) 2008 Nokia Corporation and/or its subsidiary(-ies). 134c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter * 144c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter * This program is free software; you can redistribute it and/or modify 154c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter * it under the terms of the GNU General Public License version 2 as 164c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter * published by the Free Software Foundation. 174c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter */ 184c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 194c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter#include <linux/init.h> 204c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter#include <linux/firmware.h> 214c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter#include <linux/etherdevice.h> 221a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter#include <linux/sort.h> 235a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 244c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 254c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter#include <net/mac80211.h> 26d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter#include <linux/crc-ccitt.h> 27ee40fa0656a730491765545ff7550f3c1ceb0fbcPaul Gortmaker#include <linux/export.h> 284c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 294c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter#include "p54.h" 304c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter#include "eeprom.h" 314c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter#include "lmac.h" 324c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 334c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparterstatic struct ieee80211_rate p54_bgrates[] = { 344c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 10, .hw_value = 0, }, 354c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 20, .hw_value = 1, .flags = IEEE80211_RATE_SHORT_PREAMBLE }, 364c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 55, .hw_value = 2, .flags = IEEE80211_RATE_SHORT_PREAMBLE }, 374c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 110, .hw_value = 3, .flags = IEEE80211_RATE_SHORT_PREAMBLE }, 384c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 60, .hw_value = 4, }, 394c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 90, .hw_value = 5, }, 404c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 120, .hw_value = 6, }, 414c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 180, .hw_value = 7, }, 424c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 240, .hw_value = 8, }, 434c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 360, .hw_value = 9, }, 444c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 480, .hw_value = 10, }, 454c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 540, .hw_value = 11, }, 464c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter}; 474c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 484c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparterstatic struct ieee80211_rate p54_arates[] = { 494c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 60, .hw_value = 4, }, 504c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 90, .hw_value = 5, }, 514c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 120, .hw_value = 6, }, 524c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 180, .hw_value = 7, }, 534c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 240, .hw_value = 8, }, 544c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 360, .hw_value = 9, }, 554c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 480, .hw_value = 10, }, 564c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 540, .hw_value = 11, }, 574c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter}; 584c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 597a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparterstatic struct p54_rssi_db_entry p54_rssi_default = { 607a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter /* 617a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter * The defaults are taken from usb-logs of the 627a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter * vendor driver. So, they should be safe to 637a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter * use in case we can't get a match from the 647a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter * rssi <-> dBm conversion database. 657a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter */ 667a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter .mul = 130, 677a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter .add = -398, 687a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter}; 697a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter 701a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter#define CHAN_HAS_CAL BIT(0) 711a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter#define CHAN_HAS_LIMIT BIT(1) 721a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter#define CHAN_HAS_CURVE BIT(2) 731a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter#define CHAN_HAS_ALL (CHAN_HAS_CAL | CHAN_HAS_LIMIT | CHAN_HAS_CURVE) 741a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 751a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparterstruct p54_channel_entry { 761a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter u16 freq; 771a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter u16 data; 781a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter int index; 799bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter int max_power; 801a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter enum ieee80211_band band; 814c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter}; 824c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 831a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparterstruct p54_channel_list { 841a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter struct p54_channel_entry *channels; 851a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter size_t entries; 861a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter size_t max_entries; 871a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter size_t band_channel_num[IEEE80211_NUM_BANDS]; 884c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter}; 894c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 901a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparterstatic int p54_get_band_from_freq(u16 freq) 911a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter{ 921a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter /* FIXME: sync these values with the 802.11 spec */ 931a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 941a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if ((freq >= 2412) && (freq <= 2484)) 951a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter return IEEE80211_BAND_2GHZ; 961a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 971a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if ((freq >= 4920) && (freq <= 5825)) 981a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter return IEEE80211_BAND_5GHZ; 991a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1001a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter return -1; 1011a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter} 1021a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1037a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparterstatic int same_band(u16 freq, u16 freq2) 1047a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter{ 1057a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter return p54_get_band_from_freq(freq) == p54_get_band_from_freq(freq2); 1067a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter} 1077a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter 1081a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparterstatic int p54_compare_channels(const void *_a, 1091a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter const void *_b) 1101a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter{ 1111a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter const struct p54_channel_entry *a = _a; 1121a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter const struct p54_channel_entry *b = _b; 1131a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 114192abece7565ab37048dfd5eced966cfb2fda6f5Christian Lamparter return a->freq - b->freq; 1151a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter} 1161a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1177a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparterstatic int p54_compare_rssichan(const void *_a, 1187a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter const void *_b) 1197a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter{ 1207a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter const struct p54_rssi_db_entry *a = _a; 1217a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter const struct p54_rssi_db_entry *b = _b; 1227a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter 1237a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter return a->freq - b->freq; 1247a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter} 1257a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter 1261a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparterstatic int p54_fill_band_bitrates(struct ieee80211_hw *dev, 1271a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter struct ieee80211_supported_band *band_entry, 1281a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter enum ieee80211_band band) 1291a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter{ 1301a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter /* TODO: generate rate array dynamically */ 1311a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1321a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter switch (band) { 1331a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter case IEEE80211_BAND_2GHZ: 1341a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter band_entry->bitrates = p54_bgrates; 1351a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter band_entry->n_bitrates = ARRAY_SIZE(p54_bgrates); 1361a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter break; 1371a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter case IEEE80211_BAND_5GHZ: 1381a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter band_entry->bitrates = p54_arates; 1391a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter band_entry->n_bitrates = ARRAY_SIZE(p54_arates); 1401a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter break; 1411a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter default: 1421a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter return -EINVAL; 1431a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 1441a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1451a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter return 0; 1461a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter} 1471a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1481a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparterstatic int p54_generate_band(struct ieee80211_hw *dev, 1491a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter struct p54_channel_list *list, 1500d78156eef1d8869ea4e56f8a257252a8f262f04Christian Lamparter unsigned int *chan_num, 1511a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter enum ieee80211_band band) 1521a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter{ 1531a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter struct p54_common *priv = dev->priv; 1541a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter struct ieee80211_supported_band *tmp, *old; 1551a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter unsigned int i, j; 1561a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter int ret = -ENOMEM; 1571a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1581a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if ((!list->entries) || (!list->band_channel_num[band])) 15993a59d7527147e3656664aa3179f8d19de256081Christian Lamparter return -EINVAL; 1601a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1611a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter tmp = kzalloc(sizeof(*tmp), GFP_KERNEL); 1621a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (!tmp) 1631a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter goto err_out; 1641a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1651a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter tmp->channels = kzalloc(sizeof(struct ieee80211_channel) * 1661a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter list->band_channel_num[band], GFP_KERNEL); 1671a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (!tmp->channels) 1681a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter goto err_out; 1691a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1701a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter ret = p54_fill_band_bitrates(dev, tmp, band); 1711a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (ret) 1721a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter goto err_out; 1731a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1741a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter for (i = 0, j = 0; (j < list->band_channel_num[band]) && 1751a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter (i < list->entries); i++) { 176a3162eed04ae76be710d895978478aa6d849de41Christian Lamparter struct p54_channel_entry *chan = &list->channels[i]; 1779bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter struct ieee80211_channel *dest = &tmp->channels[j]; 1781a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 179a3162eed04ae76be710d895978478aa6d849de41Christian Lamparter if (chan->band != band) 1801a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter continue; 1811a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 182a3162eed04ae76be710d895978478aa6d849de41Christian Lamparter if (chan->data != CHAN_HAS_ALL) { 183a3162eed04ae76be710d895978478aa6d849de41Christian Lamparter wiphy_err(dev->wiphy, "%s%s%s is/are missing for " 184a3162eed04ae76be710d895978478aa6d849de41Christian Lamparter "channel:%d [%d MHz].\n", 185a3162eed04ae76be710d895978478aa6d849de41Christian Lamparter (chan->data & CHAN_HAS_CAL ? "" : 186c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches " [iqauto calibration data]"), 187a3162eed04ae76be710d895978478aa6d849de41Christian Lamparter (chan->data & CHAN_HAS_LIMIT ? "" : 188c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches " [output power limits]"), 189a3162eed04ae76be710d895978478aa6d849de41Christian Lamparter (chan->data & CHAN_HAS_CURVE ? "" : 190c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches " [curve data]"), 191a3162eed04ae76be710d895978478aa6d849de41Christian Lamparter chan->index, chan->freq); 19293a59d7527147e3656664aa3179f8d19de256081Christian Lamparter continue; 1931a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 1941a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1959bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter dest->band = chan->band; 1969bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter dest->center_freq = chan->freq; 1979bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter dest->max_power = chan->max_power; 1980d78156eef1d8869ea4e56f8a257252a8f262f04Christian Lamparter priv->survey[*chan_num].channel = &tmp->channels[j]; 1990d78156eef1d8869ea4e56f8a257252a8f262f04Christian Lamparter priv->survey[*chan_num].filled = SURVEY_INFO_NOISE_DBM | 2000d78156eef1d8869ea4e56f8a257252a8f262f04Christian Lamparter SURVEY_INFO_CHANNEL_TIME | 2010d78156eef1d8869ea4e56f8a257252a8f262f04Christian Lamparter SURVEY_INFO_CHANNEL_TIME_BUSY | 2020d78156eef1d8869ea4e56f8a257252a8f262f04Christian Lamparter SURVEY_INFO_CHANNEL_TIME_TX; 2039bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter dest->hw_value = (*chan_num); 2041a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter j++; 2050d78156eef1d8869ea4e56f8a257252a8f262f04Christian Lamparter (*chan_num)++; 2061a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 2071a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 20893a59d7527147e3656664aa3179f8d19de256081Christian Lamparter if (j == 0) { 2095db5584441c2dceb75696fb31a44ac7b9b925359Joe Perches wiphy_err(dev->wiphy, "Disabling totally damaged %d GHz band\n", 210c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches (band == IEEE80211_BAND_2GHZ) ? 2 : 5); 21193a59d7527147e3656664aa3179f8d19de256081Christian Lamparter 21293a59d7527147e3656664aa3179f8d19de256081Christian Lamparter ret = -ENODATA; 21393a59d7527147e3656664aa3179f8d19de256081Christian Lamparter goto err_out; 21493a59d7527147e3656664aa3179f8d19de256081Christian Lamparter } 21593a59d7527147e3656664aa3179f8d19de256081Christian Lamparter 21693a59d7527147e3656664aa3179f8d19de256081Christian Lamparter tmp->n_channels = j; 2171a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter old = priv->band_table[band]; 2181a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter priv->band_table[band] = tmp; 2191a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (old) { 2201a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter kfree(old->channels); 2211a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter kfree(old); 2221a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 2231a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2241a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter return 0; 2251a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2261a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lampartererr_out: 2271a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (tmp) { 2281a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter kfree(tmp->channels); 2291a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter kfree(tmp); 2301a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 2311a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2321a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter return ret; 2331a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter} 2341a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2359bc63816be9bf504414d350e605a4b30f857907dChristian Lamparterstatic struct p54_channel_entry *p54_update_channel_param(struct p54_channel_list *list, 2369bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter u16 freq, u16 data) 2371a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter{ 2389bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter int i; 2399bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter struct p54_channel_entry *entry = NULL; 2401a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2411a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter /* 2421a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter * usually all lists in the eeprom are mostly sorted. 2431a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter * so it's very likely that the entry we are looking for 2441a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter * is right at the end of the list 2451a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter */ 2461a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter for (i = list->entries; i >= 0; i--) { 2471a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (freq == list->channels[i].freq) { 2489bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter entry = &list->channels[i]; 2491a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter break; 2501a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 2511a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 2521a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2531a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if ((i < 0) && (list->entries < list->max_entries)) { 2541a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter /* entry does not exist yet. Initialize a new one. */ 2559bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter int band = p54_get_band_from_freq(freq); 2561a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2571a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter /* 2581a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter * filter out frequencies which don't belong into 2591a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter * any supported band. 2601a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter */ 2619bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter if (band >= 0) { 2629bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter i = list->entries++; 2639bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter list->band_channel_num[band]++; 2649bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter 2659bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter entry = &list->channels[i]; 2669bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter entry->freq = freq; 2679bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter entry->band = band; 2689bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter entry->index = ieee80211_frequency_to_channel(freq); 2699bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter entry->max_power = 0; 2709bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter entry->data = 0; 2719bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter } 2729bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter } 2731a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2749bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter if (entry) 2759bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter entry->data |= data; 2761a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2779bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter return entry; 2789bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter} 2799bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter 2809bc63816be9bf504414d350e605a4b30f857907dChristian Lamparterstatic int p54_get_maxpower(struct p54_common *priv, void *data) 2819bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter{ 2829bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter switch (priv->rxhw & PDR_SYNTH_FRONTEND_MASK) { 2839bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter case PDR_SYNTH_FRONTEND_LONGBOW: { 2849bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter struct pda_channel_output_limit_longbow *pda = data; 2859bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter int j; 2869bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter u16 rawpower = 0; 2879bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter pda = data; 2889bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter for (j = 0; j < ARRAY_SIZE(pda->point); j++) { 2899bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter struct pda_channel_output_limit_point_longbow *point = 2909bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter &pda->point[j]; 29122c5649eef0fc37532e20c14d2656b28ca708a69Christian Lamparter rawpower = max_t(u16, 29222c5649eef0fc37532e20c14d2656b28ca708a69Christian Lamparter rawpower, le16_to_cpu(point->val_qpsk)); 29322c5649eef0fc37532e20c14d2656b28ca708a69Christian Lamparter rawpower = max_t(u16, 29422c5649eef0fc37532e20c14d2656b28ca708a69Christian Lamparter rawpower, le16_to_cpu(point->val_bpsk)); 29522c5649eef0fc37532e20c14d2656b28ca708a69Christian Lamparter rawpower = max_t(u16, 29622c5649eef0fc37532e20c14d2656b28ca708a69Christian Lamparter rawpower, le16_to_cpu(point->val_16qam)); 29722c5649eef0fc37532e20c14d2656b28ca708a69Christian Lamparter rawpower = max_t(u16, 29822c5649eef0fc37532e20c14d2656b28ca708a69Christian Lamparter rawpower, le16_to_cpu(point->val_64qam)); 2999bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter } 3009bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter /* longbow seems to use 1/16 dBm units */ 3019bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter return rawpower / 16; 3029bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter } 3039bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter 3049bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter case PDR_SYNTH_FRONTEND_DUETTE3: 3059bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter case PDR_SYNTH_FRONTEND_DUETTE2: 3069bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter case PDR_SYNTH_FRONTEND_FRISBEE: 3079bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter case PDR_SYNTH_FRONTEND_XBOW: { 3089bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter struct pda_channel_output_limit *pda = data; 3099bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter u8 rawpower = 0; 3109bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter rawpower = max(rawpower, pda->val_qpsk); 3119bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter rawpower = max(rawpower, pda->val_bpsk); 3129bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter rawpower = max(rawpower, pda->val_16qam); 3139bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter rawpower = max(rawpower, pda->val_64qam); 3149bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter /* raw values are in 1/4 dBm units */ 3159bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter return rawpower / 4; 3169bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter } 3179bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter 3189bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter default: 3199bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter return 20; 3201a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 3211a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter} 3221a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 3231a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparterstatic int p54_generate_channel_lists(struct ieee80211_hw *dev) 3241a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter{ 3251a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter struct p54_common *priv = dev->priv; 3261a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter struct p54_channel_list *list; 3270d78156eef1d8869ea4e56f8a257252a8f262f04Christian Lamparter unsigned int i, j, k, max_channel_num; 32893a59d7527147e3656664aa3179f8d19de256081Christian Lamparter int ret = 0; 3291a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter u16 freq; 3301a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 3311a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if ((priv->iq_autocal_len != priv->curve_data->entries) || 3321a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter (priv->iq_autocal_len != priv->output_limit->entries)) 333c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches wiphy_err(dev->wiphy, 334c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches "Unsupported or damaged EEPROM detected. " 335c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches "You may not be able to use all channels.\n"); 3361a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 3371a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter max_channel_num = max_t(unsigned int, priv->output_limit->entries, 3381a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter priv->iq_autocal_len); 3391a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter max_channel_num = max_t(unsigned int, max_channel_num, 3401a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter priv->curve_data->entries); 3411a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 3421a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter list = kzalloc(sizeof(*list), GFP_KERNEL); 34393a59d7527147e3656664aa3179f8d19de256081Christian Lamparter if (!list) { 34493a59d7527147e3656664aa3179f8d19de256081Christian Lamparter ret = -ENOMEM; 3451a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter goto free; 34693a59d7527147e3656664aa3179f8d19de256081Christian Lamparter } 3470d78156eef1d8869ea4e56f8a257252a8f262f04Christian Lamparter priv->chan_num = max_channel_num; 3480d78156eef1d8869ea4e56f8a257252a8f262f04Christian Lamparter priv->survey = kzalloc(sizeof(struct survey_info) * max_channel_num, 3490d78156eef1d8869ea4e56f8a257252a8f262f04Christian Lamparter GFP_KERNEL); 3500d78156eef1d8869ea4e56f8a257252a8f262f04Christian Lamparter if (!priv->survey) { 3510d78156eef1d8869ea4e56f8a257252a8f262f04Christian Lamparter ret = -ENOMEM; 3520d78156eef1d8869ea4e56f8a257252a8f262f04Christian Lamparter goto free; 3530d78156eef1d8869ea4e56f8a257252a8f262f04Christian Lamparter } 3541a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 3551a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter list->max_entries = max_channel_num; 3561a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter list->channels = kzalloc(sizeof(struct p54_channel_entry) * 3571a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter max_channel_num, GFP_KERNEL); 3580d91f22b75347d9503b17a42b6c74d3f7750acd6Julia Lawall if (!list->channels) { 3590d91f22b75347d9503b17a42b6c74d3f7750acd6Julia Lawall ret = -ENOMEM; 3601a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter goto free; 3610d91f22b75347d9503b17a42b6c74d3f7750acd6Julia Lawall } 3621a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 3631a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter for (i = 0; i < max_channel_num; i++) { 3641a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (i < priv->iq_autocal_len) { 3651a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter freq = le16_to_cpu(priv->iq_autocal[i].freq); 3661a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter p54_update_channel_param(list, freq, CHAN_HAS_CAL); 3671a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 3681a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 3691a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (i < priv->output_limit->entries) { 3709bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter struct p54_channel_entry *tmp; 3719bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter 3729bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter void *data = (void *) ((unsigned long) i * 3739bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter priv->output_limit->entry_size + 3749bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter priv->output_limit->offset + 3759bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter priv->output_limit->data); 3769bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter 3779bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter freq = le16_to_cpup((__le16 *) data); 3789bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter tmp = p54_update_channel_param(list, freq, 3799bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter CHAN_HAS_LIMIT); 3809bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter if (tmp) { 3819bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter tmp->max_power = p54_get_maxpower(priv, data); 3829bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter } 3831a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 3841a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 3851a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (i < priv->curve_data->entries) { 3861a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter freq = le16_to_cpup((__le16 *) (i * 3871a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter priv->curve_data->entry_size + 3881a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter priv->curve_data->offset + 3891a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter priv->curve_data->data)); 3901a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 3911a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter p54_update_channel_param(list, freq, CHAN_HAS_CURVE); 3921a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 3931a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 3941a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 395192abece7565ab37048dfd5eced966cfb2fda6f5Christian Lamparter /* sort the channel list by frequency */ 3961a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter sort(list->channels, list->entries, sizeof(struct p54_channel_entry), 3971a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter p54_compare_channels, NULL); 3981a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 3990d78156eef1d8869ea4e56f8a257252a8f262f04Christian Lamparter k = 0; 4001a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter for (i = 0, j = 0; i < IEEE80211_NUM_BANDS; i++) { 4010d78156eef1d8869ea4e56f8a257252a8f262f04Christian Lamparter if (p54_generate_band(dev, list, &k, i) == 0) 4021a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter j++; 4031a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 4041a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (j == 0) { 4051a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter /* no useable band available. */ 4061a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter ret = -EINVAL; 4071a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 4081a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 4091a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparterfree: 4101a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (list) { 4111a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter kfree(list->channels); 4121a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter kfree(list); 4131a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 4140d78156eef1d8869ea4e56f8a257252a8f262f04Christian Lamparter if (ret) { 4150d78156eef1d8869ea4e56f8a257252a8f262f04Christian Lamparter kfree(priv->survey); 4160d78156eef1d8869ea4e56f8a257252a8f262f04Christian Lamparter priv->survey = NULL; 4170d78156eef1d8869ea4e56f8a257252a8f262f04Christian Lamparter } 4181a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 4191a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter return ret; 4201a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter} 4211a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 4224c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparterstatic int p54_convert_rev0(struct ieee80211_hw *dev, 4234c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct pda_pa_curve_data *curve_data) 4244c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter{ 4254c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct p54_common *priv = dev->priv; 4264c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct p54_pa_curve_data_sample *dst; 4274c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct pda_pa_curve_data_sample_rev0 *src; 4284c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter size_t cd_len = sizeof(*curve_data) + 4294c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter (curve_data->points_per_channel*sizeof(*dst) + 2) * 4304c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter curve_data->channels; 4314c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter unsigned int i, j; 4324c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter void *source, *target; 4334c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4344c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data = kmalloc(sizeof(*priv->curve_data) + cd_len, 4354c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter GFP_KERNEL); 4364c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (!priv->curve_data) 4374c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return -ENOMEM; 4384c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4394c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data->entries = curve_data->channels; 4404c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data->entry_size = sizeof(__le16) + 4414c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter sizeof(*dst) * curve_data->points_per_channel; 4424c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data->offset = offsetof(struct pda_pa_curve_data, data); 4434c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data->len = cd_len; 4444c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter memcpy(priv->curve_data->data, curve_data, sizeof(*curve_data)); 4454c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter source = curve_data->data; 4464c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter target = ((struct pda_pa_curve_data *) priv->curve_data->data)->data; 4474c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter for (i = 0; i < curve_data->channels; i++) { 4484c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter __le16 *freq = source; 4494c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter source += sizeof(__le16); 4504c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter *((__le16 *)target) = *freq; 4514c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter target += sizeof(__le16); 4524c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter for (j = 0; j < curve_data->points_per_channel; j++) { 4534c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst = target; 4544c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter src = source; 4554c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4564c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst->rf_power = src->rf_power; 4574c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst->pa_detector = src->pa_detector; 4584c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst->data_64qam = src->pcv; 4594c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter /* "invent" the points for the other modulations */ 4604c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter#define SUB(x, y) (u8)(((x) - (y)) > (x) ? 0 : (x) - (y)) 4614c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst->data_16qam = SUB(src->pcv, 12); 4624c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst->data_qpsk = SUB(dst->data_16qam, 12); 4634c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst->data_bpsk = SUB(dst->data_qpsk, 12); 4644c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst->data_barker = SUB(dst->data_bpsk, 14); 4654c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter#undef SUB 4664c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter target += sizeof(*dst); 4674c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter source += sizeof(*src); 4684c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 4694c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 4704c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4714c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return 0; 4724c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter} 4734c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4744c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparterstatic int p54_convert_rev1(struct ieee80211_hw *dev, 4754c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct pda_pa_curve_data *curve_data) 4764c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter{ 4774c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct p54_common *priv = dev->priv; 4784c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct p54_pa_curve_data_sample *dst; 4794c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct pda_pa_curve_data_sample_rev1 *src; 4804c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter size_t cd_len = sizeof(*curve_data) + 4814c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter (curve_data->points_per_channel*sizeof(*dst) + 2) * 4824c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter curve_data->channels; 4834c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter unsigned int i, j; 4844c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter void *source, *target; 4854c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4864c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data = kzalloc(cd_len + sizeof(*priv->curve_data), 4874c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter GFP_KERNEL); 4884c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (!priv->curve_data) 4894c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return -ENOMEM; 4904c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4914c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data->entries = curve_data->channels; 4924c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data->entry_size = sizeof(__le16) + 4934c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter sizeof(*dst) * curve_data->points_per_channel; 4944c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data->offset = offsetof(struct pda_pa_curve_data, data); 4954c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data->len = cd_len; 4964c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter memcpy(priv->curve_data->data, curve_data, sizeof(*curve_data)); 4974c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter source = curve_data->data; 4984c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter target = ((struct pda_pa_curve_data *) priv->curve_data->data)->data; 4994c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter for (i = 0; i < curve_data->channels; i++) { 5004c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter __le16 *freq = source; 5014c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter source += sizeof(__le16); 5024c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter *((__le16 *)target) = *freq; 5034c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter target += sizeof(__le16); 5044c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter for (j = 0; j < curve_data->points_per_channel; j++) { 5054c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter memcpy(target, source, sizeof(*src)); 5064c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 5074c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter target += sizeof(*dst); 5084c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter source += sizeof(*src); 5094c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 5104c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter source++; 5114c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 5124c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 5134c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return 0; 5144c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter} 5154c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 5164c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparterstatic const char *p54_rf_chips[] = { "INVALID-0", "Duette3", "Duette2", 5174c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter "Frisbee", "Xbow", "Longbow", "INVALID-6", "INVALID-7" }; 5184c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 5197a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparterstatic int p54_parse_rssical(struct ieee80211_hw *dev, 5207a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter u8 *data, int len, u16 type) 5214c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter{ 5224c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct p54_common *priv = dev->priv; 5237a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter struct p54_rssi_db_entry *entry; 5247a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter size_t db_len, entries; 5257a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter int offset = 0, i; 5267a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter 5277a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter if (type != PDR_RSSI_LINEAR_APPROXIMATION_EXTENDED) { 5287a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter entries = (type == PDR_RSSI_LINEAR_APPROXIMATION) ? 1 : 2; 5297a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter if (len != sizeof(struct pda_rssi_cal_entry) * entries) { 5307a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter wiphy_err(dev->wiphy, "rssical size mismatch.\n"); 5317a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter goto err_data; 5327a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter } 5337a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter } else { 5347a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter /* 5357a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter * Some devices (Dell 1450 USB, Xbow 5GHz card, etc...) 5367a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter * have an empty two byte header. 5377a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter */ 5387a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter if (*((__le16 *)&data[offset]) == cpu_to_le16(0)) 5397a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter offset += 2; 5404c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 5417a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter entries = (len - offset) / 5427a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter sizeof(struct pda_rssi_cal_ext_entry); 5434c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 5446dac3447425d932fa76a4e69d32eead9dd090b27Dan Carpenter if (len < offset || 5456dac3447425d932fa76a4e69d32eead9dd090b27Dan Carpenter (len - offset) % sizeof(struct pda_rssi_cal_ext_entry) || 5466dac3447425d932fa76a4e69d32eead9dd090b27Dan Carpenter entries == 0) { 5477a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter wiphy_err(dev->wiphy, "invalid rssi database.\n"); 5487a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter goto err_data; 5497a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter } 5507a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter } 5514c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 5527a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter db_len = sizeof(*entry) * entries; 5537a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter priv->rssi_db = kzalloc(db_len + sizeof(*priv->rssi_db), GFP_KERNEL); 5547a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter if (!priv->rssi_db) 5557a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter return -ENOMEM; 5567a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter 5577a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter priv->rssi_db->offset = 0; 5587a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter priv->rssi_db->entries = entries; 5597a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter priv->rssi_db->entry_size = sizeof(*entry); 5607a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter priv->rssi_db->len = db_len; 5617a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter 5627a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter entry = (void *)((unsigned long)priv->rssi_db->data + priv->rssi_db->offset); 5637a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter if (type == PDR_RSSI_LINEAR_APPROXIMATION_EXTENDED) { 5647a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter struct pda_rssi_cal_ext_entry *cal = (void *) &data[offset]; 5657a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter 5667a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter for (i = 0; i < entries; i++) { 5677a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter entry[i].freq = le16_to_cpu(cal[i].freq); 5687a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter entry[i].mul = (s16) le16_to_cpu(cal[i].mul); 5697a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter entry[i].add = (s16) le16_to_cpu(cal[i].add); 5707a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter } 5717a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter } else { 5727a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter struct pda_rssi_cal_entry *cal = (void *) &data[offset]; 5737a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter 5747a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter for (i = 0; i < entries; i++) { 575ce6cac88a4f1e52a51a31c31562f4da347543147John W. Linville u16 freq = 0; 5767a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter switch (i) { 5777a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter case IEEE80211_BAND_2GHZ: 5787a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter freq = 2437; 5797a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter break; 5807a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter case IEEE80211_BAND_5GHZ: 5817a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter freq = 5240; 5827a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter break; 5837a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter } 5847a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter 5857a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter entry[i].freq = freq; 5867a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter entry[i].mul = (s16) le16_to_cpu(cal[i].mul); 5877a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter entry[i].add = (s16) le16_to_cpu(cal[i].add); 5887a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter } 5894c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 5904c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 5917a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter /* sort the list by channel frequency */ 5927a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter sort(entry, entries, sizeof(*entry), p54_compare_rssichan, NULL); 5937a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter return 0; 5947a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter 5957a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lampartererr_data: 5967a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter wiphy_err(dev->wiphy, 5977a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter "rssi calibration data packing type:(%x) len:%d.\n", 5987a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter type, len); 5997a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter 6007a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter print_hex_dump_bytes("rssical:", DUMP_PREFIX_NONE, data, len); 6017a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter 6027a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter wiphy_err(dev->wiphy, "please report this issue.\n"); 6037a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter return -EINVAL; 6047a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter} 6057a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter 6067a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparterstruct p54_rssi_db_entry *p54_rssi_find(struct p54_common *priv, const u16 freq) 6077a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter{ 608a5a7103fe18eb4312bd89c9f136fb850af58faf4Felix Fietkau struct p54_rssi_db_entry *entry; 6097a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter int i, found = -1; 6107a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter 611a5a7103fe18eb4312bd89c9f136fb850af58faf4Felix Fietkau if (!priv->rssi_db) 612a5a7103fe18eb4312bd89c9f136fb850af58faf4Felix Fietkau return &p54_rssi_default; 613a5a7103fe18eb4312bd89c9f136fb850af58faf4Felix Fietkau 614a5a7103fe18eb4312bd89c9f136fb850af58faf4Felix Fietkau entry = (void *)(priv->rssi_db->data + priv->rssi_db->offset); 6157a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter for (i = 0; i < priv->rssi_db->entries; i++) { 6167a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter if (!same_band(freq, entry[i].freq)) 6177a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter continue; 6187a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter 6197a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter if (found == -1) { 6207a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter found = i; 6217a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter continue; 6227a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter } 6237a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter 6247a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter /* nearest match */ 6257a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter if (abs(freq - entry[i].freq) < 6267a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter abs(freq - entry[found].freq)) { 6277a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter found = i; 6287a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter continue; 6297a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter } else { 6307a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter break; 6317a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter } 6324c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 6337a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter 6347a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter return found < 0 ? &p54_rssi_default : &entry[found]; 6354c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter} 6364c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 6374c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparterstatic void p54_parse_default_country(struct ieee80211_hw *dev, 6384c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter void *data, int len) 6394c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter{ 6404c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct pda_country *country; 6414c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 6424c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (len != sizeof(*country)) { 643c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches wiphy_err(dev->wiphy, 644c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches "found possible invalid default country eeprom entry. (entry size: %d)\n", 645c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches len); 6464c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 6474c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter print_hex_dump_bytes("country:", DUMP_PREFIX_NONE, 6484c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter data, len); 6494c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 650c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches wiphy_err(dev->wiphy, "please report this issue.\n"); 6514c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return; 6524c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 6534c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 6544c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter country = (struct pda_country *) data; 6554c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (country->flags == PDR_COUNTRY_CERT_CODE_PSEUDO) 6564c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter regulatory_hint(dev->wiphy, country->alpha2); 6574c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter else { 6584c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter /* TODO: 6594c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter * write a shared/common function that converts 6604c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter * "Regulatory domain codes" (802.11-2007 14.8.2.2) 6614c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter * into ISO/IEC 3166-1 alpha2 for regulatory_hint. 6624c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter */ 6634c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 6644c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter} 6654c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 6664c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparterstatic int p54_convert_output_limits(struct ieee80211_hw *dev, 6674c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter u8 *data, size_t len) 6684c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter{ 6694c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct p54_common *priv = dev->priv; 6704c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 6714c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (len < 2) 6724c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return -EINVAL; 6734c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 6744c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (data[0] != 0) { 675c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches wiphy_err(dev->wiphy, "unknown output power db revision:%x\n", 676c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches data[0]); 6774c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return -EINVAL; 6784c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 6794c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 6804c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (2 + data[1] * sizeof(struct pda_channel_output_limit) > len) 6814c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return -EINVAL; 6824c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 6834c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->output_limit = kmalloc(data[1] * 6844c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter sizeof(struct pda_channel_output_limit) + 6854c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter sizeof(*priv->output_limit), GFP_KERNEL); 6864c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 6874c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (!priv->output_limit) 6884c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return -ENOMEM; 6894c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 6904c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->output_limit->offset = 0; 6914c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->output_limit->entries = data[1]; 6924c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->output_limit->entry_size = 6934c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter sizeof(struct pda_channel_output_limit); 6944c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->output_limit->len = priv->output_limit->entry_size * 6954c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->output_limit->entries + 6964c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->output_limit->offset; 6974c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 6984c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter memcpy(priv->output_limit->data, &data[2], 6994c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter data[1] * sizeof(struct pda_channel_output_limit)); 7004c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 7014c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return 0; 7024c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter} 7034c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 7044c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparterstatic struct p54_cal_database *p54_convert_db(struct pda_custom_wrapper *src, 7054c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter size_t total_len) 7064c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter{ 7074c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct p54_cal_database *dst; 7084c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter size_t payload_len, entries, entry_size, offset; 7094c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 7104c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter payload_len = le16_to_cpu(src->len); 7114c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter entries = le16_to_cpu(src->entries); 7124c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter entry_size = le16_to_cpu(src->entry_size); 7134c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter offset = le16_to_cpu(src->offset); 7144c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (((entries * entry_size + offset) != payload_len) || 7154c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter (payload_len + sizeof(*src) != total_len)) 7164c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return NULL; 7174c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 7184c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst = kmalloc(sizeof(*dst) + payload_len, GFP_KERNEL); 7194c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (!dst) 7204c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return NULL; 7214c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 7224c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst->entries = entries; 7234c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst->entry_size = entry_size; 7244c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst->offset = offset; 7254c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst->len = payload_len; 7264c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 7274c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter memcpy(dst->data, src->data, payload_len); 7284c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return dst; 7294c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter} 7304c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 7314c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparterint p54_parse_eeprom(struct ieee80211_hw *dev, void *eeprom, int len) 7324c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter{ 7334c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct p54_common *priv = dev->priv; 734e6a3f551bc236010c4d4d99e626e150e98a4c3e6Larry Finger struct eeprom_pda_wrap *wrap; 7354c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct pda_entry *entry; 7364c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter unsigned int data_len, entry_len; 7374c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter void *tmp; 7384c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter int err; 7394c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter u8 *end = (u8 *)eeprom + len; 7404c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter u16 synth = 0; 741d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter u16 crc16 = ~0; 7424c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 7434c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter wrap = (struct eeprom_pda_wrap *) eeprom; 7444c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter entry = (void *)wrap->data + le16_to_cpu(wrap->len); 7454c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 7464c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter /* verify that at least the entry length/code fits */ 7474c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter while ((u8 *)entry <= end - sizeof(*entry)) { 7484c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter entry_len = le16_to_cpu(entry->len); 7494c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter data_len = ((entry_len - 1) << 1); 7504c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 7514c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter /* abort if entry exceeds whole structure */ 7524c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if ((u8 *)entry + sizeof(*entry) + data_len > end) 7534c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 7544c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 7554c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter switch (le16_to_cpu(entry->code)) { 7564c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_MAC_ADDRESS: 7574c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (data_len != ETH_ALEN) 7584c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 7594c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter SET_IEEE80211_PERM_ADDR(dev, entry->data); 7604c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 7614c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_PRISM_PA_CAL_OUTPUT_POWER_LIMITS: 7624c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (priv->output_limit) 7634c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 7644c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter err = p54_convert_output_limits(dev, entry->data, 7654c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter data_len); 7664c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (err) 7674c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter goto err; 7684c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 7694c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_PRISM_PA_CAL_CURVE_DATA: { 7704c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct pda_pa_curve_data *curve_data = 7714c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter (struct pda_pa_curve_data *)entry->data; 7724c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (data_len < sizeof(*curve_data)) { 7734c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter err = -EINVAL; 7744c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter goto err; 7754c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 7764c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 7774c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter switch (curve_data->cal_method_rev) { 7784c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case 0: 7794c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter err = p54_convert_rev0(dev, curve_data); 7804c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 7814c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case 1: 7824c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter err = p54_convert_rev1(dev, curve_data); 7834c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 7844c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter default: 785c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches wiphy_err(dev->wiphy, 786c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches "unknown curve data revision %d\n", 787c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches curve_data->cal_method_rev); 7884c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter err = -ENODEV; 7894c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 7904c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 7914c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (err) 7924c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter goto err; 7934c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 7944c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 7954c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_PRISM_ZIF_TX_IQ_CALIBRATION: 79627b81bbed881ae93e8c23c216129cdeee86d4051Julia Lawall priv->iq_autocal = kmemdup(entry->data, data_len, 79727b81bbed881ae93e8c23c216129cdeee86d4051Julia Lawall GFP_KERNEL); 7984c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (!priv->iq_autocal) { 7994c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter err = -ENOMEM; 8004c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter goto err; 8014c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 8024c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 8034c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->iq_autocal_len = data_len / sizeof(struct pda_iq_autocal_entry); 8044c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 8054c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_DEFAULT_COUNTRY: 8064c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter p54_parse_default_country(dev, entry->data, data_len); 8074c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 8084c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_INTERFACE_LIST: 8094c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter tmp = entry->data; 8104c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter while ((u8 *)tmp < entry->data + data_len) { 8114c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct exp_if *exp_if = tmp; 8124c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (exp_if->if_id == cpu_to_le16(IF_ID_ISL39000)) 8134c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter synth = le16_to_cpu(exp_if->variant); 8144c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter tmp += sizeof(*exp_if); 8154c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 8164c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 8174c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_HARDWARE_PLATFORM_COMPONENT_ID: 8184c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (data_len < 2) 8194c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 8204c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->version = *(u8 *)(entry->data + 1); 8214c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 8224c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_RSSI_LINEAR_APPROXIMATION: 8234c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_RSSI_LINEAR_APPROXIMATION_DUAL_BAND: 8244c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_RSSI_LINEAR_APPROXIMATION_EXTENDED: 8257a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter err = p54_parse_rssical(dev, entry->data, data_len, 8267a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter le16_to_cpu(entry->code)); 8277a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter if (err) 8287a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter goto err; 8294c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 8307a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter case PDR_RSSI_LINEAR_APPROXIMATION_CUSTOMV2: { 8317a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter struct pda_custom_wrapper *pda = (void *) entry->data; 8327a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter __le16 *src; 8337a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter u16 *dst; 8344c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter int i; 8354c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 8367a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter if (priv->rssi_db || data_len < sizeof(*pda)) 8377a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter break; 8387a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter 8397a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter priv->rssi_db = p54_convert_db(pda, data_len); 8407a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter if (!priv->rssi_db) 8417a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter break; 8427a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter 8437a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter src = (void *) priv->rssi_db->data; 8447a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter dst = (void *) priv->rssi_db->data; 8457a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter 8467a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter for (i = 0; i < priv->rssi_db->entries; i++) 8474c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter *(dst++) = (s16) le16_to_cpu(*(src++)); 8487a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter 8494c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 8504c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 8514c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_PRISM_PA_CAL_OUTPUT_POWER_LIMITS_CUSTOM: { 8524c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct pda_custom_wrapper *pda = (void *) entry->data; 8534c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (priv->output_limit || data_len < sizeof(*pda)) 8544c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 8554c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->output_limit = p54_convert_db(pda, data_len); 8564c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 8574c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 8584c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_PRISM_PA_CAL_CURVE_DATA_CUSTOM: { 8594c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct pda_custom_wrapper *pda = (void *) entry->data; 8604c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (priv->curve_data || data_len < sizeof(*pda)) 8614c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 8624c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data = p54_convert_db(pda, data_len); 8634c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 8644c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 8654c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_END: 866d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter crc16 = ~crc_ccitt(crc16, (u8 *) entry, sizeof(*entry)); 867d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter if (crc16 != le16_to_cpup((__le16 *)entry->data)) { 868d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter wiphy_err(dev->wiphy, "eeprom failed checksum " 869d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter "test!\n"); 870d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter err = -ENOMSG; 871d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter goto err; 872d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter } else { 873d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter goto good_eeprom; 874d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter } 8754c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 8764c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter default: 8774c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 8784c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 8794c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 880d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter crc16 = crc_ccitt(crc16, (u8 *)entry, (entry_len + 1) * 2); 881d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter entry = (void *)entry + (entry_len + 1) * 2; 8824c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 8834c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 884d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter wiphy_err(dev->wiphy, "unexpected end of eeprom data.\n"); 885d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter err = -ENODATA; 886d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter goto err; 887d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter 888d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lampartergood_eeprom: 8894c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (!synth || !priv->iq_autocal || !priv->output_limit || 8904c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter !priv->curve_data) { 891c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches wiphy_err(dev->wiphy, 892c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches "not all required entries found in eeprom!\n"); 8934c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter err = -EINVAL; 8944c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter goto err; 8954c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 8964c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 8979bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter priv->rxhw = synth & PDR_SYNTH_FRONTEND_MASK; 8989bc63816be9bf504414d350e605a4b30f857907dChristian Lamparter 8991a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter err = p54_generate_channel_lists(dev); 9001a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (err) 9011a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter goto err; 9021a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 9034c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (priv->rxhw == PDR_SYNTH_FRONTEND_XBOW) 9044c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter p54_init_xbow_synth(priv); 9054c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (!(synth & PDR_SYNTH_24_GHZ_DISABLED)) 9061a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter dev->wiphy->bands[IEEE80211_BAND_2GHZ] = 9071a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter priv->band_table[IEEE80211_BAND_2GHZ]; 9084c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (!(synth & PDR_SYNTH_5_GHZ_DISABLED)) 9091a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter dev->wiphy->bands[IEEE80211_BAND_5GHZ] = 9101a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter priv->band_table[IEEE80211_BAND_5GHZ]; 9114c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if ((synth & PDR_SYNTH_RX_DIV_MASK) == PDR_SYNTH_RX_DIV_SUPPORTED) 9124c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->rx_diversity_mask = 3; 9134c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if ((synth & PDR_SYNTH_TX_DIV_MASK) == PDR_SYNTH_TX_DIV_SUPPORTED) 9144c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->tx_diversity_mask = 3; 9154c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 9164c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (!is_valid_ether_addr(dev->wiphy->perm_addr)) { 9174c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter u8 perm_addr[ETH_ALEN]; 9184c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 919c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches wiphy_warn(dev->wiphy, 9205db5584441c2dceb75696fb31a44ac7b9b925359Joe Perches "Invalid hwaddr! Using randomly generated MAC addr\n"); 921f4f7f4143cf7d6a31bc9797f00f765d0174603cbJoe Perches eth_random_addr(perm_addr); 9224c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter SET_IEEE80211_PERM_ADDR(dev, perm_addr); 9234c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 9244c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 9257a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter priv->cur_rssi = &p54_rssi_default; 9267a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter 9275db5584441c2dceb75696fb31a44ac7b9b925359Joe Perches wiphy_info(dev->wiphy, "hwaddr %pM, MAC:isl38%02x RF:%s\n", 928c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches dev->wiphy->perm_addr, priv->version, 929c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches p54_rf_chips[priv->rxhw]); 9304c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 9314c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return 0; 9324c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 9334c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lampartererr: 9344c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter kfree(priv->iq_autocal); 9354c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter kfree(priv->output_limit); 9364c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter kfree(priv->curve_data); 9377a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter kfree(priv->rssi_db); 9380d78156eef1d8869ea4e56f8a257252a8f262f04Christian Lamparter kfree(priv->survey); 9394c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->iq_autocal = NULL; 9404c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->output_limit = NULL; 9414c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data = NULL; 9427a047f4f2f3a812f09f42aa784499a54dc4afcf2Christian Lamparter priv->rssi_db = NULL; 9430d78156eef1d8869ea4e56f8a257252a8f262f04Christian Lamparter priv->survey = NULL; 9444c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 945c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches wiphy_err(dev->wiphy, "eeprom parse failed!\n"); 9464c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return err; 9474c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter} 9484c8a32f57105a78c49e01f083717cdb531d3c2b9Christian LamparterEXPORT_SYMBOL_GPL(p54_parse_eeprom); 9494c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 9504c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparterint p54_read_eeprom(struct ieee80211_hw *dev) 9514c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter{ 9524c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct p54_common *priv = dev->priv; 9534c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter size_t eeprom_size = 0x2020, offset = 0, blocksize, maxblocksize; 9544c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter int ret = -ENOMEM; 955e6a3f551bc236010c4d4d99e626e150e98a4c3e6Larry Finger void *eeprom; 9564c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 9574c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter maxblocksize = EEPROM_READBACK_LEN; 9584c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (priv->fw_var >= 0x509) 9594c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter maxblocksize -= 0xc; 9604c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter else 9614c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter maxblocksize -= 0x4; 9624c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 9634c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter eeprom = kzalloc(eeprom_size, GFP_KERNEL); 9644c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (unlikely(!eeprom)) 9654c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter goto free; 9664c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 9674c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter while (eeprom_size) { 9684c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter blocksize = min(eeprom_size, maxblocksize); 9692c208890c6d4e16076c6664137703ec813e8fa6cJoe Perches ret = p54_download_eeprom(priv, eeprom + offset, 9704c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter offset, blocksize); 9714c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (unlikely(ret)) 9724c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter goto free; 9734c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 9744c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter offset += blocksize; 9754c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter eeprom_size -= blocksize; 9764c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 9774c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 9784c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter ret = p54_parse_eeprom(dev, eeprom, offset); 9794c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparterfree: 9804c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter kfree(eeprom); 9814c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return ret; 9824c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter} 9834c8a32f57105a78c49e01f083717cdb531d3c2b9Christian LamparterEXPORT_SYMBOL_GPL(p54_read_eeprom); 984