e1623446bb
Call IWL_DEBUG macro with explicit priv argument. Signed-off-by: Tomas Winkler <tomas.winkler@intel.com> Acked-by: Samuel Ortiz <samuel.ortiz@intel.com> Signed-off-by: Reinette Chatre <reinette.chatre@intel.com> Signed-off-by: John W. Linville <linville@tuxdriver.com>
198 lines
5.7 KiB
C
198 lines
5.7 KiB
C
/******************************************************************************
|
|
*
|
|
* Copyright(c) 2003 - 2009 Intel Corporation. All rights reserved.
|
|
*
|
|
* Portions of this file are derived from the ipw3945 project, as well
|
|
* as portions of the ieee80211 subsystem header files.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms of version 2 of the GNU General Public License as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope that it will be useful, but WITHOUT
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
* more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License along with
|
|
* this program; if not, write to the Free Software Foundation, Inc.,
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
|
|
*
|
|
* The full GNU General Public License is included in this distribution in the
|
|
* file called LICENSE.
|
|
*
|
|
* Contact Information:
|
|
* Intel Linux Wireless <ilw@linux.intel.com>
|
|
* Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
|
|
*
|
|
*****************************************************************************/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/init.h>
|
|
#include <linux/pci.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/skbuff.h>
|
|
#include <linux/netdevice.h>
|
|
#include <linux/wireless.h>
|
|
|
|
#include <net/mac80211.h>
|
|
|
|
#include "iwl-eeprom.h"
|
|
#include "iwl-dev.h"
|
|
#include "iwl-core.h"
|
|
#include "iwl-io.h"
|
|
#include "iwl-spectrum.h"
|
|
|
|
#define BEACON_TIME_MASK_LOW 0x00FFFFFF
|
|
#define BEACON_TIME_MASK_HIGH 0xFF000000
|
|
#define TIME_UNIT 1024
|
|
|
|
/*
|
|
* extended beacon time format
|
|
* time in usec will be changed into a 32-bit value in 8:24 format
|
|
* the high 1 byte is the beacon counts
|
|
* the lower 3 bytes is the time in usec within one beacon interval
|
|
*/
|
|
|
|
/* TOOD: was used in sysfs debug interface need to add to mac */
|
|
#if 0
|
|
static u32 iwl_usecs_to_beacons(u32 usec, u32 beacon_interval)
|
|
{
|
|
u32 quot;
|
|
u32 rem;
|
|
u32 interval = beacon_interval * 1024;
|
|
|
|
if (!interval || !usec)
|
|
return 0;
|
|
|
|
quot = (usec / interval) & (BEACON_TIME_MASK_HIGH >> 24);
|
|
rem = (usec % interval) & BEACON_TIME_MASK_LOW;
|
|
|
|
return (quot << 24) + rem;
|
|
}
|
|
|
|
/* base is usually what we get from ucode with each received frame,
|
|
* the same as HW timer counter counting down
|
|
*/
|
|
|
|
static __le32 iwl_add_beacon_time(u32 base, u32 addon, u32 beacon_interval)
|
|
{
|
|
u32 base_low = base & BEACON_TIME_MASK_LOW;
|
|
u32 addon_low = addon & BEACON_TIME_MASK_LOW;
|
|
u32 interval = beacon_interval * TIME_UNIT;
|
|
u32 res = (base & BEACON_TIME_MASK_HIGH) +
|
|
(addon & BEACON_TIME_MASK_HIGH);
|
|
|
|
if (base_low > addon_low)
|
|
res += base_low - addon_low;
|
|
else if (base_low < addon_low) {
|
|
res += interval + base_low - addon_low;
|
|
res += (1 << 24);
|
|
} else
|
|
res += (1 << 24);
|
|
|
|
return cpu_to_le32(res);
|
|
}
|
|
static int iwl_get_measurement(struct iwl_priv *priv,
|
|
struct ieee80211_measurement_params *params,
|
|
u8 type)
|
|
{
|
|
struct iwl4965_spectrum_cmd spectrum;
|
|
struct iwl_rx_packet *res;
|
|
struct iwl_host_cmd cmd = {
|
|
.id = REPLY_SPECTRUM_MEASUREMENT_CMD,
|
|
.data = (void *)&spectrum,
|
|
.meta.flags = CMD_WANT_SKB,
|
|
};
|
|
u32 add_time = le64_to_cpu(params->start_time);
|
|
int rc;
|
|
int spectrum_resp_status;
|
|
int duration = le16_to_cpu(params->duration);
|
|
|
|
if (iwl_is_associated(priv))
|
|
add_time =
|
|
iwl_usecs_to_beacons(
|
|
le64_to_cpu(params->start_time) - priv->last_tsf,
|
|
le16_to_cpu(priv->rxon_timing.beacon_interval));
|
|
|
|
memset(&spectrum, 0, sizeof(spectrum));
|
|
|
|
spectrum.channel_count = cpu_to_le16(1);
|
|
spectrum.flags =
|
|
RXON_FLG_TSF2HOST_MSK | RXON_FLG_ANT_A_MSK | RXON_FLG_DIS_DIV_MSK;
|
|
spectrum.filter_flags = MEASUREMENT_FILTER_FLAG;
|
|
cmd.len = sizeof(spectrum);
|
|
spectrum.len = cpu_to_le16(cmd.len - sizeof(spectrum.len));
|
|
|
|
if (iwl_is_associated(priv))
|
|
spectrum.start_time =
|
|
iwl_add_beacon_time(priv->last_beacon_time,
|
|
add_time,
|
|
le16_to_cpu(priv->rxon_timing.beacon_interval));
|
|
else
|
|
spectrum.start_time = 0;
|
|
|
|
spectrum.channels[0].duration = cpu_to_le32(duration * TIME_UNIT);
|
|
spectrum.channels[0].channel = params->channel;
|
|
spectrum.channels[0].type = type;
|
|
if (priv->active_rxon.flags & RXON_FLG_BAND_24G_MSK)
|
|
spectrum.flags |= RXON_FLG_BAND_24G_MSK |
|
|
RXON_FLG_AUTO_DETECT_MSK | RXON_FLG_TGG_PROTECT_MSK;
|
|
|
|
rc = iwl_send_cmd_sync(priv, &cmd);
|
|
if (rc)
|
|
return rc;
|
|
|
|
res = (struct iwl_rx_packet *)cmd.meta.u.skb->data;
|
|
if (res->hdr.flags & IWL_CMD_FAILED_MSK) {
|
|
IWL_ERR(priv, "Bad return from REPLY_RX_ON_ASSOC command\n");
|
|
rc = -EIO;
|
|
}
|
|
|
|
spectrum_resp_status = le16_to_cpu(res->u.spectrum.status);
|
|
switch (spectrum_resp_status) {
|
|
case 0: /* Command will be handled */
|
|
if (res->u.spectrum.id != 0xff) {
|
|
IWL_DEBUG_INFO(priv,
|
|
"Replaced existing measurement: %d\n",
|
|
res->u.spectrum.id);
|
|
priv->measurement_status &= ~MEASUREMENT_READY;
|
|
}
|
|
priv->measurement_status |= MEASUREMENT_ACTIVE;
|
|
rc = 0;
|
|
break;
|
|
|
|
case 1: /* Command will not be handled */
|
|
rc = -EAGAIN;
|
|
break;
|
|
}
|
|
|
|
dev_kfree_skb_any(cmd.meta.u.skb);
|
|
|
|
return rc;
|
|
}
|
|
#endif
|
|
|
|
static void iwl_rx_spectrum_measure_notif(struct iwl_priv *priv,
|
|
struct iwl_rx_mem_buffer *rxb)
|
|
{
|
|
struct iwl_rx_packet *pkt = (struct iwl_rx_packet *)rxb->skb->data;
|
|
struct iwl_spectrum_notification *report = &(pkt->u.spectrum_notif);
|
|
|
|
if (!report->state) {
|
|
IWL_DEBUG_11H(priv,
|
|
"Spectrum Measure Notification: Start\n");
|
|
return;
|
|
}
|
|
|
|
memcpy(&priv->measure_report, report, sizeof(*report));
|
|
priv->measurement_status |= MEASUREMENT_READY;
|
|
}
|
|
|
|
void iwl_setup_spectrum_handlers(struct iwl_priv *priv)
|
|
{
|
|
priv->rx_handlers[SPECTRUM_MEASURE_NOTIFICATION] =
|
|
iwl_rx_spectrum_measure_notif;
|
|
}
|
|
EXPORT_SYMBOL(iwl_setup_spectrum_handlers);
|