[GitHub/mt8127/android_kernel_alcatel_ttab.git] / net / ax25 / ax25_dev.c

/*
 * 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.
 *
 * Copyright (C) Jonathan Naylor G4KLX (g4klx@g4klx.demon.co.uk)
 */
#include <linux/errno.h>
#include <linux/types.h>
#include <linux/socket.h>
#include <linux/slab.h>
#include <linux/in.h>
#include <linux/kernel.h>
#include <linux/timer.h>
#include <linux/string.h>
#include <linux/sockios.h>
#include <linux/net.h>
#include <linux/spinlock.h>
#include <net/ax25.h>
#include <linux/inet.h>
#include <linux/netdevice.h>
#include <linux/if_arp.h>
#include <linux/skbuff.h>
#include <net/sock.h>
#include <asm/uaccess.h>
#include <linux/fcntl.h>
#include <linux/mm.h>
#include <linux/interrupt.h>
#include <linux/init.h>

ax25_dev *ax25_dev_list;
DEFINE_SPINLOCK(ax25_dev_lock);

ax25_dev *ax25_addr_ax25dev(ax25_address *addr)
{
	ax25_dev *ax25_dev, *res = NULL;

	spin_lock_bh(&ax25_dev_lock);
	for (ax25_dev = ax25_dev_list; ax25_dev != NULL; ax25_dev = ax25_dev->next)
		if (ax25cmp(addr, (ax25_address *)ax25_dev->dev->dev_addr) == 0) {
			res = ax25_dev;
		}
	spin_unlock_bh(&ax25_dev_lock);

	return res;
}

/*
 *	This is called when an interface is brought up. These are
 *	reasonable defaults.
 */
void ax25_dev_device_up(struct net_device *dev)
{
	ax25_dev *ax25_dev;

	if ((ax25_dev = kzalloc(sizeof(*ax25_dev), GFP_ATOMIC)) == NULL) {
		printk(KERN_ERR "AX.25: ax25_dev_device_up - out of memory\n");
		return;
	}

	dev->ax25_ptr     = ax25_dev;
	ax25_dev->dev     = dev;
	dev_hold(dev);
	ax25_dev->forward = NULL;

	ax25_dev->values[AX25_VALUES_IPDEFMODE] = AX25_DEF_IPDEFMODE;
	ax25_dev->values[AX25_VALUES_AXDEFMODE] = AX25_DEF_AXDEFMODE;
	ax25_dev->values[AX25_VALUES_BACKOFF]   = AX25_DEF_BACKOFF;
	ax25_dev->values[AX25_VALUES_CONMODE]   = AX25_DEF_CONMODE;
	ax25_dev->values[AX25_VALUES_WINDOW]    = AX25_DEF_WINDOW;
	ax25_dev->values[AX25_VALUES_EWINDOW]   = AX25_DEF_EWINDOW;
	ax25_dev->values[AX25_VALUES_T1]        = AX25_DEF_T1;
	ax25_dev->values[AX25_VALUES_T2]        = AX25_DEF_T2;
	ax25_dev->values[AX25_VALUES_T3]        = AX25_DEF_T3;
	ax25_dev->values[AX25_VALUES_IDLE]	= AX25_DEF_IDLE;
	ax25_dev->values[AX25_VALUES_N2]        = AX25_DEF_N2;
	ax25_dev->values[AX25_VALUES_PACLEN]	= AX25_DEF_PACLEN;
	ax25_dev->values[AX25_VALUES_PROTOCOL]  = AX25_DEF_PROTOCOL;
	ax25_dev->values[AX25_VALUES_DS_TIMEOUT]= AX25_DEF_DS_TIMEOUT;

#if defined(CONFIG_AX25_DAMA_SLAVE) || defined(CONFIG_AX25_DAMA_MASTER)
	ax25_ds_setup_timer(ax25_dev);
#endif

	spin_lock_bh(&ax25_dev_lock);
	ax25_dev->next = ax25_dev_list;
	ax25_dev_list  = ax25_dev;
	spin_unlock_bh(&ax25_dev_lock);

	ax25_register_dev_sysctl(ax25_dev);
}

void ax25_dev_device_down(struct net_device *dev)
{
	ax25_dev *s, *ax25_dev;

	if ((ax25_dev = ax25_dev_ax25dev(dev)) == NULL)
		return;

	ax25_unregister_dev_sysctl(ax25_dev);

	spin_lock_bh(&ax25_dev_lock);

#ifdef CONFIG_AX25_DAMA_SLAVE
	ax25_ds_del_timer(ax25_dev);
#endif

	/*
	 *	Remove any packet forwarding that points to this device.
	 */
	for (s = ax25_dev_list; s != NULL; s = s->next)
		if (s->forward == dev)
			s->forward = NULL;

	if ((s = ax25_dev_list) == ax25_dev) {
		ax25_dev_list = s->next;
		spin_unlock_bh(&ax25_dev_lock);
		dev_put(dev);
		kfree(ax25_dev);
		return;
	}

	while (s != NULL && s->next != NULL) {
		if (s->next == ax25_dev) {
			s->next = ax25_dev->next;
			spin_unlock_bh(&ax25_dev_lock);
			dev_put(dev);
			kfree(ax25_dev);
			return;
		}

		s = s->next;
	}
	spin_unlock_bh(&ax25_dev_lock);
	dev->ax25_ptr = NULL;
}

int ax25_fwd_ioctl(unsigned int cmd, struct ax25_fwd_struct *fwd)
{
	ax25_dev *ax25_dev, *fwd_dev;

	if ((ax25_dev = ax25_addr_ax25dev(&fwd->port_from)) == NULL)
		return -EINVAL;

	switch (cmd) {
	case SIOCAX25ADDFWD:
		if ((fwd_dev = ax25_addr_ax25dev(&fwd->port_to)) == NULL)
			return -EINVAL;
		if (ax25_dev->forward != NULL)
			return -EINVAL;
		ax25_dev->forward = fwd_dev->dev;
		break;

	case SIOCAX25DELFWD:
		if (ax25_dev->forward == NULL)
			return -EINVAL;
		ax25_dev->forward = NULL;
		break;

	default:
		return -EINVAL;
	}

	return 0;
}

struct net_device *ax25_fwd_dev(struct net_device *dev)
{
	ax25_dev *ax25_dev;

	if ((ax25_dev = ax25_dev_ax25dev(dev)) == NULL)
		return dev;

	if (ax25_dev->forward == NULL)
		return dev;

	return ax25_dev->forward;
}

/*
 *	Free all memory associated with device structures.
 */
void __exit ax25_dev_free(void)
{
	ax25_dev *s, *ax25_dev;

	spin_lock_bh(&ax25_dev_lock);
	ax25_dev = ax25_dev_list;
	while (ax25_dev != NULL) {
		s        = ax25_dev;
		dev_put(ax25_dev->dev);
		ax25_dev = ax25_dev->next;
		kfree(s);
	}
	ax25_dev_list = NULL;
	spin_unlock_bh(&ax25_dev_lock);
}
Commit	Line	Data
1da177e4 LT	1	/*
	2	* This program is free software; you can redistribute it and/or modify
	3	* it under the terms of the GNU General Public License as published by
	4	* the Free Software Foundation; either version 2 of the License, or
	5	* (at your option) any later version.
	6	*
	7	* Copyright (C) Jonathan Naylor G4KLX (g4klx@g4klx.demon.co.uk)
	8	*/
1da177e4 LT	9	#include <linux/errno.h>
	10	#include <linux/types.h>
	11	#include <linux/socket.h>
5a0e3ad6	12	#include <linux/slab.h>
1da177e4 LT	13	#include <linux/in.h>
1da177e4 LT	14	#include <linux/kernel.h>
1da177e4 LT	15	#include <linux/timer.h>
	16	#include <linux/string.h>
	17	#include <linux/sockios.h>
	18	#include <linux/net.h>
	19	#include <linux/spinlock.h>
	20	#include <net/ax25.h>
	21	#include <linux/inet.h>
	22	#include <linux/netdevice.h>
	23	#include <linux/if_arp.h>
	24	#include <linux/skbuff.h>
	25	#include <net/sock.h>
	26	#include <asm/uaccess.h>
1da177e4 LT	27	#include <linux/fcntl.h>
	28	#include <linux/mm.h>
	29	#include <linux/interrupt.h>
	30	#include <linux/init.h>
	31
	32	ax25_dev *ax25_dev_list;
	33	DEFINE_SPINLOCK(ax25_dev_lock);
	34
	35	ax25_dev ax25_addr_ax25dev(ax25_address addr)
	36	{
	37	ax25_dev ax25_dev, res = NULL;
	38
	39	spin_lock_bh(&ax25_dev_lock);
	40	for (ax25_dev = ax25_dev_list; ax25_dev != NULL; ax25_dev = ax25_dev->next)
	41	if (ax25cmp(addr, (ax25_address *)ax25_dev->dev->dev_addr) == 0) {
	42	res = ax25_dev;
	43	}
	44	spin_unlock_bh(&ax25_dev_lock);
	45
	46	return res;
	47	}
	48
	49	/*
	50	* This is called when an interface is brought up. These are
	51	* reasonable defaults.
	52	*/
	53	void ax25_dev_device_up(struct net_device *dev)
	54	{
	55	ax25_dev *ax25_dev;
	56
1b30dd35	57	if ((ax25_dev = kzalloc(sizeof(*ax25_dev), GFP_ATOMIC)) == NULL) {
1da177e4 LT	58	printk(KERN_ERR "AX.25: ax25_dev_device_up - out of memory\n");
	59	return;
	60	}
	61
1da177e4 LT	62	dev->ax25_ptr = ax25_dev;
	63	ax25_dev->dev = dev;
	64	dev_hold(dev);
	65	ax25_dev->forward = NULL;
	66
	67	ax25_dev->values[AX25_VALUES_IPDEFMODE] = AX25_DEF_IPDEFMODE;
	68	ax25_dev->values[AX25_VALUES_AXDEFMODE] = AX25_DEF_AXDEFMODE;
	69	ax25_dev->values[AX25_VALUES_BACKOFF] = AX25_DEF_BACKOFF;
	70	ax25_dev->values[AX25_VALUES_CONMODE] = AX25_DEF_CONMODE;
	71	ax25_dev->values[AX25_VALUES_WINDOW] = AX25_DEF_WINDOW;
	72	ax25_dev->values[AX25_VALUES_EWINDOW] = AX25_DEF_EWINDOW;
	73	ax25_dev->values[AX25_VALUES_T1] = AX25_DEF_T1;
	74	ax25_dev->values[AX25_VALUES_T2] = AX25_DEF_T2;
	75	ax25_dev->values[AX25_VALUES_T3] = AX25_DEF_T3;
	76	ax25_dev->values[AX25_VALUES_IDLE] = AX25_DEF_IDLE;
	77	ax25_dev->values[AX25_VALUES_N2] = AX25_DEF_N2;
	78	ax25_dev->values[AX25_VALUES_PACLEN] = AX25_DEF_PACLEN;
	79	ax25_dev->values[AX25_VALUES_PROTOCOL] = AX25_DEF_PROTOCOL;
	80	ax25_dev->values[AX25_VALUES_DS_TIMEOUT]= AX25_DEF_DS_TIMEOUT;
	81
	82	#if defined(CONFIG_AX25_DAMA_SLAVE) \|\| defined(CONFIG_AX25_DAMA_MASTER)
e848b583	83	ax25_ds_setup_timer(ax25_dev);
1da177e4 LT	84	#endif
	85
	86	spin_lock_bh(&ax25_dev_lock);
	87	ax25_dev->next = ax25_dev_list;
	88	ax25_dev_list = ax25_dev;
	89	spin_unlock_bh(&ax25_dev_lock);
	90
0ca7a4c8	91	ax25_register_dev_sysctl(ax25_dev);
1da177e4 LT	92	}
	93
	94	void ax25_dev_device_down(struct net_device *dev)
	95	{
	96	ax25_dev s, ax25_dev;
	97
	98	if ((ax25_dev = ax25_dev_ax25dev(dev)) == NULL)
	99	return;
	100
0ca7a4c8	101	ax25_unregister_dev_sysctl(ax25_dev);
1da177e4 LT	102
	103	spin_lock_bh(&ax25_dev_lock);
	104
	105	#ifdef CONFIG_AX25_DAMA_SLAVE
	106	ax25_ds_del_timer(ax25_dev);
	107	#endif
	108
	109	/*
	110	* Remove any packet forwarding that points to this device.
	111	*/
	112	for (s = ax25_dev_list; s != NULL; s = s->next)
	113	if (s->forward == dev)
	114	s->forward = NULL;
	115
	116	if ((s = ax25_dev_list) == ax25_dev) {
	117	ax25_dev_list = s->next;
	118	spin_unlock_bh(&ax25_dev_lock);
	119	dev_put(dev);
	120	kfree(ax25_dev);
1da177e4 LT	121	return;
	122	}
	123
	124	while (s != NULL && s->next != NULL) {
	125	if (s->next == ax25_dev) {
	126	s->next = ax25_dev->next;
	127	spin_unlock_bh(&ax25_dev_lock);
	128	dev_put(dev);
	129	kfree(ax25_dev);
1da177e4 LT	130	return;
	131	}
	132
	133	s = s->next;
	134	}
	135	spin_unlock_bh(&ax25_dev_lock);
	136	dev->ax25_ptr = NULL;
1da177e4 LT	137	}
	138
	139	int ax25_fwd_ioctl(unsigned int cmd, struct ax25_fwd_struct *fwd)
	140	{
	141	ax25_dev ax25_dev, fwd_dev;
	142
	143	if ((ax25_dev = ax25_addr_ax25dev(&fwd->port_from)) == NULL)
	144	return -EINVAL;
	145
	146	switch (cmd) {
	147	case SIOCAX25ADDFWD:
	148	if ((fwd_dev = ax25_addr_ax25dev(&fwd->port_to)) == NULL)
	149	return -EINVAL;
	150	if (ax25_dev->forward != NULL)
	151	return -EINVAL;
	152	ax25_dev->forward = fwd_dev->dev;
	153	break;
	154
	155	case SIOCAX25DELFWD:
	156	if (ax25_dev->forward == NULL)
	157	return -EINVAL;
	158	ax25_dev->forward = NULL;
	159	break;
	160
	161	default:
	162	return -EINVAL;
	163	}
	164
	165	return 0;
	166	}
	167
	168	struct net_device ax25_fwd_dev(struct net_device dev)
	169	{
	170	ax25_dev *ax25_dev;
	171
	172	if ((ax25_dev = ax25_dev_ax25dev(dev)) == NULL)
	173	return dev;
	174
	175	if (ax25_dev->forward == NULL)
	176	return dev;
	177
	178	return ax25_dev->forward;
	179	}
	180
	181	/*
	182	* Free all memory associated with device structures.
	183	*/
	184	void __exit ax25_dev_free(void)
	185	{
	186	ax25_dev s, ax25_dev;
	187
	188	spin_lock_bh(&ax25_dev_lock);
	189	ax25_dev = ax25_dev_list;
	190	while (ax25_dev != NULL) {
	191	s = ax25_dev;
	192	dev_put(ax25_dev->dev);
	193	ax25_dev = ax25_dev->next;
	194	kfree(s);
	195	}
	196	ax25_dev_list = NULL;
	197	spin_unlock_bh(&ax25_dev_lock);
	198	}