| /********************************************************************* | |
| * | |
| * Filename: iriap.c | |
| * Version: 0.8 | |
| * Description: Information Access Protocol (IAP) | |
| * Status: Experimental. | |
| * Author: Dag Brattli <dagb@cs.uit.no> | |
| * Created at: Thu Aug 21 00:02:07 1997 | |
| * Modified at: Sat Dec 25 16:42:42 1999 | |
| * Modified by: Dag Brattli <dagb@cs.uit.no> | |
| * | |
| * Copyright (c) 1998-1999 Dag Brattli <dagb@cs.uit.no>, | |
| * All Rights Reserved. | |
| * Copyright (c) 2000-2003 Jean Tourrilhes <jt@hpl.hp.com> | |
| * | |
| * 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/module.h> | |
| #include <linux/types.h> | |
| #include <linux/skbuff.h> | |
| #include <linux/fs.h> | |
| #include <linux/string.h> | |
| #include <linux/init.h> | |
| #include <linux/seq_file.h> | |
| #include <asm/byteorder.h> | |
| #include <asm/unaligned.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_event.h> | |
| #include <net/irda/iriap.h> | |
| #ifdef CONFIG_IRDA_DEBUG | |
| /* FIXME: This one should go in irlmp.c */ | |
| static const char *ias_charset_types[] = { | |
| "CS_ASCII", | |
| "CS_ISO_8859_1", | |
| "CS_ISO_8859_2", | |
| "CS_ISO_8859_3", | |
| "CS_ISO_8859_4", | |
| "CS_ISO_8859_5", | |
| "CS_ISO_8859_6", | |
| "CS_ISO_8859_7", | |
| "CS_ISO_8859_8", | |
| "CS_ISO_8859_9", | |
| "CS_UNICODE" | |
| }; | |
| #endif /* CONFIG_IRDA_DEBUG */ | |
| static hashbin_t *iriap = NULL; | |
| static void *service_handle; | |
| static void __iriap_close(struct iriap_cb *self); | |
| static int iriap_register_lsap(struct iriap_cb *self, __u8 slsap_sel, int mode); | |
| static void iriap_disconnect_indication(void *instance, void *sap, | |
| LM_REASON reason, struct sk_buff *skb); | |
| static void iriap_connect_indication(void *instance, void *sap, | |
| struct qos_info *qos, __u32 max_sdu_size, | |
| __u8 max_header_size, | |
| struct sk_buff *skb); | |
| static void iriap_connect_confirm(void *instance, void *sap, | |
| struct qos_info *qos, | |
| __u32 max_sdu_size, __u8 max_header_size, | |
| struct sk_buff *skb); | |
| static int iriap_data_indication(void *instance, void *sap, | |
| struct sk_buff *skb); | |
| static void iriap_watchdog_timer_expired(void *data); | |
| static inline void iriap_start_watchdog_timer(struct iriap_cb *self, | |
| int timeout) | |
| { | |
| irda_start_timer(&self->watchdog_timer, timeout, self, | |
| iriap_watchdog_timer_expired); | |
| } | |
| /* | |
| * Function iriap_init (void) | |
| * | |
| * Initializes the IrIAP layer, called by the module initialization code | |
| * in irmod.c | |
| */ | |
| int __init iriap_init(void) | |
| { | |
| struct ias_object *obj; | |
| struct iriap_cb *server; | |
| __u8 oct_seq[6]; | |
| __u16 hints; | |
| /* Allocate master array */ | |
| iriap = hashbin_new(HB_LOCK); | |
| if (!iriap) | |
| return -ENOMEM; | |
| /* Object repository - defined in irias_object.c */ | |
| irias_objects = hashbin_new(HB_LOCK); | |
| if (!irias_objects) { | |
| IRDA_WARNING("%s: Can't allocate irias_objects hashbin!\n", | |
| __func__); | |
| hashbin_delete(iriap, NULL); | |
| return -ENOMEM; | |
| } | |
| /* | |
| * Register some default services for IrLMP | |
| */ | |
| hints = irlmp_service_to_hint(S_COMPUTER); | |
| service_handle = irlmp_register_service(hints); | |
| /* Register the Device object with LM-IAS */ | |
| obj = irias_new_object("Device", IAS_DEVICE_ID); | |
| irias_add_string_attrib(obj, "DeviceName", "Linux", IAS_KERNEL_ATTR); | |
| oct_seq[0] = 0x01; /* Version 1 */ | |
| oct_seq[1] = 0x00; /* IAS support bits */ | |
| oct_seq[2] = 0x00; /* LM-MUX support bits */ | |
| #ifdef CONFIG_IRDA_ULTRA | |
| oct_seq[2] |= 0x04; /* Connectionless Data support */ | |
| #endif | |
| irias_add_octseq_attrib(obj, "IrLMPSupport", oct_seq, 3, | |
| IAS_KERNEL_ATTR); | |
| irias_insert_object(obj); | |
| /* | |
| * Register server support with IrLMP so we can accept incoming | |
| * connections | |
| */ | |
| server = iriap_open(LSAP_IAS, IAS_SERVER, NULL, NULL); | |
| if (!server) { | |
| IRDA_DEBUG(0, "%s(), unable to open server\n", __func__); | |
| return -1; | |
| } | |
| iriap_register_lsap(server, LSAP_IAS, IAS_SERVER); | |
| return 0; | |
| } | |
| /* | |
| * Function iriap_cleanup (void) | |
| * | |
| * Initializes the IrIAP layer, called by the module cleanup code in | |
| * irmod.c | |
| */ | |
| void iriap_cleanup(void) | |
| { | |
| irlmp_unregister_service(service_handle); | |
| hashbin_delete(iriap, (FREE_FUNC) __iriap_close); | |
| hashbin_delete(irias_objects, (FREE_FUNC) __irias_delete_object); | |
| } | |
| /* | |
| * Function iriap_open (void) | |
| * | |
| * Opens an instance of the IrIAP layer, and registers with IrLMP | |
| */ | |
| struct iriap_cb *iriap_open(__u8 slsap_sel, int mode, void *priv, | |
| CONFIRM_CALLBACK callback) | |
| { | |
| struct iriap_cb *self; | |
| IRDA_DEBUG(2, "%s()\n", __func__); | |
| self = kzalloc(sizeof(*self), GFP_ATOMIC); | |
| if (!self) { | |
| IRDA_WARNING("%s: Unable to kmalloc!\n", __func__); | |
| return NULL; | |
| } | |
| /* | |
| * Initialize instance | |
| */ | |
| self->magic = IAS_MAGIC; | |
| self->mode = mode; | |
| if (mode == IAS_CLIENT) | |
| iriap_register_lsap(self, slsap_sel, mode); | |
| self->confirm = callback; | |
| self->priv = priv; | |
| /* iriap_getvaluebyclass_request() will construct packets before | |
| * we connect, so this must have a sane value... Jean II */ | |
| self->max_header_size = LMP_MAX_HEADER; | |
| init_timer(&self->watchdog_timer); | |
| hashbin_insert(iriap, (irda_queue_t *) self, (long) self, NULL); | |
| /* Initialize state machines */ | |
| iriap_next_client_state(self, S_DISCONNECT); | |
| iriap_next_call_state(self, S_MAKE_CALL); | |
| iriap_next_server_state(self, R_DISCONNECT); | |
| iriap_next_r_connect_state(self, R_WAITING); | |
| return self; | |
| } | |
| EXPORT_SYMBOL(iriap_open); | |
| /* | |
| * Function __iriap_close (self) | |
| * | |
| * Removes (deallocates) the IrIAP instance | |
| * | |
| */ | |
| static void __iriap_close(struct iriap_cb *self) | |
| { | |
| IRDA_DEBUG(4, "%s()\n", __func__); | |
| IRDA_ASSERT(self != NULL, return;); | |
| IRDA_ASSERT(self->magic == IAS_MAGIC, return;); | |
| del_timer(&self->watchdog_timer); | |
| if (self->request_skb) | |
| dev_kfree_skb(self->request_skb); | |
| self->magic = 0; | |
| kfree(self); | |
| } | |
| /* | |
| * Function iriap_close (void) | |
| * | |
| * Closes IrIAP and deregisters with IrLMP | |
| */ | |
| void iriap_close(struct iriap_cb *self) | |
| { | |
| struct iriap_cb *entry; | |
| IRDA_DEBUG(2, "%s()\n", __func__); | |
| IRDA_ASSERT(self != NULL, return;); | |
| IRDA_ASSERT(self->magic == IAS_MAGIC, return;); | |
| if (self->lsap) { | |
| irlmp_close_lsap(self->lsap); | |
| self->lsap = NULL; | |
| } | |
| entry = (struct iriap_cb *) hashbin_remove(iriap, (long) self, NULL); | |
| IRDA_ASSERT(entry == self, return;); | |
| __iriap_close(self); | |
| } | |
| EXPORT_SYMBOL(iriap_close); | |
| static int iriap_register_lsap(struct iriap_cb *self, __u8 slsap_sel, int mode) | |
| { | |
| notify_t notify; | |
| IRDA_DEBUG(2, "%s()\n", __func__); | |
| irda_notify_init(¬ify); | |
| notify.connect_confirm = iriap_connect_confirm; | |
| notify.connect_indication = iriap_connect_indication; | |
| notify.disconnect_indication = iriap_disconnect_indication; | |
| notify.data_indication = iriap_data_indication; | |
| notify.instance = self; | |
| if (mode == IAS_CLIENT) | |
| strcpy(notify.name, "IrIAS cli"); | |
| else | |
| strcpy(notify.name, "IrIAS srv"); | |
| self->lsap = irlmp_open_lsap(slsap_sel, ¬ify, 0); | |
| if (self->lsap == NULL) { | |
| IRDA_ERROR("%s: Unable to allocated LSAP!\n", __func__); | |
| return -1; | |
| } | |
| self->slsap_sel = self->lsap->slsap_sel; | |
| return 0; | |
| } | |
| /* | |
| * Function iriap_disconnect_indication (handle, reason) | |
| * | |
| * Got disconnect, so clean up everything associated with this connection | |
| * | |
| */ | |
| static void iriap_disconnect_indication(void *instance, void *sap, | |
| LM_REASON reason, | |
| struct sk_buff *skb) | |
| { | |
| struct iriap_cb *self; | |
| IRDA_DEBUG(4, "%s(), reason=%s\n", __func__, irlmp_reasons[reason]); | |
| self = (struct iriap_cb *) instance; | |
| IRDA_ASSERT(self != NULL, return;); | |
| IRDA_ASSERT(self->magic == IAS_MAGIC, return;); | |
| IRDA_ASSERT(iriap != NULL, return;); | |
| del_timer(&self->watchdog_timer); | |
| /* Not needed */ | |
| if (skb) | |
| dev_kfree_skb(skb); | |
| if (self->mode == IAS_CLIENT) { | |
| IRDA_DEBUG(4, "%s(), disconnect as client\n", __func__); | |
| iriap_do_client_event(self, IAP_LM_DISCONNECT_INDICATION, | |
| NULL); | |
| /* | |
| * Inform service user that the request failed by sending | |
| * it a NULL value. Warning, the client might close us, so | |
| * remember no to use self anymore after calling confirm | |
| */ | |
| if (self->confirm) | |
| self->confirm(IAS_DISCONNECT, 0, NULL, self->priv); | |
| } else { | |
| IRDA_DEBUG(4, "%s(), disconnect as server\n", __func__); | |
| iriap_do_server_event(self, IAP_LM_DISCONNECT_INDICATION, | |
| NULL); | |
| iriap_close(self); | |
| } | |
| } | |
| /* | |
| * Function iriap_disconnect_request (handle) | |
| */ | |
| static void iriap_disconnect_request(struct iriap_cb *self) | |
| { | |
| struct sk_buff *tx_skb; | |
| IRDA_DEBUG(4, "%s()\n", __func__); | |
| IRDA_ASSERT(self != NULL, return;); | |
| IRDA_ASSERT(self->magic == IAS_MAGIC, return;); | |
| tx_skb = alloc_skb(LMP_MAX_HEADER, GFP_ATOMIC); | |
| if (tx_skb == NULL) { | |
| IRDA_DEBUG(0, | |
| "%s(), Could not allocate an sk_buff of length %d\n", | |
| __func__, LMP_MAX_HEADER); | |
| return; | |
| } | |
| /* | |
| * Reserve space for MUX control and LAP header | |
| */ | |
| skb_reserve(tx_skb, LMP_MAX_HEADER); | |
| irlmp_disconnect_request(self->lsap, tx_skb); | |
| } | |
| /* | |
| * Function iriap_getvaluebyclass (addr, name, attr) | |
| * | |
| * Retrieve all values from attribute in all objects with given class | |
| * name | |
| */ | |
| int iriap_getvaluebyclass_request(struct iriap_cb *self, | |
| __u32 saddr, __u32 daddr, | |
| char *name, char *attr) | |
| { | |
| struct sk_buff *tx_skb; | |
| int name_len, attr_len, skb_len; | |
| __u8 *frame; | |
| IRDA_ASSERT(self != NULL, return -1;); | |
| IRDA_ASSERT(self->magic == IAS_MAGIC, return -1;); | |
| /* Client must supply the destination device address */ | |
| if (!daddr) | |
| return -1; | |
| self->daddr = daddr; | |
| self->saddr = saddr; | |
| /* | |
| * Save operation, so we know what the later indication is about | |
| */ | |
| self->operation = GET_VALUE_BY_CLASS; | |
| /* Give ourselves 10 secs to finish this operation */ | |
| iriap_start_watchdog_timer(self, 10*HZ); | |
| name_len = strlen(name); /* Up to IAS_MAX_CLASSNAME = 60 */ | |
| attr_len = strlen(attr); /* Up to IAS_MAX_ATTRIBNAME = 60 */ | |
| skb_len = self->max_header_size+2+name_len+1+attr_len+4; | |
| tx_skb = alloc_skb(skb_len, GFP_ATOMIC); | |
| if (!tx_skb) | |
| return -ENOMEM; | |
| /* Reserve space for MUX and LAP header */ | |
| skb_reserve(tx_skb, self->max_header_size); | |
| skb_put(tx_skb, 3+name_len+attr_len); | |
| frame = tx_skb->data; | |
| /* Build frame */ | |
| frame[0] = IAP_LST | GET_VALUE_BY_CLASS; | |
| frame[1] = name_len; /* Insert length of name */ | |
| memcpy(frame+2, name, name_len); /* Insert name */ | |
| frame[2+name_len] = attr_len; /* Insert length of attr */ | |
| memcpy(frame+3+name_len, attr, attr_len); /* Insert attr */ | |
| iriap_do_client_event(self, IAP_CALL_REQUEST_GVBC, tx_skb); | |
| /* Drop reference count - see state_s_disconnect(). */ | |
| dev_kfree_skb(tx_skb); | |
| return 0; | |
| } | |
| EXPORT_SYMBOL(iriap_getvaluebyclass_request); | |
| /* | |
| * Function iriap_getvaluebyclass_confirm (self, skb) | |
| * | |
| * Got result from GetValueByClass command. Parse it and return result | |
| * to service user. | |
| * | |
| */ | |
| static void iriap_getvaluebyclass_confirm(struct iriap_cb *self, | |
| struct sk_buff *skb) | |
| { | |
| struct ias_value *value; | |
| int charset; | |
| __u32 value_len; | |
| __u32 tmp_cpu32; | |
| __u16 obj_id; | |
| __u16 len; | |
| __u8 type; | |
| __u8 *fp; | |
| int n; | |
| IRDA_ASSERT(self != NULL, return;); | |
| IRDA_ASSERT(self->magic == IAS_MAGIC, return;); | |
| IRDA_ASSERT(skb != NULL, return;); | |
| /* Initialize variables */ | |
| fp = skb->data; | |
| n = 2; | |
| /* Get length, MSB first */ | |
| len = get_unaligned_be16(fp + n); | |
| n += 2; | |
| IRDA_DEBUG(4, "%s(), len=%d\n", __func__, len); | |
| /* Get object ID, MSB first */ | |
| obj_id = get_unaligned_be16(fp + n); | |
| n += 2; | |
| type = fp[n++]; | |
| IRDA_DEBUG(4, "%s(), Value type = %d\n", __func__, type); | |
| switch (type) { | |
| case IAS_INTEGER: | |
| memcpy(&tmp_cpu32, fp+n, 4); n += 4; | |
| be32_to_cpus(&tmp_cpu32); | |
| value = irias_new_integer_value(tmp_cpu32); | |
| /* Legal values restricted to 0x01-0x6f, page 15 irttp */ | |
| IRDA_DEBUG(4, "%s(), lsap=%d\n", __func__, value->t.integer); | |
| break; | |
| case IAS_STRING: | |
| charset = fp[n++]; | |
| switch (charset) { | |
| case CS_ASCII: | |
| break; | |
| /* case CS_ISO_8859_1: */ | |
| /* case CS_ISO_8859_2: */ | |
| /* case CS_ISO_8859_3: */ | |
| /* case CS_ISO_8859_4: */ | |
| /* case CS_ISO_8859_5: */ | |
| /* case CS_ISO_8859_6: */ | |
| /* case CS_ISO_8859_7: */ | |
| /* case CS_ISO_8859_8: */ | |
| /* case CS_ISO_8859_9: */ | |
| /* case CS_UNICODE: */ | |
| default: | |
| IRDA_DEBUG(0, "%s(), charset %s, not supported\n", | |
| __func__, ias_charset_types[charset]); | |
| /* Aborting, close connection! */ | |
| iriap_disconnect_request(self); | |
| return; | |
| /* break; */ | |
| } | |
| value_len = fp[n++]; | |
| IRDA_DEBUG(4, "%s(), strlen=%d\n", __func__, value_len); | |
| /* Make sure the string is null-terminated */ | |
| fp[n+value_len] = 0x00; | |
| IRDA_DEBUG(4, "Got string %s\n", fp+n); | |
| /* Will truncate to IAS_MAX_STRING bytes */ | |
| value = irias_new_string_value(fp+n); | |
| break; | |
| case IAS_OCT_SEQ: | |
| value_len = get_unaligned_be16(fp + n); | |
| n += 2; | |
| /* Will truncate to IAS_MAX_OCTET_STRING bytes */ | |
| value = irias_new_octseq_value(fp+n, value_len); | |
| break; | |
| default: | |
| value = irias_new_missing_value(); | |
| break; | |
| } | |
| /* Finished, close connection! */ | |
| iriap_disconnect_request(self); | |
| /* Warning, the client might close us, so remember no to use self | |
| * anymore after calling confirm | |
| */ | |
| if (self->confirm) | |
| self->confirm(IAS_SUCCESS, obj_id, value, self->priv); | |
| else { | |
| IRDA_DEBUG(0, "%s(), missing handler!\n", __func__); | |
| irias_delete_value(value); | |
| } | |
| } | |
| /* | |
| * Function iriap_getvaluebyclass_response () | |
| * | |
| * Send answer back to remote LM-IAS | |
| * | |
| */ | |
| static void iriap_getvaluebyclass_response(struct iriap_cb *self, | |
| __u16 obj_id, | |
| __u8 ret_code, | |
| struct ias_value *value) | |
| { | |
| struct sk_buff *tx_skb; | |
| int n; | |
| __be32 tmp_be32; | |
| __be16 tmp_be16; | |
| __u8 *fp; | |
| IRDA_DEBUG(4, "%s()\n", __func__); | |
| IRDA_ASSERT(self != NULL, return;); | |
| IRDA_ASSERT(self->magic == IAS_MAGIC, return;); | |
| IRDA_ASSERT(value != NULL, return;); | |
| IRDA_ASSERT(value->len <= 1024, return;); | |
| /* Initialize variables */ | |
| n = 0; | |
| /* | |
| * We must adjust the size of the response after the length of the | |
| * value. We add 32 bytes because of the 6 bytes for the frame and | |
| * max 5 bytes for the value coding. | |
| */ | |
| tx_skb = alloc_skb(value->len + self->max_header_size + 32, | |
| GFP_ATOMIC); | |
| if (!tx_skb) | |
| return; | |
| /* Reserve space for MUX and LAP header */ | |
| skb_reserve(tx_skb, self->max_header_size); | |
| skb_put(tx_skb, 6); | |
| fp = tx_skb->data; | |
| /* Build frame */ | |
| fp[n++] = GET_VALUE_BY_CLASS | IAP_LST; | |
| fp[n++] = ret_code; | |
| /* Insert list length (MSB first) */ | |
| tmp_be16 = htons(0x0001); | |
| memcpy(fp+n, &tmp_be16, 2); n += 2; | |
| /* Insert object identifier ( MSB first) */ | |
| tmp_be16 = cpu_to_be16(obj_id); | |
| memcpy(fp+n, &tmp_be16, 2); n += 2; | |
| switch (value->type) { | |
| case IAS_STRING: | |
| skb_put(tx_skb, 3 + value->len); | |
| fp[n++] = value->type; | |
| fp[n++] = 0; /* ASCII */ | |
| fp[n++] = (__u8) value->len; | |
| memcpy(fp+n, value->t.string, value->len); n+=value->len; | |
| break; | |
| case IAS_INTEGER: | |
| skb_put(tx_skb, 5); | |
| fp[n++] = value->type; | |
| tmp_be32 = cpu_to_be32(value->t.integer); | |
| memcpy(fp+n, &tmp_be32, 4); n += 4; | |
| break; | |
| case IAS_OCT_SEQ: | |
| skb_put(tx_skb, 3 + value->len); | |
| fp[n++] = value->type; | |
| tmp_be16 = cpu_to_be16(value->len); | |
| memcpy(fp+n, &tmp_be16, 2); n += 2; | |
| memcpy(fp+n, value->t.oct_seq, value->len); n+=value->len; | |
| break; | |
| case IAS_MISSING: | |
| IRDA_DEBUG( 3, "%s: sending IAS_MISSING\n", __func__); | |
| skb_put(tx_skb, 1); | |
| fp[n++] = value->type; | |
| break; | |
| default: | |
| IRDA_DEBUG(0, "%s(), type not implemented!\n", __func__); | |
| break; | |
| } | |
| iriap_do_r_connect_event(self, IAP_CALL_RESPONSE, tx_skb); | |
| /* Drop reference count - see state_r_execute(). */ | |
| dev_kfree_skb(tx_skb); | |
| } | |
| /* | |
| * Function iriap_getvaluebyclass_indication (self, skb) | |
| * | |
| * getvaluebyclass is requested from peer LM-IAS | |
| * | |
| */ | |
| static void iriap_getvaluebyclass_indication(struct iriap_cb *self, | |
| struct sk_buff *skb) | |
| { | |
| struct ias_object *obj; | |
| struct ias_attrib *attrib; | |
| int name_len; | |
| int attr_len; | |
| char name[IAS_MAX_CLASSNAME + 1]; /* 60 bytes */ | |
| char attr[IAS_MAX_ATTRIBNAME + 1]; /* 60 bytes */ | |
| __u8 *fp; | |
| int n; | |
| IRDA_DEBUG(4, "%s()\n", __func__); | |
| IRDA_ASSERT(self != NULL, return;); | |
| IRDA_ASSERT(self->magic == IAS_MAGIC, return;); | |
| IRDA_ASSERT(skb != NULL, return;); | |
| fp = skb->data; | |
| n = 1; | |
| name_len = fp[n++]; | |
| memcpy(name, fp+n, name_len); n+=name_len; | |
| name[name_len] = '\0'; | |
| attr_len = fp[n++]; | |
| memcpy(attr, fp+n, attr_len); n+=attr_len; | |
| attr[attr_len] = '\0'; | |
| IRDA_DEBUG(4, "LM-IAS: Looking up %s: %s\n", name, attr); | |
| obj = irias_find_object(name); | |
| if (obj == NULL) { | |
| IRDA_DEBUG(2, "LM-IAS: Object %s not found\n", name); | |
| iriap_getvaluebyclass_response(self, 0x1235, IAS_CLASS_UNKNOWN, | |
| &irias_missing); | |
| return; | |
| } | |
| IRDA_DEBUG(4, "LM-IAS: found %s, id=%d\n", obj->name, obj->id); | |
| attrib = irias_find_attrib(obj, attr); | |
| if (attrib == NULL) { | |
| IRDA_DEBUG(2, "LM-IAS: Attribute %s not found\n", attr); | |
| iriap_getvaluebyclass_response(self, obj->id, | |
| IAS_ATTRIB_UNKNOWN, | |
| &irias_missing); | |
| return; | |
| } | |
| /* We have a match; send the value. */ | |
| iriap_getvaluebyclass_response(self, obj->id, IAS_SUCCESS, | |
| attrib->value); | |
| return; | |
| } | |
| /* | |
| * Function iriap_send_ack (void) | |
| * | |
| * Currently not used | |
| * | |
| */ | |
| void iriap_send_ack(struct iriap_cb *self) | |
| { | |
| struct sk_buff *tx_skb; | |
| __u8 *frame; | |
| IRDA_DEBUG(2, "%s()\n", __func__); | |
| IRDA_ASSERT(self != NULL, return;); | |
| IRDA_ASSERT(self->magic == IAS_MAGIC, return;); | |
| tx_skb = alloc_skb(LMP_MAX_HEADER + 1, GFP_ATOMIC); | |
| if (!tx_skb) | |
| return; | |
| /* Reserve space for MUX and LAP header */ | |
| skb_reserve(tx_skb, self->max_header_size); | |
| skb_put(tx_skb, 1); | |
| frame = tx_skb->data; | |
| /* Build frame */ | |
| frame[0] = IAP_LST | IAP_ACK | self->operation; | |
| irlmp_data_request(self->lsap, tx_skb); | |
| } | |
| void iriap_connect_request(struct iriap_cb *self) | |
| { | |
| int ret; | |
| IRDA_ASSERT(self != NULL, return;); | |
| IRDA_ASSERT(self->magic == IAS_MAGIC, return;); | |
| ret = irlmp_connect_request(self->lsap, LSAP_IAS, | |
| self->saddr, self->daddr, | |
| NULL, NULL); | |
| if (ret < 0) { | |
| IRDA_DEBUG(0, "%s(), connect failed!\n", __func__); | |
| self->confirm(IAS_DISCONNECT, 0, NULL, self->priv); | |
| } | |
| } | |
| /* | |
| * Function iriap_connect_confirm (handle, skb) | |
| * | |
| * LSAP connection confirmed! | |
| * | |
| */ | |
| static void iriap_connect_confirm(void *instance, void *sap, | |
| struct qos_info *qos, __u32 max_seg_size, | |
| __u8 max_header_size, | |
| struct sk_buff *skb) | |
| { | |
| struct iriap_cb *self; | |
| self = (struct iriap_cb *) instance; | |
| IRDA_ASSERT(self != NULL, return;); | |
| IRDA_ASSERT(self->magic == IAS_MAGIC, return;); | |
| IRDA_ASSERT(skb != NULL, return;); | |
| self->max_data_size = max_seg_size; | |
| self->max_header_size = max_header_size; | |
| del_timer(&self->watchdog_timer); | |
| iriap_do_client_event(self, IAP_LM_CONNECT_CONFIRM, skb); | |
| /* Drop reference count - see state_s_make_call(). */ | |
| dev_kfree_skb(skb); | |
| } | |
| /* | |
| * Function iriap_connect_indication ( handle, skb) | |
| * | |
| * Remote LM-IAS is requesting connection | |
| * | |
| */ | |
| static void iriap_connect_indication(void *instance, void *sap, | |
| struct qos_info *qos, __u32 max_seg_size, | |
| __u8 max_header_size, | |
| struct sk_buff *skb) | |
| { | |
| struct iriap_cb *self, *new; | |
| IRDA_DEBUG(1, "%s()\n", __func__); | |
| self = (struct iriap_cb *) instance; | |
| IRDA_ASSERT(skb != NULL, return;); | |
| IRDA_ASSERT(self != NULL, goto out;); | |
| IRDA_ASSERT(self->magic == IAS_MAGIC, goto out;); | |
| /* Start new server */ | |
| new = iriap_open(LSAP_IAS, IAS_SERVER, NULL, NULL); | |
| if (!new) { | |
| IRDA_DEBUG(0, "%s(), open failed\n", __func__); | |
| goto out; | |
| } | |
| /* Now attach up the new "socket" */ | |
| new->lsap = irlmp_dup(self->lsap, new); | |
| if (!new->lsap) { | |
| IRDA_DEBUG(0, "%s(), dup failed!\n", __func__); | |
| goto out; | |
| } | |
| new->max_data_size = max_seg_size; | |
| new->max_header_size = max_header_size; | |
| /* Clean up the original one to keep it in listen state */ | |
| irlmp_listen(self->lsap); | |
| iriap_do_server_event(new, IAP_LM_CONNECT_INDICATION, skb); | |
| out: | |
| /* Drop reference count - see state_r_disconnect(). */ | |
| dev_kfree_skb(skb); | |
| } | |
| /* | |
| * Function iriap_data_indication (handle, skb) | |
| * | |
| * Receives data from connection identified by handle from IrLMP | |
| * | |
| */ | |
| static int iriap_data_indication(void *instance, void *sap, | |
| struct sk_buff *skb) | |
| { | |
| struct iriap_cb *self; | |
| __u8 *frame; | |
| __u8 opcode; | |
| IRDA_DEBUG(3, "%s()\n", __func__); | |
| self = (struct iriap_cb *) instance; | |
| IRDA_ASSERT(skb != NULL, return 0;); | |
| IRDA_ASSERT(self != NULL, goto out;); | |
| IRDA_ASSERT(self->magic == IAS_MAGIC, goto out;); | |
| frame = skb->data; | |
| if (self->mode == IAS_SERVER) { | |
| /* Call server */ | |
| IRDA_DEBUG(4, "%s(), Calling server!\n", __func__); | |
| iriap_do_r_connect_event(self, IAP_RECV_F_LST, skb); | |
| goto out; | |
| } | |
| opcode = frame[0]; | |
| if (~opcode & IAP_LST) { | |
| IRDA_WARNING("%s:, IrIAS multiframe commands or " | |
| "results is not implemented yet!\n", | |
| __func__); | |
| goto out; | |
| } | |
| /* Check for ack frames since they don't contain any data */ | |
| if (opcode & IAP_ACK) { | |
| IRDA_DEBUG(0, "%s() Got ack frame!\n", __func__); | |
| goto out; | |
| } | |
| opcode &= ~IAP_LST; /* Mask away LST bit */ | |
| switch (opcode) { | |
| case GET_INFO_BASE: | |
| IRDA_DEBUG(0, "IrLMP GetInfoBaseDetails not implemented!\n"); | |
| break; | |
| case GET_VALUE_BY_CLASS: | |
| iriap_do_call_event(self, IAP_RECV_F_LST, NULL); | |
| switch (frame[1]) { | |
| case IAS_SUCCESS: | |
| iriap_getvaluebyclass_confirm(self, skb); | |
| break; | |
| case IAS_CLASS_UNKNOWN: | |
| IRDA_DEBUG(1, "%s(), No such class!\n", __func__); | |
| /* Finished, close connection! */ | |
| iriap_disconnect_request(self); | |
| /* | |
| * Warning, the client might close us, so remember | |
| * no to use self anymore after calling confirm | |
| */ | |
| if (self->confirm) | |
| self->confirm(IAS_CLASS_UNKNOWN, 0, NULL, | |
| self->priv); | |
| break; | |
| case IAS_ATTRIB_UNKNOWN: | |
| IRDA_DEBUG(1, "%s(), No such attribute!\n", __func__); | |
| /* Finished, close connection! */ | |
| iriap_disconnect_request(self); | |
| /* | |
| * Warning, the client might close us, so remember | |
| * no to use self anymore after calling confirm | |
| */ | |
| if (self->confirm) | |
| self->confirm(IAS_ATTRIB_UNKNOWN, 0, NULL, | |
| self->priv); | |
| break; | |
| } | |
| break; | |
| default: | |
| IRDA_DEBUG(0, "%s(), Unknown op-code: %02x\n", __func__, | |
| opcode); | |
| break; | |
| } | |
| out: | |
| /* Cleanup - sub-calls will have done skb_get() as needed. */ | |
| dev_kfree_skb(skb); | |
| return 0; | |
| } | |
| /* | |
| * Function iriap_call_indication (self, skb) | |
| * | |
| * Received call to server from peer LM-IAS | |
| * | |
| */ | |
| void iriap_call_indication(struct iriap_cb *self, struct sk_buff *skb) | |
| { | |
| __u8 *fp; | |
| __u8 opcode; | |
| IRDA_DEBUG(4, "%s()\n", __func__); | |
| IRDA_ASSERT(self != NULL, return;); | |
| IRDA_ASSERT(self->magic == IAS_MAGIC, return;); | |
| IRDA_ASSERT(skb != NULL, return;); | |
| fp = skb->data; | |
| opcode = fp[0]; | |
| if (~opcode & 0x80) { | |
| IRDA_WARNING("%s: IrIAS multiframe commands or results " | |
| "is not implemented yet!\n", __func__); | |
| return; | |
| } | |
| opcode &= 0x7f; /* Mask away LST bit */ | |
| switch (opcode) { | |
| case GET_INFO_BASE: | |
| IRDA_WARNING("%s: GetInfoBaseDetails not implemented yet!\n", | |
| __func__); | |
| break; | |
| case GET_VALUE_BY_CLASS: | |
| iriap_getvaluebyclass_indication(self, skb); | |
| break; | |
| } | |
| /* skb will be cleaned up in iriap_data_indication */ | |
| } | |
| /* | |
| * Function iriap_watchdog_timer_expired (data) | |
| * | |
| * Query has taken too long time, so abort | |
| * | |
| */ | |
| static void iriap_watchdog_timer_expired(void *data) | |
| { | |
| struct iriap_cb *self = (struct iriap_cb *) data; | |
| IRDA_ASSERT(self != NULL, return;); | |
| IRDA_ASSERT(self->magic == IAS_MAGIC, return;); | |
| /* iriap_close(self); */ | |
| } | |
| #ifdef CONFIG_PROC_FS | |
| static const char *ias_value_types[] = { | |
| "IAS_MISSING", | |
| "IAS_INTEGER", | |
| "IAS_OCT_SEQ", | |
| "IAS_STRING" | |
| }; | |
| static inline struct ias_object *irias_seq_idx(loff_t pos) | |
| { | |
| struct ias_object *obj; | |
| for (obj = (struct ias_object *) hashbin_get_first(irias_objects); | |
| obj; obj = (struct ias_object *) hashbin_get_next(irias_objects)) { | |
| if (pos-- == 0) | |
| break; | |
| } | |
| return obj; | |
| } | |
| static void *irias_seq_start(struct seq_file *seq, loff_t *pos) | |
| { | |
| spin_lock_irq(&irias_objects->hb_spinlock); | |
| return *pos ? irias_seq_idx(*pos - 1) : SEQ_START_TOKEN; | |
| } | |
| static void *irias_seq_next(struct seq_file *seq, void *v, loff_t *pos) | |
| { | |
| ++*pos; | |
| return (v == SEQ_START_TOKEN) | |
| ? (void *) hashbin_get_first(irias_objects) | |
| : (void *) hashbin_get_next(irias_objects); | |
| } | |
| static void irias_seq_stop(struct seq_file *seq, void *v) | |
| { | |
| spin_unlock_irq(&irias_objects->hb_spinlock); | |
| } | |
| static int irias_seq_show(struct seq_file *seq, void *v) | |
| { | |
| if (v == SEQ_START_TOKEN) | |
| seq_puts(seq, "LM-IAS Objects:\n"); | |
| else { | |
| struct ias_object *obj = v; | |
| struct ias_attrib *attrib; | |
| IRDA_ASSERT(obj->magic == IAS_OBJECT_MAGIC, return -EINVAL;); | |
| seq_printf(seq, "name: %s, id=%d\n", | |
| obj->name, obj->id); | |
| /* Careful for priority inversions here ! | |
| * All other uses of attrib spinlock are independent of | |
| * the object spinlock, so we are safe. Jean II */ | |
| spin_lock(&obj->attribs->hb_spinlock); | |
| /* List all attributes for this object */ | |
| for (attrib = (struct ias_attrib *) hashbin_get_first(obj->attribs); | |
| attrib != NULL; | |
| attrib = (struct ias_attrib *) hashbin_get_next(obj->attribs)) { | |
| IRDA_ASSERT(attrib->magic == IAS_ATTRIB_MAGIC, | |
| goto outloop; ); | |
| seq_printf(seq, " - Attribute name: \"%s\", ", | |
| attrib->name); | |
| seq_printf(seq, "value[%s]: ", | |
| ias_value_types[attrib->value->type]); | |
| switch (attrib->value->type) { | |
| case IAS_INTEGER: | |
| seq_printf(seq, "%d\n", | |
| attrib->value->t.integer); | |
| break; | |
| case IAS_STRING: | |
| seq_printf(seq, "\"%s\"\n", | |
| attrib->value->t.string); | |
| break; | |
| case IAS_OCT_SEQ: | |
| seq_printf(seq, "octet sequence (%d bytes)\n", | |
| attrib->value->len); | |
| break; | |
| case IAS_MISSING: | |
| seq_puts(seq, "missing\n"); | |
| break; | |
| default: | |
| seq_printf(seq, "type %d?\n", | |
| attrib->value->type); | |
| } | |
| seq_putc(seq, '\n'); | |
| } | |
| IRDA_ASSERT_LABEL(outloop:) | |
| spin_unlock(&obj->attribs->hb_spinlock); | |
| } | |
| return 0; | |
| } | |
| static const struct seq_operations irias_seq_ops = { | |
| .start = irias_seq_start, | |
| .next = irias_seq_next, | |
| .stop = irias_seq_stop, | |
| .show = irias_seq_show, | |
| }; | |
| static int irias_seq_open(struct inode *inode, struct file *file) | |
| { | |
| IRDA_ASSERT( irias_objects != NULL, return -EINVAL;); | |
| return seq_open(file, &irias_seq_ops); | |
| } | |
| const struct file_operations irias_seq_fops = { | |
| .owner = THIS_MODULE, | |
| .open = irias_seq_open, | |
| .read = seq_read, | |
| .llseek = seq_lseek, | |
| .release = seq_release, | |
| }; | |
| #endif /* PROC_FS */ |