Merge git://git.infradead.org/~dwmw2/cafe-2.6
[linux-2.6] / net / irda / irlan / irlan_provider.c
1 /*********************************************************************
2  *                
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>
14  * 
15  *     Copyright (c) 1998-1999 Dag Brattli <dagb@cs.uit.no>, 
16  *     All Rights Reserved.
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 
21  *     the License, or (at your option) any later version.
22  *
23  *     Neither Dag Brattli nor University of Tromsø admit liability nor
24  *     provide warranty for any of this software. This material is 
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
55 static void irlan_provider_connect_indication(void *instance, void *sap, 
56                                               struct qos_info *qos, 
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  */
67 static int irlan_provider_data_indication(void *instance, void *sap, 
68                                           struct sk_buff *skb) 
69 {
70         struct irlan_cb *self;
71         __u8 code;
72         
73         IRDA_DEBUG(4, "%s()\n", __FUNCTION__ );
74         
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");
86                 irlan_do_provider_event(self, IRLAN_GET_INFO_CMD, skb); 
87                 break;
88
89         case CMD_GET_MEDIA_CHAR:
90                 IRDA_DEBUG(4, "Got GET_MEDIA_CHAR command!\n");
91                 irlan_do_provider_event(self, IRLAN_GET_MEDIA_CMD, skb); 
92                 break;
93         case CMD_OPEN_DATA_CHANNEL:
94                 IRDA_DEBUG(4, "Got OPEN_DATA_CHANNEL command!\n");
95                 irlan_do_provider_event(self, IRLAN_OPEN_DATA_CMD, skb); 
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  */
122 static void irlan_provider_connect_indication(void *instance, void *sap, 
123                                               struct qos_info *qos,
124                                               __u32 max_sdu_size, 
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__ );
133         
134         self = (struct irlan_cb *) instance;
135         tsap = (struct tsap_cb *) sap;
136         
137         IRDA_ASSERT(self != NULL, return;);
138         IRDA_ASSERT(self->magic == IRLAN_MAGIC, return;);
139         
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
150         /*  
151          * If we are in peer mode, the client may not have got the discovery
152          * indication it needs to make progress. If the client is still in 
153          * IDLE state, we must kick it. 
154          */
155         if ((self->provider.access_type == ACCESS_PEER) && 
156             (self->client.state == IRLAN_IDLE)) 
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
178 static void irlan_provider_disconnect_indication(void *instance, void *sap, 
179                                                  LM_REASON reason, 
180                                                  struct sk_buff *userdata) 
181 {
182         struct irlan_cb *self;
183         struct tsap_cb *tsap;
184
185         IRDA_DEBUG(4, "%s(), reason=%d\n", __FUNCTION__ , reason);
186         
187         self = (struct irlan_cb *) instance;
188         tsap = (struct tsap_cb *) sap;
189
190         IRDA_ASSERT(self != NULL, return;);
191         IRDA_ASSERT(self->magic == IRLAN_MAGIC, return;);       
192         IRDA_ASSERT(tsap != NULL, return;);
193         IRDA_ASSERT(tsap->magic == TTP_TSAP_MAGIC, return;);
194         
195         IRDA_ASSERT(tsap == self->provider.tsap_ctrl, return;);
196         
197         irlan_do_provider_event(self, IRLAN_LMP_DISCONNECT, NULL);
198 }
199
200 /*
201  * Function irlan_parse_open_data_cmd (self, skb)
202  *
203  *    
204  *
205  */
206 int irlan_parse_open_data_cmd(struct irlan_cb *self, struct sk_buff *skb)
207 {
208         int ret;
209         
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  *
221  *    Extract all parameters from received buffer, then feed them to 
222  *    check_params for parsing
223  *
224  */
225 int irlan_provider_parse_command(struct irlan_cb *self, int cmd,
226                                  struct sk_buff *skb) 
227 {
228         __u8 *frame;
229         __u8 *ptr;
230         int count;
231         __u16 val_len;
232         int i;
233         char *name;
234         char *value;
235         int ret = RSP_SUCCESS;
236         
237         IRDA_ASSERT(skb != NULL, return -RSP_PROTOCOL_ERROR;);
238         
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;);
243         
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);
262         
263         ptr = frame+2;
264         
265         /* For all parameters */
266         for (i=0; i<count;i++) {
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  */
289 void irlan_provider_send_reply(struct irlan_cb *self, int command, 
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
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
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);
313        
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 */
359                         irlan_insert_short_param(skb, "CON_ARB", 
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);
364                 irlan_insert_string_param(skb, "RECONNECT_KEY", "LINUX RULES!");
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.
381  * 
382  */
383 int irlan_provider_open_ctrl_tsap(struct irlan_cb *self)
384 {
385         struct tsap_cb *tsap;
386         notify_t notify;
387         
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;
396         
397         /*
398          *  First register well known control TSAP
399          */
400         irda_notify_init(&notify);
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, &notify);
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