[mirror_ubuntu-zesty-kernel.git] / net / irda / irlan / irlan_filter.c

/*********************************************************************
 *
 * Filename:      irlan_filter.c
 * Version:
 * Description:
 * Status:        Experimental.
 * Author:        Dag Brattli <dagb@cs.uit.no>
 * Created at:    Fri Jan 29 11:16:38 1999
 * Modified at:   Sat Oct 30 12:58:45 1999
 * Modified by:   Dag Brattli <dagb@cs.uit.no>
 *
 *     Copyright (c) 1998-1999 Dag Brattli, All Rights Reserved.
 *
 *     This program is free software; you can redistribute it and/or
 *     modify it under the terms of the GNU General Public License as
 *     published by the Free Software Foundation; either version 2 of
 *     the License, or (at your option) any later version.
 *
 *     Neither Dag Brattli nor University of Tromsø admit liability nor
 *     provide warranty for any of this software. This material is
 *     provided "AS-IS" and at no charge.
 *
 ********************************************************************/

#include <linux/skbuff.h>
#include <linux/random.h>
#include <linux/seq_file.h>

#include <net/irda/irlan_common.h>
#include <net/irda/irlan_filter.h>

/*
 * Function irlan_filter_request (self, skb)
 *
 *    Handle filter request from client peer device
 *
 */
void irlan_filter_request(struct irlan_cb *self, struct sk_buff *skb)
{
	IRDA_ASSERT(self != NULL, return;);
	IRDA_ASSERT(self->magic == IRLAN_MAGIC, return;);

	if ((self->provider.filter_type == IRLAN_DIRECTED) &&
	    (self->provider.filter_operation == DYNAMIC))
	{
		pr_debug("Giving peer a dynamic Ethernet address\n");
		self->provider.mac_address[0] = 0x40;
		self->provider.mac_address[1] = 0x00;
		self->provider.mac_address[2] = 0x00;
		self->provider.mac_address[3] = 0x00;

		/* Use arbitration value to generate MAC address */
		if (self->provider.access_type == ACCESS_PEER) {
			self->provider.mac_address[4] =
				self->provider.send_arb_val & 0xff;
			self->provider.mac_address[5] =
				(self->provider.send_arb_val >> 8) & 0xff;
		} else {
			/* Just generate something for now */
			get_random_bytes(self->provider.mac_address+4, 1);
			get_random_bytes(self->provider.mac_address+5, 1);
		}

		skb->data[0] = 0x00; /* Success */
		skb->data[1] = 0x03;
		irlan_insert_string_param(skb, "FILTER_MODE", "NONE");
		irlan_insert_short_param(skb, "MAX_ENTRY", 0x0001);
		irlan_insert_array_param(skb, "FILTER_ENTRY",
					 self->provider.mac_address, 6);
		return;
	}

	if ((self->provider.filter_type == IRLAN_DIRECTED) &&
	    (self->provider.filter_mode == FILTER))
	{
		pr_debug("Directed filter on\n");
		skb->data[0] = 0x00; /* Success */
		skb->data[1] = 0x00;
		return;
	}
	if ((self->provider.filter_type == IRLAN_DIRECTED) &&
	    (self->provider.filter_mode == NONE))
	{
		pr_debug("Directed filter off\n");
		skb->data[0] = 0x00; /* Success */
		skb->data[1] = 0x00;
		return;
	}

	if ((self->provider.filter_type == IRLAN_BROADCAST) &&
	    (self->provider.filter_mode == FILTER))
	{
		pr_debug("Broadcast filter on\n");
		skb->data[0] = 0x00; /* Success */
		skb->data[1] = 0x00;
		return;
	}
	if ((self->provider.filter_type == IRLAN_BROADCAST) &&
	    (self->provider.filter_mode == NONE))
	{
		pr_debug("Broadcast filter off\n");
		skb->data[0] = 0x00; /* Success */
		skb->data[1] = 0x00;
		return;
	}
	if ((self->provider.filter_type == IRLAN_MULTICAST) &&
	    (self->provider.filter_mode == FILTER))
	{
		pr_debug("Multicast filter on\n");
		skb->data[0] = 0x00; /* Success */
		skb->data[1] = 0x00;
		return;
	}
	if ((self->provider.filter_type == IRLAN_MULTICAST) &&
	    (self->provider.filter_mode == NONE))
	{
		pr_debug("Multicast filter off\n");
		skb->data[0] = 0x00; /* Success */
		skb->data[1] = 0x00;
		return;
	}
	if ((self->provider.filter_type == IRLAN_MULTICAST) &&
	    (self->provider.filter_operation == GET))
	{
		pr_debug("Multicast filter get\n");
		skb->data[0] = 0x00; /* Success? */
		skb->data[1] = 0x02;
		irlan_insert_string_param(skb, "FILTER_MODE", "NONE");
		irlan_insert_short_param(skb, "MAX_ENTRY", 16);
		return;
	}
	skb->data[0] = 0x00; /* Command not supported */
	skb->data[1] = 0x00;

	pr_debug("Not implemented!\n");
}

/*
 * Function check_request_param (self, param, value)
 *
 *    Check parameters in request from peer device
 *
 */
void irlan_check_command_param(struct irlan_cb *self, char *param, char *value)
{
	IRDA_ASSERT(self != NULL, return;);
	IRDA_ASSERT(self->magic == IRLAN_MAGIC, return;);

	pr_debug("%s, %s\n", param, value);

	/*
	 *  This is experimental!! DB.
	 */
	 if (strcmp(param, "MODE") == 0) {
		self->use_udata = TRUE;
		return;
	}

	/*
	 *  FILTER_TYPE
	 */
	if (strcmp(param, "FILTER_TYPE") == 0) {
		if (strcmp(value, "DIRECTED") == 0) {
			self->provider.filter_type = IRLAN_DIRECTED;
			return;
		}
		if (strcmp(value, "MULTICAST") == 0) {
			self->provider.filter_type = IRLAN_MULTICAST;
			return;
		}
		if (strcmp(value, "BROADCAST") == 0) {
			self->provider.filter_type = IRLAN_BROADCAST;
			return;
		}
	}
	/*
	 *  FILTER_MODE
	 */
	if (strcmp(param, "FILTER_MODE") == 0) {
		if (strcmp(value, "ALL") == 0) {
			self->provider.filter_mode = ALL;
			return;
		}
		if (strcmp(value, "FILTER") == 0) {
			self->provider.filter_mode = FILTER;
			return;
		}
		if (strcmp(value, "NONE") == 0) {
			self->provider.filter_mode = FILTER;
			return;
		}
	}
	/*
	 *  FILTER_OPERATION
	 */
	if (strcmp(param, "FILTER_OPERATION") == 0) {
		if (strcmp(value, "DYNAMIC") == 0) {
			self->provider.filter_operation = DYNAMIC;
			return;
		}
		if (strcmp(value, "GET") == 0) {
			self->provider.filter_operation = GET;
			return;
		}
	}
}

/*
 * Function irlan_print_filter (filter_type, buf)
 *
 *    Print status of filter. Used by /proc file system
 *
 */
#ifdef CONFIG_PROC_FS
#define MASK2STR(m,s)	{ .mask = m, .str = s }

void irlan_print_filter(struct seq_file *seq, int filter_type)
{
	static struct {
		int mask;
		const char *str;
	} filter_mask2str[] = {
		MASK2STR(IRLAN_DIRECTED,	"DIRECTED"),
		MASK2STR(IRLAN_FUNCTIONAL,	"FUNCTIONAL"),
		MASK2STR(IRLAN_GROUP,		"GROUP"),
		MASK2STR(IRLAN_MAC_FRAME,	"MAC_FRAME"),
		MASK2STR(IRLAN_MULTICAST,	"MULTICAST"),
		MASK2STR(IRLAN_BROADCAST,	"BROADCAST"),
		MASK2STR(IRLAN_IPX_SOCKET,	"IPX_SOCKET"),
		MASK2STR(0,			NULL)
	}, *p;

	for (p = filter_mask2str; p->str; p++) {
		if (filter_type & p->mask)
			seq_printf(seq, "%s ", p->str);
	}
	seq_putc(seq, '\n');
}
#undef MASK2STR
#endif
Commit	Line	Data
1da177e4	1	/*********************************************************************
6819bc2e	2	*
1da177e4	3	* Filename: irlan_filter.c
6819bc2e YH	4	* Version:
6819bc2e YH	5	* Description:
1da177e4 LT	6	* Status: Experimental.
	7	* Author: Dag Brattli <dagb@cs.uit.no>
	8	* Created at: Fri Jan 29 11:16:38 1999
	9	* Modified at: Sat Oct 30 12:58:45 1999
	10	* Modified by: Dag Brattli <dagb@cs.uit.no>
6819bc2e	11	*
1da177e4	12	* Copyright (c) 1998-1999 Dag Brattli, All Rights Reserved.
6819bc2e YH	13	*
	14	* This program is free software; you can redistribute it and/or
	15	* modify it under the terms of the GNU General Public License as
	16	* published by the Free Software Foundation; either version 2 of
1da177e4	17	* the License, or (at your option) any later version.
6819bc2e	18	*
db955170	19	* Neither Dag Brattli nor University of Tromsø admit liability nor
6819bc2e	20	* provide warranty for any of this software. This material is
1da177e4	21	* provided "AS-IS" and at no charge.
6819bc2e	22	*
1da177e4 LT	23	********************************************************************/
	24
	25	#include <linux/skbuff.h>
	26	#include <linux/random.h>
	27	#include <linux/seq_file.h>
	28
	29	#include <net/irda/irlan_common.h>
506e7beb	30	#include <net/irda/irlan_filter.h>
1da177e4 LT	31
	32	/*
	33	* Function irlan_filter_request (self, skb)
	34	*
	35	* Handle filter request from client peer device
	36	*
	37	*/
	38	void irlan_filter_request(struct irlan_cb self, struct sk_buff skb)
	39	{
	40	IRDA_ASSERT(self != NULL, return;);
	41	IRDA_ASSERT(self->magic == IRLAN_MAGIC, return;);
	42
6819bc2e	43	if ((self->provider.filter_type == IRLAN_DIRECTED) &&
1da177e4 LT	44	(self->provider.filter_operation == DYNAMIC))
1da177e4 LT	45	{
955a9d20	46	pr_debug("Giving peer a dynamic Ethernet address\n");
1da177e4 LT	47	self->provider.mac_address[0] = 0x40;
	48	self->provider.mac_address[1] = 0x00;
	49	self->provider.mac_address[2] = 0x00;
	50	self->provider.mac_address[3] = 0x00;
6819bc2e	51
1da177e4 LT	52	/* Use arbitration value to generate MAC address */
1da177e4 LT	53	if (self->provider.access_type == ACCESS_PEER) {
6819bc2e	54	self->provider.mac_address[4] =
1da177e4	55	self->provider.send_arb_val & 0xff;
6819bc2e	56	self->provider.mac_address[5] =
1da177e4 LT	57	(self->provider.send_arb_val >> 8) & 0xff;
	58	} else {
	59	/* Just generate something for now */
	60	get_random_bytes(self->provider.mac_address+4, 1);
	61	get_random_bytes(self->provider.mac_address+5, 1);
	62	}
	63
	64	skb->data[0] = 0x00; /* Success */
	65	skb->data[1] = 0x03;
	66	irlan_insert_string_param(skb, "FILTER_MODE", "NONE");
	67	irlan_insert_short_param(skb, "MAX_ENTRY", 0x0001);
6819bc2e	68	irlan_insert_array_param(skb, "FILTER_ENTRY",
1da177e4 LT	69	self->provider.mac_address, 6);
	70	return;
	71	}
6819bc2e YH	72
6819bc2e YH	73	if ((self->provider.filter_type == IRLAN_DIRECTED) &&
1da177e4 LT	74	(self->provider.filter_mode == FILTER))
1da177e4 LT	75	{
955a9d20	76	pr_debug("Directed filter on\n");
1da177e4 LT	77	skb->data[0] = 0x00; /* Success */
	78	skb->data[1] = 0x00;
	79	return;
	80	}
6819bc2e	81	if ((self->provider.filter_type == IRLAN_DIRECTED) &&
1da177e4 LT	82	(self->provider.filter_mode == NONE))
1da177e4 LT	83	{
955a9d20	84	pr_debug("Directed filter off\n");
1da177e4 LT	85	skb->data[0] = 0x00; /* Success */
	86	skb->data[1] = 0x00;
	87	return;
	88	}
	89
6819bc2e	90	if ((self->provider.filter_type == IRLAN_BROADCAST) &&
1da177e4 LT	91	(self->provider.filter_mode == FILTER))
1da177e4 LT	92	{
955a9d20	93	pr_debug("Broadcast filter on\n");
1da177e4 LT	94	skb->data[0] = 0x00; /* Success */
	95	skb->data[1] = 0x00;
	96	return;
	97	}
6819bc2e	98	if ((self->provider.filter_type == IRLAN_BROADCAST) &&
1da177e4 LT	99	(self->provider.filter_mode == NONE))
1da177e4 LT	100	{
955a9d20	101	pr_debug("Broadcast filter off\n");
1da177e4 LT	102	skb->data[0] = 0x00; /* Success */
	103	skb->data[1] = 0x00;
	104	return;
	105	}
6819bc2e	106	if ((self->provider.filter_type == IRLAN_MULTICAST) &&
1da177e4 LT	107	(self->provider.filter_mode == FILTER))
1da177e4 LT	108	{
955a9d20	109	pr_debug("Multicast filter on\n");
1da177e4 LT	110	skb->data[0] = 0x00; /* Success */
	111	skb->data[1] = 0x00;
	112	return;
	113	}
6819bc2e	114	if ((self->provider.filter_type == IRLAN_MULTICAST) &&
1da177e4 LT	115	(self->provider.filter_mode == NONE))
1da177e4 LT	116	{
955a9d20	117	pr_debug("Multicast filter off\n");
1da177e4 LT	118	skb->data[0] = 0x00; /* Success */
	119	skb->data[1] = 0x00;
	120	return;
	121	}
6819bc2e	122	if ((self->provider.filter_type == IRLAN_MULTICAST) &&
1da177e4 LT	123	(self->provider.filter_operation == GET))
1da177e4 LT	124	{
955a9d20	125	pr_debug("Multicast filter get\n");
1da177e4 LT	126	skb->data[0] = 0x00; /* Success? */
	127	skb->data[1] = 0x02;
	128	irlan_insert_string_param(skb, "FILTER_MODE", "NONE");
	129	irlan_insert_short_param(skb, "MAX_ENTRY", 16);
	130	return;
	131	}
	132	skb->data[0] = 0x00; /* Command not supported */
	133	skb->data[1] = 0x00;
	134
955a9d20	135	pr_debug("Not implemented!\n");
1da177e4 LT	136	}
	137
	138	/*
	139	* Function check_request_param (self, param, value)
	140	*
	141	* Check parameters in request from peer device
	142	*
	143	*/
	144	void irlan_check_command_param(struct irlan_cb self, char param, char *value)
	145	{
1da177e4 LT	146	IRDA_ASSERT(self != NULL, return;);
	147	IRDA_ASSERT(self->magic == IRLAN_MAGIC, return;);
	148
955a9d20	149	pr_debug("%s, %s\n", param, value);
1da177e4 LT	150
	151	/*
	152	* This is experimental!! DB.
	153	*/
	154	if (strcmp(param, "MODE") == 0) {
1da177e4 LT	155	self->use_udata = TRUE;
	156	return;
	157	}
	158
	159	/*
	160	* FILTER_TYPE
	161	*/
	162	if (strcmp(param, "FILTER_TYPE") == 0) {
	163	if (strcmp(value, "DIRECTED") == 0) {
	164	self->provider.filter_type = IRLAN_DIRECTED;
	165	return;
	166	}
	167	if (strcmp(value, "MULTICAST") == 0) {
	168	self->provider.filter_type = IRLAN_MULTICAST;
	169	return;
	170	}
	171	if (strcmp(value, "BROADCAST") == 0) {
	172	self->provider.filter_type = IRLAN_BROADCAST;
	173	return;
	174	}
	175	}
	176	/*
	177	* FILTER_MODE
	178	*/
	179	if (strcmp(param, "FILTER_MODE") == 0) {
	180	if (strcmp(value, "ALL") == 0) {
	181	self->provider.filter_mode = ALL;
	182	return;
	183	}
	184	if (strcmp(value, "FILTER") == 0) {
	185	self->provider.filter_mode = FILTER;
	186	return;
	187	}
	188	if (strcmp(value, "NONE") == 0) {
	189	self->provider.filter_mode = FILTER;
	190	return;
	191	}
	192	}
	193	/*
	194	* FILTER_OPERATION
	195	*/
	196	if (strcmp(param, "FILTER_OPERATION") == 0) {
	197	if (strcmp(value, "DYNAMIC") == 0) {
	198	self->provider.filter_operation = DYNAMIC;
	199	return;
	200	}
	201	if (strcmp(value, "GET") == 0) {
	202	self->provider.filter_operation = GET;
	203	return;
	204	}
	205	}
	206	}
	207
	208	/*
	209	* Function irlan_print_filter (filter_type, buf)
	210	*
	211	* Print status of filter. Used by /proc file system
	212	*
	213	*/
	214	#ifdef CONFIG_PROC_FS
	215	#define MASK2STR(m,s) { .mask = m, .str = s }
	216
	217	void irlan_print_filter(struct seq_file *seq, int filter_type)
	218	{
219	static struct {
220	int mask;
221	const char *str;
222	} filter_mask2str[] = {
223	MASK2STR(IRLAN_DIRECTED, "DIRECTED"),
224	MASK2STR(IRLAN_FUNCTIONAL, "FUNCTIONAL"),
225	MASK2STR(IRLAN_GROUP, "GROUP"),
226	MASK2STR(IRLAN_MAC_FRAME, "MAC_FRAME"),
227	MASK2STR(IRLAN_MULTICAST, "MULTICAST"),
228	MASK2STR(IRLAN_BROADCAST, "BROADCAST"),
229	MASK2STR(IRLAN_IPX_SOCKET, "IPX_SOCKET"),
230	MASK2STR(0, NULL)
231	}, *p;
232
233	for (p = filter_mask2str; p->str; p++) {
234	if (filter_type & p->mask)
235	seq_printf(seq, "%s ", p->str);
236	}
237	seq_putc(seq, '\n');
238	}
239	#undef MASK2STR
240	#endif