Linux kernel mirror (for testing) git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel os linux
1
fork

Configure Feed

Select the types of activity you want to include in your feed.

at v3.16-rc4 1108 lines 27 kB view raw
1/********************************************************************* 2 * 3 * Filename: iriap.c 4 * Version: 0.8 5 * Description: Information Access Protocol (IAP) 6 * Status: Experimental. 7 * Author: Dag Brattli <dagb@cs.uit.no> 8 * Created at: Thu Aug 21 00:02:07 1997 9 * Modified at: Sat Dec 25 16:42:42 1999 10 * Modified by: Dag Brattli <dagb@cs.uit.no> 11 * 12 * Copyright (c) 1998-1999 Dag Brattli <dagb@cs.uit.no>, 13 * All Rights Reserved. 14 * Copyright (c) 2000-2003 Jean Tourrilhes <jt@hpl.hp.com> 15 * 16 * This program is free software; you can redistribute it and/or 17 * modify it under the terms of the GNU General Public License as 18 * published by the Free Software Foundation; either version 2 of 19 * the License, or (at your option) any later version. 20 * 21 * Neither Dag Brattli nor University of Tromsø admit liability nor 22 * provide warranty for any of this software. This material is 23 * provided "AS-IS" and at no charge. 24 * 25 ********************************************************************/ 26 27#include <linux/module.h> 28#include <linux/types.h> 29#include <linux/skbuff.h> 30#include <linux/fs.h> 31#include <linux/string.h> 32#include <linux/init.h> 33#include <linux/seq_file.h> 34#include <linux/slab.h> 35 36#include <asm/byteorder.h> 37#include <asm/unaligned.h> 38 39#include <net/irda/irda.h> 40#include <net/irda/irttp.h> 41#include <net/irda/irlmp.h> 42#include <net/irda/irias_object.h> 43#include <net/irda/iriap_event.h> 44#include <net/irda/iriap.h> 45 46#ifdef CONFIG_IRDA_DEBUG 47/* FIXME: This one should go in irlmp.c */ 48static const char *const ias_charset_types[] = { 49 "CS_ASCII", 50 "CS_ISO_8859_1", 51 "CS_ISO_8859_2", 52 "CS_ISO_8859_3", 53 "CS_ISO_8859_4", 54 "CS_ISO_8859_5", 55 "CS_ISO_8859_6", 56 "CS_ISO_8859_7", 57 "CS_ISO_8859_8", 58 "CS_ISO_8859_9", 59 "CS_UNICODE" 60}; 61#endif /* CONFIG_IRDA_DEBUG */ 62 63static hashbin_t *iriap = NULL; 64static void *service_handle; 65 66static void __iriap_close(struct iriap_cb *self); 67static int iriap_register_lsap(struct iriap_cb *self, __u8 slsap_sel, int mode); 68static void iriap_disconnect_indication(void *instance, void *sap, 69 LM_REASON reason, struct sk_buff *skb); 70static void iriap_connect_indication(void *instance, void *sap, 71 struct qos_info *qos, __u32 max_sdu_size, 72 __u8 max_header_size, 73 struct sk_buff *skb); 74static void iriap_connect_confirm(void *instance, void *sap, 75 struct qos_info *qos, 76 __u32 max_sdu_size, __u8 max_header_size, 77 struct sk_buff *skb); 78static int iriap_data_indication(void *instance, void *sap, 79 struct sk_buff *skb); 80 81static void iriap_watchdog_timer_expired(void *data); 82 83static inline void iriap_start_watchdog_timer(struct iriap_cb *self, 84 int timeout) 85{ 86 irda_start_timer(&self->watchdog_timer, timeout, self, 87 iriap_watchdog_timer_expired); 88} 89 90static struct lock_class_key irias_objects_key; 91 92/* 93 * Function iriap_init (void) 94 * 95 * Initializes the IrIAP layer, called by the module initialization code 96 * in irmod.c 97 */ 98int __init iriap_init(void) 99{ 100 struct ias_object *obj; 101 struct iriap_cb *server; 102 __u8 oct_seq[6]; 103 __u16 hints; 104 105 /* Allocate master array */ 106 iriap = hashbin_new(HB_LOCK); 107 if (!iriap) 108 return -ENOMEM; 109 110 /* Object repository - defined in irias_object.c */ 111 irias_objects = hashbin_new(HB_LOCK); 112 if (!irias_objects) { 113 IRDA_WARNING("%s: Can't allocate irias_objects hashbin!\n", 114 __func__); 115 hashbin_delete(iriap, NULL); 116 return -ENOMEM; 117 } 118 119 lockdep_set_class_and_name(&irias_objects->hb_spinlock, &irias_objects_key, 120 "irias_objects"); 121 122 /* 123 * Register some default services for IrLMP 124 */ 125 hints = irlmp_service_to_hint(S_COMPUTER); 126 service_handle = irlmp_register_service(hints); 127 128 /* Register the Device object with LM-IAS */ 129 obj = irias_new_object("Device", IAS_DEVICE_ID); 130 irias_add_string_attrib(obj, "DeviceName", "Linux", IAS_KERNEL_ATTR); 131 132 oct_seq[0] = 0x01; /* Version 1 */ 133 oct_seq[1] = 0x00; /* IAS support bits */ 134 oct_seq[2] = 0x00; /* LM-MUX support bits */ 135#ifdef CONFIG_IRDA_ULTRA 136 oct_seq[2] |= 0x04; /* Connectionless Data support */ 137#endif 138 irias_add_octseq_attrib(obj, "IrLMPSupport", oct_seq, 3, 139 IAS_KERNEL_ATTR); 140 irias_insert_object(obj); 141 142 /* 143 * Register server support with IrLMP so we can accept incoming 144 * connections 145 */ 146 server = iriap_open(LSAP_IAS, IAS_SERVER, NULL, NULL); 147 if (!server) { 148 IRDA_DEBUG(0, "%s(), unable to open server\n", __func__); 149 return -1; 150 } 151 iriap_register_lsap(server, LSAP_IAS, IAS_SERVER); 152 153 return 0; 154} 155 156/* 157 * Function iriap_cleanup (void) 158 * 159 * Initializes the IrIAP layer, called by the module cleanup code in 160 * irmod.c 161 */ 162void iriap_cleanup(void) 163{ 164 irlmp_unregister_service(service_handle); 165 166 hashbin_delete(iriap, (FREE_FUNC) __iriap_close); 167 hashbin_delete(irias_objects, (FREE_FUNC) __irias_delete_object); 168} 169 170/* 171 * Function iriap_open (void) 172 * 173 * Opens an instance of the IrIAP layer, and registers with IrLMP 174 */ 175struct iriap_cb *iriap_open(__u8 slsap_sel, int mode, void *priv, 176 CONFIRM_CALLBACK callback) 177{ 178 struct iriap_cb *self; 179 180 IRDA_DEBUG(2, "%s()\n", __func__); 181 182 self = kzalloc(sizeof(*self), GFP_ATOMIC); 183 if (!self) { 184 IRDA_WARNING("%s: Unable to kmalloc!\n", __func__); 185 return NULL; 186 } 187 188 /* 189 * Initialize instance 190 */ 191 192 self->magic = IAS_MAGIC; 193 self->mode = mode; 194 if (mode == IAS_CLIENT) 195 iriap_register_lsap(self, slsap_sel, mode); 196 197 self->confirm = callback; 198 self->priv = priv; 199 200 /* iriap_getvaluebyclass_request() will construct packets before 201 * we connect, so this must have a sane value... Jean II */ 202 self->max_header_size = LMP_MAX_HEADER; 203 204 init_timer(&self->watchdog_timer); 205 206 hashbin_insert(iriap, (irda_queue_t *) self, (long) self, NULL); 207 208 /* Initialize state machines */ 209 iriap_next_client_state(self, S_DISCONNECT); 210 iriap_next_call_state(self, S_MAKE_CALL); 211 iriap_next_server_state(self, R_DISCONNECT); 212 iriap_next_r_connect_state(self, R_WAITING); 213 214 return self; 215} 216EXPORT_SYMBOL(iriap_open); 217 218/* 219 * Function __iriap_close (self) 220 * 221 * Removes (deallocates) the IrIAP instance 222 * 223 */ 224static void __iriap_close(struct iriap_cb *self) 225{ 226 IRDA_DEBUG(4, "%s()\n", __func__); 227 228 IRDA_ASSERT(self != NULL, return;); 229 IRDA_ASSERT(self->magic == IAS_MAGIC, return;); 230 231 del_timer(&self->watchdog_timer); 232 233 if (self->request_skb) 234 dev_kfree_skb(self->request_skb); 235 236 self->magic = 0; 237 238 kfree(self); 239} 240 241/* 242 * Function iriap_close (void) 243 * 244 * Closes IrIAP and deregisters with IrLMP 245 */ 246void iriap_close(struct iriap_cb *self) 247{ 248 struct iriap_cb *entry; 249 250 IRDA_DEBUG(2, "%s()\n", __func__); 251 252 IRDA_ASSERT(self != NULL, return;); 253 IRDA_ASSERT(self->magic == IAS_MAGIC, return;); 254 255 if (self->lsap) { 256 irlmp_close_lsap(self->lsap); 257 self->lsap = NULL; 258 } 259 260 entry = (struct iriap_cb *) hashbin_remove(iriap, (long) self, NULL); 261 IRDA_ASSERT(entry == self, return;); 262 263 __iriap_close(self); 264} 265EXPORT_SYMBOL(iriap_close); 266 267static int iriap_register_lsap(struct iriap_cb *self, __u8 slsap_sel, int mode) 268{ 269 notify_t notify; 270 271 IRDA_DEBUG(2, "%s()\n", __func__); 272 273 irda_notify_init(&notify); 274 notify.connect_confirm = iriap_connect_confirm; 275 notify.connect_indication = iriap_connect_indication; 276 notify.disconnect_indication = iriap_disconnect_indication; 277 notify.data_indication = iriap_data_indication; 278 notify.instance = self; 279 if (mode == IAS_CLIENT) 280 strcpy(notify.name, "IrIAS cli"); 281 else 282 strcpy(notify.name, "IrIAS srv"); 283 284 self->lsap = irlmp_open_lsap(slsap_sel, &notify, 0); 285 if (self->lsap == NULL) { 286 IRDA_ERROR("%s: Unable to allocated LSAP!\n", __func__); 287 return -1; 288 } 289 self->slsap_sel = self->lsap->slsap_sel; 290 291 return 0; 292} 293 294/* 295 * Function iriap_disconnect_indication (handle, reason) 296 * 297 * Got disconnect, so clean up everything associated with this connection 298 * 299 */ 300static void iriap_disconnect_indication(void *instance, void *sap, 301 LM_REASON reason, 302 struct sk_buff *skb) 303{ 304 struct iriap_cb *self; 305 306 IRDA_DEBUG(4, "%s(), reason=%s [%d]\n", __func__, 307 irlmp_reason_str(reason), reason); 308 309 self = instance; 310 311 IRDA_ASSERT(self != NULL, return;); 312 IRDA_ASSERT(self->magic == IAS_MAGIC, return;); 313 314 IRDA_ASSERT(iriap != NULL, return;); 315 316 del_timer(&self->watchdog_timer); 317 318 /* Not needed */ 319 if (skb) 320 dev_kfree_skb(skb); 321 322 if (self->mode == IAS_CLIENT) { 323 IRDA_DEBUG(4, "%s(), disconnect as client\n", __func__); 324 325 326 iriap_do_client_event(self, IAP_LM_DISCONNECT_INDICATION, 327 NULL); 328 /* 329 * Inform service user that the request failed by sending 330 * it a NULL value. Warning, the client might close us, so 331 * remember no to use self anymore after calling confirm 332 */ 333 if (self->confirm) 334 self->confirm(IAS_DISCONNECT, 0, NULL, self->priv); 335 } else { 336 IRDA_DEBUG(4, "%s(), disconnect as server\n", __func__); 337 iriap_do_server_event(self, IAP_LM_DISCONNECT_INDICATION, 338 NULL); 339 iriap_close(self); 340 } 341} 342 343/* 344 * Function iriap_disconnect_request (handle) 345 */ 346static void iriap_disconnect_request(struct iriap_cb *self) 347{ 348 struct sk_buff *tx_skb; 349 350 IRDA_DEBUG(4, "%s()\n", __func__); 351 352 IRDA_ASSERT(self != NULL, return;); 353 IRDA_ASSERT(self->magic == IAS_MAGIC, return;); 354 355 tx_skb = alloc_skb(LMP_MAX_HEADER, GFP_ATOMIC); 356 if (tx_skb == NULL) { 357 IRDA_DEBUG(0, 358 "%s(), Could not allocate an sk_buff of length %d\n", 359 __func__, LMP_MAX_HEADER); 360 return; 361 } 362 363 /* 364 * Reserve space for MUX control and LAP header 365 */ 366 skb_reserve(tx_skb, LMP_MAX_HEADER); 367 368 irlmp_disconnect_request(self->lsap, tx_skb); 369} 370 371/* 372 * Function iriap_getvaluebyclass (addr, name, attr) 373 * 374 * Retrieve all values from attribute in all objects with given class 375 * name 376 */ 377int iriap_getvaluebyclass_request(struct iriap_cb *self, 378 __u32 saddr, __u32 daddr, 379 char *name, char *attr) 380{ 381 struct sk_buff *tx_skb; 382 int name_len, attr_len, skb_len; 383 __u8 *frame; 384 385 IRDA_ASSERT(self != NULL, return -1;); 386 IRDA_ASSERT(self->magic == IAS_MAGIC, return -1;); 387 388 /* Client must supply the destination device address */ 389 if (!daddr) 390 return -1; 391 392 self->daddr = daddr; 393 self->saddr = saddr; 394 395 /* 396 * Save operation, so we know what the later indication is about 397 */ 398 self->operation = GET_VALUE_BY_CLASS; 399 400 /* Give ourselves 10 secs to finish this operation */ 401 iriap_start_watchdog_timer(self, 10*HZ); 402 403 name_len = strlen(name); /* Up to IAS_MAX_CLASSNAME = 60 */ 404 attr_len = strlen(attr); /* Up to IAS_MAX_ATTRIBNAME = 60 */ 405 406 skb_len = self->max_header_size+2+name_len+1+attr_len+4; 407 tx_skb = alloc_skb(skb_len, GFP_ATOMIC); 408 if (!tx_skb) 409 return -ENOMEM; 410 411 /* Reserve space for MUX and LAP header */ 412 skb_reserve(tx_skb, self->max_header_size); 413 skb_put(tx_skb, 3+name_len+attr_len); 414 frame = tx_skb->data; 415 416 /* Build frame */ 417 frame[0] = IAP_LST | GET_VALUE_BY_CLASS; 418 frame[1] = name_len; /* Insert length of name */ 419 memcpy(frame+2, name, name_len); /* Insert name */ 420 frame[2+name_len] = attr_len; /* Insert length of attr */ 421 memcpy(frame+3+name_len, attr, attr_len); /* Insert attr */ 422 423 iriap_do_client_event(self, IAP_CALL_REQUEST_GVBC, tx_skb); 424 425 /* Drop reference count - see state_s_disconnect(). */ 426 dev_kfree_skb(tx_skb); 427 428 return 0; 429} 430EXPORT_SYMBOL(iriap_getvaluebyclass_request); 431 432/* 433 * Function iriap_getvaluebyclass_confirm (self, skb) 434 * 435 * Got result from GetValueByClass command. Parse it and return result 436 * to service user. 437 * 438 */ 439static void iriap_getvaluebyclass_confirm(struct iriap_cb *self, 440 struct sk_buff *skb) 441{ 442 struct ias_value *value; 443 int charset; 444 __u32 value_len; 445 __u32 tmp_cpu32; 446 __u16 obj_id; 447 __u16 len; 448 __u8 type; 449 __u8 *fp; 450 int n; 451 452 IRDA_ASSERT(self != NULL, return;); 453 IRDA_ASSERT(self->magic == IAS_MAGIC, return;); 454 IRDA_ASSERT(skb != NULL, return;); 455 456 /* Initialize variables */ 457 fp = skb->data; 458 n = 2; 459 460 /* Get length, MSB first */ 461 len = get_unaligned_be16(fp + n); 462 n += 2; 463 464 IRDA_DEBUG(4, "%s(), len=%d\n", __func__, len); 465 466 /* Get object ID, MSB first */ 467 obj_id = get_unaligned_be16(fp + n); 468 n += 2; 469 470 type = fp[n++]; 471 IRDA_DEBUG(4, "%s(), Value type = %d\n", __func__, type); 472 473 switch (type) { 474 case IAS_INTEGER: 475 memcpy(&tmp_cpu32, fp+n, 4); n += 4; 476 be32_to_cpus(&tmp_cpu32); 477 value = irias_new_integer_value(tmp_cpu32); 478 479 /* Legal values restricted to 0x01-0x6f, page 15 irttp */ 480 IRDA_DEBUG(4, "%s(), lsap=%d\n", __func__, value->t.integer); 481 break; 482 case IAS_STRING: 483 charset = fp[n++]; 484 485 switch (charset) { 486 case CS_ASCII: 487 break; 488/* case CS_ISO_8859_1: */ 489/* case CS_ISO_8859_2: */ 490/* case CS_ISO_8859_3: */ 491/* case CS_ISO_8859_4: */ 492/* case CS_ISO_8859_5: */ 493/* case CS_ISO_8859_6: */ 494/* case CS_ISO_8859_7: */ 495/* case CS_ISO_8859_8: */ 496/* case CS_ISO_8859_9: */ 497/* case CS_UNICODE: */ 498 default: 499 IRDA_DEBUG(0, "%s(), charset [%d] %s, not supported\n", 500 __func__, charset, 501 charset < ARRAY_SIZE(ias_charset_types) ? 502 ias_charset_types[charset] : 503 "(unknown)"); 504 505 /* Aborting, close connection! */ 506 iriap_disconnect_request(self); 507 return; 508 /* break; */ 509 } 510 value_len = fp[n++]; 511 IRDA_DEBUG(4, "%s(), strlen=%d\n", __func__, value_len); 512 513 /* Make sure the string is null-terminated */ 514 if (n + value_len < skb->len) 515 fp[n + value_len] = 0x00; 516 IRDA_DEBUG(4, "Got string %s\n", fp+n); 517 518 /* Will truncate to IAS_MAX_STRING bytes */ 519 value = irias_new_string_value(fp+n); 520 break; 521 case IAS_OCT_SEQ: 522 value_len = get_unaligned_be16(fp + n); 523 n += 2; 524 525 /* Will truncate to IAS_MAX_OCTET_STRING bytes */ 526 value = irias_new_octseq_value(fp+n, value_len); 527 break; 528 default: 529 value = irias_new_missing_value(); 530 break; 531 } 532 533 /* Finished, close connection! */ 534 iriap_disconnect_request(self); 535 536 /* Warning, the client might close us, so remember no to use self 537 * anymore after calling confirm 538 */ 539 if (self->confirm) 540 self->confirm(IAS_SUCCESS, obj_id, value, self->priv); 541 else { 542 IRDA_DEBUG(0, "%s(), missing handler!\n", __func__); 543 irias_delete_value(value); 544 } 545} 546 547/* 548 * Function iriap_getvaluebyclass_response () 549 * 550 * Send answer back to remote LM-IAS 551 * 552 */ 553static void iriap_getvaluebyclass_response(struct iriap_cb *self, 554 __u16 obj_id, 555 __u8 ret_code, 556 struct ias_value *value) 557{ 558 struct sk_buff *tx_skb; 559 int n; 560 __be32 tmp_be32; 561 __be16 tmp_be16; 562 __u8 *fp; 563 564 IRDA_DEBUG(4, "%s()\n", __func__); 565 566 IRDA_ASSERT(self != NULL, return;); 567 IRDA_ASSERT(self->magic == IAS_MAGIC, return;); 568 IRDA_ASSERT(value != NULL, return;); 569 IRDA_ASSERT(value->len <= 1024, return;); 570 571 /* Initialize variables */ 572 n = 0; 573 574 /* 575 * We must adjust the size of the response after the length of the 576 * value. We add 32 bytes because of the 6 bytes for the frame and 577 * max 5 bytes for the value coding. 578 */ 579 tx_skb = alloc_skb(value->len + self->max_header_size + 32, 580 GFP_ATOMIC); 581 if (!tx_skb) 582 return; 583 584 /* Reserve space for MUX and LAP header */ 585 skb_reserve(tx_skb, self->max_header_size); 586 skb_put(tx_skb, 6); 587 588 fp = tx_skb->data; 589 590 /* Build frame */ 591 fp[n++] = GET_VALUE_BY_CLASS | IAP_LST; 592 fp[n++] = ret_code; 593 594 /* Insert list length (MSB first) */ 595 tmp_be16 = htons(0x0001); 596 memcpy(fp+n, &tmp_be16, 2); n += 2; 597 598 /* Insert object identifier ( MSB first) */ 599 tmp_be16 = cpu_to_be16(obj_id); 600 memcpy(fp+n, &tmp_be16, 2); n += 2; 601 602 switch (value->type) { 603 case IAS_STRING: 604 skb_put(tx_skb, 3 + value->len); 605 fp[n++] = value->type; 606 fp[n++] = 0; /* ASCII */ 607 fp[n++] = (__u8) value->len; 608 memcpy(fp+n, value->t.string, value->len); n+=value->len; 609 break; 610 case IAS_INTEGER: 611 skb_put(tx_skb, 5); 612 fp[n++] = value->type; 613 614 tmp_be32 = cpu_to_be32(value->t.integer); 615 memcpy(fp+n, &tmp_be32, 4); n += 4; 616 break; 617 case IAS_OCT_SEQ: 618 skb_put(tx_skb, 3 + value->len); 619 fp[n++] = value->type; 620 621 tmp_be16 = cpu_to_be16(value->len); 622 memcpy(fp+n, &tmp_be16, 2); n += 2; 623 memcpy(fp+n, value->t.oct_seq, value->len); n+=value->len; 624 break; 625 case IAS_MISSING: 626 IRDA_DEBUG( 3, "%s: sending IAS_MISSING\n", __func__); 627 skb_put(tx_skb, 1); 628 fp[n++] = value->type; 629 break; 630 default: 631 IRDA_DEBUG(0, "%s(), type not implemented!\n", __func__); 632 break; 633 } 634 iriap_do_r_connect_event(self, IAP_CALL_RESPONSE, tx_skb); 635 636 /* Drop reference count - see state_r_execute(). */ 637 dev_kfree_skb(tx_skb); 638} 639 640/* 641 * Function iriap_getvaluebyclass_indication (self, skb) 642 * 643 * getvaluebyclass is requested from peer LM-IAS 644 * 645 */ 646static void iriap_getvaluebyclass_indication(struct iriap_cb *self, 647 struct sk_buff *skb) 648{ 649 struct ias_object *obj; 650 struct ias_attrib *attrib; 651 int name_len; 652 int attr_len; 653 char name[IAS_MAX_CLASSNAME + 1]; /* 60 bytes */ 654 char attr[IAS_MAX_ATTRIBNAME + 1]; /* 60 bytes */ 655 __u8 *fp; 656 int n; 657 658 IRDA_DEBUG(4, "%s()\n", __func__); 659 660 IRDA_ASSERT(self != NULL, return;); 661 IRDA_ASSERT(self->magic == IAS_MAGIC, return;); 662 IRDA_ASSERT(skb != NULL, return;); 663 664 fp = skb->data; 665 n = 1; 666 667 name_len = fp[n++]; 668 669 IRDA_ASSERT(name_len < IAS_MAX_CLASSNAME + 1, return;); 670 671 memcpy(name, fp+n, name_len); n+=name_len; 672 name[name_len] = '\0'; 673 674 attr_len = fp[n++]; 675 676 IRDA_ASSERT(attr_len < IAS_MAX_ATTRIBNAME + 1, return;); 677 678 memcpy(attr, fp+n, attr_len); n+=attr_len; 679 attr[attr_len] = '\0'; 680 681 IRDA_DEBUG(4, "LM-IAS: Looking up %s: %s\n", name, attr); 682 obj = irias_find_object(name); 683 684 if (obj == NULL) { 685 IRDA_DEBUG(2, "LM-IAS: Object %s not found\n", name); 686 iriap_getvaluebyclass_response(self, 0x1235, IAS_CLASS_UNKNOWN, 687 &irias_missing); 688 return; 689 } 690 IRDA_DEBUG(4, "LM-IAS: found %s, id=%d\n", obj->name, obj->id); 691 692 attrib = irias_find_attrib(obj, attr); 693 if (attrib == NULL) { 694 IRDA_DEBUG(2, "LM-IAS: Attribute %s not found\n", attr); 695 iriap_getvaluebyclass_response(self, obj->id, 696 IAS_ATTRIB_UNKNOWN, 697 &irias_missing); 698 return; 699 } 700 701 /* We have a match; send the value. */ 702 iriap_getvaluebyclass_response(self, obj->id, IAS_SUCCESS, 703 attrib->value); 704} 705 706/* 707 * Function iriap_send_ack (void) 708 * 709 * Currently not used 710 * 711 */ 712void iriap_send_ack(struct iriap_cb *self) 713{ 714 struct sk_buff *tx_skb; 715 __u8 *frame; 716 717 IRDA_DEBUG(2, "%s()\n", __func__); 718 719 IRDA_ASSERT(self != NULL, return;); 720 IRDA_ASSERT(self->magic == IAS_MAGIC, return;); 721 722 tx_skb = alloc_skb(LMP_MAX_HEADER + 1, GFP_ATOMIC); 723 if (!tx_skb) 724 return; 725 726 /* Reserve space for MUX and LAP header */ 727 skb_reserve(tx_skb, self->max_header_size); 728 skb_put(tx_skb, 1); 729 frame = tx_skb->data; 730 731 /* Build frame */ 732 frame[0] = IAP_LST | IAP_ACK | self->operation; 733 734 irlmp_data_request(self->lsap, tx_skb); 735} 736 737void iriap_connect_request(struct iriap_cb *self) 738{ 739 int ret; 740 741 IRDA_ASSERT(self != NULL, return;); 742 IRDA_ASSERT(self->magic == IAS_MAGIC, return;); 743 744 ret = irlmp_connect_request(self->lsap, LSAP_IAS, 745 self->saddr, self->daddr, 746 NULL, NULL); 747 if (ret < 0) { 748 IRDA_DEBUG(0, "%s(), connect failed!\n", __func__); 749 self->confirm(IAS_DISCONNECT, 0, NULL, self->priv); 750 } 751} 752 753/* 754 * Function iriap_connect_confirm (handle, skb) 755 * 756 * LSAP connection confirmed! 757 * 758 */ 759static void iriap_connect_confirm(void *instance, void *sap, 760 struct qos_info *qos, __u32 max_seg_size, 761 __u8 max_header_size, 762 struct sk_buff *skb) 763{ 764 struct iriap_cb *self; 765 766 self = instance; 767 768 IRDA_ASSERT(self != NULL, return;); 769 IRDA_ASSERT(self->magic == IAS_MAGIC, return;); 770 IRDA_ASSERT(skb != NULL, return;); 771 772 self->max_data_size = max_seg_size; 773 self->max_header_size = max_header_size; 774 775 del_timer(&self->watchdog_timer); 776 777 iriap_do_client_event(self, IAP_LM_CONNECT_CONFIRM, skb); 778 779 /* Drop reference count - see state_s_make_call(). */ 780 dev_kfree_skb(skb); 781} 782 783/* 784 * Function iriap_connect_indication ( handle, skb) 785 * 786 * Remote LM-IAS is requesting connection 787 * 788 */ 789static void iriap_connect_indication(void *instance, void *sap, 790 struct qos_info *qos, __u32 max_seg_size, 791 __u8 max_header_size, 792 struct sk_buff *skb) 793{ 794 struct iriap_cb *self, *new; 795 796 IRDA_DEBUG(1, "%s()\n", __func__); 797 798 self = instance; 799 800 IRDA_ASSERT(skb != NULL, return;); 801 IRDA_ASSERT(self != NULL, goto out;); 802 IRDA_ASSERT(self->magic == IAS_MAGIC, goto out;); 803 804 /* Start new server */ 805 new = iriap_open(LSAP_IAS, IAS_SERVER, NULL, NULL); 806 if (!new) { 807 IRDA_DEBUG(0, "%s(), open failed\n", __func__); 808 goto out; 809 } 810 811 /* Now attach up the new "socket" */ 812 new->lsap = irlmp_dup(self->lsap, new); 813 if (!new->lsap) { 814 IRDA_DEBUG(0, "%s(), dup failed!\n", __func__); 815 goto out; 816 } 817 818 new->max_data_size = max_seg_size; 819 new->max_header_size = max_header_size; 820 821 /* Clean up the original one to keep it in listen state */ 822 irlmp_listen(self->lsap); 823 824 iriap_do_server_event(new, IAP_LM_CONNECT_INDICATION, skb); 825 826out: 827 /* Drop reference count - see state_r_disconnect(). */ 828 dev_kfree_skb(skb); 829} 830 831/* 832 * Function iriap_data_indication (handle, skb) 833 * 834 * Receives data from connection identified by handle from IrLMP 835 * 836 */ 837static int iriap_data_indication(void *instance, void *sap, 838 struct sk_buff *skb) 839{ 840 struct iriap_cb *self; 841 __u8 *frame; 842 __u8 opcode; 843 844 IRDA_DEBUG(3, "%s()\n", __func__); 845 846 self = instance; 847 848 IRDA_ASSERT(skb != NULL, return 0;); 849 IRDA_ASSERT(self != NULL, goto out;); 850 IRDA_ASSERT(self->magic == IAS_MAGIC, goto out;); 851 852 frame = skb->data; 853 854 if (self->mode == IAS_SERVER) { 855 /* Call server */ 856 IRDA_DEBUG(4, "%s(), Calling server!\n", __func__); 857 iriap_do_r_connect_event(self, IAP_RECV_F_LST, skb); 858 goto out; 859 } 860 opcode = frame[0]; 861 if (~opcode & IAP_LST) { 862 IRDA_WARNING("%s:, IrIAS multiframe commands or " 863 "results is not implemented yet!\n", 864 __func__); 865 goto out; 866 } 867 868 /* Check for ack frames since they don't contain any data */ 869 if (opcode & IAP_ACK) { 870 IRDA_DEBUG(0, "%s() Got ack frame!\n", __func__); 871 goto out; 872 } 873 874 opcode &= ~IAP_LST; /* Mask away LST bit */ 875 876 switch (opcode) { 877 case GET_INFO_BASE: 878 IRDA_DEBUG(0, "IrLMP GetInfoBaseDetails not implemented!\n"); 879 break; 880 case GET_VALUE_BY_CLASS: 881 iriap_do_call_event(self, IAP_RECV_F_LST, NULL); 882 883 switch (frame[1]) { 884 case IAS_SUCCESS: 885 iriap_getvaluebyclass_confirm(self, skb); 886 break; 887 case IAS_CLASS_UNKNOWN: 888 IRDA_DEBUG(1, "%s(), No such class!\n", __func__); 889 /* Finished, close connection! */ 890 iriap_disconnect_request(self); 891 892 /* 893 * Warning, the client might close us, so remember 894 * no to use self anymore after calling confirm 895 */ 896 if (self->confirm) 897 self->confirm(IAS_CLASS_UNKNOWN, 0, NULL, 898 self->priv); 899 break; 900 case IAS_ATTRIB_UNKNOWN: 901 IRDA_DEBUG(1, "%s(), No such attribute!\n", __func__); 902 /* Finished, close connection! */ 903 iriap_disconnect_request(self); 904 905 /* 906 * Warning, the client might close us, so remember 907 * no to use self anymore after calling confirm 908 */ 909 if (self->confirm) 910 self->confirm(IAS_ATTRIB_UNKNOWN, 0, NULL, 911 self->priv); 912 break; 913 } 914 break; 915 default: 916 IRDA_DEBUG(0, "%s(), Unknown op-code: %02x\n", __func__, 917 opcode); 918 break; 919 } 920 921out: 922 /* Cleanup - sub-calls will have done skb_get() as needed. */ 923 dev_kfree_skb(skb); 924 return 0; 925} 926 927/* 928 * Function iriap_call_indication (self, skb) 929 * 930 * Received call to server from peer LM-IAS 931 * 932 */ 933void iriap_call_indication(struct iriap_cb *self, struct sk_buff *skb) 934{ 935 __u8 *fp; 936 __u8 opcode; 937 938 IRDA_DEBUG(4, "%s()\n", __func__); 939 940 IRDA_ASSERT(self != NULL, return;); 941 IRDA_ASSERT(self->magic == IAS_MAGIC, return;); 942 IRDA_ASSERT(skb != NULL, return;); 943 944 fp = skb->data; 945 946 opcode = fp[0]; 947 if (~opcode & 0x80) { 948 IRDA_WARNING("%s: IrIAS multiframe commands or results " 949 "is not implemented yet!\n", __func__); 950 return; 951 } 952 opcode &= 0x7f; /* Mask away LST bit */ 953 954 switch (opcode) { 955 case GET_INFO_BASE: 956 IRDA_WARNING("%s: GetInfoBaseDetails not implemented yet!\n", 957 __func__); 958 break; 959 case GET_VALUE_BY_CLASS: 960 iriap_getvaluebyclass_indication(self, skb); 961 break; 962 } 963 /* skb will be cleaned up in iriap_data_indication */ 964} 965 966/* 967 * Function iriap_watchdog_timer_expired (data) 968 * 969 * Query has taken too long time, so abort 970 * 971 */ 972static void iriap_watchdog_timer_expired(void *data) 973{ 974 struct iriap_cb *self = (struct iriap_cb *) data; 975 976 IRDA_ASSERT(self != NULL, return;); 977 IRDA_ASSERT(self->magic == IAS_MAGIC, return;); 978 979 /* iriap_close(self); */ 980} 981 982#ifdef CONFIG_PROC_FS 983 984static const char *const ias_value_types[] = { 985 "IAS_MISSING", 986 "IAS_INTEGER", 987 "IAS_OCT_SEQ", 988 "IAS_STRING" 989}; 990 991static inline struct ias_object *irias_seq_idx(loff_t pos) 992{ 993 struct ias_object *obj; 994 995 for (obj = (struct ias_object *) hashbin_get_first(irias_objects); 996 obj; obj = (struct ias_object *) hashbin_get_next(irias_objects)) { 997 if (pos-- == 0) 998 break; 999 } 1000 1001 return obj; 1002} 1003 1004static void *irias_seq_start(struct seq_file *seq, loff_t *pos) 1005{ 1006 spin_lock_irq(&irias_objects->hb_spinlock); 1007 1008 return *pos ? irias_seq_idx(*pos - 1) : SEQ_START_TOKEN; 1009} 1010 1011static void *irias_seq_next(struct seq_file *seq, void *v, loff_t *pos) 1012{ 1013 ++*pos; 1014 1015 return (v == SEQ_START_TOKEN) 1016 ? (void *) hashbin_get_first(irias_objects) 1017 : (void *) hashbin_get_next(irias_objects); 1018} 1019 1020static void irias_seq_stop(struct seq_file *seq, void *v) 1021{ 1022 spin_unlock_irq(&irias_objects->hb_spinlock); 1023} 1024 1025static int irias_seq_show(struct seq_file *seq, void *v) 1026{ 1027 if (v == SEQ_START_TOKEN) 1028 seq_puts(seq, "LM-IAS Objects:\n"); 1029 else { 1030 struct ias_object *obj = v; 1031 struct ias_attrib *attrib; 1032 1033 IRDA_ASSERT(obj->magic == IAS_OBJECT_MAGIC, return -EINVAL;); 1034 1035 seq_printf(seq, "name: %s, id=%d\n", 1036 obj->name, obj->id); 1037 1038 /* Careful for priority inversions here ! 1039 * All other uses of attrib spinlock are independent of 1040 * the object spinlock, so we are safe. Jean II */ 1041 spin_lock(&obj->attribs->hb_spinlock); 1042 1043 /* List all attributes for this object */ 1044 for (attrib = (struct ias_attrib *) hashbin_get_first(obj->attribs); 1045 attrib != NULL; 1046 attrib = (struct ias_attrib *) hashbin_get_next(obj->attribs)) { 1047 1048 IRDA_ASSERT(attrib->magic == IAS_ATTRIB_MAGIC, 1049 goto outloop; ); 1050 1051 seq_printf(seq, " - Attribute name: \"%s\", ", 1052 attrib->name); 1053 seq_printf(seq, "value[%s]: ", 1054 ias_value_types[attrib->value->type]); 1055 1056 switch (attrib->value->type) { 1057 case IAS_INTEGER: 1058 seq_printf(seq, "%d\n", 1059 attrib->value->t.integer); 1060 break; 1061 case IAS_STRING: 1062 seq_printf(seq, "\"%s\"\n", 1063 attrib->value->t.string); 1064 break; 1065 case IAS_OCT_SEQ: 1066 seq_printf(seq, "octet sequence (%d bytes)\n", 1067 attrib->value->len); 1068 break; 1069 case IAS_MISSING: 1070 seq_puts(seq, "missing\n"); 1071 break; 1072 default: 1073 seq_printf(seq, "type %d?\n", 1074 attrib->value->type); 1075 } 1076 seq_putc(seq, '\n'); 1077 1078 } 1079 IRDA_ASSERT_LABEL(outloop:) 1080 spin_unlock(&obj->attribs->hb_spinlock); 1081 } 1082 1083 return 0; 1084} 1085 1086static const struct seq_operations irias_seq_ops = { 1087 .start = irias_seq_start, 1088 .next = irias_seq_next, 1089 .stop = irias_seq_stop, 1090 .show = irias_seq_show, 1091}; 1092 1093static int irias_seq_open(struct inode *inode, struct file *file) 1094{ 1095 IRDA_ASSERT( irias_objects != NULL, return -EINVAL;); 1096 1097 return seq_open(file, &irias_seq_ops); 1098} 1099 1100const struct file_operations irias_seq_fops = { 1101 .owner = THIS_MODULE, 1102 .open = irias_seq_open, 1103 .read = seq_read, 1104 .llseek = seq_lseek, 1105 .release = seq_release, 1106}; 1107 1108#endif /* PROC_FS */