[GitHub/mt8127/android_kernel_alcatel_ttab.git] / net / mac80211 / rc80211_pid_debugfs.c

/*
 * Copyright 2007, Mattias Nissler <mattias.nissler@gmx.de>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/sched.h>
#include <linux/spinlock.h>
#include <linux/poll.h>
#include <linux/netdevice.h>
#include <linux/types.h>
#include <linux/skbuff.h>
#include <linux/slab.h>
#include <linux/export.h>

#include <net/mac80211.h>
#include "rate.h"

#include "rc80211_pid.h"

static void rate_control_pid_event(struct rc_pid_event_buffer *buf,
				   enum rc_pid_event_type type,
				   union rc_pid_event_data *data)
{
	struct rc_pid_event *ev;
	unsigned long status;

	spin_lock_irqsave(&buf->lock, status);
	ev = &(buf->ring[buf->next_entry]);
	buf->next_entry = (buf->next_entry + 1) % RC_PID_EVENT_RING_SIZE;

	ev->timestamp = jiffies;
	ev->id = buf->ev_count++;
	ev->type = type;
	ev->data = *data;

	spin_unlock_irqrestore(&buf->lock, status);

	wake_up_all(&buf->waitqueue);
}

void rate_control_pid_event_tx_status(struct rc_pid_event_buffer *buf,
				      struct ieee80211_tx_info *stat)
{
	union rc_pid_event_data evd;

	evd.flags = stat->flags;
	memcpy(&evd.tx_status, stat, sizeof(struct ieee80211_tx_info));
	rate_control_pid_event(buf, RC_PID_EVENT_TYPE_TX_STATUS, &evd);
}

void rate_control_pid_event_rate_change(struct rc_pid_event_buffer *buf,
					       int index, int rate)
{
	union rc_pid_event_data evd;

	evd.index = index;
	evd.rate = rate;
	rate_control_pid_event(buf, RC_PID_EVENT_TYPE_RATE_CHANGE, &evd);
}

void rate_control_pid_event_tx_rate(struct rc_pid_event_buffer *buf,
					   int index, int rate)
{
	union rc_pid_event_data evd;

	evd.index = index;
	evd.rate = rate;
	rate_control_pid_event(buf, RC_PID_EVENT_TYPE_TX_RATE, &evd);
}

void rate_control_pid_event_pf_sample(struct rc_pid_event_buffer *buf,
					     s32 pf_sample, s32 prop_err,
					     s32 int_err, s32 der_err)
{
	union rc_pid_event_data evd;

	evd.pf_sample = pf_sample;
	evd.prop_err = prop_err;
	evd.int_err = int_err;
	evd.der_err = der_err;
	rate_control_pid_event(buf, RC_PID_EVENT_TYPE_PF_SAMPLE, &evd);
}

static int rate_control_pid_events_open(struct inode *inode, struct file *file)
{
	struct rc_pid_sta_info *sinfo = inode->i_private;
	struct rc_pid_event_buffer *events = &sinfo->events;
	struct rc_pid_events_file_info *file_info;
	unsigned long status;

	/* Allocate a state struct */
	file_info = kmalloc(sizeof(*file_info), GFP_KERNEL);
	if (file_info == NULL)
		return -ENOMEM;

	spin_lock_irqsave(&events->lock, status);

	file_info->next_entry = events->next_entry;
	file_info->events = events;

	spin_unlock_irqrestore(&events->lock, status);

	file->private_data = file_info;

	return 0;
}

static int rate_control_pid_events_release(struct inode *inode,
					   struct file *file)
{
	struct rc_pid_events_file_info *file_info = file->private_data;

	kfree(file_info);

	return 0;
}

static unsigned int rate_control_pid_events_poll(struct file *file,
						 poll_table *wait)
{
	struct rc_pid_events_file_info *file_info = file->private_data;

	poll_wait(file, &file_info->events->waitqueue, wait);

	return POLLIN | POLLRDNORM;
}

#define RC_PID_PRINT_BUF_SIZE 64

static ssize_t rate_control_pid_events_read(struct file *file, char __user *buf,
					    size_t length, loff_t *offset)
{
	struct rc_pid_events_file_info *file_info = file->private_data;
	struct rc_pid_event_buffer *events = file_info->events;
	struct rc_pid_event *ev;
	char pb[RC_PID_PRINT_BUF_SIZE];
	int ret;
	int p;
	unsigned long status;

	/* Check if there is something to read. */
	if (events->next_entry == file_info->next_entry) {
		if (file->f_flags & O_NONBLOCK)
			return -EAGAIN;

		/* Wait */
		ret = wait_event_interruptible(events->waitqueue,
				events->next_entry != file_info->next_entry);

		if (ret)
			return ret;
	}

	/* Write out one event per call. I don't care whether it's a little
	 * inefficient, this is debugging code anyway. */
	spin_lock_irqsave(&events->lock, status);

	/* Get an event */
	ev = &(events->ring[file_info->next_entry]);
	file_info->next_entry = (file_info->next_entry + 1) %
				RC_PID_EVENT_RING_SIZE;

	/* Print information about the event. Note that userspace needs to
	 * provide large enough buffers. */
	length = length < RC_PID_PRINT_BUF_SIZE ?
		 length : RC_PID_PRINT_BUF_SIZE;
	p = snprintf(pb, length, "%u %lu ", ev->id, ev->timestamp);
	switch (ev->type) {
	case RC_PID_EVENT_TYPE_TX_STATUS:
		p += snprintf(pb + p, length - p, "tx_status %u %u",
			      !(ev->data.flags & IEEE80211_TX_STAT_ACK),
			      ev->data.tx_status.status.rates[0].idx);
		break;
	case RC_PID_EVENT_TYPE_RATE_CHANGE:
		p += snprintf(pb + p, length - p, "rate_change %d %d",
			      ev->data.index, ev->data.rate);
		break;
	case RC_PID_EVENT_TYPE_TX_RATE:
		p += snprintf(pb + p, length - p, "tx_rate %d %d",
			      ev->data.index, ev->data.rate);
		break;
	case RC_PID_EVENT_TYPE_PF_SAMPLE:
		p += snprintf(pb + p, length - p,
			      "pf_sample %d %d %d %d",
			      ev->data.pf_sample, ev->data.prop_err,
			      ev->data.int_err, ev->data.der_err);
		break;
	}
	p += snprintf(pb + p, length - p, "\n");

	spin_unlock_irqrestore(&events->lock, status);

	if (copy_to_user(buf, pb, p))
		return -EFAULT;

	return p;
}

#undef RC_PID_PRINT_BUF_SIZE

static const struct file_operations rc_pid_fop_events = {
	.owner = THIS_MODULE,
	.read = rate_control_pid_events_read,
	.poll = rate_control_pid_events_poll,
	.open = rate_control_pid_events_open,
	.release = rate_control_pid_events_release,
	.llseek = noop_llseek,
};

void rate_control_pid_add_sta_debugfs(void *priv, void *priv_sta,
					     struct dentry *dir)
{
	struct rc_pid_sta_info *spinfo = priv_sta;

	spinfo->events_entry = debugfs_create_file("rc_pid_events", S_IRUGO,
						   dir, spinfo,
						   &rc_pid_fop_events);
}

void rate_control_pid_remove_sta_debugfs(void *priv, void *priv_sta)
{
	struct rc_pid_sta_info *spinfo = priv_sta;

	debugfs_remove(spinfo->events_entry);
}
Commit	Line	Data
12446c67 MN	1	/*
	2	* Copyright 2007, Mattias Nissler <mattias.nissler@gmx.de>
	3	*
	4	* This program is free software; you can redistribute it and/or modify
	5	* it under the terms of the GNU General Public License version 2 as
	6	* published by the Free Software Foundation.
	7	*/
	8
d43c36dc	9	#include <linux/sched.h>
12446c67 MN	10	#include <linux/spinlock.h>
	11	#include <linux/poll.h>
	12	#include <linux/netdevice.h>
	13	#include <linux/types.h>
	14	#include <linux/skbuff.h>
5a0e3ad6	15	#include <linux/slab.h>
bc3b2d7f	16	#include <linux/export.h>
12446c67 MN	17
12446c67 MN	18	#include <net/mac80211.h>
2c8dccc7	19	#include "rate.h"
12446c67 MN	20
	21	#include "rc80211_pid.h"
	22
	23	static void rate_control_pid_event(struct rc_pid_event_buffer *buf,
	24	enum rc_pid_event_type type,
	25	union rc_pid_event_data *data)
	26	{
	27	struct rc_pid_event *ev;
	28	unsigned long status;
	29
	30	spin_lock_irqsave(&buf->lock, status);
	31	ev = &(buf->ring[buf->next_entry]);
	32	buf->next_entry = (buf->next_entry + 1) % RC_PID_EVENT_RING_SIZE;
	33
	34	ev->timestamp = jiffies;
	35	ev->id = buf->ev_count++;
	36	ev->type = type;
	37	ev->data = *data;
	38
	39	spin_unlock_irqrestore(&buf->lock, status);
	40
	41	wake_up_all(&buf->waitqueue);
	42	}
	43
	44	void rate_control_pid_event_tx_status(struct rc_pid_event_buffer *buf,
e039fa4a	45	struct ieee80211_tx_info *stat)
12446c67 MN	46	{
	47	union rc_pid_event_data evd;
	48
e6a9854b	49	evd.flags = stat->flags;
e039fa4a	50	memcpy(&evd.tx_status, stat, sizeof(struct ieee80211_tx_info));
12446c67 MN	51	rate_control_pid_event(buf, RC_PID_EVENT_TYPE_TX_STATUS, &evd);
	52	}
	53
	54	void rate_control_pid_event_rate_change(struct rc_pid_event_buffer *buf,
	55	int index, int rate)
	56	{
	57	union rc_pid_event_data evd;
	58
	59	evd.index = index;
	60	evd.rate = rate;
	61	rate_control_pid_event(buf, RC_PID_EVENT_TYPE_RATE_CHANGE, &evd);
	62	}
	63
	64	void rate_control_pid_event_tx_rate(struct rc_pid_event_buffer *buf,
	65	int index, int rate)
	66	{
	67	union rc_pid_event_data evd;
	68
	69	evd.index = index;
	70	evd.rate = rate;
	71	rate_control_pid_event(buf, RC_PID_EVENT_TYPE_TX_RATE, &evd);
	72	}
	73
	74	void rate_control_pid_event_pf_sample(struct rc_pid_event_buffer *buf,
	75	s32 pf_sample, s32 prop_err,
	76	s32 int_err, s32 der_err)
	77	{
	78	union rc_pid_event_data evd;
	79
	80	evd.pf_sample = pf_sample;
	81	evd.prop_err = prop_err;
	82	evd.int_err = int_err;
	83	evd.der_err = der_err;
	84	rate_control_pid_event(buf, RC_PID_EVENT_TYPE_PF_SAMPLE, &evd);
	85	}
	86
	87	static int rate_control_pid_events_open(struct inode inode, struct file file)
	88	{
	89	struct rc_pid_sta_info *sinfo = inode->i_private;
	90	struct rc_pid_event_buffer *events = &sinfo->events;
	91	struct rc_pid_events_file_info *file_info;
a1f2aa1b	92	unsigned long status;
12446c67 MN	93
	94	/* Allocate a state struct */
	95	file_info = kmalloc(sizeof(*file_info), GFP_KERNEL);
	96	if (file_info == NULL)
	97	return -ENOMEM;
	98
	99	spin_lock_irqsave(&events->lock, status);
	100
	101	file_info->next_entry = events->next_entry;
	102	file_info->events = events;
	103
	104	spin_unlock_irqrestore(&events->lock, status);
	105
	106	file->private_data = file_info;
	107
	108	return 0;
	109	}
	110
	111	static int rate_control_pid_events_release(struct inode *inode,
	112	struct file *file)
	113	{
	114	struct rc_pid_events_file_info *file_info = file->private_data;
	115
	116	kfree(file_info);
	117
	118	return 0;
	119	}
	120
	121	static unsigned int rate_control_pid_events_poll(struct file *file,
	122	poll_table *wait)
	123	{
	124	struct rc_pid_events_file_info *file_info = file->private_data;
	125
	126	poll_wait(file, &file_info->events->waitqueue, wait);
	127
	128	return POLLIN \| POLLRDNORM;
	129	}
	130
	131	#define RC_PID_PRINT_BUF_SIZE 64
	132
	133	static ssize_t rate_control_pid_events_read(struct file file, char __user buf,
	134	size_t length, loff_t *offset)
	135	{
	136	struct rc_pid_events_file_info *file_info = file->private_data;
	137	struct rc_pid_event_buffer *events = file_info->events;
	138	struct rc_pid_event *ev;
	139	char pb[RC_PID_PRINT_BUF_SIZE];
	140	int ret;
	141	int p;
a1f2aa1b	142	unsigned long status;
12446c67 MN	143
	144	/* Check if there is something to read. */
	145	if (events->next_entry == file_info->next_entry) {
	146	if (file->f_flags & O_NONBLOCK)
	147	return -EAGAIN;
	148
	149	/* Wait */
	150	ret = wait_event_interruptible(events->waitqueue,
	151	events->next_entry != file_info->next_entry);
	152
	153	if (ret)
	154	return ret;
	155	}
	156
	157	/* Write out one event per call. I don't care whether it's a little
	158	* inefficient, this is debugging code anyway. */
	159	spin_lock_irqsave(&events->lock, status);
	160
	161	/* Get an event */
	162	ev = &(events->ring[file_info->next_entry]);
	163	file_info->next_entry = (file_info->next_entry + 1) %
	164	RC_PID_EVENT_RING_SIZE;
	165
1fdaa46e	166	/* Print information about the event. Note that userspace needs to
12446c67 MN	167	* provide large enough buffers. */
	168	length = length < RC_PID_PRINT_BUF_SIZE ?
	169	length : RC_PID_PRINT_BUF_SIZE;
	170	p = snprintf(pb, length, "%u %lu ", ev->id, ev->timestamp);
	171	switch (ev->type) {
	172	case RC_PID_EVENT_TYPE_TX_STATUS:
	173	p += snprintf(pb + p, length - p, "tx_status %u %u",
e6a9854b JB	174	!(ev->data.flags & IEEE80211_TX_STAT_ACK),
e6a9854b JB	175	ev->data.tx_status.status.rates[0].idx);
12446c67 MN	176	break;
	177	case RC_PID_EVENT_TYPE_RATE_CHANGE:
	178	p += snprintf(pb + p, length - p, "rate_change %d %d",
	179	ev->data.index, ev->data.rate);
	180	break;
	181	case RC_PID_EVENT_TYPE_TX_RATE:
	182	p += snprintf(pb + p, length - p, "tx_rate %d %d",
	183	ev->data.index, ev->data.rate);
	184	break;
	185	case RC_PID_EVENT_TYPE_PF_SAMPLE:
	186	p += snprintf(pb + p, length - p,
	187	"pf_sample %d %d %d %d",
	188	ev->data.pf_sample, ev->data.prop_err,
	189	ev->data.int_err, ev->data.der_err);
	190	break;
	191	}
	192	p += snprintf(pb + p, length - p, "\n");
	193
	194	spin_unlock_irqrestore(&events->lock, status);
	195
	196	if (copy_to_user(buf, pb, p))
	197	return -EFAULT;
	198
	199	return p;
	200	}
	201
	202	#undef RC_PID_PRINT_BUF_SIZE
	203
5ca1b998	204	static const struct file_operations rc_pid_fop_events = {
12446c67 MN	205	.owner = THIS_MODULE,
	206	.read = rate_control_pid_events_read,
	207	.poll = rate_control_pid_events_poll,
	208	.open = rate_control_pid_events_open,
	209	.release = rate_control_pid_events_release,
6038f373	210	.llseek = noop_llseek,
12446c67 MN	211	};
	212
	213	void rate_control_pid_add_sta_debugfs(void priv, void priv_sta,
	214	struct dentry *dir)
	215	{
	216	struct rc_pid_sta_info *spinfo = priv_sta;
	217
	218	spinfo->events_entry = debugfs_create_file("rc_pid_events", S_IRUGO,
	219	dir, spinfo,
	220	&rc_pid_fop_events);
	221	}
	222
	223	void rate_control_pid_remove_sta_debugfs(void priv, void priv_sta)
	224	{
	225	struct rc_pid_sta_info *spinfo = priv_sta;
	226
	227	debugfs_remove(spinfo->events_entry);
	228	}