[GitHub/mt8127/android_kernel_alcatel_ttab.git] / net / atm / mpoa_proc.c

#define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__

#ifdef CONFIG_PROC_FS
#include <linux/errno.h>
#include <linux/kernel.h>
#include <linux/string.h>
#include <linux/mm.h>
#include <linux/module.h>
#include <linux/proc_fs.h>
#include <linux/time.h>
#include <linux/seq_file.h>
#include <linux/uaccess.h>
#include <linux/atmmpc.h>
#include <linux/atm.h>
#include <linux/gfp.h>
#include "mpc.h"
#include "mpoa_caches.h"

/*
 * mpoa_proc.c: Implementation MPOA client's proc
 * file system statistics
 */

#if 1
#define dprintk(format, args...)					\
	printk(KERN_DEBUG "mpoa:%s: " format, __FILE__, ##args)  /* debug */
#else
#define dprintk(format, args...)					\
	do { if (0)							\
		printk(KERN_DEBUG "mpoa:%s: " format, __FILE__, ##args);\
	} while (0)
#endif

#if 0
#define ddprintk(format, args...)					\
	printk(KERN_DEBUG "mpoa:%s: " format, __FILE__, ##args)  /* debug */
#else
#define ddprintk(format, args...)					\
	do { if (0)							\
		printk(KERN_DEBUG "mpoa:%s: " format, __FILE__, ##args);\
	} while (0)
#endif

#define STAT_FILE_NAME "mpc"     /* Our statistic file's name */

extern struct mpoa_client *mpcs;
extern struct proc_dir_entry *atm_proc_root;  /* from proc.c. */

static int proc_mpc_open(struct inode *inode, struct file *file);
static ssize_t proc_mpc_write(struct file *file, const char __user *buff,
			      size_t nbytes, loff_t *ppos);

static int parse_qos(const char *buff);

/*
 *   Define allowed FILE OPERATIONS
 */
static const struct file_operations mpc_file_operations = {
	.owner =	THIS_MODULE,
	.open =		proc_mpc_open,
	.read =		seq_read,
	.llseek =	seq_lseek,
	.write =	proc_mpc_write,
	.release =	seq_release,
};

/*
 * Returns the state of an ingress cache entry as a string
 */
static const char *ingress_state_string(int state)
{
	switch (state) {
	case INGRESS_RESOLVING:
		return "resolving  ";
	case INGRESS_RESOLVED:
		return "resolved   ";
	case INGRESS_INVALID:
		return "invalid    ";
	case INGRESS_REFRESHING:
		return "refreshing ";
	}

	return "";
}

/*
 * Returns the state of an egress cache entry as a string
 */
static const char *egress_state_string(int state)
{
	switch (state) {
	case EGRESS_RESOLVED:
		return "resolved   ";
	case EGRESS_PURGE:
		return "purge      ";
	case EGRESS_INVALID:
		return "invalid    ";
	}

	return "";
}

/*
 * FIXME: mpcs (and per-mpc lists) have no locking whatsoever.
 */

static void *mpc_start(struct seq_file *m, loff_t *pos)
{
	loff_t l = *pos;
	struct mpoa_client *mpc;

	if (!l--)
		return SEQ_START_TOKEN;
	for (mpc = mpcs; mpc; mpc = mpc->next)
		if (!l--)
			return mpc;
	return NULL;
}

static void *mpc_next(struct seq_file *m, void *v, loff_t *pos)
{
	struct mpoa_client *p = v;
	(*pos)++;
	return v == SEQ_START_TOKEN ? mpcs : p->next;
}

static void mpc_stop(struct seq_file *m, void *v)
{
}

/*
 * READING function - called when the /proc/atm/mpoa file is read from.
 */
static int mpc_show(struct seq_file *m, void *v)
{
	struct mpoa_client *mpc = v;
	int i;
	in_cache_entry *in_entry;
	eg_cache_entry *eg_entry;
	struct timeval now;
	unsigned char ip_string[16];

	if (v == SEQ_START_TOKEN) {
		atm_mpoa_disp_qos(m);
		return 0;
	}

	seq_printf(m, "\nInterface %d:\n\n", mpc->dev_num);
	seq_printf(m, "Ingress Entries:\nIP address      State      Holding time  Packets fwded  VPI  VCI\n");
	do_gettimeofday(&now);

	for (in_entry = mpc->in_cache; in_entry; in_entry = in_entry->next) {
		sprintf(ip_string, "%pI4", &in_entry->ctrl_info.in_dst_ip);
		seq_printf(m, "%-16s%s%-14lu%-12u",
			   ip_string,
			   ingress_state_string(in_entry->entry_state),
			   in_entry->ctrl_info.holding_time -
			   (now.tv_sec-in_entry->tv.tv_sec),
			   in_entry->packets_fwded);
		if (in_entry->shortcut)
			seq_printf(m, "   %-3d  %-3d",
				   in_entry->shortcut->vpi,
				   in_entry->shortcut->vci);
		seq_printf(m, "\n");
	}

	seq_printf(m, "\n");
	seq_printf(m, "Egress Entries:\nIngress MPC ATM addr\nCache-id        State      Holding time  Packets recvd  Latest IP addr   VPI VCI\n");
	for (eg_entry = mpc->eg_cache; eg_entry; eg_entry = eg_entry->next) {
		unsigned char *p = eg_entry->ctrl_info.in_MPC_data_ATM_addr;
		for (i = 0; i < ATM_ESA_LEN; i++)
			seq_printf(m, "%02x", p[i]);
		seq_printf(m, "\n%-16lu%s%-14lu%-15u",
			   (unsigned long)ntohl(eg_entry->ctrl_info.cache_id),
			   egress_state_string(eg_entry->entry_state),
			   (eg_entry->ctrl_info.holding_time -
			    (now.tv_sec-eg_entry->tv.tv_sec)),
			   eg_entry->packets_rcvd);

		/* latest IP address */
		sprintf(ip_string, "%pI4", &eg_entry->latest_ip_addr);
		seq_printf(m, "%-16s", ip_string);

		if (eg_entry->shortcut)
			seq_printf(m, " %-3d %-3d",
				   eg_entry->shortcut->vpi,
				   eg_entry->shortcut->vci);
		seq_printf(m, "\n");
	}
	seq_printf(m, "\n");
	return 0;
}

static const struct seq_operations mpc_op = {
	.start =	mpc_start,
	.next =		mpc_next,
	.stop =		mpc_stop,
	.show =		mpc_show
};

static int proc_mpc_open(struct inode *inode, struct file *file)
{
	return seq_open(file, &mpc_op);
}

static ssize_t proc_mpc_write(struct file *file, const char __user *buff,
			      size_t nbytes, loff_t *ppos)
{
	char *page, *p;
	unsigned int len;

	if (nbytes == 0)
		return 0;

	if (nbytes >= PAGE_SIZE)
		nbytes = PAGE_SIZE-1;

	page = (char *)__get_free_page(GFP_KERNEL);
	if (!page)
		return -ENOMEM;

	for (p = page, len = 0; len < nbytes; p++, len++) {
		if (get_user(*p, buff++)) {
			free_page((unsigned long)page);
			return -EFAULT;
		}
		if (*p == '\0' || *p == '\n')
			break;
	}

	*p = '\0';

	if (!parse_qos(page))
		printk("mpoa: proc_mpc_write: could not parse '%s'\n", page);

	free_page((unsigned long)page);

	return len;
}

static int parse_qos(const char *buff)
{
	/* possible lines look like this
	 * add 130.230.54.142 tx=max_pcr,max_sdu rx=max_pcr,max_sdu
	 */
	unsigned char ip[4];
	int tx_pcr, tx_sdu, rx_pcr, rx_sdu;
	__be32 ipaddr;
	struct atm_qos qos;

	memset(&qos, 0, sizeof(struct atm_qos));

	if (sscanf(buff, "del %hhu.%hhu.%hhu.%hhu",
			ip, ip+1, ip+2, ip+3) == 4) {
		ipaddr = *(__be32 *)ip;
		return atm_mpoa_delete_qos(atm_mpoa_search_qos(ipaddr));
	}

	if (sscanf(buff, "add %hhu.%hhu.%hhu.%hhu tx=%d,%d rx=tx",
			ip, ip+1, ip+2, ip+3, &tx_pcr, &tx_sdu) == 6) {
		rx_pcr = tx_pcr;
		rx_sdu = tx_sdu;
	} else if (sscanf(buff, "add %hhu.%hhu.%hhu.%hhu tx=%d,%d rx=%d,%d",
		ip, ip+1, ip+2, ip+3, &tx_pcr, &tx_sdu, &rx_pcr, &rx_sdu) != 8)
		return 0;

	ipaddr = *(__be32 *)ip;
	qos.txtp.traffic_class = ATM_CBR;
	qos.txtp.max_pcr = tx_pcr;
	qos.txtp.max_sdu = tx_sdu;
	qos.rxtp.traffic_class = ATM_CBR;
	qos.rxtp.max_pcr = rx_pcr;
	qos.rxtp.max_sdu = rx_sdu;
	qos.aal = ATM_AAL5;
	dprintk("parse_qos(): setting qos paramameters to tx=%d,%d rx=%d,%d\n",
		qos.txtp.max_pcr, qos.txtp.max_sdu,
		qos.rxtp.max_pcr, qos.rxtp.max_sdu);

	atm_mpoa_add_qos(ipaddr, &qos);
	return 1;
}

/*
 * INITIALIZATION function - called when module is initialized/loaded.
 */
int mpc_proc_init(void)
{
	struct proc_dir_entry *p;

	p = proc_create(STAT_FILE_NAME, 0, atm_proc_root, &mpc_file_operations);
	if (!p) {
		pr_err("Unable to initialize /proc/atm/%s\n", STAT_FILE_NAME);
		return -ENOMEM;
	}
	return 0;
}

/*
 * DELETING function - called when module is removed.
 */
void mpc_proc_clean(void)
{
	remove_proc_entry(STAT_FILE_NAME, atm_proc_root);
}

#endif /* CONFIG_PROC_FS */
Commit	Line	Data
99824461	1	#define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__
1da177e4 LT	2
	3	#ifdef CONFIG_PROC_FS
	4	#include <linux/errno.h>
	5	#include <linux/kernel.h>
f7d57453	6	#include <linux/string.h>
1da177e4 LT	7	#include <linux/mm.h>
	8	#include <linux/module.h>
	9	#include <linux/proc_fs.h>
	10	#include <linux/time.h>
	11	#include <linux/seq_file.h>
f1e10049	12	#include <linux/uaccess.h>
1da177e4 LT	13	#include <linux/atmmpc.h>
1da177e4 LT	14	#include <linux/atm.h>
5a0e3ad6	15	#include <linux/gfp.h>
1da177e4 LT	16	#include "mpc.h"
	17	#include "mpoa_caches.h"
	18
	19	/*
	20	* mpoa_proc.c: Implementation MPOA client's proc
f7d57453	21	* file system statistics
1da177e4 LT	22	*/
	23
	24	#if 1
b50c2ea7 JP	25	#define dprintk(format, args...) \
b50c2ea7 JP	26	printk(KERN_DEBUG "mpoa:%s: " format, __FILE__, ##args) /* debug */
1da177e4	27	#else
b50c2ea7 JP	28	#define dprintk(format, args...) \
	29	do { if (0) \
	30	printk(KERN_DEBUG "mpoa:%s: " format, __FILE__, ##args);\
	31	} while (0)
	32	#endif
	33
	34	#if 0
	35	#define ddprintk(format, args...) \
	36	printk(KERN_DEBUG "mpoa:%s: " format, __FILE__, ##args) /* debug */
	37	#else
	38	#define ddprintk(format, args...) \
	39	do { if (0) \
	40	printk(KERN_DEBUG "mpoa:%s: " format, __FILE__, ##args);\
	41	} while (0)
1da177e4 LT	42	#endif
	43
	44	#define STAT_FILE_NAME "mpc" /* Our statistic file's name */
	45
	46	extern struct mpoa_client *mpcs;
	47	extern struct proc_dir_entry atm_proc_root; / from proc.c. */
	48
	49	static int proc_mpc_open(struct inode inode, struct file file);
	50	static ssize_t proc_mpc_write(struct file file, const char __user buff,
f7d57453	51	size_t nbytes, loff_t *ppos);
1da177e4 LT	52
	53	static int parse_qos(const char *buff);
	54
	55	/*
	56	* Define allowed FILE OPERATIONS
	57	*/
9a32144e	58	static const struct file_operations mpc_file_operations = {
1da177e4 LT	59	.owner = THIS_MODULE,
	60	.open = proc_mpc_open,
	61	.read = seq_read,
	62	.llseek = seq_lseek,
	63	.write = proc_mpc_write,
	64	.release = seq_release,
	65	};
	66
	67	/*
	68	* Returns the state of an ingress cache entry as a string
	69	*/
f1e10049 JP	70	static const char *ingress_state_string(int state)
	71	{
	72	switch (state) {
1da177e4	73	case INGRESS_RESOLVING:
f7d57453	74	return "resolving ";
1da177e4	75	case INGRESS_RESOLVED:
f7d57453	76	return "resolved ";
1da177e4	77	case INGRESS_INVALID:
f7d57453	78	return "invalid ";
1da177e4	79	case INGRESS_REFRESHING:
f7d57453	80	return "refreshing ";
1da177e4	81	}
f1e10049 JP	82
f1e10049 JP	83	return "";
1da177e4 LT	84	}
	85
	86	/*
	87	* Returns the state of an egress cache entry as a string
	88	*/
f1e10049 JP	89	static const char *egress_state_string(int state)
	90	{
	91	switch (state) {
1da177e4	92	case EGRESS_RESOLVED:
f7d57453	93	return "resolved ";
1da177e4	94	case EGRESS_PURGE:
f7d57453	95	return "purge ";
1da177e4	96	case EGRESS_INVALID:
f7d57453	97	return "invalid ";
1da177e4	98	}
f1e10049 JP	99
f1e10049 JP	100	return "";
1da177e4 LT	101	}
	102
	103	/*
	104	* FIXME: mpcs (and per-mpc lists) have no locking whatsoever.
	105	*/
	106
	107	static void mpc_start(struct seq_file m, loff_t *pos)
	108	{
	109	loff_t l = *pos;
	110	struct mpoa_client *mpc;
	111
	112	if (!l--)
	113	return SEQ_START_TOKEN;
	114	for (mpc = mpcs; mpc; mpc = mpc->next)
	115	if (!l--)
	116	return mpc;
	117	return NULL;
	118	}
	119
	120	static void mpc_next(struct seq_file m, void v, loff_t pos)
	121	{
	122	struct mpoa_client *p = v;
	123	(*pos)++;
	124	return v == SEQ_START_TOKEN ? mpcs : p->next;
	125	}
	126
	127	static void mpc_stop(struct seq_file m, void v)
	128	{
	129	}
	130
	131	/*
	132	* READING function - called when the /proc/atm/mpoa file is read from.
	133	*/
	134	static int mpc_show(struct seq_file m, void v)
	135	{
	136	struct mpoa_client *mpc = v;
1da177e4 LT	137	int i;
	138	in_cache_entry *in_entry;
	139	eg_cache_entry *eg_entry;
	140	struct timeval now;
	141	unsigned char ip_string[16];
	142
	143	if (v == SEQ_START_TOKEN) {
	144	atm_mpoa_disp_qos(m);
	145	return 0;
	146	}
	147
f7d57453	148	seq_printf(m, "\nInterface %d:\n\n", mpc->dev_num);
1da177e4 LT	149	seq_printf(m, "Ingress Entries:\nIP address State Holding time Packets fwded VPI VCI\n");
	150	do_gettimeofday(&now);
	151
	152	for (in_entry = mpc->in_cache; in_entry; in_entry = in_entry->next) {
f1e10049	153	sprintf(ip_string, "%pI4", &in_entry->ctrl_info.in_dst_ip);
1da177e4	154	seq_printf(m, "%-16s%s%-14lu%-12u",
f1e10049 JP	155	ip_string,
	156	ingress_state_string(in_entry->entry_state),
	157	in_entry->ctrl_info.holding_time -
	158	(now.tv_sec-in_entry->tv.tv_sec),
	159	in_entry->packets_fwded);
1da177e4	160	if (in_entry->shortcut)
f1e10049 JP	161	seq_printf(m, " %-3d %-3d",
	162	in_entry->shortcut->vpi,
	163	in_entry->shortcut->vci);
1da177e4 LT	164	seq_printf(m, "\n");
	165	}
	166
	167	seq_printf(m, "\n");
	168	seq_printf(m, "Egress Entries:\nIngress MPC ATM addr\nCache-id State Holding time Packets recvd Latest IP addr VPI VCI\n");
	169	for (eg_entry = mpc->eg_cache; eg_entry; eg_entry = eg_entry->next) {
	170	unsigned char *p = eg_entry->ctrl_info.in_MPC_data_ATM_addr;
f1e10049	171	for (i = 0; i < ATM_ESA_LEN; i++)
1da177e4 LT	172	seq_printf(m, "%02x", p[i]);
	173	seq_printf(m, "\n%-16lu%s%-14lu%-15u",
	174	(unsigned long)ntohl(eg_entry->ctrl_info.cache_id),
	175	egress_state_string(eg_entry->entry_state),
f1e10049 JP	176	(eg_entry->ctrl_info.holding_time -
f1e10049 JP	177	(now.tv_sec-eg_entry->tv.tv_sec)),
1da177e4	178	eg_entry->packets_rcvd);
f7d57453	179
1da177e4	180	/* latest IP address */
f1e10049	181	sprintf(ip_string, "%pI4", &eg_entry->latest_ip_addr);
1da177e4 LT	182	seq_printf(m, "%-16s", ip_string);
	183
	184	if (eg_entry->shortcut)
f1e10049 JP	185	seq_printf(m, " %-3d %-3d",
	186	eg_entry->shortcut->vpi,
	187	eg_entry->shortcut->vci);
1da177e4 LT	188	seq_printf(m, "\n");
	189	}
	190	seq_printf(m, "\n");
	191	return 0;
	192	}
	193
56b3d975	194	static const struct seq_operations mpc_op = {
1da177e4 LT	195	.start = mpc_start,
	196	.next = mpc_next,
	197	.stop = mpc_stop,
	198	.show = mpc_show
	199	};
	200
	201	static int proc_mpc_open(struct inode inode, struct file file)
	202	{
	203	return seq_open(file, &mpc_op);
	204	}
	205
	206	static ssize_t proc_mpc_write(struct file file, const char __user buff,
f7d57453	207	size_t nbytes, loff_t *ppos)
1da177e4	208	{
f7d57453	209	char page, p;
95c96174	210	unsigned int len;
1da177e4	211
f7d57453	212	if (nbytes == 0)
1da177e4 LT	213	return 0;
1da177e4 LT	214
f7d57453	215	if (nbytes >= PAGE_SIZE)
1da177e4 LT	216	nbytes = PAGE_SIZE-1;
1da177e4 LT	217
f7d57453 YH	218	page = (char *)__get_free_page(GFP_KERNEL);
f7d57453 YH	219	if (!page)
1da177e4 LT	220	return -ENOMEM;
1da177e4 LT	221
f7d57453 YH	222	for (p = page, len = 0; len < nbytes; p++, len++) {
f7d57453 YH	223	if (get_user(*p, buff++)) {
1da177e4 LT	224	free_page((unsigned long)page);
	225	return -EFAULT;
	226	}
f7d57453 YH	227	if (p == '\0' \|\| p == '\n')
	228	break;
	229	}
1da177e4	230
f7d57453	231	*p = '\0';
1da177e4 LT	232
1da177e4 LT	233	if (!parse_qos(page))
f7d57453 YH	234	printk("mpoa: proc_mpc_write: could not parse '%s'\n", page);
	235
	236	free_page((unsigned long)page);
1da177e4	237
f7d57453	238	return len;
1da177e4 LT	239	}
	240
	241	static int parse_qos(const char *buff)
	242	{
f7d57453 YH	243	/* possible lines look like this
	244	* add 130.230.54.142 tx=max_pcr,max_sdu rx=max_pcr,max_sdu
	245	*/
	246	unsigned char ip[4];
1da177e4	247	int tx_pcr, tx_sdu, rx_pcr, rx_sdu;
f7d57453 YH	248	__be32 ipaddr;
	249	struct atm_qos qos;
	250
	251	memset(&qos, 0, sizeof(struct atm_qos));
1da177e4 LT	252
	253	if (sscanf(buff, "del %hhu.%hhu.%hhu.%hhu",
	254	ip, ip+1, ip+2, ip+3) == 4) {
30d492da	255	ipaddr = (__be32 )ip;
1da177e4 LT	256	return atm_mpoa_delete_qos(atm_mpoa_search_qos(ipaddr));
	257	}
	258
	259	if (sscanf(buff, "add %hhu.%hhu.%hhu.%hhu tx=%d,%d rx=tx",
	260	ip, ip+1, ip+2, ip+3, &tx_pcr, &tx_sdu) == 6) {
	261	rx_pcr = tx_pcr;
	262	rx_sdu = tx_sdu;
	263	} else if (sscanf(buff, "add %hhu.%hhu.%hhu.%hhu tx=%d,%d rx=%d,%d",
	264	ip, ip+1, ip+2, ip+3, &tx_pcr, &tx_sdu, &rx_pcr, &rx_sdu) != 8)
	265	return 0;
	266
f7d57453	267	ipaddr = (__be32 )ip;
1da177e4 LT	268	qos.txtp.traffic_class = ATM_CBR;
	269	qos.txtp.max_pcr = tx_pcr;
	270	qos.txtp.max_sdu = tx_sdu;
	271	qos.rxtp.traffic_class = ATM_CBR;
	272	qos.rxtp.max_pcr = rx_pcr;
	273	qos.rxtp.max_sdu = rx_sdu;
f7d57453	274	qos.aal = ATM_AAL5;
b50c2ea7 JP	275	dprintk("parse_qos(): setting qos paramameters to tx=%d,%d rx=%d,%d\n",
	276	qos.txtp.max_pcr, qos.txtp.max_sdu,
	277	qos.rxtp.max_pcr, qos.rxtp.max_sdu);
1da177e4 LT	278
	279	atm_mpoa_add_qos(ipaddr, &qos);
	280	return 1;
	281	}
	282
	283	/*
	284	* INITIALIZATION function - called when module is initialized/loaded.
	285	*/
	286	int mpc_proc_init(void)
	287	{
	288	struct proc_dir_entry *p;
	289
16e297b3	290	p = proc_create(STAT_FILE_NAME, 0, atm_proc_root, &mpc_file_operations);
1da177e4	291	if (!p) {
99824461	292	pr_err("Unable to initialize /proc/atm/%s\n", STAT_FILE_NAME);
f7d57453 YH	293	return -ENOMEM;
f7d57453 YH	294	}
1da177e4 LT	295	return 0;
	296	}
	297
	298	/*
	299	* DELETING function - called when module is removed.
	300	*/
	301	void mpc_proc_clean(void)
	302	{
f1e10049	303	remove_proc_entry(STAT_FILE_NAME, atm_proc_root);
1da177e4 LT	304	}
1da177e4 LT	305
1da177e4 LT	306	#endif /* CONFIG_PROC_FS */
	307
	308
	309
	310
	311
	312