Commit | Line | Data |
---|---|---|
1da177e4 | 1 | /********************************************************************* |
6819bc2e | 2 | * |
1da177e4 LT |
3 | * Filename: irlan_provider.c |
4 | * Version: 0.9 | |
5 | * Description: IrDA LAN Access Protocol Implementation | |
6 | * Status: Experimental. | |
7 | * Author: Dag Brattli <dagb@cs.uit.no> | |
8 | * Created at: Sun Aug 31 20:14:37 1997 | |
9 | * Modified at: Sat Oct 30 12:52:10 1999 | |
10 | * Modified by: Dag Brattli <dagb@cs.uit.no> | |
11 | * Sources: skeleton.c by Donald Becker <becker@CESDIS.gsfc.nasa.gov> | |
12 | * slip.c by Laurence Culhane, <loz@holmes.demon.co.uk> | |
13 | * Fred N. van Kempen, <waltje@uwalt.nl.mugnet.org> | |
6819bc2e YH |
14 | * |
15 | * Copyright (c) 1998-1999 Dag Brattli <dagb@cs.uit.no>, | |
1da177e4 | 16 | * All Rights Reserved. |
6819bc2e YH |
17 | * |
18 | * This program is free software; you can redistribute it and/or | |
19 | * modify it under the terms of the GNU General Public License as | |
20 | * published by the Free Software Foundation; either version 2 of | |
1da177e4 LT |
21 | * the License, or (at your option) any later version. |
22 | * | |
96de0e25 | 23 | * Neither Dag Brattli nor University of Tromsø admit liability nor |
6819bc2e | 24 | * provide warranty for any of this software. This material is |
1da177e4 LT |
25 | * provided "AS-IS" and at no charge. |
26 | * | |
27 | ********************************************************************/ | |
28 | ||
29 | #include <linux/kernel.h> | |
30 | #include <linux/string.h> | |
31 | #include <linux/errno.h> | |
32 | #include <linux/netdevice.h> | |
33 | #include <linux/etherdevice.h> | |
34 | #include <linux/init.h> | |
35 | #include <linux/random.h> | |
36 | #include <linux/bitops.h> | |
37 | ||
38 | #include <asm/system.h> | |
39 | #include <asm/byteorder.h> | |
40 | ||
41 | #include <net/irda/irda.h> | |
42 | #include <net/irda/irttp.h> | |
43 | #include <net/irda/irlmp.h> | |
44 | #include <net/irda/irias_object.h> | |
45 | #include <net/irda/iriap.h> | |
46 | #include <net/irda/timer.h> | |
47 | ||
48 | #include <net/irda/irlan_common.h> | |
49 | #include <net/irda/irlan_eth.h> | |
50 | #include <net/irda/irlan_event.h> | |
51 | #include <net/irda/irlan_provider.h> | |
52 | #include <net/irda/irlan_filter.h> | |
53 | #include <net/irda/irlan_client.h> | |
54 | ||
6819bc2e YH |
55 | static void irlan_provider_connect_indication(void *instance, void *sap, |
56 | struct qos_info *qos, | |
1da177e4 LT |
57 | __u32 max_sdu_size, |
58 | __u8 max_header_size, | |
59 | struct sk_buff *skb); | |
60 | ||
61 | /* | |
62 | * Function irlan_provider_control_data_indication (handle, skb) | |
63 | * | |
64 | * This function gets the data that is received on the control channel | |
65 | * | |
66 | */ | |
6819bc2e YH |
67 | static int irlan_provider_data_indication(void *instance, void *sap, |
68 | struct sk_buff *skb) | |
1da177e4 LT |
69 | { |
70 | struct irlan_cb *self; | |
71 | __u8 code; | |
6819bc2e | 72 | |
1da177e4 | 73 | IRDA_DEBUG(4, "%s()\n", __FUNCTION__ ); |
6819bc2e | 74 | |
1da177e4 LT |
75 | self = (struct irlan_cb *) instance; |
76 | ||
77 | IRDA_ASSERT(self != NULL, return -1;); | |
78 | IRDA_ASSERT(self->magic == IRLAN_MAGIC, return -1;); | |
79 | ||
80 | IRDA_ASSERT(skb != NULL, return -1;); | |
81 | ||
82 | code = skb->data[0]; | |
83 | switch(code) { | |
84 | case CMD_GET_PROVIDER_INFO: | |
85 | IRDA_DEBUG(4, "Got GET_PROVIDER_INFO command!\n"); | |
6819bc2e | 86 | irlan_do_provider_event(self, IRLAN_GET_INFO_CMD, skb); |
1da177e4 LT |
87 | break; |
88 | ||
89 | case CMD_GET_MEDIA_CHAR: | |
90 | IRDA_DEBUG(4, "Got GET_MEDIA_CHAR command!\n"); | |
6819bc2e | 91 | irlan_do_provider_event(self, IRLAN_GET_MEDIA_CMD, skb); |
1da177e4 LT |
92 | break; |
93 | case CMD_OPEN_DATA_CHANNEL: | |
94 | IRDA_DEBUG(4, "Got OPEN_DATA_CHANNEL command!\n"); | |
6819bc2e | 95 | irlan_do_provider_event(self, IRLAN_OPEN_DATA_CMD, skb); |
1da177e4 LT |
96 | break; |
97 | case CMD_FILTER_OPERATION: | |
98 | IRDA_DEBUG(4, "Got FILTER_OPERATION command!\n"); | |
99 | irlan_do_provider_event(self, IRLAN_FILTER_CONFIG_CMD, skb); | |
100 | break; | |
101 | case CMD_RECONNECT_DATA_CHAN: | |
102 | IRDA_DEBUG(2, "%s(), Got RECONNECT_DATA_CHAN command\n", __FUNCTION__ ); | |
103 | IRDA_DEBUG(2, "%s(), NOT IMPLEMENTED\n", __FUNCTION__ ); | |
104 | break; | |
105 | case CMD_CLOSE_DATA_CHAN: | |
106 | IRDA_DEBUG(2, "Got CLOSE_DATA_CHAN command!\n"); | |
107 | IRDA_DEBUG(2, "%s(), NOT IMPLEMENTED\n", __FUNCTION__ ); | |
108 | break; | |
109 | default: | |
110 | IRDA_DEBUG(2, "%s(), Unknown command!\n", __FUNCTION__ ); | |
111 | break; | |
112 | } | |
113 | return 0; | |
114 | } | |
115 | ||
116 | /* | |
117 | * Function irlan_provider_connect_indication (handle, skb, priv) | |
118 | * | |
119 | * Got connection from peer IrLAN client | |
120 | * | |
121 | */ | |
6819bc2e | 122 | static void irlan_provider_connect_indication(void *instance, void *sap, |
1da177e4 | 123 | struct qos_info *qos, |
6819bc2e | 124 | __u32 max_sdu_size, |
1da177e4 LT |
125 | __u8 max_header_size, |
126 | struct sk_buff *skb) | |
127 | { | |
128 | struct irlan_cb *self; | |
129 | struct tsap_cb *tsap; | |
130 | __u32 saddr, daddr; | |
131 | ||
132 | IRDA_DEBUG(0, "%s()\n", __FUNCTION__ ); | |
6819bc2e | 133 | |
1da177e4 LT |
134 | self = (struct irlan_cb *) instance; |
135 | tsap = (struct tsap_cb *) sap; | |
6819bc2e | 136 | |
1da177e4 LT |
137 | IRDA_ASSERT(self != NULL, return;); |
138 | IRDA_ASSERT(self->magic == IRLAN_MAGIC, return;); | |
6819bc2e | 139 | |
1da177e4 LT |
140 | IRDA_ASSERT(tsap == self->provider.tsap_ctrl,return;); |
141 | IRDA_ASSERT(self->provider.state == IRLAN_IDLE, return;); | |
142 | ||
143 | daddr = irttp_get_daddr(tsap); | |
144 | saddr = irttp_get_saddr(tsap); | |
145 | self->provider.max_sdu_size = max_sdu_size; | |
146 | self->provider.max_header_size = max_header_size; | |
147 | ||
148 | irlan_do_provider_event(self, IRLAN_CONNECT_INDICATION, NULL); | |
149 | ||
6819bc2e | 150 | /* |
1da177e4 | 151 | * If we are in peer mode, the client may not have got the discovery |
6819bc2e YH |
152 | * indication it needs to make progress. If the client is still in |
153 | * IDLE state, we must kick it. | |
1da177e4 | 154 | */ |
6819bc2e YH |
155 | if ((self->provider.access_type == ACCESS_PEER) && |
156 | (self->client.state == IRLAN_IDLE)) | |
1da177e4 LT |
157 | { |
158 | irlan_client_wakeup(self, self->saddr, self->daddr); | |
159 | } | |
160 | } | |
161 | ||
162 | /* | |
163 | * Function irlan_provider_connect_response (handle) | |
164 | * | |
165 | * Accept incoming connection | |
166 | * | |
167 | */ | |
168 | void irlan_provider_connect_response(struct irlan_cb *self, | |
169 | struct tsap_cb *tsap) | |
170 | { | |
171 | IRDA_ASSERT(self != NULL, return;); | |
172 | IRDA_ASSERT(self->magic == IRLAN_MAGIC, return;); | |
173 | ||
174 | /* Just accept */ | |
175 | irttp_connect_response(tsap, IRLAN_MTU, NULL); | |
176 | } | |
177 | ||
6819bc2e YH |
178 | static void irlan_provider_disconnect_indication(void *instance, void *sap, |
179 | LM_REASON reason, | |
180 | struct sk_buff *userdata) | |
1da177e4 LT |
181 | { |
182 | struct irlan_cb *self; | |
183 | struct tsap_cb *tsap; | |
184 | ||
185 | IRDA_DEBUG(4, "%s(), reason=%d\n", __FUNCTION__ , reason); | |
6819bc2e | 186 | |
1da177e4 LT |
187 | self = (struct irlan_cb *) instance; |
188 | tsap = (struct tsap_cb *) sap; | |
189 | ||
190 | IRDA_ASSERT(self != NULL, return;); | |
6819bc2e | 191 | IRDA_ASSERT(self->magic == IRLAN_MAGIC, return;); |
1da177e4 LT |
192 | IRDA_ASSERT(tsap != NULL, return;); |
193 | IRDA_ASSERT(tsap->magic == TTP_TSAP_MAGIC, return;); | |
6819bc2e | 194 | |
1da177e4 | 195 | IRDA_ASSERT(tsap == self->provider.tsap_ctrl, return;); |
6819bc2e | 196 | |
1da177e4 LT |
197 | irlan_do_provider_event(self, IRLAN_LMP_DISCONNECT, NULL); |
198 | } | |
199 | ||
200 | /* | |
201 | * Function irlan_parse_open_data_cmd (self, skb) | |
202 | * | |
6819bc2e | 203 | * |
1da177e4 LT |
204 | * |
205 | */ | |
206 | int irlan_parse_open_data_cmd(struct irlan_cb *self, struct sk_buff *skb) | |
207 | { | |
208 | int ret; | |
6819bc2e | 209 | |
1da177e4 LT |
210 | ret = irlan_provider_parse_command(self, CMD_OPEN_DATA_CHANNEL, skb); |
211 | ||
212 | /* Open data channel */ | |
213 | irlan_open_data_tsap(self); | |
214 | ||
215 | return ret; | |
216 | } | |
217 | ||
218 | /* | |
219 | * Function parse_command (skb) | |
220 | * | |
6819bc2e | 221 | * Extract all parameters from received buffer, then feed them to |
1da177e4 LT |
222 | * check_params for parsing |
223 | * | |
224 | */ | |
225 | int irlan_provider_parse_command(struct irlan_cb *self, int cmd, | |
6819bc2e | 226 | struct sk_buff *skb) |
1da177e4 LT |
227 | { |
228 | __u8 *frame; | |
229 | __u8 *ptr; | |
230 | int count; | |
231 | __u16 val_len; | |
232 | int i; | |
233 | char *name; | |
6819bc2e | 234 | char *value; |
1da177e4 | 235 | int ret = RSP_SUCCESS; |
6819bc2e | 236 | |
1da177e4 | 237 | IRDA_ASSERT(skb != NULL, return -RSP_PROTOCOL_ERROR;); |
6819bc2e | 238 | |
1da177e4 LT |
239 | IRDA_DEBUG(4, "%s(), skb->len=%d\n", __FUNCTION__ , (int)skb->len); |
240 | ||
241 | IRDA_ASSERT(self != NULL, return -RSP_PROTOCOL_ERROR;); | |
242 | IRDA_ASSERT(self->magic == IRLAN_MAGIC, return -RSP_PROTOCOL_ERROR;); | |
6819bc2e | 243 | |
1da177e4 LT |
244 | if (!skb) |
245 | return -RSP_PROTOCOL_ERROR; | |
246 | ||
247 | frame = skb->data; | |
248 | ||
249 | name = kmalloc(255, GFP_ATOMIC); | |
250 | if (!name) | |
251 | return -RSP_INSUFFICIENT_RESOURCES; | |
252 | value = kmalloc(1016, GFP_ATOMIC); | |
253 | if (!value) { | |
254 | kfree(name); | |
255 | return -RSP_INSUFFICIENT_RESOURCES; | |
256 | } | |
257 | ||
258 | /* How many parameters? */ | |
259 | count = frame[1]; | |
260 | ||
261 | IRDA_DEBUG(4, "Got %d parameters\n", count); | |
6819bc2e | 262 | |
1da177e4 | 263 | ptr = frame+2; |
6819bc2e | 264 | |
1da177e4 | 265 | /* For all parameters */ |
6819bc2e | 266 | for (i=0; i<count;i++) { |
1da177e4 LT |
267 | ret = irlan_extract_param(ptr, name, value, &val_len); |
268 | if (ret < 0) { | |
269 | IRDA_DEBUG(2, "%s(), IrLAN, Error!\n", __FUNCTION__ ); | |
270 | break; | |
271 | } | |
272 | ptr+=ret; | |
273 | ret = RSP_SUCCESS; | |
274 | irlan_check_command_param(self, name, value); | |
275 | } | |
276 | /* Cleanup */ | |
277 | kfree(name); | |
278 | kfree(value); | |
279 | ||
280 | return ret; | |
281 | } | |
282 | ||
283 | /* | |
284 | * Function irlan_provider_send_reply (self, info) | |
285 | * | |
286 | * Send reply to query to peer IrLAN layer | |
287 | * | |
288 | */ | |
6819bc2e | 289 | void irlan_provider_send_reply(struct irlan_cb *self, int command, |
1da177e4 LT |
290 | int ret_code) |
291 | { | |
292 | struct sk_buff *skb; | |
293 | ||
294 | IRDA_DEBUG(4, "%s()\n", __FUNCTION__ ); | |
295 | ||
296 | IRDA_ASSERT(self != NULL, return;); | |
297 | IRDA_ASSERT(self->magic == IRLAN_MAGIC, return;); | |
298 | ||
1b0fee7d SO |
299 | skb = alloc_skb(IRLAN_MAX_HEADER + IRLAN_CMD_HEADER + |
300 | /* Bigger param length comes from CMD_GET_MEDIA_CHAR */ | |
301 | IRLAN_STRING_PARAMETER_LEN("FILTER_TYPE", "DIRECTED") + | |
302 | IRLAN_STRING_PARAMETER_LEN("FILTER_TYPE", "BORADCAST") + | |
303 | IRLAN_STRING_PARAMETER_LEN("FILTER_TYPE", "MULTICAST") + | |
304 | IRLAN_STRING_PARAMETER_LEN("ACCESS_TYPE", "HOSTED"), | |
305 | GFP_ATOMIC); | |
306 | ||
1da177e4 LT |
307 | if (!skb) |
308 | return; | |
309 | ||
310 | /* Reserve space for TTP, LMP, and LAP header */ | |
311 | skb_reserve(skb, self->provider.max_header_size); | |
312 | skb_put(skb, 2); | |
6819bc2e | 313 | |
1da177e4 LT |
314 | switch (command) { |
315 | case CMD_GET_PROVIDER_INFO: | |
316 | skb->data[0] = 0x00; /* Success */ | |
317 | skb->data[1] = 0x02; /* 2 parameters */ | |
318 | switch (self->media) { | |
319 | case MEDIA_802_3: | |
320 | irlan_insert_string_param(skb, "MEDIA", "802.3"); | |
321 | break; | |
322 | case MEDIA_802_5: | |
323 | irlan_insert_string_param(skb, "MEDIA", "802.5"); | |
324 | break; | |
325 | default: | |
326 | IRDA_DEBUG(2, "%s(), unknown media type!\n", __FUNCTION__ ); | |
327 | break; | |
328 | } | |
329 | irlan_insert_short_param(skb, "IRLAN_VER", 0x0101); | |
330 | break; | |
331 | ||
332 | case CMD_GET_MEDIA_CHAR: | |
333 | skb->data[0] = 0x00; /* Success */ | |
334 | skb->data[1] = 0x05; /* 5 parameters */ | |
335 | irlan_insert_string_param(skb, "FILTER_TYPE", "DIRECTED"); | |
336 | irlan_insert_string_param(skb, "FILTER_TYPE", "BROADCAST"); | |
337 | irlan_insert_string_param(skb, "FILTER_TYPE", "MULTICAST"); | |
338 | ||
339 | switch (self->provider.access_type) { | |
340 | case ACCESS_DIRECT: | |
341 | irlan_insert_string_param(skb, "ACCESS_TYPE", "DIRECT"); | |
342 | break; | |
343 | case ACCESS_PEER: | |
344 | irlan_insert_string_param(skb, "ACCESS_TYPE", "PEER"); | |
345 | break; | |
346 | case ACCESS_HOSTED: | |
347 | irlan_insert_string_param(skb, "ACCESS_TYPE", "HOSTED"); | |
348 | break; | |
349 | default: | |
350 | IRDA_DEBUG(2, "%s(), Unknown access type\n", __FUNCTION__ ); | |
351 | break; | |
352 | } | |
353 | irlan_insert_short_param(skb, "MAX_FRAME", 0x05ee); | |
354 | break; | |
355 | case CMD_OPEN_DATA_CHANNEL: | |
356 | skb->data[0] = 0x00; /* Success */ | |
357 | if (self->provider.send_arb_val) { | |
358 | skb->data[1] = 0x03; /* 3 parameters */ | |
6819bc2e | 359 | irlan_insert_short_param(skb, "CON_ARB", |
1da177e4 LT |
360 | self->provider.send_arb_val); |
361 | } else | |
362 | skb->data[1] = 0x02; /* 2 parameters */ | |
363 | irlan_insert_byte_param(skb, "DATA_CHAN", self->stsap_sel_data); | |
1b0fee7d | 364 | irlan_insert_string_param(skb, "RECONNECT_KEY", "LINUX RULES!"); |
1da177e4 LT |
365 | break; |
366 | case CMD_FILTER_OPERATION: | |
367 | irlan_filter_request(self, skb); | |
368 | break; | |
369 | default: | |
370 | IRDA_DEBUG(2, "%s(), Unknown command!\n", __FUNCTION__ ); | |
371 | break; | |
372 | } | |
373 | ||
374 | irttp_data_request(self->provider.tsap_ctrl, skb); | |
375 | } | |
376 | ||
377 | /* | |
378 | * Function irlan_provider_register(void) | |
379 | * | |
380 | * Register provider support so we can accept incoming connections. | |
6819bc2e | 381 | * |
1da177e4 LT |
382 | */ |
383 | int irlan_provider_open_ctrl_tsap(struct irlan_cb *self) | |
384 | { | |
385 | struct tsap_cb *tsap; | |
386 | notify_t notify; | |
6819bc2e | 387 | |
1da177e4 LT |
388 | IRDA_DEBUG(4, "%s()\n", __FUNCTION__ ); |
389 | ||
390 | IRDA_ASSERT(self != NULL, return -1;); | |
391 | IRDA_ASSERT(self->magic == IRLAN_MAGIC, return -1;); | |
392 | ||
393 | /* Check if already open */ | |
394 | if (self->provider.tsap_ctrl) | |
395 | return -1; | |
6819bc2e | 396 | |
1da177e4 LT |
397 | /* |
398 | * First register well known control TSAP | |
399 | */ | |
400 | irda_notify_init(¬ify); | |
401 | notify.data_indication = irlan_provider_data_indication; | |
402 | notify.connect_indication = irlan_provider_connect_indication; | |
403 | notify.disconnect_indication = irlan_provider_disconnect_indication; | |
404 | notify.instance = self; | |
405 | strlcpy(notify.name, "IrLAN ctrl (p)", sizeof(notify.name)); | |
406 | ||
407 | tsap = irttp_open_tsap(LSAP_ANY, 1, ¬ify); | |
408 | if (!tsap) { | |
409 | IRDA_DEBUG(2, "%s(), Got no tsap!\n", __FUNCTION__ ); | |
410 | return -1; | |
411 | } | |
412 | self->provider.tsap_ctrl = tsap; | |
413 | ||
414 | /* Register with LM-IAS */ | |
415 | irlan_ias_register(self, tsap->stsap_sel); | |
416 | ||
417 | return 0; | |
418 | } | |
419 |