[linux-2.6-block.git] / drivers / net / wireless / ath / ath9k / spectral.c

/*
 * Copyright (c) 2013 Qualcomm Atheros, Inc.
 *
 * Permission to use, copy, modify, and/or distribute this software for any
 * purpose with or without fee is hereby granted, provided that the above
 * copyright notice and this permission notice appear in all copies.
 *
 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 */

#include <linux/relay.h>
#include "ath9k.h"

static s8 fix_rssi_inv_only(u8 rssi_val)
{
	if (rssi_val == 128)
		rssi_val = 0;
	return (s8) rssi_val;
}

static void ath_debug_send_fft_sample(struct ath_softc *sc,
				      struct fft_sample_tlv *fft_sample_tlv)
{
	int length;
	if (!sc->rfs_chan_spec_scan)
		return;

	length = __be16_to_cpu(fft_sample_tlv->length) +
		 sizeof(*fft_sample_tlv);
	relay_write(sc->rfs_chan_spec_scan, fft_sample_tlv, length);
}

/* returns 1 if this was a spectral frame, even if not handled. */
int ath_process_fft(struct ath_softc *sc, struct ieee80211_hdr *hdr,
		    struct ath_rx_status *rs, u64 tsf)
{
	struct ath_hw *ah = sc->sc_ah;
	u8 num_bins, *bins, *vdata = (u8 *)hdr;
	struct fft_sample_ht20 fft_sample_20;
	struct fft_sample_ht20_40 fft_sample_40;
	struct fft_sample_tlv *tlv;
	struct ath_radar_info *radar_info;
	int len = rs->rs_datalen;
	int dc_pos;
	u16 fft_len, length, freq = ah->curchan->chan->center_freq;
	enum nl80211_channel_type chan_type;

	/* AR9280 and before report via ATH9K_PHYERR_RADAR, AR93xx and newer
	 * via ATH9K_PHYERR_SPECTRAL. Haven't seen ATH9K_PHYERR_FALSE_RADAR_EXT
	 * yet, but this is supposed to be possible as well.
	 */
	if (rs->rs_phyerr != ATH9K_PHYERR_RADAR &&
	    rs->rs_phyerr != ATH9K_PHYERR_FALSE_RADAR_EXT &&
	    rs->rs_phyerr != ATH9K_PHYERR_SPECTRAL)
		return 0;

	/* check if spectral scan bit is set. This does not have to be checked
	 * if received through a SPECTRAL phy error, but shouldn't hurt.
	 */
	radar_info = ((struct ath_radar_info *)&vdata[len]) - 1;
	if (!(radar_info->pulse_bw_info & SPECTRAL_SCAN_BITMASK))
		return 0;

	chan_type = cfg80211_get_chandef_type(&sc->hw->conf.chandef);
	if ((chan_type == NL80211_CHAN_HT40MINUS) ||
	    (chan_type == NL80211_CHAN_HT40PLUS)) {
		fft_len = SPECTRAL_HT20_40_TOTAL_DATA_LEN;
		num_bins = SPECTRAL_HT20_40_NUM_BINS;
		bins = (u8 *)fft_sample_40.data;
	} else {
		fft_len = SPECTRAL_HT20_TOTAL_DATA_LEN;
		num_bins = SPECTRAL_HT20_NUM_BINS;
		bins = (u8 *)fft_sample_20.data;
	}

	/* Variation in the data length is possible and will be fixed later */
	if ((len > fft_len + 2) || (len < fft_len - 1))
		return 1;

	switch (len - fft_len) {
	case 0:
		/* length correct, nothing to do. */
		memcpy(bins, vdata, num_bins);
		break;
	case -1:
		/* first byte missing, duplicate it. */
		memcpy(&bins[1], vdata, num_bins - 1);
		bins[0] = vdata[0];
		break;
	case 2:
		/* MAC added 2 extra bytes at bin 30 and 32, remove them. */
		memcpy(bins, vdata, 30);
		bins[30] = vdata[31];
		memcpy(&bins[31], &vdata[33], num_bins - 31);
		break;
	case 1:
		/* MAC added 2 extra bytes AND first byte is missing. */
		bins[0] = vdata[0];
		memcpy(&bins[1], vdata, 30);
		bins[31] = vdata[31];
		memcpy(&bins[32], &vdata[33], num_bins - 32);
		break;
	default:
		return 1;
	}

	/* DC value (value in the middle) is the blind spot of the spectral
	 * sample and invalid, interpolate it.
	 */
	dc_pos = num_bins / 2;
	bins[dc_pos] = (bins[dc_pos + 1] + bins[dc_pos - 1]) / 2;

	if ((chan_type == NL80211_CHAN_HT40MINUS) ||
	    (chan_type == NL80211_CHAN_HT40PLUS)) {
		s8 lower_rssi, upper_rssi;
		s16 ext_nf;
		u8 lower_max_index, upper_max_index;
		u8 lower_bitmap_w, upper_bitmap_w;
		u16 lower_mag, upper_mag;
		struct ath9k_hw_cal_data *caldata = ah->caldata;
		struct ath_ht20_40_mag_info *mag_info;

		if (caldata)
			ext_nf = ath9k_hw_getchan_noise(ah, ah->curchan,
					caldata->nfCalHist[3].privNF);
		else
			ext_nf = ATH_DEFAULT_NOISE_FLOOR;

		length = sizeof(fft_sample_40) - sizeof(struct fft_sample_tlv);
		fft_sample_40.tlv.type = ATH_FFT_SAMPLE_HT20_40;
		fft_sample_40.tlv.length = __cpu_to_be16(length);
		fft_sample_40.freq = __cpu_to_be16(freq);
		fft_sample_40.channel_type = chan_type;

		if (chan_type == NL80211_CHAN_HT40PLUS) {
			lower_rssi = fix_rssi_inv_only(rs->rs_rssi_ctl[0]);
			upper_rssi = fix_rssi_inv_only(rs->rs_rssi_ext[0]);

			fft_sample_40.lower_noise = ah->noise;
			fft_sample_40.upper_noise = ext_nf;
		} else {
			lower_rssi = fix_rssi_inv_only(rs->rs_rssi_ext[0]);
			upper_rssi = fix_rssi_inv_only(rs->rs_rssi_ctl[0]);

			fft_sample_40.lower_noise = ext_nf;
			fft_sample_40.upper_noise = ah->noise;
		}
		fft_sample_40.lower_rssi = lower_rssi;
		fft_sample_40.upper_rssi = upper_rssi;

		mag_info = ((struct ath_ht20_40_mag_info *)radar_info) - 1;
		lower_mag = spectral_max_magnitude(mag_info->lower_bins);
		upper_mag = spectral_max_magnitude(mag_info->upper_bins);
		fft_sample_40.lower_max_magnitude = __cpu_to_be16(lower_mag);
		fft_sample_40.upper_max_magnitude = __cpu_to_be16(upper_mag);
		lower_max_index = spectral_max_index(mag_info->lower_bins);
		upper_max_index = spectral_max_index(mag_info->upper_bins);
		fft_sample_40.lower_max_index = lower_max_index;
		fft_sample_40.upper_max_index = upper_max_index;
		lower_bitmap_w = spectral_bitmap_weight(mag_info->lower_bins);
		upper_bitmap_w = spectral_bitmap_weight(mag_info->upper_bins);
		fft_sample_40.lower_bitmap_weight = lower_bitmap_w;
		fft_sample_40.upper_bitmap_weight = upper_bitmap_w;
		fft_sample_40.max_exp = mag_info->max_exp & 0xf;

		fft_sample_40.tsf = __cpu_to_be64(tsf);

		tlv = (struct fft_sample_tlv *)&fft_sample_40;
	} else {
		u8 max_index, bitmap_w;
		u16 magnitude;
		struct ath_ht20_mag_info *mag_info;

		length = sizeof(fft_sample_20) - sizeof(struct fft_sample_tlv);
		fft_sample_20.tlv.type = ATH_FFT_SAMPLE_HT20;
		fft_sample_20.tlv.length = __cpu_to_be16(length);
		fft_sample_20.freq = __cpu_to_be16(freq);

		fft_sample_20.rssi = fix_rssi_inv_only(rs->rs_rssi_ctl[0]);
		fft_sample_20.noise = ah->noise;

		mag_info = ((struct ath_ht20_mag_info *)radar_info) - 1;
		magnitude = spectral_max_magnitude(mag_info->all_bins);
		fft_sample_20.max_magnitude = __cpu_to_be16(magnitude);
		max_index = spectral_max_index(mag_info->all_bins);
		fft_sample_20.max_index = max_index;
		bitmap_w = spectral_bitmap_weight(mag_info->all_bins);
		fft_sample_20.bitmap_weight = bitmap_w;
		fft_sample_20.max_exp = mag_info->max_exp & 0xf;

		fft_sample_20.tsf = __cpu_to_be64(tsf);

		tlv = (struct fft_sample_tlv *)&fft_sample_20;
	}

	ath_debug_send_fft_sample(sc, tlv);

	return 1;
}

/*********************/
/* spectral_scan_ctl */
/*********************/

static ssize_t read_file_spec_scan_ctl(struct file *file, char __user *user_buf,
				       size_t count, loff_t *ppos)
{
	struct ath_softc *sc = file->private_data;
	char *mode = "";
	unsigned int len;

	switch (sc->spectral_mode) {
	case SPECTRAL_DISABLED:
		mode = "disable";
		break;
	case SPECTRAL_BACKGROUND:
		mode = "background";
		break;
	case SPECTRAL_CHANSCAN:
		mode = "chanscan";
		break;
	case SPECTRAL_MANUAL:
		mode = "manual";
		break;
	}
	len = strlen(mode);
	return simple_read_from_buffer(user_buf, count, ppos, mode, len);
}

static ssize_t write_file_spec_scan_ctl(struct file *file,
					const char __user *user_buf,
					size_t count, loff_t *ppos)
{
	struct ath_softc *sc = file->private_data;
	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
	char buf[32];
	ssize_t len;

	if (config_enabled(CONFIG_ATH9K_TX99))
		return -EOPNOTSUPP;

	len = min(count, sizeof(buf) - 1);
	if (copy_from_user(buf, user_buf, len))
		return -EFAULT;

	buf[len] = '\0';

	if (strncmp("trigger", buf, 7) == 0) {
		ath9k_spectral_scan_trigger(sc->hw);
	} else if (strncmp("background", buf, 9) == 0) {
		ath9k_spectral_scan_config(sc->hw, SPECTRAL_BACKGROUND);
		ath_dbg(common, CONFIG, "spectral scan: background mode enabled\n");
	} else if (strncmp("chanscan", buf, 8) == 0) {
		ath9k_spectral_scan_config(sc->hw, SPECTRAL_CHANSCAN);
		ath_dbg(common, CONFIG, "spectral scan: channel scan mode enabled\n");
	} else if (strncmp("manual", buf, 6) == 0) {
		ath9k_spectral_scan_config(sc->hw, SPECTRAL_MANUAL);
		ath_dbg(common, CONFIG, "spectral scan: manual mode enabled\n");
	} else if (strncmp("disable", buf, 7) == 0) {
		ath9k_spectral_scan_config(sc->hw, SPECTRAL_DISABLED);
		ath_dbg(common, CONFIG, "spectral scan: disabled\n");
	} else {
		return -EINVAL;
	}

	return count;
}

static const struct file_operations fops_spec_scan_ctl = {
	.read = read_file_spec_scan_ctl,
	.write = write_file_spec_scan_ctl,
	.open = simple_open,
	.owner = THIS_MODULE,
	.llseek = default_llseek,
};

/*************************/
/* spectral_short_repeat */
/*************************/

static ssize_t read_file_spectral_short_repeat(struct file *file,
					       char __user *user_buf,
					       size_t count, loff_t *ppos)
{
	struct ath_softc *sc = file->private_data;
	char buf[32];
	unsigned int len;

	len = sprintf(buf, "%d\n", sc->spec_config.short_repeat);
	return simple_read_from_buffer(user_buf, count, ppos, buf, len);
}

static ssize_t write_file_spectral_short_repeat(struct file *file,
						const char __user *user_buf,
						size_t count, loff_t *ppos)
{
	struct ath_softc *sc = file->private_data;
	unsigned long val;
	char buf[32];
	ssize_t len;

	len = min(count, sizeof(buf) - 1);
	if (copy_from_user(buf, user_buf, len))
		return -EFAULT;

	buf[len] = '\0';
	if (kstrtoul(buf, 0, &val))
		return -EINVAL;

	if (val > 1)
		return -EINVAL;

	sc->spec_config.short_repeat = val;
	return count;
}

static const struct file_operations fops_spectral_short_repeat = {
	.read = read_file_spectral_short_repeat,
	.write = write_file_spectral_short_repeat,
	.open = simple_open,
	.owner = THIS_MODULE,
	.llseek = default_llseek,
};

/******************/
/* spectral_count */
/******************/

static ssize_t read_file_spectral_count(struct file *file,
					char __user *user_buf,
					size_t count, loff_t *ppos)
{
	struct ath_softc *sc = file->private_data;
	char buf[32];
	unsigned int len;

	len = sprintf(buf, "%d\n", sc->spec_config.count);
	return simple_read_from_buffer(user_buf, count, ppos, buf, len);
}

static ssize_t write_file_spectral_count(struct file *file,
					 const char __user *user_buf,
					 size_t count, loff_t *ppos)
{
	struct ath_softc *sc = file->private_data;
	unsigned long val;
	char buf[32];
	ssize_t len;

	len = min(count, sizeof(buf) - 1);
	if (copy_from_user(buf, user_buf, len))
		return -EFAULT;

	buf[len] = '\0';
	if (kstrtoul(buf, 0, &val))
		return -EINVAL;

	if (val > 255)
		return -EINVAL;

	sc->spec_config.count = val;
	return count;
}

static const struct file_operations fops_spectral_count = {
	.read = read_file_spectral_count,
	.write = write_file_spectral_count,
	.open = simple_open,
	.owner = THIS_MODULE,
	.llseek = default_llseek,
};

/*******************/
/* spectral_period */
/*******************/

static ssize_t read_file_spectral_period(struct file *file,
					 char __user *user_buf,
					 size_t count, loff_t *ppos)
{
	struct ath_softc *sc = file->private_data;
	char buf[32];
	unsigned int len;

	len = sprintf(buf, "%d\n", sc->spec_config.period);
	return simple_read_from_buffer(user_buf, count, ppos, buf, len);
}

static ssize_t write_file_spectral_period(struct file *file,
					  const char __user *user_buf,
					  size_t count, loff_t *ppos)
{
	struct ath_softc *sc = file->private_data;
	unsigned long val;
	char buf[32];
	ssize_t len;

	len = min(count, sizeof(buf) - 1);
	if (copy_from_user(buf, user_buf, len))
		return -EFAULT;

	buf[len] = '\0';
	if (kstrtoul(buf, 0, &val))
		return -EINVAL;

	if (val > 255)
		return -EINVAL;

	sc->spec_config.period = val;
	return count;
}

static const struct file_operations fops_spectral_period = {
	.read = read_file_spectral_period,
	.write = write_file_spectral_period,
	.open = simple_open,
	.owner = THIS_MODULE,
	.llseek = default_llseek,
};

/***********************/
/* spectral_fft_period */
/***********************/

static ssize_t read_file_spectral_fft_period(struct file *file,
					     char __user *user_buf,
					     size_t count, loff_t *ppos)
{
	struct ath_softc *sc = file->private_data;
	char buf[32];
	unsigned int len;

	len = sprintf(buf, "%d\n", sc->spec_config.fft_period);
	return simple_read_from_buffer(user_buf, count, ppos, buf, len);
}

static ssize_t write_file_spectral_fft_period(struct file *file,
					      const char __user *user_buf,
					      size_t count, loff_t *ppos)
{
	struct ath_softc *sc = file->private_data;
	unsigned long val;
	char buf[32];
	ssize_t len;

	len = min(count, sizeof(buf) - 1);
	if (copy_from_user(buf, user_buf, len))
		return -EFAULT;

	buf[len] = '\0';
	if (kstrtoul(buf, 0, &val))
		return -EINVAL;

	if (val > 15)
		return -EINVAL;

	sc->spec_config.fft_period = val;
	return count;
}

static const struct file_operations fops_spectral_fft_period = {
	.read = read_file_spectral_fft_period,
	.write = write_file_spectral_fft_period,
	.open = simple_open,
	.owner = THIS_MODULE,
	.llseek = default_llseek,
};

/*******************/
/* Relay interface */
/*******************/

static struct dentry *create_buf_file_handler(const char *filename,
					      struct dentry *parent,
					      umode_t mode,
					      struct rchan_buf *buf,
					      int *is_global)
{
	struct dentry *buf_file;

	buf_file = debugfs_create_file(filename, mode, parent, buf,
				       &relay_file_operations);
	*is_global = 1;
	return buf_file;
}

static int remove_buf_file_handler(struct dentry *dentry)
{
	debugfs_remove(dentry);

	return 0;
}

static struct rchan_callbacks rfs_spec_scan_cb = {
	.create_buf_file = create_buf_file_handler,
	.remove_buf_file = remove_buf_file_handler,
};

/*********************/
/* Debug Init/Deinit */
/*********************/

void ath9k_spectral_deinit_debug(struct ath_softc *sc)
{
	if (config_enabled(CONFIG_ATH9K_DEBUGFS) && sc->rfs_chan_spec_scan) {
		relay_close(sc->rfs_chan_spec_scan);
		sc->rfs_chan_spec_scan = NULL;
	}
}

void ath9k_spectral_init_debug(struct ath_softc *sc)
{
	sc->rfs_chan_spec_scan = relay_open("spectral_scan",
					    sc->debug.debugfs_phy,
					    1024, 256, &rfs_spec_scan_cb,
					    NULL);
	debugfs_create_file("spectral_scan_ctl",
			    S_IRUSR | S_IWUSR,
			    sc->debug.debugfs_phy, sc,
			    &fops_spec_scan_ctl);
	debugfs_create_file("spectral_short_repeat",
			    S_IRUSR | S_IWUSR,
			    sc->debug.debugfs_phy, sc,
			    &fops_spectral_short_repeat);
	debugfs_create_file("spectral_count",
			    S_IRUSR | S_IWUSR,
			    sc->debug.debugfs_phy, sc,
			    &fops_spectral_count);
	debugfs_create_file("spectral_period",
			    S_IRUSR | S_IWUSR,
			    sc->debug.debugfs_phy, sc,
			    &fops_spectral_period);
	debugfs_create_file("spectral_fft_period",
			    S_IRUSR | S_IWUSR,
			    sc->debug.debugfs_phy, sc,
			    &fops_spectral_fft_period);
}
Commit	Line	Data
f65c0825 SM	1	/*
	2	* Copyright (c) 2013 Qualcomm Atheros, Inc.
	3	*
	4	* Permission to use, copy, modify, and/or distribute this software for any
	5	* purpose with or without fee is hereby granted, provided that the above
	6	* copyright notice and this permission notice appear in all copies.
	7	*
	8	* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
	9	* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
	10	* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
	11	* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
	12	* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
	13	* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
	14	* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
	15	*/
	16
	17	#include <linux/relay.h>
	18	#include "ath9k.h"
	19
	20	static s8 fix_rssi_inv_only(u8 rssi_val)
	21	{
	22	if (rssi_val == 128)
	23	rssi_val = 0;
	24	return (s8) rssi_val;
	25	}
	26
	27	static void ath_debug_send_fft_sample(struct ath_softc *sc,
	28	struct fft_sample_tlv *fft_sample_tlv)
	29	{
	30	int length;
	31	if (!sc->rfs_chan_spec_scan)
	32	return;
	33
	34	length = __be16_to_cpu(fft_sample_tlv->length) +
	35	sizeof(*fft_sample_tlv);
	36	relay_write(sc->rfs_chan_spec_scan, fft_sample_tlv, length);
	37	}
	38
	39	/* returns 1 if this was a spectral frame, even if not handled. */
	40	int ath_process_fft(struct ath_softc sc, struct ieee80211_hdr hdr,
	41	struct ath_rx_status *rs, u64 tsf)
	42	{
	43	struct ath_hw *ah = sc->sc_ah;
	44	u8 num_bins, bins, vdata = (u8 *)hdr;
	45	struct fft_sample_ht20 fft_sample_20;
	46	struct fft_sample_ht20_40 fft_sample_40;
	47	struct fft_sample_tlv *tlv;
	48	struct ath_radar_info *radar_info;
	49	int len = rs->rs_datalen;
	50	int dc_pos;
	51	u16 fft_len, length, freq = ah->curchan->chan->center_freq;
	52	enum nl80211_channel_type chan_type;
	53
	54	/* AR9280 and before report via ATH9K_PHYERR_RADAR, AR93xx and newer
	55	* via ATH9K_PHYERR_SPECTRAL. Haven't seen ATH9K_PHYERR_FALSE_RADAR_EXT
	56	* yet, but this is supposed to be possible as well.
	57	*/
	58	if (rs->rs_phyerr != ATH9K_PHYERR_RADAR &&
	59	rs->rs_phyerr != ATH9K_PHYERR_FALSE_RADAR_EXT &&
	60	rs->rs_phyerr != ATH9K_PHYERR_SPECTRAL)
	61	return 0;
	62
	63	/* check if spectral scan bit is set. This does not have to be checked
	64	* if received through a SPECTRAL phy error, but shouldn't hurt.
65	*/
66	radar_info = ((struct ath_radar_info *)&vdata[len]) - 1;
67	if (!(radar_info->pulse_bw_info & SPECTRAL_SCAN_BITMASK))
68	return 0;
69
70	chan_type = cfg80211_get_chandef_type(&sc->hw->conf.chandef);
71	if ((chan_type == NL80211_CHAN_HT40MINUS) \|\|
72	(chan_type == NL80211_CHAN_HT40PLUS)) {
73	fft_len = SPECTRAL_HT20_40_TOTAL_DATA_LEN;
74	num_bins = SPECTRAL_HT20_40_NUM_BINS;
75	bins = (u8 *)fft_sample_40.data;
76	} else {
77	fft_len = SPECTRAL_HT20_TOTAL_DATA_LEN;
78	num_bins = SPECTRAL_HT20_NUM_BINS;
79	bins = (u8 *)fft_sample_20.data;
80	}
81
82	/* Variation in the data length is possible and will be fixed later */
83	if ((len > fft_len + 2) \|\| (len < fft_len - 1))
84	return 1;
85
86	switch (len - fft_len) {
87	case 0:
88	/* length correct, nothing to do. */
89	memcpy(bins, vdata, num_bins);
90	break;
91	case -1:
92	/* first byte missing, duplicate it. */
93	memcpy(&bins[1], vdata, num_bins - 1);
94	bins[0] = vdata[0];
95	break;
96	case 2:
97	/* MAC added 2 extra bytes at bin 30 and 32, remove them. */
98	memcpy(bins, vdata, 30);
99	bins[30] = vdata[31];
100	memcpy(&bins[31], &vdata[33], num_bins - 31);
101	break;
102	case 1:
103	/* MAC added 2 extra bytes AND first byte is missing. */
104	bins[0] = vdata[0];
105	memcpy(&bins[1], vdata, 30);
106	bins[31] = vdata[31];
107	memcpy(&bins[32], &vdata[33], num_bins - 32);
108	break;
109	default:
110	return 1;
111	}
112
113	/* DC value (value in the middle) is the blind spot of the spectral
114	* sample and invalid, interpolate it.
115	*/
116	dc_pos = num_bins / 2;
117	bins[dc_pos] = (bins[dc_pos + 1] + bins[dc_pos - 1]) / 2;
118
119	if ((chan_type == NL80211_CHAN_HT40MINUS) \|\|
120	(chan_type == NL80211_CHAN_HT40PLUS)) {
121	s8 lower_rssi, upper_rssi;
122	s16 ext_nf;
123	u8 lower_max_index, upper_max_index;
124	u8 lower_bitmap_w, upper_bitmap_w;
125	u16 lower_mag, upper_mag;
126	struct ath9k_hw_cal_data *caldata = ah->caldata;
127	struct ath_ht20_40_mag_info *mag_info;
128
129	if (caldata)
130	ext_nf = ath9k_hw_getchan_noise(ah, ah->curchan,
131	caldata->nfCalHist[3].privNF);
132	else
133	ext_nf = ATH_DEFAULT_NOISE_FLOOR;
134
135	length = sizeof(fft_sample_40) - sizeof(struct fft_sample_tlv);
136	fft_sample_40.tlv.type = ATH_FFT_SAMPLE_HT20_40;
137	fft_sample_40.tlv.length = __cpu_to_be16(length);
138	fft_sample_40.freq = __cpu_to_be16(freq);
139	fft_sample_40.channel_type = chan_type;
140
141	if (chan_type == NL80211_CHAN_HT40PLUS) {
142	lower_rssi = fix_rssi_inv_only(rs->rs_rssi_ctl[0]);
143	upper_rssi = fix_rssi_inv_only(rs->rs_rssi_ext[0]);
144
145	fft_sample_40.lower_noise = ah->noise;
146	fft_sample_40.upper_noise = ext_nf;
147	} else {
148	lower_rssi = fix_rssi_inv_only(rs->rs_rssi_ext[0]);
149	upper_rssi = fix_rssi_inv_only(rs->rs_rssi_ctl[0]);
150
151	fft_sample_40.lower_noise = ext_nf;
152	fft_sample_40.upper_noise = ah->noise;
153	}
154	fft_sample_40.lower_rssi = lower_rssi;
155	fft_sample_40.upper_rssi = upper_rssi;
156
157	mag_info = ((struct ath_ht20_40_mag_info *)radar_info) - 1;
158	lower_mag = spectral_max_magnitude(mag_info->lower_bins);
159	upper_mag = spectral_max_magnitude(mag_info->upper_bins);
160	fft_sample_40.lower_max_magnitude = __cpu_to_be16(lower_mag);
161	fft_sample_40.upper_max_magnitude = __cpu_to_be16(upper_mag);
162	lower_max_index = spectral_max_index(mag_info->lower_bins);
163	upper_max_index = spectral_max_index(mag_info->upper_bins);
164	fft_sample_40.lower_max_index = lower_max_index;
165	fft_sample_40.upper_max_index = upper_max_index;
166	lower_bitmap_w = spectral_bitmap_weight(mag_info->lower_bins);
167	upper_bitmap_w = spectral_bitmap_weight(mag_info->upper_bins);
168	fft_sample_40.lower_bitmap_weight = lower_bitmap_w;
169	fft_sample_40.upper_bitmap_weight = upper_bitmap_w;
170	fft_sample_40.max_exp = mag_info->max_exp & 0xf;
171
172	fft_sample_40.tsf = __cpu_to_be64(tsf);
173
174	tlv = (struct fft_sample_tlv *)&fft_sample_40;
175	} else {
176	u8 max_index, bitmap_w;
177	u16 magnitude;
178	struct ath_ht20_mag_info *mag_info;
179
180	length = sizeof(fft_sample_20) - sizeof(struct fft_sample_tlv);
181	fft_sample_20.tlv.type = ATH_FFT_SAMPLE_HT20;
182	fft_sample_20.tlv.length = __cpu_to_be16(length);
183	fft_sample_20.freq = __cpu_to_be16(freq);
184
185	fft_sample_20.rssi = fix_rssi_inv_only(rs->rs_rssi_ctl[0]);
186	fft_sample_20.noise = ah->noise;
187
188	mag_info = ((struct ath_ht20_mag_info *)radar_info) - 1;
189	magnitude = spectral_max_magnitude(mag_info->all_bins);
190	fft_sample_20.max_magnitude = __cpu_to_be16(magnitude);
191	max_index = spectral_max_index(mag_info->all_bins);
192	fft_sample_20.max_index = max_index;
193	bitmap_w = spectral_bitmap_weight(mag_info->all_bins);
194	fft_sample_20.bitmap_weight = bitmap_w;
195	fft_sample_20.max_exp = mag_info->max_exp & 0xf;
196
197	fft_sample_20.tsf = __cpu_to_be64(tsf);
198
199	tlv = (struct fft_sample_tlv *)&fft_sample_20;
200	}
201
202	ath_debug_send_fft_sample(sc, tlv);
203
204	return 1;
205	}
206
207	/*********************/
208	/* spectral_scan_ctl */
209	/*********************/
210
211	static ssize_t read_file_spec_scan_ctl(struct file file, char __user user_buf,
212	size_t count, loff_t *ppos)
213	{
214	struct ath_softc *sc = file->private_data;
215	char *mode = "";
216	unsigned int len;
217
218	switch (sc->spectral_mode) {
219	case SPECTRAL_DISABLED:
220	mode = "disable";
221	break;
222	case SPECTRAL_BACKGROUND:
223	mode = "background";
224	break;
225	case SPECTRAL_CHANSCAN:
226	mode = "chanscan";
227	break;
228	case SPECTRAL_MANUAL:
229	mode = "manual";
230	break;
231	}
232	len = strlen(mode);
233	return simple_read_from_buffer(user_buf, count, ppos, mode, len);
234	}
235
236	static ssize_t write_file_spec_scan_ctl(struct file *file,
237	const char __user *user_buf,
238	size_t count, loff_t *ppos)
239	{
240	struct ath_softc *sc = file->private_data;
241	struct ath_common *common = ath9k_hw_common(sc->sc_ah);
242	char buf[32];
243	ssize_t len;
244
245	if (config_enabled(CONFIG_ATH9K_TX99))
246	return -EOPNOTSUPP;
247
248	len = min(count, sizeof(buf) - 1);
249	if (copy_from_user(buf, user_buf, len))
250	return -EFAULT;
251
252	buf[len] = '\0';
253
254	if (strncmp("trigger", buf, 7) == 0) {
255	ath9k_spectral_scan_trigger(sc->hw);
256	} else if (strncmp("background", buf, 9) == 0) {
257	ath9k_spectral_scan_config(sc->hw, SPECTRAL_BACKGROUND);
258	ath_dbg(common, CONFIG, "spectral scan: background mode enabled\n");
259	} else if (strncmp("chanscan", buf, 8) == 0) {
260	ath9k_spectral_scan_config(sc->hw, SPECTRAL_CHANSCAN);
261	ath_dbg(common, CONFIG, "spectral scan: channel scan mode enabled\n");
262	} else if (strncmp("manual", buf, 6) == 0) {
263	ath9k_spectral_scan_config(sc->hw, SPECTRAL_MANUAL);
264	ath_dbg(common, CONFIG, "spectral scan: manual mode enabled\n");
265	} else if (strncmp("disable", buf, 7) == 0) {
266	ath9k_spectral_scan_config(sc->hw, SPECTRAL_DISABLED);
267	ath_dbg(common, CONFIG, "spectral scan: disabled\n");
268	} else {
269	return -EINVAL;
270	}
271
272	return count;
273	}
274
275	static const struct file_operations fops_spec_scan_ctl = {
276	.read = read_file_spec_scan_ctl,
277	.write = write_file_spec_scan_ctl,
278	.open = simple_open,
279	.owner = THIS_MODULE,
280	.llseek = default_llseek,
281	};
282
283	/*************************/
284	/* spectral_short_repeat */
285	/*************************/
286
287	static ssize_t read_file_spectral_short_repeat(struct file *file,
288	char __user *user_buf,
289	size_t count, loff_t *ppos)
290	{
291	struct ath_softc *sc = file->private_data;
292	char buf[32];
293	unsigned int len;
294
295	len = sprintf(buf, "%d\n", sc->spec_config.short_repeat);
296	return simple_read_from_buffer(user_buf, count, ppos, buf, len);
297	}
298
299	static ssize_t write_file_spectral_short_repeat(struct file *file,
300	const char __user *user_buf,
301	size_t count, loff_t *ppos)
302	{
303	struct ath_softc *sc = file->private_data;
304	unsigned long val;
305	char buf[32];
306	ssize_t len;
307
308	len = min(count, sizeof(buf) - 1);
309	if (copy_from_user(buf, user_buf, len))
310	return -EFAULT;
311
312	buf[len] = '\0';
313	if (kstrtoul(buf, 0, &val))
314	return -EINVAL;
315
3f557202	316	if (val > 1)
f65c0825 SM	317	return -EINVAL;
	318
	319	sc->spec_config.short_repeat = val;
	320	return count;
	321	}
	322
	323	static const struct file_operations fops_spectral_short_repeat = {
	324	.read = read_file_spectral_short_repeat,
	325	.write = write_file_spectral_short_repeat,
	326	.open = simple_open,
	327	.owner = THIS_MODULE,
	328	.llseek = default_llseek,
	329	};
	330
	331	/******************/
	332	/* spectral_count */
	333	/******************/
	334
	335	static ssize_t read_file_spectral_count(struct file *file,
	336	char __user *user_buf,
	337	size_t count, loff_t *ppos)
	338	{
	339	struct ath_softc *sc = file->private_data;
	340	char buf[32];
	341	unsigned int len;
	342
	343	len = sprintf(buf, "%d\n", sc->spec_config.count);
	344	return simple_read_from_buffer(user_buf, count, ppos, buf, len);
	345	}
	346
	347	static ssize_t write_file_spectral_count(struct file *file,
	348	const char __user *user_buf,
	349	size_t count, loff_t *ppos)
	350	{
	351	struct ath_softc *sc = file->private_data;
	352	unsigned long val;
	353	char buf[32];
	354	ssize_t len;
	355
	356	len = min(count, sizeof(buf) - 1);
	357	if (copy_from_user(buf, user_buf, len))
	358	return -EFAULT;
	359
	360	buf[len] = '\0';
	361	if (kstrtoul(buf, 0, &val))
	362	return -EINVAL;
	363
3f557202	364	if (val > 255)
f65c0825 SM	365	return -EINVAL;
	366
	367	sc->spec_config.count = val;
	368	return count;
	369	}
	370
	371	static const struct file_operations fops_spectral_count = {
	372	.read = read_file_spectral_count,
	373	.write = write_file_spectral_count,
	374	.open = simple_open,
	375	.owner = THIS_MODULE,
	376	.llseek = default_llseek,
	377	};
	378
	379	/*******************/
	380	/* spectral_period */
	381	/*******************/
	382
	383	static ssize_t read_file_spectral_period(struct file *file,
	384	char __user *user_buf,
	385	size_t count, loff_t *ppos)
	386	{
	387	struct ath_softc *sc = file->private_data;
	388	char buf[32];
	389	unsigned int len;
	390
	391	len = sprintf(buf, "%d\n", sc->spec_config.period);
	392	return simple_read_from_buffer(user_buf, count, ppos, buf, len);
	393	}
	394
	395	static ssize_t write_file_spectral_period(struct file *file,
	396	const char __user *user_buf,
	397	size_t count, loff_t *ppos)
	398	{
	399	struct ath_softc *sc = file->private_data;
	400	unsigned long val;
	401	char buf[32];
	402	ssize_t len;
	403
	404	len = min(count, sizeof(buf) - 1);
	405	if (copy_from_user(buf, user_buf, len))
	406	return -EFAULT;
	407
	408	buf[len] = '\0';
	409	if (kstrtoul(buf, 0, &val))
	410	return -EINVAL;
	411
3f557202	412	if (val > 255)
f65c0825 SM	413	return -EINVAL;
	414
	415	sc->spec_config.period = val;
	416	return count;
	417	}
	418
	419	static const struct file_operations fops_spectral_period = {
	420	.read = read_file_spectral_period,
	421	.write = write_file_spectral_period,
	422	.open = simple_open,
	423	.owner = THIS_MODULE,
	424	.llseek = default_llseek,
	425	};
	426
	427	/***********************/
	428	/* spectral_fft_period */
	429	/***********************/
	430
	431	static ssize_t read_file_spectral_fft_period(struct file *file,
	432	char __user *user_buf,
	433	size_t count, loff_t *ppos)
	434	{
	435	struct ath_softc *sc = file->private_data;
	436	char buf[32];
	437	unsigned int len;
	438
	439	len = sprintf(buf, "%d\n", sc->spec_config.fft_period);
	440	return simple_read_from_buffer(user_buf, count, ppos, buf, len);
	441	}
	442
	443	static ssize_t write_file_spectral_fft_period(struct file *file,
	444	const char __user *user_buf,
	445	size_t count, loff_t *ppos)
	446	{
	447	struct ath_softc *sc = file->private_data;
	448	unsigned long val;
	449	char buf[32];
	450	ssize_t len;
	451
	452	len = min(count, sizeof(buf) - 1);
	453	if (copy_from_user(buf, user_buf, len))
	454	return -EFAULT;
	455
	456	buf[len] = '\0';
	457	if (kstrtoul(buf, 0, &val))
	458	return -EINVAL;
	459
3f557202	460	if (val > 15)
f65c0825 SM	461	return -EINVAL;
	462
	463	sc->spec_config.fft_period = val;
	464	return count;
	465	}
	466
	467	static const struct file_operations fops_spectral_fft_period = {
	468	.read = read_file_spectral_fft_period,
	469	.write = write_file_spectral_fft_period,
	470	.open = simple_open,
	471	.owner = THIS_MODULE,
	472	.llseek = default_llseek,
	473	};
	474
	475	/*******************/
	476	/* Relay interface */
	477	/*******************/
	478
	479	static struct dentry create_buf_file_handler(const char filename,
	480	struct dentry *parent,
	481	umode_t mode,
	482	struct rchan_buf *buf,
	483	int *is_global)
	484	{
	485	struct dentry *buf_file;
	486
	487	buf_file = debugfs_create_file(filename, mode, parent, buf,
	488	&relay_file_operations);
	489	*is_global = 1;
	490	return buf_file;
	491	}
	492
	493	static int remove_buf_file_handler(struct dentry *dentry)
	494	{
	495	debugfs_remove(dentry);
	496
	497	return 0;
	498	}
	499
f84d1b49	500	static struct rchan_callbacks rfs_spec_scan_cb = {
f65c0825 SM	501	.create_buf_file = create_buf_file_handler,
	502	.remove_buf_file = remove_buf_file_handler,
	503	};
	504
	505	/*********************/
	506	/* Debug Init/Deinit */
	507	/*********************/
	508
	509	void ath9k_spectral_deinit_debug(struct ath_softc *sc)
	510	{
	511	if (config_enabled(CONFIG_ATH9K_DEBUGFS) && sc->rfs_chan_spec_scan) {
	512	relay_close(sc->rfs_chan_spec_scan);
	513	sc->rfs_chan_spec_scan = NULL;
	514	}
	515	}
	516
	517	void ath9k_spectral_init_debug(struct ath_softc *sc)
	518	{
	519	sc->rfs_chan_spec_scan = relay_open("spectral_scan",
	520	sc->debug.debugfs_phy,
	521	1024, 256, &rfs_spec_scan_cb,
	522	NULL);
	523	debugfs_create_file("spectral_scan_ctl",
	524	S_IRUSR \| S_IWUSR,
	525	sc->debug.debugfs_phy, sc,
	526	&fops_spec_scan_ctl);
	527	debugfs_create_file("spectral_short_repeat",
	528	S_IRUSR \| S_IWUSR,
	529	sc->debug.debugfs_phy, sc,
	530	&fops_spectral_short_repeat);
	531	debugfs_create_file("spectral_count",
	532	S_IRUSR \| S_IWUSR,
	533	sc->debug.debugfs_phy, sc,
	534	&fops_spectral_count);
	535	debugfs_create_file("spectral_period",
	536	S_IRUSR \| S_IWUSR,
	537	sc->debug.debugfs_phy, sc,
	538	&fops_spectral_period);
	539	debugfs_create_file("spectral_fft_period",
	540	S_IRUSR \| S_IWUSR,
	541	sc->debug.debugfs_phy, sc,
	542	&fops_spectral_fft_period);
	543	}