/********************************************************************* * * Filename: irlan_client.c * Version: 0.9 * Description: IrDA LAN Access Protocol (IrLAN) Client * Status: Experimental. * Author: Dag Brattli <dagb@cs.uit.no> * Created at: Sun Aug 31 20:14:37 1997 * Modified at: Tue Dec 14 15:47:02 1999 * Modified by: Dag Brattli <dagb@cs.uit.no> * Sources: skeleton.c by Donald Becker <becker@CESDIS.gsfc.nasa.gov> * slip.c by Laurence Culhane, <loz@holmes.demon.co.uk> * Fred N. van Kempen, <waltje@uwalt.nl.mugnet.org> * * Copyright (c) 1998-1999 Dag Brattli <dagb@cs.uit.no>, * All Rights Reserved. * * 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. * * Neither Dag Brattli nor University of Tromsø admit liability nor * provide warranty for any of this software. This material is * provided "AS-IS" and at no charge. * ********************************************************************/ #include <linux/kernel.h> #include <linux/string.h> #include <linux/slab.h> #include <linux/errno.h> #include <linux/init.h> #include <linux/netdevice.h> #include <linux/etherdevice.h> #include <linux/if_arp.h> #include <linux/bitops.h> #include <net/arp.h> #include <asm/byteorder.h> #include <net/irda/irda.h> #include <net/irda/irttp.h> #include <net/irda/irlmp.h> #include <net/irda/irias_object.h> #include <net/irda/iriap.h> #include <net/irda/timer.h> #include <net/irda/irlan_common.h> #include <net/irda/irlan_event.h> #include <net/irda/irlan_eth.h> #include <net/irda/irlan_provider.h> #include <net/irda/irlan_client.h> #undef CONFIG_IRLAN_GRATUITOUS_ARP static void irlan_client_ctrl_disconnect_indication(void *instance, void *sap, LM_REASON reason, struct sk_buff *); static int irlan_client_ctrl_data_indication(void *instance, void *sap, struct sk_buff *skb); static void irlan_client_ctrl_connect_confirm(void *instance, void *sap, struct qos_info *qos, __u32 max_sdu_size, __u8 max_header_size, struct sk_buff *); static void irlan_check_response_param(struct irlan_cb *self, char *param, char *value, int val_len); static void irlan_client_open_ctrl_tsap(struct irlan_cb *self); static void irlan_client_kick_timer_expired(void *data) { struct irlan_cb *self = (struct irlan_cb *) data; IRDA_ASSERT(self != NULL, return;); IRDA_ASSERT(self->magic == IRLAN_MAGIC, return;); /* * If we are in peer mode, the client may not have got the discovery * indication it needs to make progress. If the client is still in * IDLE state, we must kick it to, but only if the provider is not IDLE */ if ((self->provider.access_type == ACCESS_PEER) && (self->client.state == IRLAN_IDLE) && (self->provider.state != IRLAN_IDLE)) { irlan_client_wakeup(self, self->saddr, self->daddr); } } static void irlan_client_start_kick_timer(struct irlan_cb *self, int timeout) { irda_start_timer(&self->client.kick_timer, timeout, (void *) self, irlan_client_kick_timer_expired); } /* * Function irlan_client_wakeup (self, saddr, daddr) * * Wake up client * */ void irlan_client_wakeup(struct irlan_cb *self, __u32 saddr, __u32 daddr) { IRDA_ASSERT(self != NULL, return;); IRDA_ASSERT(self->magic == IRLAN_MAGIC, return;); /* * Check if we are already awake, or if we are a provider in direct * mode (in that case we must leave the client idle */ if ((self->client.state != IRLAN_IDLE) || (self->provider.access_type == ACCESS_DIRECT)) { pr_debug("%s(), already awake!\n", __func__); return; } /* Addresses may have changed! */ self->saddr = saddr; self->daddr = daddr; if (self->disconnect_reason == LM_USER_REQUEST) { pr_debug("%s(), still stopped by user\n", __func__); return; } /* Open TSAPs */ irlan_client_open_ctrl_tsap(self); irlan_open_data_tsap(self); irlan_do_client_event(self, IRLAN_DISCOVERY_INDICATION, NULL); /* Start kick timer */ irlan_client_start_kick_timer(self, 2*HZ); } /* * Function irlan_discovery_indication (daddr) * * Remote device with IrLAN server support discovered * */ void irlan_client_discovery_indication(discinfo_t *discovery, DISCOVERY_MODE mode, void *priv) { struct irlan_cb *self; __u32 saddr, daddr; IRDA_ASSERT(discovery != NULL, return;); /* * I didn't check it, but I bet that IrLAN suffer from the same * deficiency as IrComm and doesn't handle two instances * simultaneously connecting to each other. * Same workaround, drop passive discoveries. * Jean II */ if(mode == DISCOVERY_PASSIVE) return; saddr = discovery->saddr; daddr = discovery->daddr; /* Find instance */ rcu_read_lock(); self = irlan_get_any(); if (self) { IRDA_ASSERT(self->magic == IRLAN_MAGIC, goto out;); pr_debug("%s(), Found instance (%08x)!\n", __func__ , daddr); irlan_client_wakeup(self, saddr, daddr); } IRDA_ASSERT_LABEL(out:) rcu_read_unlock(); } /* * Function irlan_client_data_indication (handle, skb) * * This function gets the data that is received on the control channel * */ static int irlan_client_ctrl_data_indication(void *instance, void *sap, struct sk_buff *skb) { struct irlan_cb *self; self = instance; IRDA_ASSERT(self != NULL, return -1;); IRDA_ASSERT(self->magic == IRLAN_MAGIC, return -1;); IRDA_ASSERT(skb != NULL, return -1;); irlan_do_client_event(self, IRLAN_DATA_INDICATION, skb); /* Ready for a new command */ pr_debug("%s(), clearing tx_busy\n", __func__); self->client.tx_busy = FALSE; /* Check if we have some queued commands waiting to be sent */ irlan_run_ctrl_tx_queue(self); return 0; } static void irlan_client_ctrl_disconnect_indication(void *instance, void *sap, LM_REASON reason, struct sk_buff *userdata) { struct irlan_cb *self; struct tsap_cb *tsap; struct sk_buff *skb; pr_debug("%s(), reason=%d\n", __func__ , reason); self = instance; tsap = sap; IRDA_ASSERT(self != NULL, return;); IRDA_ASSERT(self->magic == IRLAN_MAGIC, return;); IRDA_ASSERT(tsap != NULL, return;); IRDA_ASSERT(tsap->magic == TTP_TSAP_MAGIC, return;); IRDA_ASSERT(tsap == self->client.tsap_ctrl, return;); /* Remove frames queued on the control channel */ while ((skb = skb_dequeue(&self->client.txq)) != NULL) { dev_kfree_skb(skb); } self->client.tx_busy = FALSE; irlan_do_client_event(self, IRLAN_LMP_DISCONNECT, NULL); } /* * Function irlan_client_open_tsaps (self) * * Initialize callbacks and open IrTTP TSAPs * */ static void irlan_client_open_ctrl_tsap(struct irlan_cb *self) { struct tsap_cb *tsap; notify_t notify; IRDA_ASSERT(self != NULL, return;); IRDA_ASSERT(self->magic == IRLAN_MAGIC, return;); /* Check if already open */ if (self->client.tsap_ctrl) return; irda_notify_init(¬ify); /* Set up callbacks */ notify.data_indication = irlan_client_ctrl_data_indication; notify.connect_confirm = irlan_client_ctrl_connect_confirm; notify.disconnect_indication = irlan_client_ctrl_disconnect_indication; notify.instance = self; strlcpy(notify.name, "IrLAN ctrl (c)", sizeof(notify.name)); tsap = irttp_open_tsap(LSAP_ANY, DEFAULT_INITIAL_CREDIT, ¬ify); if (!tsap) { pr_debug("%s(), Got no tsap!\n", __func__); return; } self->client.tsap_ctrl = tsap; } /* * Function irlan_client_connect_confirm (handle, skb) * * Connection to peer IrLAN laye confirmed * */ static void irlan_client_ctrl_connect_confirm(void *instance, void *sap, struct qos_info *qos, __u32 max_sdu_size, __u8 max_header_size, struct sk_buff *skb) { struct irlan_cb *self; self = instance; IRDA_ASSERT(self != NULL, return;); IRDA_ASSERT(self->magic == IRLAN_MAGIC, return;); self->client.max_sdu_size = max_sdu_size; self->client.max_header_size = max_header_size; /* TODO: we could set the MTU depending on the max_sdu_size */ irlan_do_client_event(self, IRLAN_CONNECT_COMPLETE, NULL); } /* * Function print_ret_code (code) * * Print return code of request to peer IrLAN layer. * */ static void print_ret_code(__u8 code) { switch(code) { case 0: printk(KERN_INFO "Success\n"); break; case 1: net_warn_ratelimited("IrLAN: Insufficient resources\n"); break; case 2: net_warn_ratelimited("IrLAN: Invalid command format\n"); break; case 3: net_warn_ratelimited("IrLAN: Command not supported\n"); break; case 4: net_warn_ratelimited("IrLAN: Parameter not supported\n"); break; case 5: net_warn_ratelimited("IrLAN: Value not supported\n"); break; case 6: net_warn_ratelimited("IrLAN: Not open\n"); break; case 7: net_warn_ratelimited("IrLAN: Authentication required\n"); break; case 8: net_warn_ratelimited("IrLAN: Invalid password\n"); break; case 9: net_warn_ratelimited("IrLAN: Protocol error\n"); break; case 255: net_warn_ratelimited("IrLAN: Asynchronous status\n"); break; } } /* * Function irlan_client_parse_response (self, skb) * * Extract all parameters from received buffer, then feed them to * check_params for parsing */ void irlan_client_parse_response(struct irlan_cb *self, struct sk_buff *skb) { __u8 *frame; __u8 *ptr; int count; int ret; __u16 val_len; int i; char *name; char *value; IRDA_ASSERT(skb != NULL, return;); pr_debug("%s() skb->len=%d\n", __func__ , (int)skb->len); IRDA_ASSERT(self != NULL, return;); IRDA_ASSERT(self->magic == IRLAN_MAGIC, return;); if (!skb) { net_err_ratelimited("%s(), Got NULL skb!\n", __func__); return; } frame = skb->data; /* * Check return code and print it if not success */ if (frame[0]) { print_ret_code(frame[0]); return; } name = kmalloc(255, GFP_ATOMIC); if (!name) return; value = kmalloc(1016, GFP_ATOMIC); if (!value) { kfree(name); return; } /* How many parameters? */ count = frame[1]; pr_debug("%s(), got %d parameters\n", __func__ , count); ptr = frame+2; /* For all parameters */ for (i=0; i<count;i++) { ret = irlan_extract_param(ptr, name, value, &val_len); if (ret < 0) { pr_debug("%s(), IrLAN, Error!\n", __func__); break; } ptr += ret; irlan_check_response_param(self, name, value, val_len); } /* Cleanup */ kfree(name); kfree(value); } /* * Function irlan_check_response_param (self, param, value, val_len) * * Check which parameter is received and update local variables * */ static void irlan_check_response_param(struct irlan_cb *self, char *param, char *value, int val_len) { __u16 tmp_cpu; /* Temporary value in host order */ __u8 *bytes; int i; pr_debug("%s(), parm=%s\n", __func__ , param); IRDA_ASSERT(self != NULL, return;); IRDA_ASSERT(self->magic == IRLAN_MAGIC, return;); /* Media type */ if (strcmp(param, "MEDIA") == 0) { if (strcmp(value, "802.3") == 0) self->media = MEDIA_802_3; else self->media = MEDIA_802_5; return; } if (strcmp(param, "FILTER_TYPE") == 0) { if (strcmp(value, "DIRECTED") == 0) self->client.filter_type |= IRLAN_DIRECTED; else if (strcmp(value, "FUNCTIONAL") == 0) self->client.filter_type |= IRLAN_FUNCTIONAL; else if (strcmp(value, "GROUP") == 0) self->client.filter_type |= IRLAN_GROUP; else if (strcmp(value, "MAC_FRAME") == 0) self->client.filter_type |= IRLAN_MAC_FRAME; else if (strcmp(value, "MULTICAST") == 0) self->client.filter_type |= IRLAN_MULTICAST; else if (strcmp(value, "BROADCAST") == 0) self->client.filter_type |= IRLAN_BROADCAST; else if (strcmp(value, "IPX_SOCKET") == 0) self->client.filter_type |= IRLAN_IPX_SOCKET; } if (strcmp(param, "ACCESS_TYPE") == 0) { if (strcmp(value, "DIRECT") == 0) self->client.access_type = ACCESS_DIRECT; else if (strcmp(value, "PEER") == 0) self->client.access_type = ACCESS_PEER; else if (strcmp(value, "HOSTED") == 0) self->client.access_type = ACCESS_HOSTED; else { pr_debug("%s(), unknown access type!\n", __func__); } } /* IRLAN version */ if (strcmp(param, "IRLAN_VER") == 0) { pr_debug("IrLAN version %d.%d\n", (__u8)value[0], (__u8)value[1]); self->version[0] = value[0]; self->version[1] = value[1]; return; } /* Which remote TSAP to use for data channel */ if (strcmp(param, "DATA_CHAN") == 0) { self->dtsap_sel_data = value[0]; pr_debug("Data TSAP = %02x\n", self->dtsap_sel_data); return; } if (strcmp(param, "CON_ARB") == 0) { memcpy(&tmp_cpu, value, 2); /* Align value */ le16_to_cpus(&tmp_cpu); /* Convert to host order */ self->client.recv_arb_val = tmp_cpu; pr_debug("%s(), receive arb val=%d\n", __func__ , self->client.recv_arb_val); } if (strcmp(param, "MAX_FRAME") == 0) { memcpy(&tmp_cpu, value, 2); /* Align value */ le16_to_cpus(&tmp_cpu); /* Convert to host order */ self->client.max_frame = tmp_cpu; pr_debug("%s(), max frame=%d\n", __func__ , self->client.max_frame); } /* RECONNECT_KEY, in case the link goes down! */ if (strcmp(param, "RECONNECT_KEY") == 0) { pr_debug("Got reconnect key: "); /* for (i = 0; i < val_len; i++) */ /* printk("%02x", value[i]); */ memcpy(self->client.reconnect_key, value, val_len); self->client.key_len = val_len; pr_debug("\n"); } /* FILTER_ENTRY, have we got an ethernet address? */ if (strcmp(param, "FILTER_ENTRY") == 0) { bytes = value; pr_debug("Ethernet address = %pM\n", bytes); for (i = 0; i < 6; i++) self->dev->dev_addr[i] = bytes[i]; } } /* * Function irlan_client_get_value_confirm (obj_id, value) * * Got results from remote LM-IAS * */ void irlan_client_get_value_confirm(int result, __u16 obj_id, struct ias_value *value, void *priv) { struct irlan_cb *self; IRDA_ASSERT(priv != NULL, return;); self = priv; IRDA_ASSERT(self->magic == IRLAN_MAGIC, return;); /* We probably don't need to make any more queries */ iriap_close(self->client.iriap); self->client.iriap = NULL; /* Check if request succeeded */ if (result != IAS_SUCCESS) { pr_debug("%s(), got NULL value!\n", __func__); irlan_do_client_event(self, IRLAN_IAS_PROVIDER_NOT_AVAIL, NULL); return; } switch (value->type) { case IAS_INTEGER: self->dtsap_sel_ctrl = value->t.integer; if (value->t.integer != -1) { irlan_do_client_event(self, IRLAN_IAS_PROVIDER_AVAIL, NULL); return; } irias_delete_value(value); break; default: pr_debug("%s(), unknown type!\n", __func__); break; } irlan_do_client_event(self, IRLAN_IAS_PROVIDER_NOT_AVAIL, NULL); }