/********************************************************************* * * Filename: iriap.c * Version: 0.8 * Description: Information Access Protocol (IAP) * Status: Experimental. * Author: Dag Brattli * Created at: Thu Aug 21 00:02:07 1997 * Modified at: Sat Oct 9 17:00:56 1999 * Modified by: Dag Brattli * * Copyright (c) 1998-1999 Dag Brattli , * 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 #include #include #include #include #include #include #include #include #include #include #include #include #include /* 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" }; static hashbin_t *iriap = NULL; static __u32 service_handle; extern char *lmp_reasons[]; static struct iriap_cb *iriap_open( __u8 slsap, int mode); static void __iriap_close(struct iriap_cb *self); 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); /* * Function iriap_init (void) * * Initializes the IrIAP layer, called by the module initialization code * in irmod.c */ int __init iriap_init(void) { __u16 hints; struct ias_object *obj; /* Allocate master array */ iriap = hashbin_new(HB_LOCAL); if (!iriap) return -ENOMEM; objects = hashbin_new(HB_LOCAL); if (!objects) { WARNING(__FUNCTION__ "(), Can't allocate objects hashbin!\n"); return -ENOMEM; } /* * Register some default services for IrLMP */ hints = irlmp_service_to_hint(S_COMPUTER); hints |= irlmp_service_to_hint(S_PNP); 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"); irias_insert_object(obj); /* * Register server support with IrLMP so we can accept incoming * connections */ iriap_open(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(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) { struct iriap_cb *self; struct lsap_cb *lsap; notify_t notify; IRDA_DEBUG(4, __FUNCTION__ "()\n"); self = kmalloc(sizeof(struct iriap_cb), GFP_ATOMIC); if (!self) { WARNING(__FUNCTION__ "(), Unable to kmalloc!\n"); return NULL; } /* * Initialize instance */ memset(self, 0, sizeof(struct iriap_cb)); 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"); lsap = irlmp_open_lsap(slsap_sel, ¬ify); if (lsap == NULL) { ERROR(__FUNCTION__ "(), Unable to allocated LSAP!\n"); return NULL; } slsap_sel = lsap->slsap_sel; self->magic = IAS_MAGIC; self->lsap = lsap; self->slsap_sel = slsap_sel; self->mode = mode; init_timer(&self->watchdog_timer); hashbin_insert(iriap, (queue_t *) self, slsap_sel, 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; } /* * Function __iriap_close (self) * * Removes (deallocates) the IrIAP instance * */ static void __iriap_close(struct iriap_cb *self) { IRDA_DEBUG(4, __FUNCTION__ "()\n"); ASSERT(self != NULL, return;); ASSERT(self->magic == IAS_MAGIC, return;); del_timer(&self->watchdog_timer); 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; ASSERT(self != NULL, return;); ASSERT(self->magic == IAS_MAGIC, return;); if (self->lsap) { irlmp_close_lsap(self->lsap); self->lsap = NULL; } entry = (struct iriap_cb *) hashbin_remove(iriap, self->slsap_sel, NULL); ASSERT(entry == self, return;); __iriap_close(self); } /* * Function iriap_disconnect_indication (handle, reason) * * Got disconnect, so clean up everything assosiated with this connection * */ static void iriap_disconnect_indication(void *instance, void *sap, LM_REASON reason, struct sk_buff *userdata) { struct iriap_cb *self; IRDA_DEBUG(4, __FUNCTION__ "(), reason=%s\n", lmp_reasons[reason]); self = (struct iriap_cb *) instance; ASSERT(self != NULL, return;); ASSERT(self->magic == IAS_MAGIC, return;); ASSERT(iriap != NULL, return;); del_timer(&self->watchdog_timer); if (self->mode == IAS_CLIENT) { IRDA_DEBUG(4, __FUNCTION__ "(), disconnect as client\n"); /* * Inform service user that the request failed by sending * it a NULL value. */ if (self->confirm) self->confirm(IAS_DISCONNECT, 0, NULL, self->priv); iriap_do_client_event(self, IAP_LM_DISCONNECT_INDICATION, NULL); /* Close instance only if client */ iriap_close(self); } else { IRDA_DEBUG(4, __FUNCTION__ "(), disconnect as server\n"); iriap_do_server_event(self, IAP_LM_DISCONNECT_INDICATION, NULL); } if (userdata) dev_kfree_skb(userdata); } /* * Function iriap_disconnect_request (handle) * * * */ void iriap_disconnect_request(struct iriap_cb *self) { struct sk_buff *skb; IRDA_DEBUG(4, __FUNCTION__ "()\n"); ASSERT(self != NULL, return;); ASSERT(self->magic == IAS_MAGIC, return;); skb = dev_alloc_skb(64); if (skb == NULL) { IRDA_DEBUG(0, __FUNCTION__ "(), Could not allocate an sk_buff of length %d\n", 64); return; } /* * Reserve space for MUX control and LAP header */ skb_reserve(skb, LMP_MAX_HEADER); irlmp_disconnect_request(self->lsap, skb); } void iriap_getinfobasedetails_request(void) { IRDA_DEBUG(0, __FUNCTION__ "(), Not implemented!\n"); } void iriap_getinfobasedetails_confirm(void) { IRDA_DEBUG(0, __FUNCTION__ "(), Not implemented!\n"); } void iriap_getobjects_request(void) { IRDA_DEBUG(0, __FUNCTION__ "(), Not implemented!\n"); } void iriap_getobjects_confirm(void) { IRDA_DEBUG(0, __FUNCTION__ "(), Not implemented!\n"); } void iriap_getvalue(void) { IRDA_DEBUG(0, __FUNCTION__ "(), Not implemented!\n"); } /* * Function iriap_getvaluebyclass (addr, name, attr) * * Retreive all values from attribute in all objects with given class * name */ void iriap_getvaluebyclass_request(char *name, char *attr, __u32 saddr, __u32 daddr, CONFIRM_CALLBACK callback, void *priv) { struct sk_buff *skb; struct iriap_cb *self; int name_len, attr_len; __u8 slsap = LSAP_ANY; /* Source LSAP to use */ __u8 *frame; /* Client must supply the destination device address */ if (!daddr) return; self = iriap_open(slsap, IAS_CLIENT); if (!self) return; self->mode = IAS_CLIENT; self->confirm = callback; self->priv = priv; 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); skb = dev_alloc_skb(64); if (!skb) return; name_len = strlen(name); attr_len = strlen(attr); /* Reserve space for MUX and LAP header */ skb_reserve(skb, self->max_header_size); skb_put(skb, 3+name_len+attr_len); frame = 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, skb); } /* * Function iriap_getvaluebyclass_confirm (self, skb) * * Got result from GetValueByClass command. Parse it and return result * to service user. * */ 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; ASSERT(self != NULL, return;); ASSERT(self->magic == IAS_MAGIC, return;); ASSERT(skb != NULL, return;); /* Initialize variables */ fp = skb->data; n = 2; /* Get length, MSB first */ len = be16_to_cpu(get_unaligned((__u16 *)(fp+n))); n += 2; IRDA_DEBUG(4, __FUNCTION__ "(), len=%d\n", len); /* Get object ID, MSB first */ obj_id = be16_to_cpu(get_unaligned((__u16 *)(fp+n))); n += 2; type = fp[n++]; IRDA_DEBUG(4, __FUNCTION__ "(), Value type = %d\n", 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, __FUNCTION__ "(), lsap=%d\n", 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, __FUNCTION__"(), charset %s, not supported\n", ias_charset_types[charset]); return; /* break; */ } value_len = fp[n++]; IRDA_DEBUG(4, __FUNCTION__ "(), strlen=%d\n", value_len); ASSERT(value_len < 64, return;); /* Make sure the string is null-terminated */ fp[n+value_len] = 0x00; IRDA_DEBUG(4, "Got string %s\n", fp+n); value = irias_new_string_value(fp+n); break; case IAS_OCT_SEQ: value_len = be16_to_cpu(get_unaligned((__u16 *)(fp+n))); n += 2; ASSERT(value_len <= 55, return;); value = irias_new_octseq_value(fp+n, value_len); break; default: value = &missing; break; } /* Finished, close connection! */ iriap_disconnect_request(self); if (self->confirm) self->confirm(IAS_SUCCESS, obj_id, value, self->priv); } /* * Function iriap_getvaluebyclass_response () * * Send answer back to remote LM-IAS * */ void iriap_getvaluebyclass_response(struct iriap_cb *self, __u16 obj_id, __u8 ret_code, struct ias_value *value) { struct sk_buff *skb; int n; __u32 tmp_be32, tmp_be16; __u8 *fp; IRDA_DEBUG(4, __FUNCTION__ "()\n"); ASSERT(self != NULL, return;); ASSERT(self->magic == IAS_MAGIC, return;); ASSERT(value != NULL, return;); 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 9 bytes because of the 6 bytes for the frame and * max 3 bytes for the value coding. */ skb = dev_alloc_skb(value->len + self->max_header_size + 9); if (!skb) return; /* Reserve space for MUX and LAP header */ skb_reserve(skb, self->max_header_size); skb_put(skb, 6); fp = skb->data; /* Build frame */ fp[n++] = GET_VALUE_BY_CLASS | IAP_LST; fp[n++] = ret_code; /* Insert list length (MSB first) */ tmp_be16 = __constant_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(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(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(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, __FUNCTION__ ": sending IAS_MISSING\n"); skb_put( skb, 1); fp[n++] = value->type; break; default: IRDA_DEBUG(0, __FUNCTION__ "(), type not implemented!\n"); break; } iriap_do_r_connect_event(self, IAP_CALL_RESPONSE, skb); } /* * Function iriap_getvaluebyclass_indication (self, skb) * * getvaluebyclass is requested from peer LM-IAS * */ 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[64]; char attr[64]; __u8 *fp; int n; IRDA_DEBUG(4, __FUNCTION__ "()\n"); ASSERT(self != NULL, return;); ASSERT(self->magic == IAS_MAGIC, return;); 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'; dev_kfree_skb(skb); /* * Now, do some advanced parsing! :-) */ IRDA_DEBUG(4, "LM-IAS: Looking up %s: %s\n", name, attr); obj = irias_find_object(name); if (obj == NULL) { IRDA_DEBUG(0, "LM-IAS: Object not found\n"); iriap_getvaluebyclass_response(self, 0x1235, IAS_CLASS_UNKNOWN, &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(0, "LM-IAS: Attribute %s not found\n", attr); iriap_getvaluebyclass_response(self, obj->id, IAS_ATTRIB_UNKNOWN, &missing); return; } IRDA_DEBUG(4, "LM-IAS: found %s\n", attrib->name); /* * 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 *skb; __u8 *frame; IRDA_DEBUG(6, __FUNCTION__ "()\n"); ASSERT(self != NULL, return;); ASSERT(self->magic == IAS_MAGIC, return;); skb = dev_alloc_skb(64); if (!skb) return; /* Reserve space for MUX and LAP header */ skb_reserve(skb, self->max_header_size); skb_put(skb, 1); frame = skb->data; /* Build frame */ frame[0] = IAP_LST | self->operation; } /* * Function iriap_connect_confirm (handle, skb) * * LSAP connection confirmed! * */ static void iriap_connect_confirm(void *instance, void *sap, struct qos_info *qos, __u32 max_sdu_size, __u8 header_size, struct sk_buff *userdata) { struct iriap_cb *self; self = (struct iriap_cb *) instance; ASSERT(self != NULL, return;); ASSERT(self->magic == IAS_MAGIC, return;); ASSERT(userdata != NULL, return;); IRDA_DEBUG(4, __FUNCTION__ "()\n"); del_timer(&self->watchdog_timer); iriap_do_client_event(self, IAP_LM_CONNECT_CONFIRM, userdata); } /* * 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_sdu_size, __u8 header_size, struct sk_buff *userdata) { struct iriap_cb *self; self = (struct iriap_cb *) instance; ASSERT(self != NULL, return;); ASSERT(self->magic == IAS_MAGIC, return;); iriap_do_server_event(self, IAP_LM_CONNECT_INDICATION, userdata); } /* * 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( 4, __FUNCTION__ "()\n"); self = (struct iriap_cb *) instance; ASSERT(self != NULL, return 0;); ASSERT(self->magic == IAS_MAGIC, return 0;); ASSERT(skb != NULL, return 0;); frame = skb->data; if (self->mode == IAS_SERVER) { /* Call server */ IRDA_DEBUG(4, __FUNCTION__ "(), Calling server!\n"); iriap_do_r_connect_event( self, IAP_RECV_F_LST, skb); return 0; } opcode = frame[0]; if (~opcode & IAP_LST) { WARNING(__FUNCTION__ "(), IrIAS multiframe commands or " "results is not implemented yet!\n"); return 0; } /* Check for ack frames since they don't contain any data */ if (opcode & IAP_ACK) { IRDA_DEBUG(0, __FUNCTION__ "() Got ack frame!\n"); return 0; } 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: switch (frame[1]) { case IAS_SUCCESS: iriap_getvaluebyclass_confirm(self, skb); break; case IAS_CLASS_UNKNOWN: WARNING(__FUNCTION__ "(), No such class!\n"); /* Finished, close connection! */ iriap_disconnect_request(self); if (self->confirm) self->confirm(IAS_CLASS_UNKNOWN, 0, NULL, self->priv); break; case IAS_ATTRIB_UNKNOWN: WARNING(__FUNCTION__ "(), No such attribute!\n"); /* Finished, close connection! */ iriap_disconnect_request(self); if (self->confirm) self->confirm(IAS_CLASS_UNKNOWN, 0, NULL, self->priv); break; } iriap_do_call_event(self, IAP_RECV_F_LST, skb); /* * We remove LSAPs used by IrIAS as a client since these * are more difficult to reuse! */ iriap_close(self); break; default: IRDA_DEBUG(0, __FUNCTION__ "(), Unknown op-code: %02x\n", opcode); break; } 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, __FUNCTION__ "()\n"); ASSERT(self != NULL, return;); ASSERT(self->magic == IAS_MAGIC, return;); ASSERT(skb != NULL, return;); fp = skb->data; opcode = fp[0]; if (~opcode & 0x80) { WARNING(__FUNCTION__ "(), IrIAS multiframe commands or results" "is not implemented yet!\n"); return; } opcode &= 0x7f; /* Mask away LST bit */ switch (opcode) { case GET_INFO_BASE: WARNING(__FUNCTION__ "(), GetInfoBaseDetails not implemented yet!\n"); break; case GET_VALUE_BY_CLASS: iriap_getvaluebyclass_indication(self, skb); break; } } /* * Function iriap_watchdog_timer_expired (data) * * Query has taken to long time, so abort * */ void iriap_watchdog_timer_expired(void *data) { struct iriap_cb *self = (struct iriap_cb *) data; ASSERT(self != NULL, return;); ASSERT(self->magic == IAS_MAGIC, return;); iriap_close(self); } #ifdef CONFIG_PROC_FS static char *ias_value_types[] = { "IAS_MISSING", "IAS_INTEGER", "IAS_OCT_SEQ", "IAS_STRING" }; int irias_proc_read(char *buf, char **start, off_t offset, int len, int unused) { struct ias_object *obj; struct ias_attrib *attrib; unsigned long flags; ASSERT( objects != NULL, return 0;); save_flags( flags); cli(); len = 0; len += sprintf(buf+len, "LM-IAS Objects:\n"); /* List all objects */ obj = (struct ias_object *) hashbin_get_first(objects); while ( obj != NULL) { ASSERT(obj->magic == IAS_OBJECT_MAGIC, return 0;); len += sprintf(buf+len, "name: %s, ", obj->name); len += sprintf(buf+len, "id=%d", obj->id); len += sprintf(buf+len, "\n"); /* List all attributes for this object */ attrib = (struct ias_attrib *) hashbin_get_first(obj->attribs); while (attrib != NULL) { ASSERT(attrib->magic == IAS_ATTRIB_MAGIC, return 0;); len += sprintf(buf+len, " - Attribute name: \"%s\", ", attrib->name); len += sprintf(buf+len, "value[%s]: ", ias_value_types[attrib->value->type]); switch (attrib->value->type) { case IAS_INTEGER: len += sprintf(buf+len, "%d\n", attrib->value->t.integer); break; case IAS_STRING: len += sprintf(buf+len, "\"%s\"\n", attrib->value->t.string); break; case IAS_OCT_SEQ: len += sprintf(buf+len, "octet sequence\n"); break; case IAS_MISSING: len += sprintf(buf+len, "missing\n"); break; default: IRDA_DEBUG(0, __FUNCTION__ "(), Unknown value type!\n"); return -1; } len += sprintf(buf+len, "\n"); attrib = (struct ias_attrib *) hashbin_get_next(obj->attribs); } obj = (struct ias_object *) hashbin_get_next(objects); } restore_flags(flags); return len; } #endif /* PROC_FS */