[linux-2.6-block.git] / net / ax25 / ax25_dev.c

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