pn_dev.c 6.5 KB
Newer Older
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
/*
 * File: pn_dev.c
 *
 * Phonet network device
 *
 * Copyright (C) 2008 Nokia Corporation.
 *
 * Contact: Remi Denis-Courmont <remi.denis-courmont@nokia.com>
 * Original author: Sakari Ailus <sakari.ailus@nokia.com>
 *
 * 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.
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
 * 02110-1301 USA
 */

#include <linux/kernel.h>
#include <linux/net.h>
#include <linux/netdevice.h>
#include <linux/phonet.h>
David S. Miller's avatar
David S. Miller committed
30
#include <linux/proc_fs.h>
31
#include <net/sock.h>
32
#include <net/netns/generic.h>
33
34
#include <net/phonet/pn_dev.h>

35
36
struct phonet_net {
	struct phonet_device_list pndevs;
37
38
};

39
40
41
42
43
44
45
46
int phonet_net_id;

struct phonet_device_list *phonet_device_list(struct net *net)
{
	struct phonet_net *pnn = net_generic(net, phonet_net_id);
	return &pnn->pndevs;
}

47
48
49
/* Allocate new Phonet device. */
static struct phonet_device *__phonet_device_alloc(struct net_device *dev)
{
50
	struct phonet_device_list *pndevs = phonet_device_list(dev_net(dev));
51
52
53
54
55
56
	struct phonet_device *pnd = kmalloc(sizeof(*pnd), GFP_ATOMIC);
	if (pnd == NULL)
		return NULL;
	pnd->netdev = dev;
	bitmap_zero(pnd->addrs, 64);

57
	list_add(&pnd->list, &pndevs->list);
58
59
60
61
62
	return pnd;
}

static struct phonet_device *__phonet_get(struct net_device *dev)
{
63
	struct phonet_device_list *pndevs = phonet_device_list(dev_net(dev));
64
65
	struct phonet_device *pnd;

66
	list_for_each_entry(pnd, &pndevs->list, list) {
67
68
69
70
71
72
		if (pnd->netdev == dev)
			return pnd;
	}
	return NULL;
}

73
static void phonet_device_destroy(struct net_device *dev)
74
{
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
	struct phonet_device_list *pndevs = phonet_device_list(dev_net(dev));
	struct phonet_device *pnd;

	ASSERT_RTNL();

	spin_lock_bh(&pndevs->lock);
	pnd = __phonet_get(dev);
	if (pnd)
		list_del(&pnd->list);
	spin_unlock_bh(&pndevs->lock);

	if (pnd) {
		u8 addr;

		for (addr = find_first_bit(pnd->addrs, 64); addr < 64;
			addr = find_next_bit(pnd->addrs, 64, 1+addr))
			phonet_address_notify(RTM_DELADDR, dev, addr);
		kfree(pnd);
	}
94
95
96
97
}

struct net_device *phonet_device_get(struct net *net)
{
98
	struct phonet_device_list *pndevs = phonet_device_list(net);
99
	struct phonet_device *pnd;
Eric Dumazet's avatar
Eric Dumazet committed
100
	struct net_device *dev = NULL;
101

102
103
	spin_lock_bh(&pndevs->lock);
	list_for_each_entry(pnd, &pndevs->list, list) {
104
105
106
		dev = pnd->netdev;
		BUG_ON(!dev);

107
		if ((dev->reg_state == NETREG_REGISTERED) &&
108
109
110
111
112
113
			((pnd->netdev->flags & IFF_UP)) == IFF_UP)
			break;
		dev = NULL;
	}
	if (dev)
		dev_hold(dev);
114
	spin_unlock_bh(&pndevs->lock);
115
116
117
118
119
	return dev;
}

int phonet_address_add(struct net_device *dev, u8 addr)
{
120
	struct phonet_device_list *pndevs = phonet_device_list(dev_net(dev));
121
122
123
	struct phonet_device *pnd;
	int err = 0;

124
	spin_lock_bh(&pndevs->lock);
125
126
127
128
129
130
131
132
	/* Find or create Phonet-specific device data */
	pnd = __phonet_get(dev);
	if (pnd == NULL)
		pnd = __phonet_device_alloc(dev);
	if (unlikely(pnd == NULL))
		err = -ENOMEM;
	else if (test_and_set_bit(addr >> 2, pnd->addrs))
		err = -EEXIST;
133
	spin_unlock_bh(&pndevs->lock);
134
135
136
137
138
	return err;
}

int phonet_address_del(struct net_device *dev, u8 addr)
{
139
	struct phonet_device_list *pndevs = phonet_device_list(dev_net(dev));
140
141
142
	struct phonet_device *pnd;
	int err = 0;

143
	spin_lock_bh(&pndevs->lock);
144
145
146
	pnd = __phonet_get(dev);
	if (!pnd || !test_and_clear_bit(addr >> 2, pnd->addrs))
		err = -EADDRNOTAVAIL;
147
148
149
150
	else if (bitmap_empty(pnd->addrs, 64)) {
		list_del(&pnd->list);
		kfree(pnd);
	}
151
	spin_unlock_bh(&pndevs->lock);
152
153
154
155
156
157
	return err;
}

/* Gets a source address toward a destination, through a interface. */
u8 phonet_address_get(struct net_device *dev, u8 addr)
{
158
	struct phonet_device_list *pndevs = phonet_device_list(dev_net(dev));
159
160
	struct phonet_device *pnd;

161
	spin_lock_bh(&pndevs->lock);
162
163
164
165
166
167
168
169
170
	pnd = __phonet_get(dev);
	if (pnd) {
		BUG_ON(bitmap_empty(pnd->addrs, 64));

		/* Use same source address as destination, if possible */
		if (!test_bit(addr >> 2, pnd->addrs))
			addr = find_first_bit(pnd->addrs, 64) << 2;
	} else
		addr = PN_NO_ADDR;
171
	spin_unlock_bh(&pndevs->lock);
172
173
174
	return addr;
}

175
int phonet_address_lookup(struct net *net, u8 addr)
176
{
177
	struct phonet_device_list *pndevs = phonet_device_list(net);
178
	struct phonet_device *pnd;
179
	int err = -EADDRNOTAVAIL;
180

181
182
	spin_lock_bh(&pndevs->lock);
	list_for_each_entry(pnd, &pndevs->list, list) {
183
184
185
186
187
188
		/* Don't allow unregistering devices! */
		if ((pnd->netdev->reg_state != NETREG_REGISTERED) ||
				((pnd->netdev->flags & IFF_UP)) != IFF_UP)
			continue;

		if (test_bit(addr >> 2, pnd->addrs)) {
189
190
			err = 0;
			goto found;
191
192
		}
	}
193
194
195
found:
	spin_unlock_bh(&pndevs->lock);
	return err;
196
197
198
199
200
201
202
203
}

/* notify Phonet of device events */
static int phonet_device_notify(struct notifier_block *me, unsigned long what,
				void *arg)
{
	struct net_device *dev = arg;

204
205
	if (what == NETDEV_UNREGISTER)
		phonet_device_destroy(dev);
206
207
208
209
210
211
212
213
214
	return 0;

}

static struct notifier_block phonet_device_notifier = {
	.notifier_call = phonet_device_notify,
	.priority = 0,
};

215
216
217
218
219
220
221
/* Per-namespace Phonet devices handling */
static int phonet_init_net(struct net *net)
{
	struct phonet_net *pnn = kmalloc(sizeof(*pnn), GFP_KERNEL);
	if (!pnn)
		return -ENOMEM;

222
223
224
225
226
	if (!proc_net_fops_create(net, "phonet", 0, &pn_sock_seq_fops)) {
		kfree(pnn);
		return -ENOMEM;
	}

227
228
229
230
231
232
233
234
235
	INIT_LIST_HEAD(&pnn->pndevs.list);
	spin_lock_init(&pnn->pndevs.lock);
	net_assign_generic(net, phonet_net_id, pnn);
	return 0;
}

static void phonet_exit_net(struct net *net)
{
	struct phonet_net *pnn = net_generic(net, phonet_net_id);
236
	struct net_device *dev;
237

238
239
240
241
	rtnl_lock();
	for_each_netdev(net, dev)
		phonet_device_destroy(dev);
	rtnl_unlock();
242
243

	proc_net_remove(net, "phonet");
244
245
246
247
248
249
250
251
	kfree(pnn);
}

static struct pernet_operations phonet_net_ops = {
	.init = phonet_init_net,
	.exit = phonet_exit_net,
};

252
/* Initialize Phonet devices list */
253
int __init phonet_device_init(void)
254
{
255
256
257
	int err = register_pernet_gen_device(&phonet_net_id, &phonet_net_ops);
	if (err)
		return err;
258

259
	register_netdevice_notifier(&phonet_device_notifier);
260
261
262
263
	err = phonet_netlink_register();
	if (err)
		phonet_device_exit();
	return err;
264
265
266
267
268
}

void phonet_device_exit(void)
{
	rtnl_unregister_all(PF_PHONET);
269
	unregister_netdevice_notifier(&phonet_device_notifier);
270
	unregister_pernet_gen_device(phonet_net_id, &phonet_net_ops);
271
}