eeprom.c revision d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3b
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> 274c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 284c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter#include "p54.h" 294c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter#include "eeprom.h" 304c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter#include "lmac.h" 314c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 324c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparterstatic struct ieee80211_rate p54_bgrates[] = { 334c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 10, .hw_value = 0, }, 344c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 20, .hw_value = 1, .flags = IEEE80211_RATE_SHORT_PREAMBLE }, 354c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 55, .hw_value = 2, .flags = IEEE80211_RATE_SHORT_PREAMBLE }, 364c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 110, .hw_value = 3, .flags = IEEE80211_RATE_SHORT_PREAMBLE }, 374c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 60, .hw_value = 4, }, 384c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 90, .hw_value = 5, }, 394c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 120, .hw_value = 6, }, 404c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 180, .hw_value = 7, }, 414c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 240, .hw_value = 8, }, 424c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 360, .hw_value = 9, }, 434c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 480, .hw_value = 10, }, 444c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 540, .hw_value = 11, }, 454c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter}; 464c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 474c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparterstatic struct ieee80211_rate p54_arates[] = { 484c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 60, .hw_value = 4, }, 494c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 90, .hw_value = 5, }, 504c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 120, .hw_value = 6, }, 514c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 180, .hw_value = 7, }, 524c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 240, .hw_value = 8, }, 534c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 360, .hw_value = 9, }, 544c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 480, .hw_value = 10, }, 554c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter { .bitrate = 540, .hw_value = 11, }, 564c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter}; 574c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 581a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter#define CHAN_HAS_CAL BIT(0) 591a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter#define CHAN_HAS_LIMIT BIT(1) 601a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter#define CHAN_HAS_CURVE BIT(2) 611a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter#define CHAN_HAS_ALL (CHAN_HAS_CAL | CHAN_HAS_LIMIT | CHAN_HAS_CURVE) 621a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 631a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparterstruct p54_channel_entry { 641a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter u16 freq; 651a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter u16 data; 661a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter int index; 671a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter enum ieee80211_band band; 684c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter}; 694c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 701a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparterstruct p54_channel_list { 711a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter struct p54_channel_entry *channels; 721a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter size_t entries; 731a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter size_t max_entries; 741a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter size_t band_channel_num[IEEE80211_NUM_BANDS]; 754c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter}; 764c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 771a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparterstatic int p54_get_band_from_freq(u16 freq) 781a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter{ 791a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter /* FIXME: sync these values with the 802.11 spec */ 801a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 811a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if ((freq >= 2412) && (freq <= 2484)) 821a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter return IEEE80211_BAND_2GHZ; 831a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 841a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if ((freq >= 4920) && (freq <= 5825)) 851a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter return IEEE80211_BAND_5GHZ; 861a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 871a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter return -1; 881a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter} 891a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 901a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparterstatic int p54_compare_channels(const void *_a, 911a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter const void *_b) 921a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter{ 931a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter const struct p54_channel_entry *a = _a; 941a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter const struct p54_channel_entry *b = _b; 951a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 961a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter return a->index - b->index; 971a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter} 981a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 991a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparterstatic int p54_fill_band_bitrates(struct ieee80211_hw *dev, 1001a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter struct ieee80211_supported_band *band_entry, 1011a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter enum ieee80211_band band) 1021a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter{ 1031a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter /* TODO: generate rate array dynamically */ 1041a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1051a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter switch (band) { 1061a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter case IEEE80211_BAND_2GHZ: 1071a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter band_entry->bitrates = p54_bgrates; 1081a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter band_entry->n_bitrates = ARRAY_SIZE(p54_bgrates); 1091a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter break; 1101a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter case IEEE80211_BAND_5GHZ: 1111a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter band_entry->bitrates = p54_arates; 1121a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter band_entry->n_bitrates = ARRAY_SIZE(p54_arates); 1131a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter break; 1141a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter default: 1151a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter return -EINVAL; 1161a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 1171a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1181a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter return 0; 1191a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter} 1201a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1211a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparterstatic int p54_generate_band(struct ieee80211_hw *dev, 1221a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter struct p54_channel_list *list, 1231a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter enum ieee80211_band band) 1241a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter{ 1251a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter struct p54_common *priv = dev->priv; 1261a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter struct ieee80211_supported_band *tmp, *old; 1271a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter unsigned int i, j; 1281a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter int ret = -ENOMEM; 1291a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1301a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if ((!list->entries) || (!list->band_channel_num[band])) 13193a59d7527147e3656664aa3179f8d19de256081Christian Lamparter return -EINVAL; 1321a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1331a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter tmp = kzalloc(sizeof(*tmp), GFP_KERNEL); 1341a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (!tmp) 1351a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter goto err_out; 1361a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1371a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter tmp->channels = kzalloc(sizeof(struct ieee80211_channel) * 1381a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter list->band_channel_num[band], GFP_KERNEL); 1391a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (!tmp->channels) 1401a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter goto err_out; 1411a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1421a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter ret = p54_fill_band_bitrates(dev, tmp, band); 1431a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (ret) 1441a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter goto err_out; 1451a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1461a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter for (i = 0, j = 0; (j < list->band_channel_num[band]) && 1471a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter (i < list->entries); i++) { 1481a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1491a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (list->channels[i].band != band) 1501a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter continue; 1511a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1521a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (list->channels[i].data != CHAN_HAS_ALL) { 153c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches wiphy_err(dev->wiphy, 154c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches "%s%s%s is/are missing for channel:%d [%d MHz].\n", 155c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches (list->channels[i].data & CHAN_HAS_CAL ? "" : 156c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches " [iqauto calibration data]"), 157c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches (list->channels[i].data & CHAN_HAS_LIMIT ? "" : 158c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches " [output power limits]"), 159c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches (list->channels[i].data & CHAN_HAS_CURVE ? "" : 160c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches " [curve data]"), 161c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches list->channels[i].index, list->channels[i].freq); 16293a59d7527147e3656664aa3179f8d19de256081Christian Lamparter continue; 1631a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 1641a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1651a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter tmp->channels[j].band = list->channels[i].band; 1661a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter tmp->channels[j].center_freq = list->channels[i].freq; 1671a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter j++; 1681a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 1691a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 17093a59d7527147e3656664aa3179f8d19de256081Christian Lamparter if (j == 0) { 171c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches wiphy_err(dev->wiphy, "disabling totally damaged %d GHz band\n", 172c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches (band == IEEE80211_BAND_2GHZ) ? 2 : 5); 17393a59d7527147e3656664aa3179f8d19de256081Christian Lamparter 17493a59d7527147e3656664aa3179f8d19de256081Christian Lamparter ret = -ENODATA; 17593a59d7527147e3656664aa3179f8d19de256081Christian Lamparter goto err_out; 17693a59d7527147e3656664aa3179f8d19de256081Christian Lamparter } 17793a59d7527147e3656664aa3179f8d19de256081Christian Lamparter 17893a59d7527147e3656664aa3179f8d19de256081Christian Lamparter tmp->n_channels = j; 1791a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter old = priv->band_table[band]; 1801a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter priv->band_table[band] = tmp; 1811a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (old) { 1821a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter kfree(old->channels); 1831a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter kfree(old); 1841a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 1851a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1861a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter return 0; 1871a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1881a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lampartererr_out: 1891a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (tmp) { 1901a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter kfree(tmp->channels); 1911a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter kfree(tmp); 1921a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 1931a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1941a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter return ret; 1951a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter} 1961a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 1971a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparterstatic void p54_update_channel_param(struct p54_channel_list *list, 1981a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter u16 freq, u16 data) 1991a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter{ 2001a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter int band, i; 2011a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2021a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter /* 2031a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter * usually all lists in the eeprom are mostly sorted. 2041a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter * so it's very likely that the entry we are looking for 2051a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter * is right at the end of the list 2061a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter */ 2071a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter for (i = list->entries; i >= 0; i--) { 2081a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (freq == list->channels[i].freq) { 2091a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter list->channels[i].data |= data; 2101a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter break; 2111a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 2121a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 2131a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2141a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if ((i < 0) && (list->entries < list->max_entries)) { 2151a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter /* entry does not exist yet. Initialize a new one. */ 2161a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter band = p54_get_band_from_freq(freq); 2171a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2181a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter /* 2191a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter * filter out frequencies which don't belong into 2201a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter * any supported band. 2211a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter */ 2221a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (band < 0) 2231a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter return ; 2241a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2251a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter i = list->entries++; 2261a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter list->band_channel_num[band]++; 2271a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2281a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter list->channels[i].freq = freq; 2291a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter list->channels[i].data = data; 2301a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter list->channels[i].band = band; 2311a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter list->channels[i].index = ieee80211_frequency_to_channel(freq); 2321a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter /* TODO: parse output_limit and fill max_power */ 2331a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 2341a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter} 2351a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2361a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparterstatic int p54_generate_channel_lists(struct ieee80211_hw *dev) 2371a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter{ 2381a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter struct p54_common *priv = dev->priv; 2391a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter struct p54_channel_list *list; 2401a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter unsigned int i, j, max_channel_num; 24193a59d7527147e3656664aa3179f8d19de256081Christian Lamparter int ret = 0; 2421a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter u16 freq; 2431a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2441a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if ((priv->iq_autocal_len != priv->curve_data->entries) || 2451a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter (priv->iq_autocal_len != priv->output_limit->entries)) 246c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches wiphy_err(dev->wiphy, 247c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches "Unsupported or damaged EEPROM detected. " 248c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches "You may not be able to use all channels.\n"); 2491a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2501a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter max_channel_num = max_t(unsigned int, priv->output_limit->entries, 2511a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter priv->iq_autocal_len); 2521a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter max_channel_num = max_t(unsigned int, max_channel_num, 2531a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter priv->curve_data->entries); 2541a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2551a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter list = kzalloc(sizeof(*list), GFP_KERNEL); 25693a59d7527147e3656664aa3179f8d19de256081Christian Lamparter if (!list) { 25793a59d7527147e3656664aa3179f8d19de256081Christian Lamparter ret = -ENOMEM; 2581a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter goto free; 25993a59d7527147e3656664aa3179f8d19de256081Christian Lamparter } 2601a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2611a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter list->max_entries = max_channel_num; 2621a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter list->channels = kzalloc(sizeof(struct p54_channel_entry) * 2631a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter max_channel_num, GFP_KERNEL); 2641a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (!list->channels) 2651a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter goto free; 2661a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2671a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter for (i = 0; i < max_channel_num; i++) { 2681a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (i < priv->iq_autocal_len) { 2691a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter freq = le16_to_cpu(priv->iq_autocal[i].freq); 2701a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter p54_update_channel_param(list, freq, CHAN_HAS_CAL); 2711a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 2721a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2731a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (i < priv->output_limit->entries) { 2741a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter freq = le16_to_cpup((__le16 *) (i * 2751a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter priv->output_limit->entry_size + 2761a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter priv->output_limit->offset + 2771a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter priv->output_limit->data)); 2781a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2791a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter p54_update_channel_param(list, freq, CHAN_HAS_LIMIT); 2801a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 2811a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2821a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (i < priv->curve_data->entries) { 2831a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter freq = le16_to_cpup((__le16 *) (i * 2841a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter priv->curve_data->entry_size + 2851a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter priv->curve_data->offset + 2861a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter priv->curve_data->data)); 2871a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2881a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter p54_update_channel_param(list, freq, CHAN_HAS_CURVE); 2891a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 2901a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 2911a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2921a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter /* sort the list by the channel index */ 2931a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter sort(list->channels, list->entries, sizeof(struct p54_channel_entry), 2941a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter p54_compare_channels, NULL); 2951a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 2961a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter for (i = 0, j = 0; i < IEEE80211_NUM_BANDS; i++) { 29793a59d7527147e3656664aa3179f8d19de256081Christian Lamparter if (p54_generate_band(dev, list, i) == 0) 2981a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter j++; 2991a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 3001a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (j == 0) { 3011a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter /* no useable band available. */ 3021a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter ret = -EINVAL; 3031a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 3041a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 3051a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparterfree: 3061a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (list) { 3071a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter kfree(list->channels); 3081a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter kfree(list); 3091a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter } 3101a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 3111a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter return ret; 3121a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter} 3131a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 3144c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparterstatic int p54_convert_rev0(struct ieee80211_hw *dev, 3154c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct pda_pa_curve_data *curve_data) 3164c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter{ 3174c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct p54_common *priv = dev->priv; 3184c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct p54_pa_curve_data_sample *dst; 3194c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct pda_pa_curve_data_sample_rev0 *src; 3204c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter size_t cd_len = sizeof(*curve_data) + 3214c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter (curve_data->points_per_channel*sizeof(*dst) + 2) * 3224c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter curve_data->channels; 3234c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter unsigned int i, j; 3244c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter void *source, *target; 3254c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 3264c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data = kmalloc(sizeof(*priv->curve_data) + cd_len, 3274c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter GFP_KERNEL); 3284c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (!priv->curve_data) 3294c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return -ENOMEM; 3304c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 3314c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data->entries = curve_data->channels; 3324c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data->entry_size = sizeof(__le16) + 3334c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter sizeof(*dst) * curve_data->points_per_channel; 3344c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data->offset = offsetof(struct pda_pa_curve_data, data); 3354c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data->len = cd_len; 3364c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter memcpy(priv->curve_data->data, curve_data, sizeof(*curve_data)); 3374c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter source = curve_data->data; 3384c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter target = ((struct pda_pa_curve_data *) priv->curve_data->data)->data; 3394c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter for (i = 0; i < curve_data->channels; i++) { 3404c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter __le16 *freq = source; 3414c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter source += sizeof(__le16); 3424c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter *((__le16 *)target) = *freq; 3434c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter target += sizeof(__le16); 3444c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter for (j = 0; j < curve_data->points_per_channel; j++) { 3454c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst = target; 3464c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter src = source; 3474c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 3484c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst->rf_power = src->rf_power; 3494c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst->pa_detector = src->pa_detector; 3504c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst->data_64qam = src->pcv; 3514c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter /* "invent" the points for the other modulations */ 3524c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter#define SUB(x, y) (u8)(((x) - (y)) > (x) ? 0 : (x) - (y)) 3534c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst->data_16qam = SUB(src->pcv, 12); 3544c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst->data_qpsk = SUB(dst->data_16qam, 12); 3554c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst->data_bpsk = SUB(dst->data_qpsk, 12); 3564c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst->data_barker = SUB(dst->data_bpsk, 14); 3574c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter#undef SUB 3584c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter target += sizeof(*dst); 3594c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter source += sizeof(*src); 3604c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 3614c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 3624c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 3634c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return 0; 3644c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter} 3654c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 3664c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparterstatic int p54_convert_rev1(struct ieee80211_hw *dev, 3674c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct pda_pa_curve_data *curve_data) 3684c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter{ 3694c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct p54_common *priv = dev->priv; 3704c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct p54_pa_curve_data_sample *dst; 3714c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct pda_pa_curve_data_sample_rev1 *src; 3724c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter size_t cd_len = sizeof(*curve_data) + 3734c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter (curve_data->points_per_channel*sizeof(*dst) + 2) * 3744c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter curve_data->channels; 3754c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter unsigned int i, j; 3764c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter void *source, *target; 3774c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 3784c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data = kzalloc(cd_len + sizeof(*priv->curve_data), 3794c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter GFP_KERNEL); 3804c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (!priv->curve_data) 3814c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return -ENOMEM; 3824c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 3834c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data->entries = curve_data->channels; 3844c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data->entry_size = sizeof(__le16) + 3854c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter sizeof(*dst) * curve_data->points_per_channel; 3864c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data->offset = offsetof(struct pda_pa_curve_data, data); 3874c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data->len = cd_len; 3884c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter memcpy(priv->curve_data->data, curve_data, sizeof(*curve_data)); 3894c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter source = curve_data->data; 3904c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter target = ((struct pda_pa_curve_data *) priv->curve_data->data)->data; 3914c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter for (i = 0; i < curve_data->channels; i++) { 3924c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter __le16 *freq = source; 3934c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter source += sizeof(__le16); 3944c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter *((__le16 *)target) = *freq; 3954c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter target += sizeof(__le16); 3964c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter for (j = 0; j < curve_data->points_per_channel; j++) { 3974c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter memcpy(target, source, sizeof(*src)); 3984c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 3994c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter target += sizeof(*dst); 4004c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter source += sizeof(*src); 4014c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 4024c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter source++; 4034c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 4044c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4054c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return 0; 4064c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter} 4074c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4084c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparterstatic const char *p54_rf_chips[] = { "INVALID-0", "Duette3", "Duette2", 4094c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter "Frisbee", "Xbow", "Longbow", "INVALID-6", "INVALID-7" }; 4104c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4114c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparterstatic void p54_parse_rssical(struct ieee80211_hw *dev, void *data, int len, 4124c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter u16 type) 4134c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter{ 4144c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct p54_common *priv = dev->priv; 4154c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter int offset = (type == PDR_RSSI_LINEAR_APPROXIMATION_EXTENDED) ? 2 : 0; 4164c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter int entry_size = sizeof(struct pda_rssi_cal_entry) + offset; 4174c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter int num_entries = (type == PDR_RSSI_LINEAR_APPROXIMATION) ? 1 : 2; 4184c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter int i; 4194c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4204c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (len != (entry_size * num_entries)) { 421c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches wiphy_err(dev->wiphy, 422c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches "unknown rssi calibration data packing type:(%x) len:%d.\n", 423c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches type, len); 4244c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4254c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter print_hex_dump_bytes("rssical:", DUMP_PREFIX_NONE, 4264c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter data, len); 4274c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 428c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches wiphy_err(dev->wiphy, "please report this issue.\n"); 4294c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return; 4304c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 4314c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4324c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter for (i = 0; i < num_entries; i++) { 4334c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct pda_rssi_cal_entry *cal = data + 4344c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter (offset + i * entry_size); 4354c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->rssical_db[i].mul = (s16) le16_to_cpu(cal->mul); 4364c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->rssical_db[i].add = (s16) le16_to_cpu(cal->add); 4374c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 4384c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter} 4394c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4404c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparterstatic void p54_parse_default_country(struct ieee80211_hw *dev, 4414c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter void *data, int len) 4424c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter{ 4434c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct pda_country *country; 4444c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4454c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (len != sizeof(*country)) { 446c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches wiphy_err(dev->wiphy, 447c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches "found possible invalid default country eeprom entry. (entry size: %d)\n", 448c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches len); 4494c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4504c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter print_hex_dump_bytes("country:", DUMP_PREFIX_NONE, 4514c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter data, len); 4524c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 453c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches wiphy_err(dev->wiphy, "please report this issue.\n"); 4544c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return; 4554c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 4564c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4574c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter country = (struct pda_country *) data; 4584c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (country->flags == PDR_COUNTRY_CERT_CODE_PSEUDO) 4594c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter regulatory_hint(dev->wiphy, country->alpha2); 4604c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter else { 4614c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter /* TODO: 4624c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter * write a shared/common function that converts 4634c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter * "Regulatory domain codes" (802.11-2007 14.8.2.2) 4644c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter * into ISO/IEC 3166-1 alpha2 for regulatory_hint. 4654c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter */ 4664c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 4674c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter} 4684c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4694c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparterstatic int p54_convert_output_limits(struct ieee80211_hw *dev, 4704c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter u8 *data, size_t len) 4714c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter{ 4724c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct p54_common *priv = dev->priv; 4734c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4744c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (len < 2) 4754c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return -EINVAL; 4764c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4774c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (data[0] != 0) { 478c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches wiphy_err(dev->wiphy, "unknown output power db revision:%x\n", 479c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches data[0]); 4804c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return -EINVAL; 4814c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 4824c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4834c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (2 + data[1] * sizeof(struct pda_channel_output_limit) > len) 4844c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return -EINVAL; 4854c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4864c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->output_limit = kmalloc(data[1] * 4874c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter sizeof(struct pda_channel_output_limit) + 4884c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter sizeof(*priv->output_limit), GFP_KERNEL); 4894c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4904c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (!priv->output_limit) 4914c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return -ENOMEM; 4924c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 4934c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->output_limit->offset = 0; 4944c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->output_limit->entries = data[1]; 4954c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->output_limit->entry_size = 4964c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter sizeof(struct pda_channel_output_limit); 4974c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->output_limit->len = priv->output_limit->entry_size * 4984c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->output_limit->entries + 4994c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->output_limit->offset; 5004c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 5014c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter memcpy(priv->output_limit->data, &data[2], 5024c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter data[1] * sizeof(struct pda_channel_output_limit)); 5034c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 5044c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return 0; 5054c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter} 5064c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 5074c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparterstatic struct p54_cal_database *p54_convert_db(struct pda_custom_wrapper *src, 5084c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter size_t total_len) 5094c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter{ 5104c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct p54_cal_database *dst; 5114c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter size_t payload_len, entries, entry_size, offset; 5124c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 5134c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter payload_len = le16_to_cpu(src->len); 5144c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter entries = le16_to_cpu(src->entries); 5154c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter entry_size = le16_to_cpu(src->entry_size); 5164c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter offset = le16_to_cpu(src->offset); 5174c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (((entries * entry_size + offset) != payload_len) || 5184c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter (payload_len + sizeof(*src) != total_len)) 5194c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return NULL; 5204c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 5214c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst = kmalloc(sizeof(*dst) + payload_len, GFP_KERNEL); 5224c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (!dst) 5234c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return NULL; 5244c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 5254c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst->entries = entries; 5264c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst->entry_size = entry_size; 5274c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst->offset = offset; 5284c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter dst->len = payload_len; 5294c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 5304c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter memcpy(dst->data, src->data, payload_len); 5314c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return dst; 5324c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter} 5334c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 5344c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparterint p54_parse_eeprom(struct ieee80211_hw *dev, void *eeprom, int len) 5354c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter{ 5364c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct p54_common *priv = dev->priv; 537e6a3f551bc236010c4d4d99e626e150e98a4c3e6Larry Finger struct eeprom_pda_wrap *wrap; 5384c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct pda_entry *entry; 5394c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter unsigned int data_len, entry_len; 5404c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter void *tmp; 5414c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter int err; 5424c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter u8 *end = (u8 *)eeprom + len; 5434c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter u16 synth = 0; 544d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter u16 crc16 = ~0; 5454c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 5464c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter wrap = (struct eeprom_pda_wrap *) eeprom; 5474c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter entry = (void *)wrap->data + le16_to_cpu(wrap->len); 5484c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 5494c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter /* verify that at least the entry length/code fits */ 5504c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter while ((u8 *)entry <= end - sizeof(*entry)) { 5514c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter entry_len = le16_to_cpu(entry->len); 5524c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter data_len = ((entry_len - 1) << 1); 5534c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 5544c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter /* abort if entry exceeds whole structure */ 5554c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if ((u8 *)entry + sizeof(*entry) + data_len > end) 5564c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 5574c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 5584c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter switch (le16_to_cpu(entry->code)) { 5594c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_MAC_ADDRESS: 5604c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (data_len != ETH_ALEN) 5614c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 5624c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter SET_IEEE80211_PERM_ADDR(dev, entry->data); 5634c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 5644c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_PRISM_PA_CAL_OUTPUT_POWER_LIMITS: 5654c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (priv->output_limit) 5664c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 5674c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter err = p54_convert_output_limits(dev, entry->data, 5684c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter data_len); 5694c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (err) 5704c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter goto err; 5714c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 5724c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_PRISM_PA_CAL_CURVE_DATA: { 5734c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct pda_pa_curve_data *curve_data = 5744c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter (struct pda_pa_curve_data *)entry->data; 5754c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (data_len < sizeof(*curve_data)) { 5764c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter err = -EINVAL; 5774c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter goto err; 5784c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 5794c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 5804c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter switch (curve_data->cal_method_rev) { 5814c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case 0: 5824c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter err = p54_convert_rev0(dev, curve_data); 5834c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 5844c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case 1: 5854c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter err = p54_convert_rev1(dev, curve_data); 5864c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 5874c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter default: 588c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches wiphy_err(dev->wiphy, 589c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches "unknown curve data revision %d\n", 590c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches curve_data->cal_method_rev); 5914c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter err = -ENODEV; 5924c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 5934c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 5944c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (err) 5954c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter goto err; 5964c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 5974c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 5984c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_PRISM_ZIF_TX_IQ_CALIBRATION: 59927b81bbed881ae93e8c23c216129cdeee86d4051Julia Lawall priv->iq_autocal = kmemdup(entry->data, data_len, 60027b81bbed881ae93e8c23c216129cdeee86d4051Julia Lawall GFP_KERNEL); 6014c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (!priv->iq_autocal) { 6024c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter err = -ENOMEM; 6034c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter goto err; 6044c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 6054c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 6064c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->iq_autocal_len = data_len / sizeof(struct pda_iq_autocal_entry); 6074c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 6084c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_DEFAULT_COUNTRY: 6094c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter p54_parse_default_country(dev, entry->data, data_len); 6104c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 6114c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_INTERFACE_LIST: 6124c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter tmp = entry->data; 6134c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter while ((u8 *)tmp < entry->data + data_len) { 6144c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct exp_if *exp_if = tmp; 6154c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (exp_if->if_id == cpu_to_le16(IF_ID_ISL39000)) 6164c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter synth = le16_to_cpu(exp_if->variant); 6174c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter tmp += sizeof(*exp_if); 6184c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 6194c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 6204c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_HARDWARE_PLATFORM_COMPONENT_ID: 6214c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (data_len < 2) 6224c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 6234c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->version = *(u8 *)(entry->data + 1); 6244c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 6254c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_RSSI_LINEAR_APPROXIMATION: 6264c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_RSSI_LINEAR_APPROXIMATION_DUAL_BAND: 6274c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_RSSI_LINEAR_APPROXIMATION_EXTENDED: 6284c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter p54_parse_rssical(dev, entry->data, data_len, 6294c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter le16_to_cpu(entry->code)); 6304c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 6314c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_RSSI_LINEAR_APPROXIMATION_CUSTOM: { 6324c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter __le16 *src = (void *) entry->data; 6334c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter s16 *dst = (void *) &priv->rssical_db; 6344c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter int i; 6354c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 6364c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (data_len != sizeof(priv->rssical_db)) { 6374c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter err = -EINVAL; 6384c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter goto err; 6394c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 6404c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter for (i = 0; i < sizeof(priv->rssical_db) / 6414c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter sizeof(*src); i++) 6424c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter *(dst++) = (s16) le16_to_cpu(*(src++)); 6434c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 6444c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 6454c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_PRISM_PA_CAL_OUTPUT_POWER_LIMITS_CUSTOM: { 6464c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct pda_custom_wrapper *pda = (void *) entry->data; 6474c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (priv->output_limit || data_len < sizeof(*pda)) 6484c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 6494c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->output_limit = p54_convert_db(pda, data_len); 6504c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 6514c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 6524c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_PRISM_PA_CAL_CURVE_DATA_CUSTOM: { 6534c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct pda_custom_wrapper *pda = (void *) entry->data; 6544c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (priv->curve_data || data_len < sizeof(*pda)) 6554c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 6564c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data = p54_convert_db(pda, data_len); 6574c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 6584c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 6594c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter case PDR_END: 660d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter crc16 = ~crc_ccitt(crc16, (u8 *) entry, sizeof(*entry)); 661d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter if (crc16 != le16_to_cpup((__le16 *)entry->data)) { 662d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter wiphy_err(dev->wiphy, "eeprom failed checksum " 663d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter "test!\n"); 664d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter err = -ENOMSG; 665d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter goto err; 666d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter } else { 667d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter goto good_eeprom; 668d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter } 6694c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 6704c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter default: 6714c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter break; 6724c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 6734c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 674d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter crc16 = crc_ccitt(crc16, (u8 *)entry, (entry_len + 1) * 2); 675d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter entry = (void *)entry + (entry_len + 1) * 2; 6764c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 6774c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 678d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter wiphy_err(dev->wiphy, "unexpected end of eeprom data.\n"); 679d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter err = -ENODATA; 680d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter goto err; 681d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lamparter 682d7eb50c0f7cb5d3ebb7bea8c681a6dfda3819a3bChristian Lampartergood_eeprom: 6834c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (!synth || !priv->iq_autocal || !priv->output_limit || 6844c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter !priv->curve_data) { 685c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches wiphy_err(dev->wiphy, 686c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches "not all required entries found in eeprom!\n"); 6874c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter err = -EINVAL; 6884c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter goto err; 6894c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 6904c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 6911a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter err = p54_generate_channel_lists(dev); 6921a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter if (err) 6931a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter goto err; 6941a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter 6954c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->rxhw = synth & PDR_SYNTH_FRONTEND_MASK; 6964c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (priv->rxhw == PDR_SYNTH_FRONTEND_XBOW) 6974c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter p54_init_xbow_synth(priv); 6984c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (!(synth & PDR_SYNTH_24_GHZ_DISABLED)) 6991a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter dev->wiphy->bands[IEEE80211_BAND_2GHZ] = 7001a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter priv->band_table[IEEE80211_BAND_2GHZ]; 7014c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (!(synth & PDR_SYNTH_5_GHZ_DISABLED)) 7021a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter dev->wiphy->bands[IEEE80211_BAND_5GHZ] = 7031a9b6679adfb8ef1f1f3dbb7ebd2ee72e2ea4b56Christian Lamparter priv->band_table[IEEE80211_BAND_5GHZ]; 7044c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if ((synth & PDR_SYNTH_RX_DIV_MASK) == PDR_SYNTH_RX_DIV_SUPPORTED) 7054c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->rx_diversity_mask = 3; 7064c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if ((synth & PDR_SYNTH_TX_DIV_MASK) == PDR_SYNTH_TX_DIV_SUPPORTED) 7074c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->tx_diversity_mask = 3; 7084c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 7094c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (!is_valid_ether_addr(dev->wiphy->perm_addr)) { 7104c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter u8 perm_addr[ETH_ALEN]; 7114c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 712c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches wiphy_warn(dev->wiphy, 713c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches "invalid hwaddr! using randomly generated mac addr\n"); 7144c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter random_ether_addr(perm_addr); 7154c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter SET_IEEE80211_PERM_ADDR(dev, perm_addr); 7164c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 7174c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 718c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches wiphy_info(dev->wiphy, "hwaddr %pm, mac:isl38%02x rf:%s\n", 719c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches dev->wiphy->perm_addr, priv->version, 720c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches p54_rf_chips[priv->rxhw]); 7214c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 7224c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return 0; 7234c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 7244c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lampartererr: 7254c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter kfree(priv->iq_autocal); 7264c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter kfree(priv->output_limit); 7274c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter kfree(priv->curve_data); 7284c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->iq_autocal = NULL; 7294c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->output_limit = NULL; 7304c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter priv->curve_data = NULL; 7314c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 732c96c31e499b70964cfc88744046c998bb710e4b8Joe Perches wiphy_err(dev->wiphy, "eeprom parse failed!\n"); 7334c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return err; 7344c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter} 7354c8a32f57105a78c49e01f083717cdb531d3c2b9Christian LamparterEXPORT_SYMBOL_GPL(p54_parse_eeprom); 7364c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 7374c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparterint p54_read_eeprom(struct ieee80211_hw *dev) 7384c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter{ 7394c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter struct p54_common *priv = dev->priv; 7404c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter size_t eeprom_size = 0x2020, offset = 0, blocksize, maxblocksize; 7414c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter int ret = -ENOMEM; 742e6a3f551bc236010c4d4d99e626e150e98a4c3e6Larry Finger void *eeprom; 7434c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 7444c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter maxblocksize = EEPROM_READBACK_LEN; 7454c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (priv->fw_var >= 0x509) 7464c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter maxblocksize -= 0xc; 7474c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter else 7484c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter maxblocksize -= 0x4; 7494c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 7504c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter eeprom = kzalloc(eeprom_size, GFP_KERNEL); 7514c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (unlikely(!eeprom)) 7524c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter goto free; 7534c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 7544c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter while (eeprom_size) { 7554c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter blocksize = min(eeprom_size, maxblocksize); 7564c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter ret = p54_download_eeprom(priv, (void *) (eeprom + offset), 7574c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter offset, blocksize); 7584c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter if (unlikely(ret)) 7594c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter goto free; 7604c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 7614c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter offset += blocksize; 7624c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter eeprom_size -= blocksize; 7634c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter } 7644c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter 7654c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter ret = p54_parse_eeprom(dev, eeprom, offset); 7664c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparterfree: 7674c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter kfree(eeprom); 7684c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter return ret; 7694c8a32f57105a78c49e01f083717cdb531d3c2b9Christian Lamparter} 7704c8a32f57105a78c49e01f083717cdb531d3c2b9Christian LamparterEXPORT_SYMBOL_GPL(p54_read_eeprom); 771